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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › 单片机避障小车代码
返回列表 发新帖
查看: 1100|回复: 1
打印 上一主题 下一主题
收起左侧

单片机避障小车代码

[复制链接]
跳转到指定楼层
楼主
ID:466394 发表于 2019-1-11 12:25 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
一种可调速避障小车源程序

单片机源程序如下:
  1. #include "reg52.h"                         //此文件中定义了单片机的一些特殊功能寄存器
  2. #include<intrins.h>                //因为要用到左右移函数，所以加入这个头文件
  3. #include "Timer.h"

  5. typedef unsigned int u16;          //对数据类型进行声明定义
  6. typedef unsigned char u8;


  9. sbit leftmoto1 = P1^7;       
  10. sbit leftmoto2 = P1^6;       
  11. sbit rightmoto1=P1^5;       
  12. sbit rightmoto2=P1^4;
  13.        
  14. sbit L1 = P1^3;       
  15. sbit L2 = P1^2;       
  16. sbit R1=P1^0;       
  17. sbit R2=P1^1;

  19. //#define Leftmotogo {left-moto1= 0 ;left-moto2= 1 ; };
  20. //#define Leftmotoback {left-moto1= 1 ;left-moto2= 0 ; };
  21. //#define Leftmotostop {left-moto1= 1 ;left-moto2= 1 ; };
  22. //#define Rightmotogo {right-moto1= 0 ;right-moto2= 1 ;};
  23. //#define Rightmotoback {right-moto1= 1 ;right-moto2= 0 ; };
  24. //#define Rightmotostop {right-moto1= 1 ;right-moto2= 1 ; };

  26. void run()
  27. {
  28.         leftmoto1= 1 ;
  29.         leftmoto2= 0 ;
  30.         rightmoto1= 1 ;
  31.         rightmoto2= 0 ;            //正转
  32. }

  34. void left()
  35. {
  36.         leftmoto1= 0 ;
  37.         leftmoto2= 1 ;          //左轮反转
  38.         rightmoto1= 1 ;
  39.         rightmoto2= 0 ;          //右轮正转
  40. }
  41. void right()
  42. {
  43.         leftmoto1= 1 ;
  44.         leftmoto2= 0 ;           //左轮正转
  45.         rightmoto1= 0 ;
  46.         rightmoto2= 1 ;          //右轮反转
  47. }
  48. void stop()
  49. {
  50.         leftmoto1= 1 ;
  51.         leftmoto2= 1 ;
  52.         rightmoto1= 1 ;
  53.         rightmoto2= 1 ;
  54. }

  56. void back()
  57. {
  58.         leftmoto1= 0 ;
  59.         leftmoto2= 1 ;
  60.         rightmoto1= 0 ;
  61.         rightmoto2= 1 ;
  62. }

  64. void delay_ms(u16 x)
  65. {        while(x--);
  66. //    unsigned int i,j;
  67. //        for(i = x;i > 0;i--)
  68. //        {
  69. //        for(j = 10 ;j > 0;j--);
  70. //        }       
  71. }

  73. void main()
  74. {
  75.    ENA = 1 ;
  76.    ENB = 1 ;
  77.    while(1)
  78.    {
  79.   
  80.           InitTimer0();
  81.         while(1)
  82.         {
  83.         if(L1&&L2&&R1&&R2)        run();
  84.         if((!L1)&&(!L2)&&R1&&R2)  //right();
  85.         {
  86.         stop();
  87.         //delay_ms( 1 );
  88.         right();
  89.         }
  90.         if(L1&&(!L2)&&R1&&R2)  
  91.         {
  92.         stop();
  93.         //delay_ms( 1 );
  94.         right();
  95.         }
  96.         if((!L1)&&L2&&R1&&R2)  
  97.         {
  98.         stop();
  99.         //0delay_ms( 10 );
  100.         right();         
  101.         }
  102.         if((!L1)&&(!L2)&&(!R1)&&R2)  
  103.         {
  104.         stop();
  105.         //delay_ms( 1 );
  106.         right();         
  107.         }
  108.         if(L1&&L2&&R1&&(!R2))
  109.         {
  110.         stop();
  111.         //delay_ms( 1 );
  112.         left();         
  113.         }
  114.         if(L1&&L2&&(!R1)&&R2)
  115.         {
  116.         stop();  
  117.         left();
  118.         }
  119.         if(L1&&L2&&(!R2)&&(!R2))
  120.         {
  121.         stop();  
  122.         left();
  123.         }
  124.         if(L1&&(!L2)&&(!R1)&&(!R2))  
  125.         {
  126.         stop();  
  127.         left();
  128.         }
  129.         if((!L1)&&(!L2)&&(!R1)&&(!R2))  
  130.         {
  131.         stop();  
  132.         back();
  133.         }
  134.                
  135.         }                         
  136. }
  137. }
复制代码

所有资料51hei提供下载:
小车.zip (28.5 KB, 下载次数: 8)



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

使用道具 举报

沙发
ID:1 发表于 2019-1-11 15:30 | 只看该作者
需要补全原理图即可获得100黑币+
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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