key=KEY_Scan(0); //得到鍵值
if(key)
{
switch(key)
{
case KEYA_PRES://前進
switch(numval)
{
case 1: pwmval=350; pwmval4=0;break;
case 2: pwmval=450; pwmval4=0;break;
case 3: pwmval=550; pwmval4=0;break;
case 4: pwmval=650; pwmval4=0;break;
case 5: pwmval=750; pwmval4=0;break;
case 6: pwmval=899; pwmval4=0;break;
}
INA3_0; INA4_0;
TIM_SetCompare2(TIM3,pwmval); //pwm輸出函數
TIM_SetCompare1(TIM4,pwmval4);
break;
case KEYB_PRES://后退
switch(numval4)
{
case 1: pwmval4=350;pwmval=0;break;
case 2: pwmval4=450;pwmval=0;break;
case 3: pwmval4=550;pwmval=0;break;
case 4: pwmval4=650;pwmval=0;break;
case 5: pwmval4=750;pwmval=0;break;
case 6: pwmval4=899;pwmval=0;break;
}
INA3_0; INA4_0;
TIM_SetCompare2(TIM3,pwmval); //pwm輸出函數
TIM_SetCompare1(TIM4,pwmval4);
break;
case KEYC_PRES: //左轉
INA3_1
INA4_0
TIM_SetCompare2(TIM3,pwmval); //pwm輸出函數
TIM_SetCompare1(TIM4,pwmval4);
break;
case KEYD_PRES: //右轉