设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › MicroMouse高级实验源码
返回列表 发新帖
查看: 2023|回复: 0
打印 上一主题 下一主题
收起左侧

MicroMouse高级实验源码

[复制链接]
跳转到指定楼层
楼主
ID:320785 发表于 2018-10-1 16:37 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
MicroMouse源程序如下:
  1. /****************************************Copyright (c)****************************************************
  2. **                            Guangzhou ZHIYUAN electronics Co.,LTD.
  3. **
  4. **
  5. **--------------File Info---------------------------------------------------------------------------------
  6. ** File name:           main.c
  7. ** Last modified Date:  2011-03-11
  8. ** Last Version:        V1.01
  9. ** Descriptions:        The main() function example template
  10. **
  11. **--------------------------------------------------------------------------------------------------------
  12. ** Created by:          廖茂刚
  13. ** Created date:        2008-02-14
  14. ** Version:             V1.00
  15. ** Descriptions:        MicroMouse615上的无记忆功能的走迷宫实验
  16. **
  17. **--------------------------------------------------------------------------------------------------------
  18. ** Modified by:         FanLinyun
  19. ** Modified date:       2011-03-11
  20. ** Version:             V1.01
  21. ** Descriptions:        移植到MicroMouse1752上
  22. **
  23. ** Rechecked by:        
  24. *********************************************************************************************************/
  25. #include "..\config.h"

  27. /*********************************************************************************************************
  28.   按键宏定义
  29. *********************************************************************************************************/
  30. #define  KEY                        (1 << 6)                            /*  按键连接的端口              */
  31. #define  KEY_PRESS()                (!(FIO2PIN & KEY))                  /*  按键是否按下判断            */

  33. /*********************************************************************************************************
  34.   IR相关宏定义
  35. *********************************************************************************************************/
  36. #define IR_SIDE_LFT                 (1ul << 0)                          /*  左方传感器输出的信号        */
  37. #define IR_DIG_LFT                  (1ul << 1)                          /*  左前方传感器输出的信号      */
  38. #define IR_FRONT                    (1ul << 4)                          /*  前方传感器输出的信号        */
  39. #define IR_DIG_RGT                  (1ul << 8)                          /*  右前方传感器输出的信号      */
  40. #define IR_SIDE_RGT                 (1ul << 9)                          /*  右方传感器输出的信号        */

  42. #define FRONT_SIDE_PWM_INDEX        1                                   /*  左前右驱动传感器PWM索引号   */
  43. #define DIG_PWM_INDEX               2                                   /*  左前右前驱动传感器PWM索引号 */

  45. #define PWM_RESET()                 PWM1TCR  = 0x02                     /*  PWM复位                     */
  46. #define PWM_START()                 PWM1TCR  = 0x05                     /*  PWM使能                     */

  48. #define PWM_FRQ_SET(x)              PWM1MR0 = (FPCLK / (x))             /*  PWM频率设置                 */

  50. #define FRONTSIDE_PWM_PULSE_SET(x)  PWM1MR2 = (x)                       /*  左前右PWM占空比设置         */
  51. #define DIG_PWM_PULSE_SET(x)        PWM1MR1 = (x)                       /*  左前右前PWM占空比设置       */

  53. #define FRONTSIDE_PWM_EN()          PWM1PCR |= (1 << 10)                /*  左前右PWM输出使能           */
  54. #define DIG_PWM_EN()                PWM1PCR |= (1 << 9)                 /*  左前右前PWM输出使能         */

  56. #define FRONTSIDE_PWM_DIS()         PWM1PCR &= ~(1 << 10)               /*  左前右PWM输出禁能           */
  57. #define DIG_PWM_DIS()               PWM1PCR &= ~(1 << 9)                /*  左前右前PWM输出禁能         */

  59. #define IR_PIN_MODE_IN()            FIO1DIR &=                         /*  配置传感器检测引脚为输入    */\
  60.                 ~(IR_SIDE_LFT | IR_DIG_LFT | IR_FRONT | IR_DIG_RGT | IR_SIDE_RGT)
  61. #define IR_READ()                   FIO1PIN                             /*  红外信号读取                */

  63. /*********************************************************************************************************
  64.   电机相关宏定义
  65. *********************************************************************************************************/
  66. /*
  67. *  左电机接口
  68. */
  69. #define MT_LFT_A1           (1 << 2)
  70. #define MT_LFT_A2           (1 << 3)
  71. #define MT_LFT_B1           (1 << 4)
  72. #define MT_LFT_B2           (1 << 5)

  74. /*
  75. *  右电机接口
  76. */
  77. #define MT_RGT_A1           (1 << 25)
  78. #define MT_RGT_A2           (1 << 26)
  79. #define MT_RGT_B1           (1 << 28)
  80. #define MT_RGT_B2           (1 << 29)

  82. /*
  83. *  左电机拍数宏定义
  84. */
  85. #define MT_LFT_OFF()        FIO2CLR = (MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2)
  86. #define MT_LFT_STEP1_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  87.                             FIO2SET = MT_LFT_A1
  88. #define MT_LFT_STEP2_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  89.                             FIO2SET = MT_LFT_A1 | MT_LFT_B1
  90. #define MT_LFT_STEP3_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  91.                             FIO2SET = MT_LFT_B1
  92. #define MT_LFT_STEP4_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  93.                             FIO2SET = MT_LFT_A2 | MT_LFT_B1
  94. #define MT_LFT_STEP5_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  95.                             FIO2SET = MT_LFT_A2
  96. #define MT_LFT_STEP6_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  97.                             FIO2SET = MT_LFT_A2 | MT_LFT_B2
  98. #define MT_LFT_STEP7_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  99.                             FIO2SET = MT_LFT_B2
  100. #define MT_LFT_STEP8_SET()  FIO2CLR = MT_LFT_A1 | MT_LFT_A2 | MT_LFT_B1 | MT_LFT_B2;    \
  101.                             FIO2SET = MT_LFT_A1 | MT_LFT_B2
  102. /*
  103. *  右电机拍数宏定义
  104. */
  105. #define MT_RGT_OFF()        FIO1CLR = (MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2)
  106. #define MT_RGT_STEP1_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  107.                             FIO1SET = MT_RGT_A1
  108. #define MT_RGT_STEP2_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  109.                             FIO1SET = MT_RGT_A1 | MT_RGT_B1
  110. #define MT_RGT_STEP3_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  111.                             FIO1SET = MT_RGT_B1
  112. #define MT_RGT_STEP4_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  113.                             FIO1SET = MT_RGT_A2 | MT_RGT_B1
  114. #define MT_RGT_STEP5_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  115.                             FIO1SET = MT_RGT_A2
  116. #define MT_RGT_STEP6_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  117.                             FIO1SET = MT_RGT_A2 | MT_RGT_B2
  118. #define MT_RGT_STEP7_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  119.                             FIO1SET = MT_RGT_B2
  120. #define MT_RGT_STEP8_SET()  FIO1CLR = MT_RGT_A1 | MT_RGT_A2 | MT_RGT_B1 | MT_RGT_B2;    \
  121.                             FIO1SET = MT_RGT_A1 | MT_RGT_B2

  123. /*********************************************************************************************************
  124.   定时器宏定义
  125. *********************************************************************************************************/
  126. #define TIMER0_INT_CLR()    T0IR = 0x01                                 /*  定时器0清中断标志           */
  127. #define TIMER1_INT_CLR()    T1IR = 0x01                                 /*  定时器1清中断标志           */

  129. #define TIMER0_LOAD_SET(x)  T0TCR  = 0x02;                            /*  定时器0装载值设定           */ \
  130.                             T0MR0  = x;    \
  131.                             T0TCR  = 0x01
  132. #define TIMER1_LOAD_SET(x)  T1TCR  = 0x02;                            /*  定时器1装载值设定           */ \
  133.                             T1MR0  = x;    \
  134.                             T1TCR  = 0x01

  136. /*********************************************************************************************************
  137.   前进一个迷宫格步进电机需要走的步数宏定义
  138. *********************************************************************************************************/
  139. #define ONE_BLOCK           125

  141. /*********************************************************************************************************
  142.   电脑鼠状态宏定义
  143. *********************************************************************************************************/
  144. #define STOP               0                                            /*  电脑鼠停止                  */
  145. #define GO_AHEAD           1                                            /*  电脑鼠前进                  */
  146. #define TURN_LEFT          3                                            /*  电脑鼠向左转                */
  147. #define TURN_RIGHT         4                                            /*  电脑鼠向右转                */
  148. #define TURN_BACK          5                                            /*  电脑鼠向后转                */

  150. /*********************************************************************************************************
  151.   传感器宏定义
  152. *********************************************************************************************************/
  153. #define LEFT               0                                            /*  左方传感器                  */
  154. #define FRONTL             1                                            /*  左前方传感器                */
  155. #define FRONT              2                                            /*  前方传感器                  */
  156. #define FRONTR             3                                            /*  右前方传感器                */
  157. #define RIGHT              4                                            /*  右方传感器                  */

  159. /*********************************************************************************************************
  160.   电机状态宏定义
  161. *********************************************************************************************************/
  162. #define MOTOR_STOP         0                                            /*  电机停止                    */
  163. #define WAITONE_STEP       1                                            /*  电机暂停一步                */
  164. #define MOTOR_RUN          2                                            /*  电机运行                    */

  166. /*********************************************************************************************************
  167.   常量宏定义--电机运行方向
  168. *********************************************************************************************************/
  169. #define MOTOR_GO_AHEAD     0                                            /*  电机前进                    */
  170. #define MOTOR_GO_BACK      1                                            /*  电机后退                    */


  173. /*********************************************************************************************************
  174.   结构体定义
  175. *********************************************************************************************************/
  176. struct motor {
  177.     volatile INT8S    cState;                                           /*  电机运行状态                */
  178.     volatile INT8S    cDir;                                             /*  电机运行方向                */
  179.     volatile INT32U   ulPulse;                                          /*  电机需要转动的步数          */
  180.     volatile INT32U   ulPulseCtr;                                       /*  电机已转动的步数            */
  181.     volatile INT32S   lSpeed;                                           /*  电机转动速度                */
  182. };
  183. typedef struct motor MOTOR;

  185. /*********************************************************************************************************
  186.   定义全局变量
  187. *********************************************************************************************************/
  188. static MOTOR   GmRight  = {MOTOR_STOP, MOTOR_GO_AHEAD, 0, 0, 0};        /*  定义并初始化右电机状态      */
  189. static MOTOR   GmLeft   = {MOTOR_STOP, MOTOR_GO_AHEAD, 0, 0, 0};        /*  定义并初始化左电机状态      */
  190.                                                                         
  191. static volatile INT8U GucMouseState = STOP;                             /*  保存电脑鼠当前运行状态      */
  192. static INT32U GulAccelTable[300]    = {0};                              /*  电机加减速各阶段定时器值    */
  193. static INT32S GlMaxSpeed            = 60;                               /*  保存允许运行的最大速度      */

  195. static volatile INT8U GucDistance[5]    = {0};                          /*  记录传感器状态              */

  197. /*********************************************************************************************************
  198. ** Function name:       myDelay
  199. ** Descriptions:        软件延时
  200. ** input parameters:    延时时间，单位为us
  201. ** output parameters:   无
  202. ** Returned value:      无
  203. *********************************************************************************************************/
  204. void delayMs(INT32U ulTime)
  205. {
  206.     INT32U i;
  207.     while (ulTime--) {
  208.       for (i = 0; i < (FCCLK / 1000 / 3); i++);
  209.     }
  210. }
  211. /*********************************************************************************************************
  212. ** Function name:       lftMtCtrl
  213. ** Descriptions:        左步进电机驱动时序
  214. ** input parameters:    GmLeft.cDir :电机运行方向
  215. ** output parameters:   无
  216. ** Returned value:      无
  217. *********************************************************************************************************/
  218. void  lftMtCtrl (void)
  219. {
  220.     static INT8U ucRunStep = 0;                                         /*  保存电机当前位置            */
  221.    
  222.     switch (GmLeft.cDir) {
  223.     case MOTOR_GO_AHEAD:                                                /*  向前步进                    */
  224.         if (++ucRunStep >= 8) {
  225.             ucRunStep = 0;
  226.         }
  227.         break;
  228.     case MOTOR_GO_BACK:                                                 /*  向后步进                    */
  229.         if (--ucRunStep >= 8) {                                         /*  溢出                        */
  230.             ucRunStep = 7;
  231.         }
  232.         break;
  233.     default:
  234.         break;
  235.     }
  236.    
  237.     switch (ucRunStep) {                                                /*  执行步进电机时序            */
  238.     case 0:
  239.         MT_LFT_STEP1_SET();
  240.         break;
  241.     case 1:
  242.         MT_LFT_STEP2_SET();
  243.         break;
  244.     case 2:
  245.         MT_LFT_STEP3_SET();
  246.         break;
  247.     case 3:
  248.         MT_LFT_STEP4_SET();
  249.         break;
  250.     case 4:
  251.         MT_LFT_STEP5_SET();
  252.         break;
  253.     case 5:
  254.         MT_LFT_STEP6_SET();
  255.         break;
  256.     case 6:
  257.         MT_LFT_STEP7_SET();
  258.         break;
  259.     case 7:
  260.         MT_LFT_STEP8_SET();
  261.         break;
  262.     default:
  263.         break;
  264.     }
  265. }


  268. /*********************************************************************************************************
  269. ** Function name:       rgtMtCtrl
  270. ** Descriptions:        右步进电机驱动时序
  271. ** input parameters:    无
  272. ** output parameters:   无
  273. ** Returned value:      无
  274. *********************************************************************************************************/
  275. void  rgtMtCtrl (void)
  276. {
  277.     static INT8U ucRunStep = 0;                                         /*  保存电机当前位置            */
  278.    
  279.     switch (GmRight.cDir) {
  280.     case MOTOR_GO_AHEAD:                                                /*  向前步进                    */
  281.         if (--ucRunStep >= 8) {                                         /*  溢出                        */
  282.             ucRunStep = 7;
  283.         }
  284.         break;
  285.     case MOTOR_GO_BACK:                                                 /*  向后步进                    */
  286.         if (++ucRunStep >= 8) {
  287.             ucRunStep = 0;
  288.         }
  289.         break;
  290.     default:
  291.         break;
  292.     }
  293.    
  294.     switch (ucRunStep) {                                                /*  执行步进电机时序            */
  295.     case 0:
  296.         MT_RGT_STEP1_SET();
  297.         break;
  298.     case 1:
  299.         MT_RGT_STEP2_SET();
  300.         break;
  301.     case 2:
  302.         MT_RGT_STEP3_SET();
  303.         break;
  304.     case 3:
  305.         MT_RGT_STEP4_SET();
  306.         break;
  307.     case 4:
  308.         MT_RGT_STEP5_SET();
  309.         break;
  310.     case 5:
  311.         MT_RGT_STEP6_SET();
  312.         break;
  313.     case 6:
  314.         MT_RGT_STEP7_SET();
  315.         break;
  316.     case 7:
  317.         MT_RGT_STEP8_SET();
  318.         break;
  319.     default:
  320.         break;
  321.     }
  322. }


  325. /*********************************************************************************************************
  326. ** Function name:       lftMtSpeedCtrl
  327. ** Descriptions:        左电机速度调节
  328. ** input parameters:    无
  329. ** output parameters:   无
  330. ** Returned value:      无
  331. *********************************************************************************************************/
  332. void lftMtSpeedCtrl (void)
  333. {
  334.     INT32S lDownPusle;
  335.    
  336.     lDownPusle = GmLeft.ulPulse - GmLeft.ulPulseCtr;                    /*  统计电机还剩余的步数        */
  337.     if (lDownPusle <= GmLeft.lSpeed) {
  338.         GmLeft.lSpeed--;
  339.     } else {                                                            /*  非减速区间，则加速到最大值  */
  340.         if (GmLeft.lSpeed < GlMaxSpeed) {
  341.             GmLeft.lSpeed++;
  342.         }
  343.     }
  344.     if (GmLeft.lSpeed < 0) {                                            /*  设置速度下限                */
  345.         GmLeft.lSpeed = 0;
  346.     }
  347.    
  348.     TIMER0_LOAD_SET(GulAccelTable[GmLeft.lSpeed]);                     /*  设置定时时间                 */
  349. }

  351. /*********************************************************************************************************
  352. ** Function name:       rgtMtSpeedCtrl
  353. ** Descriptions:        右电机速度调节
  354. ** input parameters:    无
  355. ** output parameters:   无
  356. ** Returned value:      无
  357. *********************************************************************************************************/
  358. void rgtMtSpeedCtrl (void)
  359. {
  360.     INT32S lDownPusle;
  361.    
  362.     lDownPusle = GmRight.ulPulse - GmRight.ulPulseCtr;                  /*  统计电机还剩余的步数        */
  363.     if (lDownPusle <= GmRight.lSpeed) {
  364.         GmRight.lSpeed--;
  365.     } else {                                                            /*  非减速区间，则加速到最大值  */
  366.         if (GmRight.lSpeed < GlMaxSpeed) {
  367.             GmRight.lSpeed++;
  368.         } else {
  369.             GmRight.lSpeed--;
  370.         }
  371.     }
  372.     if (GmRight.lSpeed < 0) {                                           /*  设置速度下限                */
  373.         GmRight.lSpeed = 0;
  374.     }

  376.     TIMER1_LOAD_SET(GulAccelTable[GmRight.lSpeed]);                     /*  设置定时时间                */

  378. }

  380. /*********************************************************************************************************
  381. ** Function name:       timer0Isr
  382. ** Descriptions:        Timer0中断服务函数
  383. ** input parameters:    GmLeft.cState :驱动步进电机的时序状态
  384. **                      GmLeft.cDir   :步进电机运动的方向
  385. ** output parameters:   无
  386. ** Returned value:      无
  387. *********************************************************************************************************/
  388. void timer0Isr(void)
  389. {
  390.     static INT8S ucCnt1 = 0, ucCnt2 = 0;                                /*  修正姿态计数变量            */
  391.     TIMER0_INT_CLR();                                                   /*  清除中断标志                */

  393.     switch (GmLeft.cState) {        
  394.     case MOTOR_STOP:                                                    /*  停止，同时清零速度和脉冲值  */
  395.         GmLeft.lSpeed     = 0;
  396.         GmLeft.ulPulse    = 0;
  397.         GmLeft.ulPulseCtr = 0;
  398.         break;        
  399.     case WAITONE_STEP:                                                  /*  暂停一步                    */
  400.         GmLeft.cState     = MOTOR_RUN;
  401.         break;
  402.     case MOTOR_RUN:                                                     /*  电机运行                    */
  403.         if (GucMouseState == GO_AHEAD) {                                /*  根据传感器状态微调电机位置  */
  404.             if (GucDistance[FRONTR] &&                                 /*  前右方有挡板                */\
  405.                (GucDistance[FRONTL]==0)) {                              /*  前左方无挡板                */
  406.                 if (ucCnt1 == 1) {
  407.                     GmLeft.cState = WAITONE_STEP;                       /*  使下一步暂停                */
  408.                 }
  409.                 if (++ucCnt1 > 3) {                                     /*  3步暂停一步                 */
  410.                     ucCnt1 = 0;
  411.                 }
  412.             } else {
  413.                 ucCnt1 = 0;
  414.             }
  415.             if ((GucDistance[LEFT] == 1) &&                             /*  左远方有挡板               */\
  416.                (GucDistance[RIGHT] == 0)) {                             /*  右方无挡板                  */
  417.                 if(ucCnt2 == 3) {
  418.                     GmLeft.cState = WAITONE_STEP;                       /*  使下一步暂停                */
  419.                 }
  420.                 if (++ucCnt2 > 6) {                                     /*  6步暂停一步                 */
  421.                     ucCnt2 = 0;
  422.                 }
  423.             } else {
  424.                 ucCnt2  = 0;
  425.             }
  426.         }
  427.         lftMtCtrl();                                                    /*  电机驱动程序                */
  428.         break;
  429.     default:
  430.         break;
  431.     }
  432.     /*
  433.      *  是否完成任务判断
  434.      */
  435.     if (GmLeft.cState != MOTOR_STOP) {
  436.         GmLeft.ulPulseCtr++;                                            /*  运行脉冲计数                */
  437.         lftMtSpeedCtrl();                                               /*  速度调节                    */
  438.         if (GmLeft.ulPulseCtr >= GmLeft.ulPulse) {
  439.             GmLeft.cState      = MOTOR_STOP;
  440.             GmLeft.ulPulseCtr  = 0;
  441.             GmLeft.ulPulse     = 0;
  442.             GmLeft.lSpeed      = 0;
  443.         }
  444.     }
  445. }
  446. /*********************************************************************************************************
  447. ** Function name:       timer1Isr
  448. ** Descriptions:        Timer1中断服务函数
  449. ** input parameters:    无
  450. ** output parameters:   无
  451. ** Returned value:      无
  452. *********************************************************************************************************/
  453. void timer1Isr(void)
  454. {
  455.     static INT8S ucCnt1 = 0, ucCnt2 = 0;                                /*  修正姿态计数变量            */
  456.     TIMER1_INT_CLR();                                                   /*  清除中断标志                */
  457.    
  458.     switch (GmRight.cState) {
  459.     case MOTOR_STOP:                                                     /*  停止，同时清零速度和脉冲值  */
  460.         GmRight.lSpeed     = 0;
  461.         GmRight.ulPulse    = 0;
  462.         GmRight.ulPulseCtr = 0;
  463.         break;

  465.     case WAITONE_STEP:                                                   /*  暂停一步                    */
  466.         GmRight.cState     = MOTOR_RUN;
  467.         break;
  468.     case MOTOR_RUN:                                                     /*  电机运行                    */
  469.         if (GucMouseState == GO_AHEAD) {                                /*  根据传感器状态微调电机位置  */
  470.             if (GucDistance[FRONTL] &&                                 /*  前左方有挡板                */\
  471.                (GucDistance[FRONTR]==0)) {                              /*  前右方无挡板                */
  472.                 if (ucCnt1 == 1) {
  473.                     GmRight.cState = WAITONE_STEP;                      /*  使下一步暂停                */
  474.                 }
  475.                 if (++ucCnt1 > 3) {                                     /*  3步暂停一步                 */
  476.                     ucCnt1 = 0;
  477.                 }
  478.             } else {
  479.                 ucCnt1 = 0;
  480.             }
  481.             if ((GucDistance[RIGHT] == 1) &&                           /*  右远方有挡板               */\
  482.                (GucDistance[LEFT] == 0)) {                              /*  左方无挡板                  */
  483.                 if(ucCnt2 == 3) {
  484.                     GmRight.cState = WAITONE_STEP;                      /*  使下一步暂停                */
  485.                 }
  486.                 if (++ucCnt2 > 6) {                                     /*  6步暂停一步                 */
  487.                     ucCnt2 = 0;
  488.                 }
  489.             } else {
  490.                 ucCnt2  = 0;
  491.             }
  492.         }
  493.         rgtMtCtrl();                                                    /*  推动电机转动一步            */
  494.         break;

  496.     default:
  497.         break;
  498.     }
  499.     /*
  500.      *  是否完成任务判断
  501.      */
  502.     if (GmRight.cState != MOTOR_STOP) {
  503.         GmRight.ulPulseCtr++;                                           /*  运行脉冲计数                */
  504.         rgtMtSpeedCtrl();                                               /*  速度调节                    */
  505.         if (GmRight.ulPulseCtr >= GmRight.ulPulse) {
  506.             GmRight.cState      = MOTOR_STOP;
  507.             GmRight.ulPulseCtr  = 0;
  508.             GmRight.ulPulse     = 0;
  509.             GmRight.lSpeed      = 0;
  510.         }
  511.     }
  512. }

  514. /*********************************************************************************************************
  515. ** Function name:       irSend
  516. ** Descriptions:        红外发射启动函数
  517. ** input parameters:    ucIndex: 红外发射索引号
  518. **                      ulFreq : 红外载波频率
  519. ** output parameters:   无
  520. ** Returned value:      无
  521. *********************************************************************************************************/
  522. void  irSend (INT8U ucIndex, INT32U ulFreq)
  523. {
  524.     switch (ucIndex) {
  525.     case FRONT_SIDE_PWM_INDEX:
  526.         PWM_RESET();
  527.         PWM_FRQ_SET(ulFreq);
  528.         FRONTSIDE_PWM_PULSE_SET(FPCLK / ulFreq / 2);
  529.         PWM_START();
  530.         FRONTSIDE_PWM_EN();
  531.         break;
  532.     case DIG_PWM_INDEX:
  533.         PWM_RESET();
  534.         PWM_FRQ_SET(ulFreq);
  535.         DIG_PWM_PULSE_SET(FPCLK / ulFreq / 2);
  536.         PWM_START();
  537.         DIG_PWM_EN();
  538.         break;
  539.     default:
  540.         break;
  541.     }
  542. }
  543. /*********************************************************************************************************
  544. ** Function name:       irCheck
  545. ** Descriptions:        红外线传感器检测。
  546. ** input parameters:    无
  547. ** output parameters:   无
  548. ** Returned value:      无
  549. *********************************************************************************************************/
  550. void irCheck (void)
  551. {
  552.     static INT8U ucState = 0;
  553.     static INT32U ulIRCheck;
  554.    
  555.     switch (ucState) {
  556.     case 0:
  557.         irSend(FRONT_SIDE_PWM_INDEX, 32200);                            /*  探测左右两侧近距            */
  558.         irSend(DIG_PWM_INDEX, 35000);                                   /*  驱动斜角上的传感器检测      */
  559.         break;
  560.     case 1:
  561.         ulIRCheck = IR_READ();                                          /*  读取传感器状态              */
  562.         FRONTSIDE_PWM_DIS();                                            /*  禁止PWM发生器2              */
  563.         DIG_PWM_DIS();                                                  /*  禁止PWM发生器1              */
  564.         
  565.         if (ulIRCheck & IR_SIDE_LFT) {
  566.             GucDistance[LEFT]   &= 0xfd;
  567.         } else {
  568.             GucDistance[LEFT]   |= 0x02;
  569.         }

  571.         if (ulIRCheck & IR_DIG_LFT) {
  572.             GucDistance[FRONTL]  = 0x00;
  573.         } else {
  574.             GucDistance[FRONTL]  = 0x01;
  575.         }
  576.         
  577.         if (ulIRCheck & IR_DIG_RGT) {
  578.             GucDistance[FRONTR]  = 0x00;
  579.         } else {
  580.             GucDistance[FRONTR]  = 0x01;
  581.         }
  582.         if (ulIRCheck & IR_SIDE_RGT) {
  583.             GucDistance[RIGHT]  &= 0xfd;
  584.         } else {
  585.             GucDistance[RIGHT]  |= 0x02;
  586.         }
  587.         break;
  588.     case 2:
  589.         irSend(FRONT_SIDE_PWM_INDEX, 36000);                            /*  驱动检测左前右三个方向远距  */
  590.         
  591.         break;
  592.     case 3:
  593.         ulIRCheck = IR_READ();                                          /*  读取传感器状态              */
  594.         FRONTSIDE_PWM_DIS();                                            /*  禁止PWM发生器2              */
  595.         break;
  596.     case 4:
  597.         irSend(FRONT_SIDE_PWM_INDEX, 36000);                            /*  重复检测左前右三个方向远距  */
  598.         break;
  599.     case 5:
  600.         ulIRCheck &= IR_READ();                                         /*  读取传感器状态              */
  601.         FRONTSIDE_PWM_DIS();                                            /*  禁止PWM发生器2              */

  603.         
  604.         if (ulIRCheck & IR_SIDE_LFT) {
  605.             GucDistance[LEFT]  &= 0xfe;
  606.         } else {
  607.             GucDistance[LEFT]  |= 0x01;
  608.         }
  609.         if (ulIRCheck & IR_FRONT) {
  610.             GucDistance[FRONT] &= 0xfe;
  611.         } else {
  612.             GucDistance[FRONT] |= 0x01;
  613.         }
  614.         if (ulIRCheck & IR_SIDE_RGT) {
  615.             GucDistance[RIGHT] &= 0xfe;
  616.         } else {
  617.             GucDistance[RIGHT] |= 0x01;
  618.         }
  619.         break;
  620.     default:
  621.         break;
  622.     }
  623.     if (++ucState >= 6) {
  624.         ucState = 0;
  625.     }
  626. }

  628. /*********************************************************************************************************
  629. ** Function name:       keyCheck
  630. ** Descriptions:        读取按键
  631. ** input parameters:    无
  632. ** output parameters:   无
  633. ** Returned value:      true:  按键已按下
  634. **                      false: 按键未按下
  635. *********************************************************************************************************/
  636. BOOLEAN keyCheck (void)
  637. {
  638.     if (KEY_PRESS()) {                                                  /*  按键按下                    */
  639.         delayMs(10);                                                    /*  延时10ms消抖动              */
  640.         if (KEY_PRESS()) {                                              /*  按键按下                    */
  641.             delayMs(10);                                                /*  延时10ms消抖动              */
  642.             while(!KEY_PRESS());                                        /*  等待按键释放                */
  643.             return (true);
  644.         }
  645.     }
  646.     return (false);
  647. }
  648. /*********************************************************************************************************
  649. ** Function name:       sysTickIsr
  650. ** Descriptions:        定时中断扫描。
  651. ** input parameters:    无
  652. ** output parameters:   无
  653. ** Returned value:      无
  654. *********************************************************************************************************/
  655. void sysTickIsr(void)
  656. {
  657.     static INT32S lLft = 0, lRgt = 0;
  658.    
  659.     /*
  660.      *  如果左电机长时间停止，则断电
  661.      */
  662.     if (GmLeft.cState == MOTOR_STOP) {
  663.         lLft++;
  664.     } else {
  665.         lLft = 0;
  666.     }
  667.     if (lLft >= 500) {
  668.         MT_LFT_OFF();
  669.     }
  670.     /*
  671.      *  如果右电机长时间停止，则断电
  672.      */
  673.     if (GmRight.cState == MOTOR_STOP) {
  674.         lRgt++;
  675.     } else {
  676.         lRgt = 0;
  677.     }
  678.     if (lRgt >= 500) {
  679.         MT_RGT_OFF();
  680.     }
  681.     /*
  682.      *  红外线检测
  683.      */
  684.     irCheck();
  685. }
  686. /*********************************************************************************************************
  687. ** Function name:       sensorInit
  688. ** Descriptions:        传感器控制初始化
  689. ** input parameters:    无
  690. ** output parameters:   无
  691. ** Returned value:      无
  692. *********************************************************************************************************/
  693. void  sensorInit (void)
  694. {
  695.     IR_PIN_MODE_IN();                                                   /* 红外检测引脚配置为输入引脚   */
  696.    
  697.     PWM1TCR  = 0x02;                                                    /* 复位PWM1定时器               */
  698.     PWM1TC   = 0;                                                       /* 定时器设置为0                */
  699.     PWM1PR   = 0;                                                       /* 时钟不分频                   */
  700.     PWM1MCR  = 0x02;                                                    /* 设置PWMMR0匹配后复位PWMTC，  */
  701.                                                                         /* 并产生中断标志               */
  702.     PWM1MR0  = FPCLK / 38000;                                           /* 38KHz频率                    */
  703.     PWM1MR1  = FPCLK / 38000 / 2;
  704.     PWM1MR2  = FPCLK / 38000 / 2;

  706.     PWM1PCR  &= ~((1 << 9) | (1 << 10));                                /* 禁止输出                     */
  707.     PWM1TCR  = 0x05;                                                    /* 启动定时器                   */
  708. }
  709. /*********************************************************************************************************
  710. ** Function name:       stepMotorIint
  711. ** Descriptions:        步进电机控制初始化
  712. ** input parameters:    无
  713. ** output parameters:   无
  714. ** Returned value:      无
  715. *********************************************************************************************************/
  716. void stepMotorIint (void)
  717. {
  718.      INT32U n;
  719.      /*
  720.      *  设置驱动步进电机的八个I/O口为输出模式
  721.      */
  722.      FIO1DIR |= (1 << 25) | (1 << 26) | (1 << 28) | (1 << 29);
  723.      FIO2DIR |= (1 << 2) | (1 << 3) | (1 << 4) | (1 << 5);
  724.     /*
  725.      *  对左右电机转动的位置初始化
  726.      */
  727.      MT_LFT_STEP1_SET();
  728.      MT_RGT_STEP1_SET();
  729.     /*
  730.      *  初始化加速/减速时定时器加载值的数据表
  731.      *  C0=F*sqrt(2/w) , W=1000时，sqrt(2/w) = 0.04472136
  732.      *  C1 = 0.4142*C0
  733.      */
  734.     GulAccelTable[0] = (INT32U)(FPCLK * 0.04472136);
  735.     GulAccelTable[1] = (INT32U)((unsigned long long)GulAccelTable[0] * 4142 / 10000);
  736.     for(n = 2; n < 300; n++) {
  737.         GulAccelTable[n] = GulAccelTable[n - 1] - (2 * GulAccelTable[n - 1] / (4 * n + 1));
  738.     }

  740.     /*
  741.      *  初始化定时器0，用来控制左电机的转速
  742.      */
  743.     T0TCR  = 0x02;
  744.     T0IR   = 1;
  745.     T0CTCR = 0;
  746.     T0TC   = 0;
  747.     T0PR   = 0;
  748.     T0MR0  = GulAccelTable[0];                                          /* 装载值                       */
  749.     T0MCR  = 0x03;                                                      /* 匹配后产生中断               */
  750.    
  751.     zyIsrSet(NVIC_TIMER0, (unsigned long)timer0Isr, PRIO_THREE);        /* 设置中断并使能               */
  752.     T0TCR  = 0x01;                                                      /* 启动定时器0                  */                                /*  使能定时器0                 */
  753.    
  754.     /*
  755.      *  初始化定时器1，用来控制右电机的转速
  756.      */
  757.     T1TCR  = 0x02;
  758. ……………………

  760. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
MicroMouse_高级实验.zip (137.56 KB, 下载次数: 10)



评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励！

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶顶 踩踩
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表