找回密码
 立即注册

QQ登录

只需一步,快速开始

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

小车循迹avr单片机版源程序

[复制链接]
跳转到指定楼层
楼主
小车循迹avr版

  1. #include<mega128.h>
  2. #include "delay.h"
  3. #define left1   PORTC.0  
  4. #define left2   PORTC.1
  5. #define min     PORTC.2
  6. #define right1  PORTC.3
  7. #define right2  PORTC.4  
  8. #define Turn_Left       PORTC.5
  9. #define Turn_Right      PORTC.6
  10. #define u8      unsigned char
  11. #define u16     unsigned int  

  12. void  Init_IO(void)
  13. {
  14.     DDRC = DDRC&0xe0; //将C端口低5位定义为输入,浮空
  15.     PORTC = 0xe0;//
  16.     DDRB = 0xff; //将B端口设为输出模式
  17.     PORTB = 0xff;
  18.     PORTA = 0xff;
  19.     DDRA = 0xff;
  20. }   

  21. void Adjust_Speed(u8 Left_Speed,u8 Right_Speed)
  22. {
  23.       OCR1A = (u16)Right_Speed*10 ;//Left_Speed:1--100,为右电机占空比
  24.       OCR1B = (u16)Left_Speed*10;//Right_Speed:1--100,为左电机的占空比   
  25. }

  26. void    Init_Timer1(void)
  27. {       u16     i,j;
  28.         i = 300; //实际测试发现1600时电机速度还是很快的。
  29.         j = 300;
  30.         TCCR1A = 0xa0;//相位与频率修正PWM,TOP值为ICR1,向上计数匹配清零,向下计数匹配时置1
  31.         TCCR1B = 0x12;//系统时钟8分频,A,B同时输出PWM   
  32.         OCR1A = i; //右电机
  33.         OCR1B = j;  //在电机
  34.         ICR1 = 1000;
  35. }

  36. void main(void)
  37. {   
  38.         Init_IO();
  39.         Init_Timer1();
  40.         while(1)
  41.         {
  42.            if(PINC==0xfb)//只有中间循迹管检测到黑线11011
  43.            {
  44.                Adjust_Speed(90,90);//前进(35,35):一圈循迹时间16.3S  (38,38)一圈循迹时间15.5s (40,40)一圈循迹时间16.34s (50,50)15.34s(60,60)14.21s
  45.                PORTA = 0xfe;        //(80,80)13.68s
  46.            }
  47.            
  48.          if(PINC==0xf9)//中间和左边第二个循迹管检测到黑线10011
  49.          {
  50.                Adjust_Speed(20,60);//左转
  51.               //  delay_ms(5);
  52.                PORTA = 0xfd;
  53.           }
  54.             
  55.            if(PINC==0xfd)//左边第二个循迹管检测到黑线10111
  56.            {
  57.                 Adjust_Speed(15,65);//左转
  58.                //delay_ms(5);
  59.                  PORTA = 0xfb;
  60.            }
  61.             
  62.            if(PINC==0xfc)//左边两个同时检测到黑线00111
  63.            {
  64.            
  65.                 Adjust_Speed(10,70);//左转
  66.                  PORTA = 0xf7;
  67.            }
  68.            
  69.           if(PINC==0xfe)//左边第一个循迹管检测到黑线01111
  70.           {
  71.               
  72.                Adjust_Speed(7,85);//左转
  73.              //   delay_ms(5);
  74.                 PORTA = 0xef;
  75.           }
  76.            
  77.             if(PINC==0xf3)//中间和右边第二个循迹管检测到黑线11001
  78.           {
  79.               
  80.                Adjust_Speed(35,15);//右转
  81.                 PORTA = 0xdf;
  82.            }
  83.           if(PINC==0xf7)//右边第二个循迹管检测到黑线11101
  84.           {
  85.                Adjust_Speed(70,13);//右转  
  86.                 PORTA = 0xbf;
  87.            }  
  88.            if(PINC==0xe7)//右边两个检测到黑线11100
  89.            {
  90.                Adjust_Speed(80,10);//右转  
  91.                PORTA = 0x7f;
  92.            }  
  93.            if(PINC==0xef)//右边第一个检测到黑线11110
  94.            {
  95.                Adjust_Speed(100,10);//右转   
  96.                PORTA = 0xfc;
  97.            }   
  98.            if(PINC==0xe3)//右侧三个循迹管同时检测到黑线(直角)11000
  99.            {
  100.                Adjust_Speed(40,0);//右转
  101.                PORTA = 0xf8;   
  102.            }
  103.            if(PINC==0xe7)//左侧三个循迹管同时检测到黑线(直角)00011左转
  104.           {
  105.                Adjust_Speed(0,40);//左转
  106.                 PORTA = 0xf0;
  107.            }
  108.            if(PINC==0xe0)//5个循迹管同时检测到交叉00000直走
  109.            {
  110.              Adjust_Speed(25,25);//直走
  111.               PORTA = 0xe0;
  112.            }
  113.        //    if(PINC==0xff)
  114.          //  {
  115.            //    Adjust_Speed(0,100);//直走
  116.              // PORTA = 0xc0;   
  117.            //}
  118. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

下载:
小车循迹AVR版.rar (65.89 KB, 下载次数: 8)

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

使用道具 举报

沙发
ID:194034 发表于 2017-5-4 11:28 | 只看该作者
真的很好,我很需要。谢谢
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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