标题: 智能寻迹小车CODE [打印本页]
作者: 风中的大表哥    时间: 2017-1-9 16:20
标题: 智能寻迹小车CODE
第一次发帖 给我点黑b吧


资料下载：
智能寻迹小车CODE 11-14.rar (32.13 KB, 下载次数: 10)

  1. /*******************引脚定义****************/
  2. #include "reg51.h"  
  3. typedef unsigned int uint;  
  4. typedef unsigned char uchar;

  6. #define Duty_cycle  35  //占空比
  7. #define Cycle       100 //PWM周期

  9. sbit Sensor_1 = P1^1;  //红外检测
  10. sbit Sensor_2 = P1^2;  
  11. sbit Sensor_3 = P1^3;   

  13. sbit Motor_1H = P2^0;  //电机驱动控制信号
  14. sbit Motor_1L = P2^1;  
  15. sbit Motor_2H = P2^2;  
  16. sbit Motor_2L = P2^3;  

  18. sbit En_pwm1 = P2^4;          //使能信号（PWM）
  19. sbit En_pwm2 = P2^5;

  21. uchar timer1;           //定义变量
  22. /*******************************************************************************
  23. * 函 数 名       : Time1Config
  24. * 函数功能                 : 设置定时器
  25. * 输    入       : 无
  26. * 输    出       : 无
  27. *******************************************************************************/
  28. /**************设置定时器***********/
  29. void Time1Config()
  30. {
  31.         TMOD|= 0x10;   //设置定时计数器T1工作在模式1

  33.         /***定时器赋初始值，12MHZ下定时0.5ms***/  
  34.         TH1 = 0xFE;
  35.         TL1 = 0x0C;

  37.         ET1 = 1;          //开启定时器1中断
  38.         EA = 1;
  39.         TR1 = 1;         //开启定时器       
  40. }

  42. /************************************************  
  43. 延时函数   
  44. 总共延时
  45. 1ms
  46. 乘以
  47. count  
  48. ************************************************/  
  49. void DelayX1ms(uint count)  
  50. {  
  51. uint j;  
  52. while(count--!=0)  
  53. {  
  54.   for(j=0;j<72;j++);
  55. }  
  56. }  
  57. /************************************************

  59. 电机转动函数定义

  61. ************************************************/  

  63. void Go_Straight( )  
  64. {   
  65. Motor_1H = 0;  
  66. Motor_1L = 0;  
  67. Motor_2H = 0;  
  68. Motor_2L = 0;
  69. DelayX1ms(10);

  71. Motor_1H = 1;  
  72. Motor_1L = 0;  
  73. Motor_2H = 1;  
  74. Motor_2L = 0;
  75. DelayX1ms(20);
  76. }  

  78. void Turn_Left( )  
  79. {
  80. En_pwm1=0;
  81. En_pwm2=0;
  82. DelayX1ms(10);  

  84. Motor_1H = 0;  
  85. Motor_1L = 1;  
  86. Motor_2H = 1;  
  87. Motor_2L = 0;
  88. DelayX1ms(20);
  89. }  

  91. void Turn_Right( )  
  92. {  
  93. En_pwm1=0;
  94. En_pwm2=0;
  95. DelayX1ms(10);

  97. Motor_1H = 1;  
  98. Motor_1L = 0;  
  99. Motor_2H = 0;  
  100. Motor_2L = 1;
  101. DelayX1ms(20);
  102. }  

  104. void Go_Back( )  
  105. {  
  106. Motor_1H = 0;  
  107. Motor_1L = 0;  
  108. Motor_2H = 0;  
  109. Motor_2L = 0;
  110. DelayX1ms(10);

  112. Motor_1H = 0;  
  113. Motor_1L = 1;  
  114. Motor_2H = 0;  
  115. Motor_2L = 1;
  116. DelayX1ms(20);
  117. }


  120. /**************主函数**************************/  
  121. void main( )  
  122. {  
  123. Time1Config();  //定时器初始化

  125. while(1)  
  126. {  
  127. if(Sensor_1==0 && Sensor_2==1 && Sensor_3==0)      //状态：轨迹居中
  128.    Go_Straight();                                  //方向：前进
  129. else if(Sensor_1==0 && Sensor_2==0 && Sensor_3==1)       //状态：偏左
  130.    Turn_Right();                                     //方向：右转
  131. else if(Sensor_1==1 && Sensor_2==0 && Sensor_3==0) //状态：偏右
  132.    Turn_Left();                                //方向：左转
  133. else if(Sensor_1==0 && Sensor_2==0 && Sensor_3==0)       //状态：偏离轨道
  134.    Go_Back();                                      //方向：后退
  135. else  Go_Straight( );                              //其他情况：前进
  136. }     
  137. }

  139. /*******************************************************************************
  140. * 函 数 名       : Time1
  141. * 函数功能                 : 定时器1的中断函数
  142. * 输    入       : 无
  143. * 输    出       : 无
  144. * 备    注       ： 3 为定时器1的中断号 1 定时器0的中断号 0 外部中断1 2 外部中断2  4 串口中断
  145. *******************************************************************************/
  146. /********************定时器1的中断函数********************/
  147. void Time1(void) interrupt 3    //3 为定时器1的中断号
  148. {
  149.            timer1++;         
  150.         if(timer1>Cycle)              //PWM周期为100*0.5ms
  151.                 {
  152.                         timer1=0;
  153.                 }
  154.                 if(timer1 < Duty_cycle)            //改变Duty_cycle这个值可以改变直流电机的速度
  155.                 {
  156.                         En_pwm1=1;
  157.                         En_pwm2=1;
  158.                 }
  159.                 else
  160.                 {
  161.                         En_pwm1=0;
  162.                         En_pwm2=0;
  163.                 }       
  164.         TH1 = 0xFE;                   //重新赋初值
  165.         TL1 = 0x0C;
  166. }
复制代码






欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1