#include "bsp_moto.h"
#include "c_delay.h"
#include "debug_drv.h"
TS_moto_ ts_moto=
{
	D_MOTO_STOP

};

void L0_moto_run(unsigned char mode)
{
	switch (mode)
	{
		case D_MOTO_FORWARD:
			D_Motor_BI_ON();
			///D_Motor_BI_OFF();			
			///D_Motor_FI_ON(); 
			D_Motor_FI_OFF();
			ts_moto.mode = mode|0x80;
	printf(" F ");
			break;
		case D_MOTO_BACKWARD:
			///D_Motor_BI_ON();
			D_Motor_BI_OFF();			
			D_Motor_FI_ON(); 
			ts_moto.mode = mode|0x80;

	printf(" B ");
			///D_Motor_FI_OFF();
		break;
		case D_MOTO_STOP:
			D_Motor_BI_ON();
			///D_Motor_BI_OFF();			
			D_Motor_FI_ON(); 
			ts_moto.mode = mode;
	printf(" T ");
			///D_Motor_FI_OFF();
		break;
		default :
			///D_Motor_BI_ON();
			D_Motor_BI_OFF();			
			///D_Motor_FI_ON(); 
			D_Motor_FI_OFF();
			ts_moto.mode = mode;
		////:D_MOTO_STANDBY
	printf(" S ");
		break;
	}
}


void L0_moto_init(unsigned char onf)
{
	if(onf)
	{
		L0_moto_run(D_MOTO_STANDBY);
		D_MOTOR_IO_OPEN();

	printf("\r\nD_MOTOR_IO_OPEN\r\n");

	}else
	{
		L0_moto_run(D_MOTO_STANDBY);
		D_MOTOR_IO_CLOSE();
	}
}