找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 2130|回复: 1
打印 上一主题 下一主题
收起左侧

小车循迹AVR单片机版程序

[复制链接]
跳转到指定楼层
楼主


单片机源程序如下:
  1. /****
  2. **********************************
  3. *程序说明:
  4. *此ATmega128
  5. *包含功能:
  6. *1、
  7. *2、
  8. *3、
  9. *4、
  10. *5、
  11. **********************************
  12. *文件:main.c
  13. *用途:系统主程序
  14. *注意:系统时钟8MHZ
  15. *编译环境:Code VisionAVR
  16. **********************************
  17. *版本:循迹小车v1.0
  18. *作者:吾ARM1
  19. *完成时间:2012年4月16日
  20. **********************************/

  21. #include<mega128.h>
  22. #include "delay.h"
  23. #define left1   PORTC.0  
  24. #define left2   PORTC.1
  25. #define min     PORTC.2
  26. #define right1  PORTC.3
  27. #define right2  PORTC.4  
  28. #define Turn_Left       PORTC.5
  29. #define Turn_Right      PORTC.6
  30. #define u8      unsigned char
  31. #define u16     unsigned int  

  32. void  Init_IO(void)
  33. {
  34.     DDRC = DDRC&0xe0; //将C端口低5位定义为输入,浮空
  35.     PORTC = 0xe0;//
  36.     DDRB = 0xff; //将B端口设为输出模式
  37.     PORTB = 0xff;
  38.     PORTA = 0xff;
  39.     DDRA = 0xff;
  40. }   

  41. void Adjust_Speed(u8 Left_Speed,u8 Right_Speed)
  42. {
  43.       OCR1A = (u16)Right_Speed*10 ;//Left_Speed:1--100,为右电机占空比
  44.       OCR1B = (u16)Left_Speed*10;//Right_Speed:1--100,为左电机的占空比   
  45. }

  46. void    Init_Timer1(void)
  47. {       u16     i,j;
  48.         i = 300; //实际测试发现1600时电机速度还是很快的。
  49.         j = 300;
  50.         TCCR1A = 0xa0;//相位与频率修正PWM,TOP值为ICR1,向上计数匹配清零,向下计数匹配时置1
  51.         TCCR1B = 0x12;//系统时钟8分频,A,B同时输出PWM   
  52.         OCR1A = i; //右电机
  53.         OCR1B = j;  //在电机
  54.         ICR1 = 1000;
  55. }

  56. void main(void)
  57. {   
  58.         Init_IO();
  59.         Init_Timer1();
  60.         while(1)
  61.         {
  62.            if(PINC==0xfb)//只有中间循迹管检测到黑线11011
  63.            {
  64.                Adjust_Speed(90,90);//前进(35,35):一圈循迹时间16.3S  (38,38)一圈循迹时间15.5s (40,40)一圈循迹时间16.34s (50,50)15.34s(60,60)14.21s
  65.                PORTA = 0xfe;        //(80,80)13.68s
  66.            }
  67.            
  68.          if(PINC==0xf9)//中间和左边第二个循迹管检测到黑线10011
  69.          {
  70.                Adjust_Speed(20,60);//左转
  71.               //  delay_ms(5);
  72.                PORTA = 0xfd;
  73.           }
  74.             
  75.            if(PINC==0xfd)//左边第二个循迹管检测到黑线10111
  76.            {
  77.                 Adjust_Speed(15,65);//左转
  78.                //delay_ms(5);
  79.                  PORTA = 0xfb;
  80.            }
  81.             
  82.            if(PINC==0xfc)//左边两个同时检测到黑线00111
  83.            {
  84.            
  85.                 Adjust_Speed(10,70);//左转
  86.                  PORTA = 0xf7;
  87.            }
  88.            
  89.           if(PINC==0xfe)//左边第一个循迹管检测到黑线01111
  90.           {
  91.               
  92.                Adjust_Speed(7,85);//左转
  93.              //   delay_ms(5);
  94.                 PORTA = 0xef;
  95.           }
  96.            
  97.             if(PINC==0xf3)//中间和右边第二个循迹管检测到黑线11001
  98.           {
  99.               
  100.                Adjust_Speed(35,15);//右转
  101.                 PORTA = 0xdf;
  102.            }
  103.           if(PINC==0xf7)//右边第二个循迹管检测到黑线11101
  104.           {
  105.                Adjust_Speed(70,13);//右转  
  106.                 PORTA = 0xbf;
  107.            }  
  108.            if(PINC==0xe7)//右边两个检测到黑线11100
  109.            {
  110.                Adjust_Speed(80,10);//右转  
  111.                PORTA = 0x7f;
  112.            }  
  113.            if(PINC==0xef)//右边第一个检测到黑线11110
  114.            {
  115.                Adjust_Speed(100,10);//右转   
  116.                PORTA = 0xfc;
  117.            }   
  118.            if(PINC==0xe3)//右侧三个循迹管同时检测到黑线(直角)11000
  119.            {
  120.                Adjust_Speed(40,0);//右转
  121.                PORTA = 0xf8;   
  122.            }
  123.            if(PINC==0xe7)//左侧三个循迹管同时检测到黑线(直角)00011左转
  124.           {
  125.                Adjust_Speed(0,40);//左转
  126.                 PORTA = 0xf0;
  127.            }
  128.            if(PINC==0xe0)//5个循迹管同时检测到交叉00000直走
  129.            {
  130.              Adjust_Speed(25,25);//直走
  131.               PORTA = 0xe0;
  132.            }
  133.        //    if(PINC==0xff)
  134.          //  {
  135.            //    Adjust_Speed(0,100);//直走
  136.              // PORTA = 0xc0;   
  137.            //}
  138.            
  139.         }
  140.         
  141. }
复制代码

所有资料51hei附件下载:
小车循迹AVR版.7z (145.86 KB, 下载次数: 16)

评分

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

查看全部评分

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

使用道具 举报

沙发
ID:974131 发表于 2022-3-30 09:20 | 只看该作者
thanks,收藏啦。
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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