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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 电子技术分类讨论区 › 智能小车/机器人 › 我的单片机pwm寻迹小车源程序
返回列表 发新帖
查看: 3455|回复: 2
打印 上一主题 下一主题
收起左侧

我的单片机pwm寻迹小车源程序

[复制链接]
跳转到指定楼层
楼主
ID:242216 发表于 2017-10-23 20:40 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
  1. #include<reg52.h>
  2. #define uint unsigned int
  3. #define uchar unsigned char

  5. sbit Z1=P2^0;  //左电机前进
  6. sbit Z2=P2^1;  //左电机后退
  7. sbit Y1=P2^2;  //右电机前进
  8. sbit Y2=P2^3;  //右电机后退
  9. sbit ENA=P0^0;
  10. sbit ENB=P0^1;
  11. sbit L1=P1^0;        //左1
  12. sbit L2=P1^1;        //左2
  13. sbit R1=P1^2;        //右1
  14. sbit R2=P1^3;        //右2
  15. double a=0;
  16. int aa=0,d=0,c=0;
  17. uchar b,bb;
  18. uchar pwm_val_left =0;

  20. double push_val_left =0; //左电机占空比N/10

  22. uchar pwm_val_right =0;

  24. double push_val_right=0; //右电机占空比N/10

  26. bit Right_moto_stp=1;

  28. bit Left_moto_stp =1;



  32. void run1(void) //前进函数

  34. {

  36. push_val_left =5.5; //PWM 调节参数1-20 1为最慢20是最快 改这个值可以改变其速度



  40. push_val_right =5.5; //PWM 调节参数1-20 1为最慢20是最快 改这个值可以改变其速度

  42. Z1=0;Z2=1;
  43. Y1=0;Y2=1;



  47. }
  48. void run(void) //前进函数
  49. {
  50. push_val_left =20; //PWM 调节参数1-20 1为最慢20是最快 改这个值可以改变其速度
  51. push_val_right =20; //PWM 调节参数1-20 1为最慢20是最快 改这个值可以改变其速度
  52. Z1=0;Z2=1;
  53. Y1=0;Y2=1;
  54. }
  55. void run2(void) //前进函数
  56. {
  57. push_val_left =9; //PWM 调节参数1-20 1为最慢20是最快 改这个值可以改变其速度
  58. push_val_right =9; //PWM 调节参数1-20 1为最慢20是最快 改这个值可以改变其速度
  59. Z1=0;Z2=1;
  60. Y1=0;Y2=1;
  61. }

  63. void left(void) //直角左转函数

  65. {

  67. push_val_left =18;

  69. push_val_right =18;

  71.         Z1=1;Z2=0;
  72.         Y1=0;Y2=1;

  74. }
  75. void left1(void) //左转函数

  77. {

  79. push_val_left =16;
  80.                                  
  81. push_val_right =16;

  83.         Z1=1;Z2=0;
  84.         Y1=0;Y2=1;

  86. }
  87. void left2(void) //小左转函数

  89. {

  91. push_val_left =19;
  92.                                  
  93. push_val_right =19;

  95.         Z1=1;Z2=1;
  96.         Y1=0;Y2=1;

  98. }
  99. void right(void) //直角右转函数

  101. {

  103. push_val_left =18;

  105. push_val_right =18;

  107. Z1=0;Z2=1;

  109. Y1=1;Y2=0;

  111. }
  112. void right1(void) //右转函数

  114. {

  116. push_val_left =16;

  118. push_val_right =16;

  120. Z1=0;Z2=1;

  122. Y1=1;Y2=0;
  123. }
  124. void right2(void) //小右转函数

  126. {

  128. push_val_left =19;

  130. push_val_right =19;

  132. Z1=0;Z2=1;

  134. Y1=1;Y2=1;
  135. }
  136. void stop(void)

  138. {
  139. Z1=1;Z2=1;

  141. Y1=1;Y2=1;


  144. }




  149. void pwm_out_left_moto(void) //左电机调速,调节push_val_left的值改变电机转速,占空比

  151. {

  153. if(Left_moto_stp)

  155. {                                                                           
  156. {if(pwm_val_left<=push_val_left)

  158. { ENB=1;}

  160. else

  162.   {ENB=0;}
  163.   }
  164. {if(pwm_val_left>=20)

  166.   {pwm_val_left=0;}
  167.   }
  168. }

  170. else

  172. {ENB=0;}

  174. }



  178. void pwm_out_right_moto(void) //右电机调速,调节push_val_left的值改变电机转速,占空比

  180. {

  182. if(Right_moto_stp)

  184. {

  186. if(pwm_val_right<=push_val_right)

  188. {ENA=1;}

  190. else

  192. {ENA=0;}

  194. if(pwm_val_right>=20)

  196. {pwm_val_right=0;}

  198. }

  200. else

  202. {ENA=0;}

  204. }



  208. void xunji()
  209. {
  210.                  if(L1==1&&L2==1&&R1==1&&R2==1)
  211.                 a++;

  213.                 if(L1==0&&L2==0&&R1==0&&R2==0)                 
  214.                 {run();aa++;}
  215.                 if((L1==1&&L2==0&&R1==0&&R2==0)||(L1==1&&L2==1&&R1==1&&R2==0)||(L1==1&&L2==1&&R1==0&&R2==0))
  216.                 left1();
  217.                 if((L1==0&&L2==0&&R1==0&&R2==1)||(L1==0&&L2==1&&R1==1&&R2==1)||(L1==0&&L2==0&&R1==1&&R2==1))
  218.                 right1();
  219.                 if(L1==0&&L2==1&&R1==0&&R2==0)          left2();
  220.                 if(L1==0&&L2==0&&R1==1&&R2==0)          right2();
  221.                 if((L1==1&&L2==1&&R1==1&&R2==1)&&a>=100)
  222.                 {
  223.                         stop();          a=0;
  224.                 }
  225.                 if(aa>=13000)         { bb=1; aa=0;         }
  226.                 while(bb==1)
  227.                 {
  228.                
  229.                 if(L1==0&&L2==0&&R1==0&&R2==0)                 run2();
  230.                 if((L1==1&&L2==0&&R1==0&&R2==0)||(L1==1&&L2==1&&R1==1&&R2==0)||(L1==1&&L2==1&&R1==0&&R2==0))
  231.                 left1();
  232.                 if((L1==0&&L2==0&&R1==0&&R2==1)||(L1==0&&L2==1&&R1==1&&R2==1)||(L1==0&&L2==0&&R1==1&&R2==1))
  233.                 right1();
  234.                 if(L1==0&&L2==1&&R1==0&&R2==0)          {left2();aa++;}
  235.                 if(L1==0&&L2==0&&R1==1&&R2==0)          {right2();aa++;}
  236.                 while(aa>=700)
  237.                 {
  238.                 if(L1==0&&L2==0&&R1==0&&R2==0)                 
  239.                 run();
  240.                 if((L1==1&&L2==0&&R1==0&&R2==0)||(L1==1&&L2==1&&R1==1&&R2==0)||(L1==1&&L2==1&&R1==0&&R2==0))
  241.                 left1();
  242.                 if((L1==0&&L2==0&&R1==0&&R2==1)||(L1==0&&L2==1&&R1==1&&R2==1)||(L1==0&&L2==0&&R1==1&&R2==1))
  243.                 right1();
  244.                 if(L1==0&&L2==1&&R1==0&&R2==0)          {left2();}
  245.                 if(L1==0&&L2==0&&R1==1&&R2==0)          right2();
  246.                 if(L1==1&&L2==1&&R1==1&&R2==1)    a++;
  247.                                 if((a>=60))
  248.                 {
  249.                         b=1;
  250.                 }
  251.                 while(b==1)
  252.                 {
  253.                         if(L1==0&&L2==0&&R1==0&&R2==0)                 
  254.                         run1();
  255.                         if((L1==1&&L2==0&&R1==0&&R2==0)||(L1==1&&L2==1&&R1==1&&R2==0)||(L1==1&&L2==1&&R1==0&&R2==0))
  256.                         left();
  257.                         if((L1==0&&L2==0&&R1==0&&R2==1)||(L1==0&&L2==1&&R1==1&&R2==1)||(L1==0&&L2==0&&R1==1&&R2==1))
  258.                         right();
  259.                         if(L1==0&&L2==1&&R1==0&&R2==0)          {left2();        c++;}
  260.                     if(L1==0&&L2==0&&R1==1&&R2==0)          {right2();d++;}

  262.                         while(c+d>=15000)
  263.                         {
  264.                                 if(L1==0&&L2==0&&R1==0&&R2==0)         run();
  265.                                 if((L1==1&&L2==0&&R1==0&&R2==0)||(L1==1&&L2==1&&R1==1&&R2==0)||(L1==1&&L2==1&&R1==0&&R2==0))
  266.                                 left1();
  267.                                 if((L1==0&&L2==0&&R1==0&&R2==1)||(L1==0&&L2==1&&R1==1&&R2==1)||(L1==0&&L2==0&&R1==1&&R2==1))
  268.                                 right1();
  269.                                 if(L1==0&&L2==1&&R1==0&&R2==0)          left2();
  270.                                 if(L1==0&&L2==0&&R1==1&&R2==0)          right2();
  271.                                 if(L1==1&&L2==1&&R1==1&&R2==1)          stop();
  272.                         }

  274.                         if((L1==1&&L2==1&&R1==1&&R2==1))
  275.                 {
  276.                         stop();          a=0;
  277.                 }

  279.                 }
  280.                
  281.                 }

  283.                 }










  294. //                if((a>=60))
  295. //                {
  296. //                        b=1;
  297. //                }
  298. //                while(b==1)
  299. //                {
  300. //                        if(L1==0&&L2==0&&R1==0&&R2==0)                 
  301. //                        run1();
  302. //                        if((L1==1&&L2==0&&R1==0&&R2==0)||(L1==1&&L2==1&&R1==1&&R2==0)||(L1==1&&L2==1&&R1==0&&R2==0))
  303. //                        left();
  304. //                        if((L1==0&&L2==0&&R1==0&&R2==1)||(L1==0&&L2==1&&R1==1&&R2==1)||(L1==0&&L2==0&&R1==1&&R2==1))
  305. //                        right();
  306. //                        if(L1==0&&L2==1&&R1==0&&R2==0)          {left2();        c++;}
  307. //                    if(L1==0&&L2==0&&R1==1&&R2==0)          {right2();d++;}
  308. //
  309. //                        while(c+d>=15000)
  310. //                        {
  311. //                                if(L1==0&&L2==0&&R1==0&&R2==0)         run();
  312. //                                if((L1==1&&L2==0&&R1==0&&R2==0)||(L1==1&&L2==1&&R1==1&&R2==0)||(L1==1&&L2==1&&R1==0&&R2==0))
  313. //                                left1();
  314. //                                if((L1==0&&L2==0&&R1==0&&R2==1)||(L1==0&&L2==1&&R1==1&&R2==1)||(L1==0&&L2==0&&R1==1&&R2==1))
  315. //                                right1();
  316. //                                if(L1==0&&L2==1&&R1==0&&R2==0)          left2();
  317. //                                if(L1==0&&L2==0&&R1==1&&R2==0)          right2();
  318. //                                if(L1==1&&L2==1&&R1==1&&R2==1)          stop();
  319. //                        }
  320. //
  321. //                        if((L1==1&&L2==1&&R1==1&&R2==1))
  322. //                {
  323. //                        stop();          a=0;
  324. //                }
  325. //
  326. //                }
  327.                         
  328.         
  329.                         
  330. }
  331. /***********TIMER0中断服务子函数产生PWM信号**********/

  333. void timer0()interrupt 1 using 2

  335. {

  337. TH0=0XFC; //2Ms定时

  339. TL0=0X30;

  341. pwm_val_left++;

  343. pwm_val_right++;

  345. pwm_out_left_moto();

  347. pwm_out_right_moto();

  349. }

  351. /***************************************************/

  353. void main(void)

  355. {

  357. TMOD=0X01;

  359. TH0= 0XFC; //2ms定时

  361. TL0= 0X30;                                                                 

  363. TR0= 1;

  365. ET0= 1;

  367. EA = 1;

  369. while(1) /*无限循环*/

  371. {

  373. xunji();
  374. }

  376. }
复制代码
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶顶 踩踩
回复

使用道具 举报

沙发
ID:242625 发表于 2017-10-24 22:52 | 只看该作者
楼主能分享一下电路图吗?
回复

使用道具 举报

板凳
ID:250071 发表于 2017-11-16 15:42 | 只看该作者
楼主有电路图吗
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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