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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 嵌入式/单片机论坛 › 24小时必答区 › 我的无法正常循迹 程序是我自己写的 我想知道哪里 ...
返回列表 发新帖
查看: 2054|回复: 1
打印 上一主题 下一主题
收起左侧

我的无法正常循迹 程序是我自己写的 我想知道哪里出了问题

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

sbit  leftmotor_in1=P2^7;
sbit  leftmotor_in2=P2^6;
sbit  rightmotor_in3=P2^5;
sbit        rightmotor_in4=P2^4;
sbit    Trig=P1^1;
sbit    Echo=P1^2;
sbit en_1=P2^3;
sbit en_2=P2^2;
uint S,time,i,j,pwm1,pwm2;
void stop();
void straight();
void turn_left();
void turn_right();
void Sensor_5_Car_State_Adjustment();
void delay20us(unsigned char t)
{   
        while(--t);
}
/*******延时函数——延时50ms*******/
void delay(uint xms)                //@11.0592MHz
{
       
           unsigned char m, n;
      for(m=xms;m>0;m--)
              for(n=110;n>0;n--);
                               
}

void csb()
        {
                Trig=1;
                delay20us(15);
                Trig=0;
                while(!Echo);               
            TR0=1;       
          while(Echo);               
           TR0=0;                               
          time=TH0*256+TL0;
                S=(time*1.7)/100;
                         
             TH0=0;
         TL0=0;
         
        }
void T0_time()interrupt 1
{

}
void T1_time()interrupt 3
{  
        TR1=0;
        TH1=(65536-100)/256;
        TL1=(65536-100)%256;
        i++;
        j++;
          if(i<pwm1)
                                                {
                                                         en_1=1;
                                                }
            else
                         en_1=0;
           if(j<pwm2)
                                                {
                                                                 en_2=1;
                                                }
      else
                        en_2=0;
                     
        if(i>=100)
                                {
                                         i=0;
                                }
        if(j>=100)
                                {
                                                j=0;
                                }
                TR1=1;
}
void main()

  {  
   TMOD=0x10;
   TH1=(65536-100)/256;
         TL1=(65536-100)%256;
         TH0=0;
         TL0=0;     
                ET1=1;
    ET0=1;
    TR1=1;               
    TR0=1;                  
                EA=1;                          

        while(1)
        {

                 csb();
                 if(S>100)
                 {
                 
                        Sensor_5_Car_State_Adjustment();
                 }
           if(S<=100)
                 {  pwm1=0;
                          pwm2=0;
                    stop();
                         
                 }
                 
}


}  
void straight()      //直走函数
{

        leftmotor_in1=0;
        leftmotor_in2=1;
  rightmotor_in3=0;
        rightmotor_in4=1;
}
void turn_left()    //左转函数
{

        leftmotor_in1=1;
        leftmotor_in2=0;
  rightmotor_in3=0;
        rightmotor_in4=1;
}
void turn_right()   //右转函数
{

        leftmotor_in1=0;
        leftmotor_in2=1;
  rightmotor_in3=1;
        rightmotor_in4=0;
}

void stop()        //停止函数
{
  leftmotor_in1=0;
        leftmotor_in2=0;
  rightmotor_in3=0;
        rightmotor_in4=0;
}
void Sensor_5_Car_State_Adjustment(void)
{     
              P0_State=P0_State&0x00;
                       switch(P0_State)
                 {
                        
                             
                         
                              case 0x1f:
                                                case 0x1b:  pwm1=40;
                                                                                                pwm2=40;                         straight();     //P0.0|P0.1|P0.2|P0.3|P0.4为11011说明小车正常寻迹下一步小车直行
                                                                                                break;
                                                case 0x1d:      while(1)                 //P0.0|P0.1|P0.2|P0.3|P0.4为11101说明小车左偏下一步小车右拐                         
                                                   {  
                                   pwm2=35;
                                   pwm1=35;                                                                                         
                              turn_right();
                                                                                                                                 
                                                                                                                                if(P0^2==0)
                                                                                                                                        break;
                                                                                                         }
                                         break;
                              case 0x17:       while(1)                                       //10111
                                                                                                        {      
                                                                                                                        pwm2=35;
                                                                                                                                                pwm1=35;
                                                                                                                                turn_left();
                                                                                                                                        if(P0^2==0)
                                   break;                                                                                                                                               
                                                                                                        }                                                                                 //P0.0|P0.1|P0.2|P0.3|P0.4为10111说明小车右偏下一步左拐  
                                   break;
            case 0x03:
                                                                                                                        pwm1=50;
                                                                                                                        pwm2=50;
                                                                                                         straight();
                                                                                                                 delay(1);
                                                                                                                                        while(1)                           //P1.0|P1.1|P1.2|P1.3|P1.4为00011说明小车遇到左T标置物小车左拐
                                                                                                                                        {
                                                                                                                                                pwm1=30;
                                                                                                                                                pwm2=40;
                                                                                                                          turn_left();                       
                                                                                                                                                        if(P0^2==0)
                                                                                                                                                          {
                                                                                                                                                             break;
                                                                                                                                                                }
                                                                                                                                         }
                                        break;
     case 0x18:  
                                                pwm1=50;
                                                                              pwm2=50;
                                                                           straight();
                             delay(1);                                                                 
                                                                                                                                         while(1)                       //P0.0|P0.1|P0.2|P0.3|P0.4为11000说明小车遇到右T标志物下一步小车右拐
                                                                                                                                                {   
                                                                                                                                                                pwm1=40;
                                                                                                                                                          pwm2=30;
                                                                                                                                         turn_right();
                                                                                                                                                                if(P0^2==0)
                                                                                                                                                                {
                                                                                                                                                                         break;
                                                                                                                                                                }
                                                                                                                                                                               
                                                                                                                                                }  
                    break;

               
      case 0x11:                          //P0.0|P0.1|P0.2|P0.3|P0.4为00001说明小车遇到十字标志物下一步直行
                  case 0x10:                         //P0.0|P0.1|P0.2|P0.3|P0.4为10001说明小车遇到十字标志物体下一步小车直行
                  case 0x01:                        //P0.0|P0.1|P0.2|P0.3|P0.4为10000说明小车遇到十字标志物下一步直行
      case 0x00:                       //P0.0|P0.1|P0.2|P0.3|P0.4为00000说明小车遇到十字标志物下一步小车直行
                                                                        while(1)                     
                                                                                                                         {
                                                                                                                                            pwm1=40;
                                                                                                                                            pwm2=40;
                                                                                                                                 turn_right();
                                                                                                                                                 if(P0^2==0)
                                                                                                                                                 {
                                                                                                                                                                break;
                                                                                                                                                         
                                                                                                                                                 }         
                                                                                                                         }     
                   break;
                        case 0x1c:      
                                                                                                 while(1)                //11100
                                                                                                                {
                                                                                                                        pwm1=50;
                                                                                                                        pwm2=50;
                                                                                                                       
                                                                                                                         turn_right();
                                                                                                                        if(P0^2==0)
                                                                                                                                break;

                                                                                                                }
                                    
                break;
                        case 0x07:      
                                                 while(1)                                      //00111
                                              {
                                  pwm1=50;
                                                                                                                            pwm2=50;
                                                                                                                        turn_left();
                                                                                                                        if(P0^2==0)
                                                                                                                                   break;
                            }
                                     
                                                      break;        
      case 0x0b :              while(1)                  //01011
                                               {
                               pwm1=40;
                               pwm2=30;
                              turn_left();
                      if(P0^2==0)
                                                                                                   {
                                     break;
                                 }                                                                                               
                             }
                                break;
                        case 0x1a:                                  //11010
                                                                                while(1)                     
                                                                                                {
                                                                                                                         pwm1=30;
                                                                                                                         pwm2=40;
                                                                                                        turn_right();
                                                                                                                        if(P0^2==0)
                                                                                                                        {
                                                                                                                               
                                                                                                                                 break;
                                                                                                                        }
                                                                                                }
                                                                  
                                        
                                    break;
                        case   0x0f:  while(1)             //01111
                                                                                                 {     
                                                                                                                                                pwm1=50;
                                                                                                                                                pwm2=50;
                                                                                                                                 turn_left();
                                                                                                                          
                                                                                                                         if(P0^2==0)
                                                                                                                                         {  
                                                                                                                                                                break;


                                                                                                                                         }
                                                                 
                                                                                                 }
                                            break;
                        case  0x1e:
                                              while(1)
                                                                                                {
                                                                                                             pwm1=50;
                                                                                                             pwm2=50;
                                                                                                        turn_right();                                                                                //11110
                                                                                                          
                                                                                                    if(P0^2==0)
                                                                                                             break;
                                                                                                 
                                                                                                 }
                                break;
                        default:   
                                      break;                                //P.0|P0.1|P0.2|P0.3|P0.4    其他情况不做任何改动
      }

}


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

相关帖子
回复

使用道具 举报

沙发
ID:162229 发表于 2017-2-5 13:28 | 只看该作者
这是我以前做的一个循迹小车的测试时的程序，比较简单，你看一下，可能会有帮助。

  1. /**************************************************
  2. /*STC89C52控制的智能红外循迹小车
  3. ****************************************************/

  5. #include<reg52.h>
  6. #define uint unsigned int
  7. /**************************************************
  8. /*定义引脚
  9. ***************************************************/
  10. //sbit zuoh1=P3^1;
  11. sbit zuoh2=P3^2;                 //定义左侧探头,用外部中断0
  12. sbit youh2=P3^3;                 //定义右侧探头,用外部中断1
  13. //sbit zuoh1=P3^4;

  15. sbit en1=P2^0;                        //定义右轮使能
  16. sbit you=P2^1;                        //定义右轮前转
  17. sbit zuo=P2^2;                        //定义右轮前转
  18. sbit en2=P2^3;                        //定义左轮使能

  20. uint m,i;
  21. /**************************************************
  22. /*开启定时器1，设置pwm调速
  23. ***************************************************/                                                                       
  24. void Time1()               
  25. {
  26.         TMOD=0x20;
  27.         EA=1;
  28.         ET1=1;
  29.         TH1=0xfe;
  30.         TL1=0xfe;
  31.         TR1=1;
  32. }
  33. /**************************************************
  34. /*pwm调速函数，占空比为w%
  35. ***************************************************/
  36. void run(uint w)               
  37. {
  38.         if(m<w)  en1=en2=1;
  39.         else  en1=en2=0;
  40. }
  41. /**************************************************
  42. /*中断开启函数
  43. ***************************************************/
  44. void inter()                               
  45. {
  46.         EX0=1;
  47.         EX1=1;
  48.         IT0=0;
  49.         IT1=0;
  50. }

  52. /**************************************************
  53. /*        //主函数
  54. ***************************************************/                                                                                                       
  55. void main()                                                                                 
  56. {
  57.         Time1();
  58.         inter();
  59.         while(1)
  60.         {       
  61.                 run(25);                                       
  62.         }
  63. }
  64. /**************************************************
  65. /*//定时器服务函数，pwm
  66. ***************************************************/

  68. void Time() interrupt 3                  
  69. {
  70.         m++;
  71.         if(m>=100)  m=0;
  72. }
  73. /**************************************************
  74. /*//右侧探头服务函数
  75. ***************************************************/
  76. void inter0() interrupt 0                       
  77. {
  78.         en1=en2=1;                  
  79.          while(zuoh2==0)
  80.          {
  81.                  zuo=1;
  82.                  you=0;
  83.          }
  84.          zuo=you=1;         
  85. }
  86. /**************************************************
  87. /*//左侧探头服务函数
  88. ***************************************************/
  89. void inter1() interrupt 2                       
  90. {
  91.         en1=en2=1;
  92.          while(youh2==0)
  93.          {
  94.                  you=1;
  95.                  zuo=0;
  96.          }
  97.          zuo=you=1;
  98. }
复制代码
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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