main.c

来自「设计大赛寻迹小车题目程序」· C语言 代码 · 共 60 行

/*******************************************************************************
** 文件名：main.c   工程主文件
*******************************************************************************/
#include "config.h"

volatile uint8 flag; //小车状态
//0未偏 1左偏 2右偏 3前出线 4后出线 5脱轨
void main(void)
{
 init_devices();
 straight();
 
 flag_test();  //测试小车状态
 while(1) //没有脱轨
 {
  flag_test();
  switch(flag)
  {
  case 0:      //正常情况将速度设成相等
    motor_right_speed_set(0xFE);
    motor_left_speed_set(0xFE);
    break;
  case 1:
   mic_turn_right();
   break;
  case 2:
   mic_turn_left();
   break;
  case 3:
   break;
  case 4:
   break;
  case 5:
   stop();
   break;
  default:
   break;
  }
 }
}//end main

/** moto test  *****************************************************************
void main(void)
{
 init_devices();
 
   straight();
    Delay1s(5);
   turn_left();
    Delay1s(5);
   turn_right();
    Delay1s(5);
   straight_back();
    Delay1s(5);
   stop();
 
 while(1)
 ;
}
*******************************************************************************/