找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 1888|回复: 1
收起左侧

单片机红外避障小车程序

[复制链接]
ID:497164 发表于 2020-5-25 11:51 | 显示全部楼层 |阅读模式
红外避障小车

单片机源程序如下:
  1. /******************************************************************
  2. ***名称:小车红外避障参考程序(PWM)*******************************
  3. ***晶振:11.0592MHZ*************************************************
  4. ******************************************************************/

  5. /******************************************************************
  6. ************************* 头文件 **********************************
  7. ******************************************************************/
  8. #include<AT89X52.H>          

  9. /******************************************************************
  10. ************************电机驱动定义*******************************
  11. ******************************************************************/
  12. #define LS     {P1_1=0,P1_2=0;}    //左电机停转
  13. #define Lg     {P1_1=1,P1_2=0;}    //左电机正转
  14. #define Lb     {P1_1=0,P1_2=1;}           //左电机反转
  15. #define RS     {P1_4=0,P1_5=0;}          //右电机停转                     
  16. #define Rg     {P1_4=1,P1_5=0;}          //右电机正转
  17. #define Rb     {P1_4=0,P1_5=1;}          //右电机反转


  18. #define Lp            P1_0          //PWM信号端
  19. #define Rp            P1_3          //PWM信号端
  20. #define Ll      P3_4          //左传感器      
  21. #define Rl      P3_5          //右传感器

  22. sbit BUZZ = P2^3;                 //蜂鸣器引脚

  23. /******************************************************************
  24. **********************PWM调速相关变量******************************
  25. ******************************************************************/
  26. unsigned char pwm_val_left  =0;              //变量定义
  27. unsigned char push_val_left =0;              //左电机占空比N/20
  28. unsigned char pwm_val_right =0;
  29. unsigned char push_val_right=0;              //右电机占空比N/20
  30. bit Rs=1;
  31. bit Ls =1;
  32. unsigned  int  time=0;

  33. /******************************************************************
  34. **********************延时函数*************************************
  35. ******************************************************************/       
  36. void delay(unsigned int k)
  37. {   
  38.      unsigned int x,y;
  39.          for(x=0;x<k;x++)
  40.            for(y=0;y<2000;y++);
  41. }

  42. /******************************************************************
  43. ******************************小车前进*****************************
  44. ******************************************************************/
  45. void  front_run(void)
  46. {
  47.          push_val_left=10;
  48.          push_val_right=10.1;
  49.          Lg;   
  50.          Rg;  
  51. }

  52. /******************************************************************
  53. ******************************小车后退*****************************
  54. ******************************************************************/
  55. void  back_run(void)
  56. {
  57.          push_val_left=10;
  58.          push_val_right=10.1;
  59.          Lb;   
  60.          Rb;  
  61. }


  62. /******************************************************************
  63. ******************************小车左转*****************************
  64. ******************************************************************/
  65. void  left_run(void)
  66. {
  67.          push_val_left=12;
  68.          push_val_right=12;
  69.          Rg;   
  70.          Lb;  
  71. }

  72. /******************************************************************
  73. ******************************小车右转******************************
  74. ******************************************************************/
  75. void  right_run(void)
  76. {
  77.          push_val_left=12;
  78.          push_val_right=12;
  79.          Lg;   
  80.          Rb;  
  81. }

  82. /******************************************************************
  83. ******************************小车停*******************************
  84. ******************************************************************/
  85. void  stop(void)
  86. {
  87.          push_val_left=15;
  88.          push_val_right=15;
  89.          LS;
  90.          RS;   
  91. }

  92. /******************************************************************
  93. ****************************左电机调速*****************************
  94. ******************************************************************/
  95. void pwm_out_left_moto(void)
  96. {  
  97.         if(Ls)
  98.         {
  99.             if(pwm_val_left<=push_val_left)
  100.                         {
  101.                                 Lp=1;
  102.        
  103.                         }
  104.                 else
  105.                     {
  106.                         Lp=0;
  107.        
  108.                         }
  109.                 if(pwm_val_left>=20)
  110.                     pwm_val_left=0;
  111.         }
  112.         else   
  113.         {
  114.                 Lp=0;
  115.         }
  116. }

  117. /******************************************************************
  118. ***************************右电机调速******************************
  119. ******************************************************************/
  120. void pwm_out_right_moto(void)
  121. {
  122.         if(Rs)
  123.     {
  124.             if(pwm_val_right<=push_val_right)
  125.             {
  126.                     Rp=1;
  127.                 }
  128.         else
  129.             {
  130.                         Rp=0;
  131.                 }
  132.         if(pwm_val_right>=20)
  133.                pwm_val_right=0;
  134.    }
  135.    else   
  136.    {
  137.        Rp=0;

  138.    }
  139. }

  140. /******************************************************************
  141. ************************定时器0初始化******************************
  142. ******************************************************************/
  143. void timer0_Init(void)
  144. {
  145.         TMOD=0X01;
  146.         TH0= 0XFc;                  //1ms定时
  147.         TL0= 0X18;
  148.         TR0= 1;
  149.         ET0= 1;
  150.         EA = 1;                           //开总中断       
  151. }
  152.            
  153. /******************************************************************
  154. *******************定时器0中断服务子程序***************************
  155. ******************************************************************/
  156. void timer0()interrupt 1   using 2
  157. {
  158.    TH0=0XFc;          
  159.          TL0=0X18;
  160.          time++;
  161.          pwm_val_left++;
  162.          pwm_val_right++;
  163.          pwm_out_left_moto();
  164.          pwm_out_right_moto();
  165. }       

  166. /******************************************************************
  167. **************************主函数***********************************
  168. ******************************************************************/
  169. void main(void)
  170. {
  171.         unsigned char i;
  172.         stop();                        //小车停转            
  173.   timer0_Init();     
  174.         while(1)
  175.         {
  176.                 if(Ll==1&&Rl==1)                       //前方无障碍
  177.                    front_run();                        //前进
  178.                 else
  179.             {                          
  180.                         if(Ll==1&&Rl==0)                     //右前方右障碍
  181.                         {
  182.                                 left_run();                                     //左转
  183.                                 delay(40);
  184.                         }  
  185.                         if(Rl==1&&Ll==0)                     //左前方右障碍
  186.                     {          
  187.                                 right_run();                                   //右转
  188.         delay(40);
  189.                     }
  190.                         if(Rl==0&&Ll==0)                     //前方有障碍
  191.                     {          
  192.                                 back_run();                                     //后退
  193.         delay(40);
  194.                                 right_run();                                   //右转
  195.         delay(90);
  196.                     }
  197.                 }         
  198.         }
  199. }
  200. /******************************************************************
  201. ******************************结束*********************************
  202. *******************************************************************/
复制代码

所有资料51hei提供下载:
XC.zip (32.23 KB, 下载次数: 23)
回复

使用道具 举报

ID:1 发表于 2020-5-29 01:02 | 显示全部楼层
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

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

Powered by 单片机教程网

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