标题: 单片机+超声波控制舵机转动源程序 [打印本页]
作者: wW123xz    时间: 2020-3-12 17:52
标题: 单片机+超声波控制舵机转动源程序
单片机源程序如下:
  1. #include<reg52.h>
  2. #include<stdio.h>
  3. #include<intrins.h>
  4. #define uchar unsigned char
  5. #define uint unsigned int
  6. sbit Trig=P3^4;            //控制端
  7. sbit Echo=P3^5;          //接收端
  8. sbit led=P1^3;
  9. sbit servorControl =P1^3;  //舵机的控制引脚

  11. uchar flag=0;
  12. uchar control=5;
  13. uchar servorTime=0;






  20. unsigned char T0RH=0;
  21. unsigned char T0RL=0;

  23. void time_init()
  24. {
  25.         EA=1;
  26.         TMOD=0x11;
  27.         TH0 = 0;
  28.         TL0 = 0;
  29. }
  30. ///////////////////////////////////////
  31. void delay(uchar time){  //延迟函数
  32. uchar i;
  33. for(;time>0;time--){
  34.   for(i=0;i<255;i++);
  35. }
  36. }

  38. //初始化定时器
  39. void Delay_us(unsigned char t)
  40. {
  41.         while(--t);
  42. }         //大约延时t*2+5us         超声波模块用
  43. //////////////////////////////////////

  45. void timer0()interrupt 1
  46. {
  47. TH0 = 0;
  48. TL0 = 0;
  49. }
  50. //中断程序 初始化赋值 重新计数 超声波模块用 计算时间
  51. void main()
  52. {
  53.         unsigned int time,distance;
  54.          
  55.         EA=1;
  56.   ET0=1;
  57.   ET1=1;
  58.   TMOD=0x11;
  59.   TH1=0xff;
  60.   TL1=0x9c;
  61.   servorTime=0;
  62.          
  63.          
  64.          
  65.         Trig=0;
  66.         Echo=0;
  67.         time_init();
  68.         while(1)
  69.         {

  71.                 Trig=1;
  72.                 Delay_us(5);
  73.                 Trig=0;
  74.                 while(Echo==0);
  75.                 TR0=1;
  76.                 while(Echo);
  77.                 TR0=0;
  78.                 time=TH0*256+TL0;
  79.                 distance=(int)(time*0.017);                           //计算路程 单位为cm
  80.                 TH0=0;
  81.                 TL0=0;
  82.                 if(distance<30)                                        //如果距离小于30cm 蜂鸣器响
  83.                 {
  84.                 control=15;   //使舵机向正摆动
  85.     servorTime=0;
  86.     TR1=1;
  87.     delay(200);
  88.                 delay(200);
  89.     TR1=0;
  90.                 }
  91.                 else
  92.                 {
  93.                 control=5;   //使舵机向右摆动
  94.     servorTime=0;
  95.     TR1=1;
  96.     delay(200);
  97.                 delay(200);
  98.     TR1=0;
  99.     delay(200);
  100.                 delay(200);
  101.                 }
  102.         }
  103. }
  104. void T1_int(void) interrupt 3{   //产生舵机所需要的脉冲
  105.   TH1=0xff;
  106.   TL1= 0x9c;
  107.   servorTime++;
  108.   if(servorTime<=control)
  109.    servorControl=1;
  110.   else
  111.    servorControl=0;
  112.    if(servorTime>=200)
  113.    servorTime=0;
  114. }
复制代码

所有资料51hei提供下载:
舵机转向与超声波.zip (29.16 KB, 下载次数: 14)

作者: admin    时间: 2020-3-12 22:18
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)
作者: 于丽华    时间: 2020-4-1 15:40
admin 发表于 2020-3-12 22:18
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)

没有编辑按钮啊



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