#include "DebugOpt.h"

uint8_t DebugOpt::led_flow_cnt = 0;
bool DebugOpt::led_flow_switch = true;

void DebugOpt::DoLEDFlow()
{
	if (!led_flow_switch)
		return;
	switch (led_flow_cnt)
	{
	case 0:
		CoreLED.TurnOn(LED1);
		CoreLED.TurnOff(LED2);
		CoreLED.TurnOff(LED3);
		CoreLED.TurnOff(LED4);

		digitalWrite(LED_BUILTIN, HIGH);
		break;
	case 1:
		CoreLED.TurnOff(LED1);
		CoreLED.TurnOn(LED2);
		CoreLED.TurnOff(LED3);
		CoreLED.TurnOff(LED4);

		digitalWrite(LED_BUILTIN, LOW);
		break;
	case 2:
		CoreLED.TurnOff(LED1);
		CoreLED.TurnOff(LED2);
		CoreLED.TurnOn(LED3);
		CoreLED.TurnOff(LED4);

		digitalWrite(LED_BUILTIN, LOW);
		break;
	case 3:
		CoreLED.TurnOff(LED1);
		CoreLED.TurnOff(LED2);
		CoreLED.TurnOff(LED3);
		CoreLED.TurnOn(LED4);

		digitalWrite(LED_BUILTIN, LOW);
		break;
	}
	led_flow_cnt++;
	if (led_flow_cnt >= 4)
		led_flow_cnt = 0;
	delay(15);
}

void DebugOpt::DebugRun()
{
	LED.LeftTurnOn();
	LED.RightTurnOn();
	BEEP.TurnOn();
	delay(100);
	BEEP.TurnOff();
	/*AccurateMotor.RunForward(10);
	AccurateMotor.DelayUntilCarStop();
	AccurateMotor.RunBackward(10);
	AccurateMotor.DelayUntilCarStop();
	AccurateMotor.TurnLeft(20);
	AccurateMotor.DelayUntilCarStop();
	AccurateMotor.TurnRight(20);
	AccurateMotor.DelayUntilCarStop();*/
	AccurateMotor.TurnRight(180);
	AccurateMotor.DelayUntilCarStop();
	AccurateMotor.RunForward(10);
	AccurateMotor.DelayUntilCarStop();
	BEEP.TurnOn();
	delay(100);
	BEEP.TurnOff();
	LED.LeftTurnOff();
	LED.RightTurnOff();
}

void DebugOpt::DebugServo()
{
	for (int i = -80; i <= 20; i++)
	{
		OpenMVOpt::Servo_Control(i);
		delay(50);
	}
	OpenMVOpt::Servo_Control(0);
}

void DebugOpt::LEDFlowOn()
{
	led_flow_switch = true;
}

void DebugOpt::LEDFlowOff()
{
	led_flow_switch = false;
}

void DebugOpt::Road_Gate_Test()
{
	BarrierCommand b_cmd;
	ZigBeeOperator.SendCommand(b_cmd.CMD_GateDown());
}

void DebugOpt::Speech_Sounds_Ctr()
{
	//ExtSRAMInterface.ExMem_Write_Bytes(0x6180, voive_test_buf, 13);
}

void DebugOpt::Speech_Disc()
{
	uint8_t sph_id = 0;
	/*0为控制语音播报标志物随机播报并开启识别，
	2-6为指定词条识别，具体信息可查看通信协议*/
	sph_id = BKRC_Voice.BKRC_Voice_Extern(0);
	delay(200);
	//Serial.print("识别到的词条ID为：");
	//Serial.println(sph_id, HEX);
	//voice_trm_buf[2] = sph_id;
	//ExtSRAMInterface.ExMem_Write_Bytes(0x6008, voice_trm_buf, 8);//上传识别结果至评分终端
}

void DebugOpt::Infrared_Test()
{
	//Infrare.Transmition(ir_repo_buf, 6);
}