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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › 单片机+超声波控制舵机转动源程序
返回列表 发新帖
查看: 2532|回复: 2
打印 上一主题 下一主题
收起左侧

单片机+超声波控制舵机转动源程序

[复制链接]
跳转到指定楼层
楼主
ID:595263 发表于 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)

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

使用道具 举报

沙发
ID:1 发表于 2020-3-12 22:18 | 只看该作者
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)
回复

使用道具 举报

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

没有编辑按钮啊
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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