当前位置:文档之家› 必看一、如何用舵机控制器控制机械手(最新)

必看一、如何用舵机控制器控制机械手(最新)

必看一、如何用舵机控制器控制机械手(最新)
必看一、如何用舵机控制器控制机械手(最新)

20路舵机控制器控制机械手详细步骤

一、首先检查所有的物件是否齐全,一台组装好的机械手,20路舵机控制器、USB下载线、PS2手柄(套餐六不含)、电池、稳压模块、导线。

二、按照“控制板接线说明”(见附件)把线接好。

三、检查下线路如下图把USB线插到电脑USB接口上。现在开始联机操作。

四、安装驱动,舵机控制器文件夹下usc_driver.exe

装好后,在我的电脑-设备管理器找到我们需要的端口号,如下图:

注意可能有的电脑不是COM5,只要出现COM口就行了。

五、打开舵机控制器文件下面的上位机软件:

六、这是可以在界面空白处右键选择机械臂布局:

七、可以看到现在是这样的布局:

八、接着找到我们电脑设备管理器出现的COM口,找到后点击“联机”如下图:

九、联机状态如下:

这里是COM4可能有的电脑上不是这个口,只要与设备管理器里面一致就行

十、现在可以把舵机接线插到控制板上从下到上分别插到S1-S6(注意:红线—+,黄色—S,棕色—-),然后把电池接上。

十一、现在拖动上位机对应舵机的滑条,可以看到相应的舵机会转动。

按照上面的步骤在上位机上拖动滑条舵机会动,这就说明已经联机成功了下面就可以慢慢自己调动作。

1.打开我们的《参考动作文件》里面的“标准动作”文件,导入进去之后点击运行

运行出来机械臂应该是直立的状态,而且手爪闭合。这是作为一个基本的标准动作我们可以下到板子里去,点击下载,下载完成后我们在文件里面刷新下可以看到有个1txt,这就说明此标准动作已经下到板子里去了且默认为1号动作组,这时我们可以把鼠标放在1txt上点击鼠标右键将此动作“设置脱机运行”,意思是当我们脱机时接通电源机械手就会自动执行此动作。当然您也可以将其他动作设置为脱机运行,同样接通电源后会自动执行此动作。

2.我们可以将《参考动作文件》中其他动作组也导入进去运行看看,同时您也可以自己编辑其他动作组依次下载到板子里去,下一个就会增加一个动作组,下载完成可以在文件里查看,1txt、2txt、3txt。。。。。。等。如果觉得动作不行的话或者想换可以把原来下载好的删除掉,也是在文件里刷新出来想要删除哪一个就右键点击“删除”,然后再重新编辑下载。

3.自己想要的动作组编辑好下载完成之后,我们可以设置PS2(没有PS2的就无需设置了)

点击上位机左上角的工具—PS2手柄可以看到如下界面:

这里手柄上的数字符号如#1GC1表示的意思是动作组1循环执行1次,您可以直

接修改每个按键上的数字符号来改变其原始所对应的动作组号及循环次数。全部设置好后点击“确定”会提示设置成功。下面我们就可以在脱机状态下来用手柄执行每个动作组了。

脱机操作:

1.在前面的联机操作中我们已经把动作组编好下载到板子里去了,现在开始就是脱机运行操作了,这时先把电池拔掉,USB拔下重新接线如下图:

一定要反复检查好线路是否正确才能接上电池。

2.这样把线接好后,把PS2的接收器插到控制板上

3.接上电池,拿两个7号电池装在PS2上,打开手柄开关ON,按start键可以看到手柄接收器上的灯不闪了,手柄上的灯也不闪,这种情况就表示已经连接成功,如果没连接上灯会闪烁。

4.当我们接通电池的瞬间可以看到机械臂会自动执行之前设置为脱机运行的动作组。下面就按手柄上的按键执行其他对应设置的动作组了。

5.按照以上步骤一步步来操作有问题先自行排查原因,找不出原因及时在旺旺上跟我们联系我们会在第一时间给您解答。

51单片机程序:按键控制舵机角度

#include "reg52.h" unsigned char count; //0.5ms次数标识 sbit pwm =P2^7 ; //PWM信号输出 sbit jia =P2^4; //角度增加按键检测IO口 sbit jan =P2^5; //角度减少按键检测IO口 unsigned char jd=5; //角度标识 void delay(unsigned char i)//延时 { unsigned char j,k; for(j=i;j>0;j--) for(k=125;k>0;k--); } void Time0_Init() //定时器初始化 { TMOD = 0x01; //定时器0工作在方式1 IE = 0x82; TH0 = 0xfe; TL0 = 0x33; //11.0592MZ晶振,0.5ms TR0=1; //定时器开始 } void Time0_Int() interrupt 1 //中断程序 { TH0 = 0xfe; //重新赋值 TL0 = 0x33; if(count< jd) //判断0.5ms次数是否小于角度标识 pwm=1; //确实小于,PWM输出高电平 else pwm=0; //大于则输出低电平 count=(count+1); //0.5ms次数加1 count=count%40; //次数始终保持为40 即保持周期为20ms } void keyscan() //按键扫描 { if(jia==0) //角度增加按键是否按下 { delay(10); //按下延时,消抖 if(jia==0) //确实按下 { jd++; //角度标识加1 count=0; //按键按下则20ms周期从新开始 if(jd==6) jd=5; //已经是180度,则保持 while(jia==0); //等待按键放开

舵机工作原理

控制思想 该模块的程序框图如图4.5 所示。车模在行驶过程中不断采样赛道信息,并通过分析车模与赛道相对位置判断车模所处赛道路况,是弯道还是直道,弯道时是左转还是右转。直道时小车舵机状态保持不变,弯道时左转或右转,计算转弯半径。我们所用舵机的标准PWM 周期为20ms,转动角度最大为左右90度,PWM调制波如图7.2所示。

当给舵机输入脉宽为0.5ms,即占空比为0.5/20=2.5%的调制波时,舵机右转90度;当给舵机输入脉宽为1.5ms,即占空比为1.5/20=7.5%的调制波时,舵机静止不动;当给舵机输入脉宽为2.5ms,即占空比为2.5/20=12.5%的调制波时,舵机左转90度。可以推导出舵机转动角度与脉冲宽度的关系计算公式为: 注:其中t为正脉冲宽度(ms);θ为转动角度;当左转时取加法计算,右转时取减法计算结果。 当我们根据赛道弯度计算出转动角度以后便可以根据舵机的参数计算出脉冲宽度,控制舵机转动,舵机转角与PWM脉宽关系如表4-1所示。

在具体操作中PWM调制波的周期可以设置在20ms左右一定范围内,比如设置为10ms 或是30ms均可以使舵机正常转动,但是设置周期较长时,系统延迟时间较多,舵机转向会出现滞后,导致赛车冲出跑道;设置周期如果过短,系统输出PWM 调制波不稳定,舵机转动也会受影响,不能实现赛车的精确转向。经过反复测试,最终把输出PWM 调制波周期设定为13ms (用计数器实现)。 运行电机的转速以及舵机的转角,在软件上都是通过对PWM 波占空比进行设置来相应控制的。前面提到,舵机转角控制需要将两个

八位寄存器合成为一个十六位寄存器。程序中的舵机位置信号,当PWM调制波周期设为13ms时,因为总线频率为24MHz,用时钟SB,可计算得到16进制参数为9870H,舵机中间位置时占空比16进制参数为1680H,要分配给PWM6和7,分配时这2个端口的赋值必须是16进制,那么PWM模块初始化赋值为 PWMPER6= 0x98,PWMPER7= 0x70,PWMDTY6= 0x16,PWMDTY7= 0x80,因此这就牵涉到如何将1个十进制数分配为2个十六进制数问题。有2种方案,一种是除法取余,另一种是移位操作,前者编译生成的代码比后者要多,所以采用移位操作来实现,即取高位时与0xFF00先作“&”计算,然后将所得到的数向右移8位(>>8),即可取得高8位;同理,取低8位时只要与0x00FF作“&”计算即可(算法)。 2、结构和控制 一般来讲,舵机主要由以下几个部分组成,舵盘、减速齿轮组、位置反馈电位计5k、直流电机、控制电路板等。 工作原理:控制电路板接受来自信号线的控制信号(具体信号待会再讲),控制电机转动,电机带动一系列齿轮组,减速后传动至输出舵盘。舵机的输出轴和位置反馈电位计是相连的,舵盘转动的同时,带动位置反馈电位计,电位计将输出一个电压信号到控制电路板,进行反馈,然后控制电路板根据所在位置决定电机的转动方向和速度,从而达到目标停止。

详细的舵机控制原理资料

目录 一.舵机PWM信号介绍 (1) 1.PWM信号的定义 (1) 2.PWM信号控制精度制定 (2) 二.单舵机拖动及调速算法 (3) 1.舵机为随动机构 (3) (1)HG14-M舵机的位置控制方法 (3) (2)HG14-M舵机的运动协议 (4) 2.目标规划系统的特征 (5) (1)舵机的追随特性 (5) (2)舵机ω值测定 (6) (3)舵机ω值计算 (6) (4)采用双摆试验验证 (6) 3.DA V的定义 (7) 4.DIV的定义 (7) 5.单舵机调速算法 (8) (1)舵机转动时的极限下降沿PWM脉宽 (8) 三.8舵机联动单周期PWM指令算法 (10) 1.控制要求 (10) 2.注意事项 (10) 3.8路PWM信号发生算法解析 (11) 4.N排序子程序RAM的制定 (12) 5.N差子程序解析 (13) 6.关于扫尾问题 (14) (1)提出扫尾的概念 (14) (2)扫尾值的计算 (14)

一.舵机PWM 信号介绍 1.PWM 信号的定义 PWM 信号为脉宽调制信号,其特点在于他的上升沿与下降沿之间的时间宽度。具体的时间宽窄协议参考下列讲述。我们目前使用的舵机主要依赖于模型行业的标准协议,随着机器人行业的渐渐独立,有些厂商已经推出全新的舵机协议,这些舵机只能应用于机器人行业,已经不能够应用于传统的模型上面了。 目前,北京汉库的HG14-M 舵机可能是这个过渡时期的产物,它采用传统的PWM 协议,优缺点一目了然。优点是已经产业化,成本低,旋转角度大(目前所生产的都可达到185度);缺点是控制比较复杂,毕竟采用PWM 格式。 但是它是一款数字型的舵机,其对PWM 信号的要求较低: (1) 不用随时接收指令,减少CPU 的疲劳程度; (2) 可以位置自锁、位置跟踪,这方面超越了普通的步进电机; 其PWM 格式注意的几个要点: (1 ) 上升沿最少为0.5mS ,为0.5mS---2.5mS 之间; (2) HG14-M 数字舵机下降沿时间没要求,目前采用0.5Ms 就行;也就是说PWM 波形 可以是一个周期1mS 的标准方波; (3) HG0680为塑料齿轮模拟舵机,其要求连续供给PWM 信号;它也可以输入一个周 期为1mS 的标准方波,这时表现出来的跟随性能很好、很紧密。

舵机及转向控制原理

舵机及转向控制原理 令狐采学 1、概述 2、舵机的组成 3、舵机工作原理 4、舵机选购 5、舵机使用中应注意的事项 6、辉盛S90舵机简介 7、如何利用程序实现转向 8、51单片机舵机测试程序 1、概述 舵机也叫伺服电机,最早用于船舶上实现其转向功能,由于可以通过程序连续控制其转角,因而被广泛应用智能小车以

实现转向以及机器人各类关节运动中,如图1、图2所示。 令狐采学创作 图1舵机用于机器人 图2舵机用于智能小车中 舵机是小车转向的控制机构,具有体积小、力矩大、外部机械设计简单、稳定性高等特点,无论是在硬件设计还是软件设计,舵机设计是小车控制部分重要的组成部分,图3为舵机的外形图。 图3舵机外形图 2、舵机的组成 一般来讲,舵机主要由以下几个部分组成,舵盘、减速齿 轮组、位置反馈电位计、直流电机、控制电路等,如图4、图5所示。 图4舵机的组成示意图 图5舵机组成

舵机的输入线共有三条,如图6所示,红色中间,是电源线,一边黑色的是地线,这辆根线给舵机提供最基本的能源保证,主要是电机的转动消耗。电源有两种规格,一是4.8V, —令狐采学创作是6.0V,分别对应不同的转矩标准,即输出力矩不 同,6.0V对应的要大一些,具体看应用条件;另外一根线是控制信号线,Futaba的一般为白色,JR的一般为桔黄色。另外要注意一点,SANWA的某些型号的舵机引线电源线在边上而不是中间,需要辨认。但记住红色为电源,黑色为地线,一般不会搞错。 图6舵机的输出线 3、舵机工作原理 控制电路板接受来自信号线的控制信号,控制电机转动,电机带动一系列齿轮组,减速后传动至输出舵盘。舵机的输出轴和位置反馈电位计是相连的,舵盘转动的同时,带动位置反馈电位计,电位计将输出一个电压信号到控制电路板,进行反馈,然后控制电路板根据所在位置决定电机转动的方向和速度,从而达到目标停止。其工作流程为:控制信号一控制电路板―电机转动-齿轮组减速-舵盘转动?位置反馈电位计-控制电路板反馈。

飞鸿16路舵机控制器使用说明书

FH24路舵机控制器使用说明书 飞鸿科技 2012-5-24 一、产品介绍 (1) 二、功能特点 (3) 三、接口说明 (4) 四、指令说明 (6) 五、16路舵机调试软件使用说明 (7) 二、连接PC上位机 (9) 三、上位机界面编辑 (10) 四、单路舵机调试 (11) 五、动作组编辑 (12) 六、注意事项及故障解决 (13) 产品介绍 一、 一、产品介绍 设计该舵机控制板是为了方便新手学习多路舵机的控制。多路舵机控制并不很复杂,但至今网上关于多路舵机控制的资源很少,当前淘宝上的舵机控制板也都不提供程序代码。由于这些原因,大批的机器人爱好者不能掌握多路舵机控制。使得很多机器人爱好者停滞不前,在这些最基本的地方浪费大量时间,不能不精力放到更高层的机器人控制方面的研究。如果每个人

都从头做起,整体的进步必将非常的缓慢。别人做好的东西我们不妨拿来学习,这样要节省很多的时间与精力。在这个基础上继续前进,做出属于自己的更高级的机器人。 由于本人在这些基础的东西上耗费的大量的精力,导致我没有时间去做高级的控制,如自平衡,语音识别等。大学接近尾声,没能让自己的机器人进一步升级感到非常遗憾。 基于方便学习的原则,本板子的设计有一下几个特点: 1、选用大家熟悉的,容易掌握的51单片机。但不是普通51单片机,是功能强大的增强型单片机STC12C5A60S2。 有人说51控制的精度肯定不如ARM。是的,这是明显的事实。但是我用ARM的芯片来写教程,只能给少数人看,而且如果那个人ARM掌握的都很好了,也不需要看此教程了。该控制板设计的目的就是给机器人初级爱好者学习,仅仅因为这一点,选择51单片机是最恰当不过了。 我最初做的32路舵机控制板就是在arm芯片上做的,那些不适合新手学习,在51上学会了舵机控制的基本方法,等你会使用更高级单片机的时候可以很容易的移植到上面,实现更多舵机,更高精度的控制。 STC12C5A60S2单片机属于增强型51。他兼容传统的51单片机,也就是说,你原来的学习的、编写的51程序不用改动就能在这个单片机上直接使用,不会出现问题,而且速度提高8~12倍。但是它与传统51相比,在速度性能与资源方面都有了很大的提升。 (1)60K的flash程序存储器。89C52只有8K。 (2)1280字节的SRAM。你课本上学的RAM只有128字节。1280足够用了,省去外部扩展的麻烦。 (3)两个串口。 (4)独立波特率发生器。做机器人定时器往往很不够用,而传统51单片机串口通信还要占用定时器,有了独立波特率发生器就可以节省出一个定时器。 (5)PCA模块。可以硬件输出快速PWM。可以扩展出两个定时器。 (6)8路A/D转换通道。A/D转换在机器人、各种比赛中都很常用,使用这款单片机就不必再做AD转换电路。 2、程序下载接口、IO口引出。该板是单片机最小系统板+16路舵机控制板。不是单纯的舵机控制板,而是一款可以用来学习、编程、二次开发的开发板。可以直接用来参加比赛,DIY,毕业设计。 5、详细的教程,丰富的资料。该板子是淘宝中唯一提供程序代码、可以学习的舵机控制板。提供原理图、接口示意图、程序代码、上位机软件。另外购买该产品赠送本人搜集的单片机开发常用工具软件,机器人资料,单片机视频教程以及丰富的例程。

MG996R舵机控制说课讲解

M G996R舵机控制

MG996R舵机控制方法 红:+5v,棕:GND,黄:信号 基于单片机的舵机控制方法具有简单、精度高、成本低、体积小的特点,并可根据不同的舵机数量加以灵活应用。 在机器人机电控制系统中,舵机控制效果是性能的重要影响因素。舵机可以在微机电系统和航模中作为基本的输出执行机构,其简单的控制和输出使得单片机系统非常容易与之接口。 舵机是一种位置伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。其工作原理是:控制信号由接收机的通道进入信号调制芯片,获得直流偏置电压。它内部有一个基准电路,产生周期为20ms,宽度为1.5ms的基准信号,将获得的直流偏置电压与电位器的电压比较,获得电压差输出。最后,电压差的正负输出到电机驱动芯片决定电机的正反转。当电机转速一定时,通过级联减速齿轮带动电位器旋转,使得电压差为0,电机停止转动。 图1舵机的控制要求

舵机的控制信号是PWM信号,利用占空比的变化改变舵机的位置。一般舵机的控制要求如图1所示。 单片机实现舵机转角控制 可以使用FPGA、模拟电路、单片机来产生舵机的控制信号,但FPGA成本高且电路复杂。对于脉宽调制信号的脉宽变换,常用的一种方法是采用调制信号获取有源滤波后的直流电压,但是需要50Hz(周期是20ms)的信号,这对运放器件的选择有较高要求,从电路体积和功耗考虑也不易采用。5mV以上的控制电压的变化就会引起舵机的抖动,对于机载的测控系统而言,电源和其他器件的信号噪声都远大于5mV,所以滤波电路的精度难以达到舵机的控制精度要求。 也可以用单片机作为舵机的控制单元,使PWM信号的脉冲宽度实现微秒级的变化,从而提高舵机的转角精度。单片机完成控制算法,再将计算结果转化为PWM信号输出到舵机,由于单片机系统是一个数字系统,其控制信号的变化完全依靠硬件计数,所以受外界干扰较小,整个系统工作可靠。 单片机系统实现对舵机输出转角的控制,必须首先完成两个任务:首先是产生基本的PWM周期信号,本设计是产生20ms的周期信号;其次是脉宽的调整,即单片机模拟PWM信号的输出,并且调整占空比。 当系统中只需要实现一个舵机的控制,采用的控制方式是改变单片机的一个定时器中断的初值,将20ms分为两次中断执行,一次短定时中断和一次长定

单片机程序按键控制舵机角度

#i n c l u d e"r e g52.h" unsigned char count; //0.5ms次数标识 sbit pwm =P2^7 ; //PWM信号输出 sbit jia =P2^4; //角度增加按键检测IO口 sbit jan =P2^5; //角度减少按键检测IO口 unsigned char jd=5; //角度标识 void delay(unsigned char i)//延时 { unsigned char j,k; for(j=i;j>0;j--) for(k=125;k>0;k--); } void Time0_Init() //定时器初始化 { TMOD = 0x01; //定时器0工作在方式1 IE = 0x82; TH0 = 0xfe; TL0 = 0x33; //11.0592MZ晶振,0.5ms TR0=1; //定时器开始 } void Time0_Int() interrupt 1 //中断程序 {

TH0 = 0xfe; //重新赋值 TL0 = 0x33; if(count< jd) //判断0.5ms次数是否小于角度标识 pwm=1; //确实小于,PWM输出高电平 else pwm=0; //大于则输出低电平 count=(count+1); //0.5ms次数加1 count=count%40; //次数始终保持为40 即保持周期为20ms } void keyscan() //按键扫描 { if(jia==0) //角度增加按键是否按下 { delay(10); //按下延时,消抖 if(jia==0) //确实按下 { jd++; //角度标识加1 count=0; //按键按下则20ms周期从新开始 if(jd==6) jd=5; //已经是180度,则保持 while(jia==0); //等待按键放开 }

舵机控制程序

在机器人机电控制系统中,舵机控制效果是性能的重要影响因素。舵机可以在微机电系统和航模中作为基本的输出执行机构,其简单的控制和输出使得单片机系统非常容易与之接口。 舵机是一种位置伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。其工作原理是:控制信号由接收机的通道进入信号调制芯片,

获得直流偏置电压。它内部有一个基准电路,产生周期为20ms,宽度为1.5ms的基准信号,将获得的直流偏置电压与电位器的电压比较,获得电压差输出。最后,电压差的正负输出到电机驱动芯片决定电机的正反转。当电机转速一定时,通过级联减速齿轮带动电位器旋转,使得电压差为0,电机停止转动。舵机的控制信号是PWM信号,利用占

空比的变化改变舵机的位置。一般舵机的控制要求如图1所示。 图1 舵机的控制要求 单片机实现舵机转角控制可以使用FPGA、模拟电路、单片机来产生舵机的控制信号,但FPGA成本高且电路复杂。对于脉宽调制信号的脉宽变换,常用的一种方法是采用调制信号获取有源滤波后的直流电压,但是需要50Hz(周期是20ms)的信号,这对运放 器件的选择有较高要求,从电路体积和功耗考虑也不易采用。5mV 以上的控制电压的变化就会引起舵机的抖动,对于机载的测控系统而言,电源和其他器件的信号噪声都远大于5mV,所以滤波

电路的精度难以达到舵机的控制精度要求。 也可以用单片机作为舵机的控制单元,使PWM信号的脉冲宽度实现微秒级的变化,从而提高舵机的转角精度。单片机完成控制算法,再将计算结果转化为PWM信号输出到舵机,由于单片机系统是一个数字系统,其控制信号的变化完全依靠硬件计数,所以受外界干扰较小,整个系统工作可靠。 单片机系统实现对舵机输出转角的控制,必须首先完成两个任务:首先是产生基本的PWM周期信号,本设计是产生20ms的周期信号;其次是脉宽的调整,即单片机模拟PWM信号的输出,并且调整占空比。当系统中只需要实现一个舵机的控制,采用的控制方式是改变单片机的一个定时器中断的初值,将20ms分为两次中断执行,一次短定时中断和一次长定时中断。这样既节省了硬件电路,也减少了软件开销,控制系统工作效率和控制精度都很高。 具体的设计过程: 例如想让舵机转向左极限的角度,它的正脉冲为2ms,则负脉冲为 20ms-2ms=18ms,所以开始时在控制口发送高电平,然后设置定时器在

舵机测试方案

舵机测试方案 1、舵机转速测量 方案一:通过测量舵机无负载的情况下转过60°角所需时间来确定舵机转速。以扇形纸板固定在舵盘上,在舵机从-45°~+45°(或-90°~+90°)位置之间的-30°~+30°角线的适当位置制作两小孔(下图A,B处为红外对管信息采集通道),以给红外射对管提供信息传递通道。这样就可以在这两个信息通道采集舵机在转过60°范围的起始位置和结束位置的信号变化,将采集到的信号经过比较器(LM393)整形后送入单片机进行处理(这里可将整形后的数字变化信号进行定时中断处理),就可以获得舵机在转过60°范围的起始位置和结束位置过程中需要的时间值,并将时间值通过数码管显示出来。从而测得舵机的转速值。

方案二:测试设备:舵机控制器速度测试架 操作方法: 1设定好舵机供电电压 2舵机控制器脉冲宽度制调节在,接上舵机,使舵机静止在舵机的中央位置 3舵机固定在角度测试架上,指针较准在90度 4使舵机控制器的脉宽输出变成2ms,记录正向60度角摆幅的时间(正向1) 5使舵机控制器的脉宽输出变回,记录反向60度角摆幅的时间(反向1) 6使舵机控制器的脉宽输出变成,记录反向60度角摆幅的时间(反向2) 7使舵机控制器的脉宽输出变回,记录正向60度角摆幅的时间(正

向2) 8更改舵机供电电压,重覆步骤2到7 2、转矩测量 方案一:通过实际的测试来验证该舵机的转矩。因为舵机扭矩的单位是Kg·cm,所以可以在舵盘上距舵机轴中心水平 距离1cm处,测试舵机能够带动物体的重量。 注意:因为较高的电压可以提高电机的速度和扭矩,所以在测试其性能参数时应根据具体情况合理选择舵机的工作 电压。

51控制舵机程序大全

#include void InitTimer0(void) { TMOD = 0x01; TH0 = 0x0B1; TL0 = 0x0E0; EA = 1; ET0 = 1; TR0 = 1; }void delay(1)(void) { unsigned char a,b,c; for(c=1;c>0;c--) for(b=142;b>0;b--) for(a=2;a>0;a--); } void main(void) { InitTimer0(); P1_2=0; while(1); } void Timer0Interrupt(void) interrupt 1 { //20ms中断 TH0 = 0x0B1; TL0 = 0x0E0; P1_2=1; delay(1); P1_2=0; }

#include #include #include #define uchar unsigned char #define uint unsigned int sbit IN1=P0^0; sbit IN2=P0^1; sbit EA1=P0^5; sbitdj=P0^7; //舵机口 uint t=0;//中断次数 ucharzk;//高电平中断次数uchar p=0;//定义pwm占空比void delay(uint z) { uinti,j; for(i=0;i>8;//100us一次中断TL0=-100%256; if(t==0)zk=p; if(t=zk) dj=0; t++; if(t>=200) t=0;//20mspwm周期 } void turn_left() { IN1=1;IN2=0;EA1=1;//电机工作p=5;//0.5ms delay(600); } void turn_right() { IN1=1;IN2=0;EA1=1;//电机工作p=25;//2.5ms delay(600);

舵机控制C程序

舵机控制C程序 #include #defineucharunsignedchar #defineuintunsignedint /* 变量定义 */ ucharkey_stime_counter,hight_votage=15,timeT_counter; bitkey_stime_ok; /* 引脚定义 */ sbitcontrol_signal=P0^0; sbitturn_left=P3^4; sbitturn_right=P3^5; /***************************************************************** 名称:定时器0初始化 功能:20ms定时,11.0592M晶振 初值20ms 初值0.1ms *****************************************************************/ voidTimerInit() { control_signal=0; TMOD=0x01;//设置定时器0为工作方式1 EA=1;//开总中断 ET0=1;//定时器0中断允许 TH0=0xFF;//定时器装初值 TL0=0xA3; TR0=1;//启动定时器0 } /********************************************** 定时器0中断服务函数 ***********************************************/ voidtimer0(void)interrupt1using0 { TH0=0xFF; TL0=0xA3;//定时器0重新装入数值

MG996R舵机控制

MG996R舵机控制方法 红:+5v,棕:GND,黄:信号 基于单片机的舵机控制方法具有简单、精度高、成本低、体积小的特点,并可根据不同的舵机数量加以灵活应用。 在机器人机电控制系统中,舵机控制效果是性能的重要影响因素。舵机可以在微机电系统和航模中作为基本的输出执行机构,其简单的控制和输出使得单片机系统非常容易与之接口。 舵机是一种位置伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。其工作原理是:控制信号由接收机的通道进入信号调制芯片,获得直流偏置电压。它内部有一个基准电路,产生周期为20ms,宽度为1.5ms的基准信号,将获得的直流偏置电压与电位器的电压比较,获得电压差输出。最后,电压差的正负输出到电机驱动芯片决定电机的正反转。当电机转速一定时,通过级联减速齿轮带动电位器旋转,使得电压差为0,电机停止转动。 图1舵机的控制要求 舵机的控制信号是PWM信号,利用占空比的变化改变舵机的位置。一般舵机的控制要求如图1所示。 单片机实现舵机转角控制 可以使用FPGA、模拟电路、单片机来产生舵机的控制信号,但FPGA成本高且电路复杂。对于脉宽调制信号的脉宽变换,常用的一种方法是采用调制信号获取有源滤波后的直流电压,但是需要50Hz(周期是20ms)的信号,这对运放器件的选择有较高要求,从电路体积和功耗考虑也不易采用。5mV以上的控制电压

的变化就会引起舵机的抖动,对于机载的测控系统而言,电源和其他器件的信号噪声都远大于5mV,所以滤波电路的精度难以达到舵机的控制精度要求。 也可以用单片机作为舵机的控制单元,使PWM信号的脉冲宽度实现微秒级的变化,从而提高舵机的转角精度。单片机完成控制算法,再将计算结果转化为PWM信号输出到舵机,由于单片机系统是一个数字系统,其控制信号的变化完全依靠硬件计数,所以受外界干扰较小,整个系统工作可靠。 单片机系统实现对舵机输出转角的控制,必须首先完成两个任务:首先是产生基本的PWM周期信号,本设计是产生20ms的周期信号;其次是脉宽的调整,即单片机模拟PWM信号的输出,并且调整占空比。 当系统中只需要实现一个舵机的控制,采用的控制方式是改变单片机的一个定时器中断的初值,将20ms分为两次中断执行,一次短定时中断和一次长定时中断。这样既节省了硬件电路,也减少了软件开销,控制系统工作效率和控制精度都很高。 具体的设计过程:例如想让舵机转向左极限的角度,它的正脉冲为2ms,则负脉冲为20ms-2ms=18ms,所以开始时在控制口发送高电平,然后设置定时器在2ms后发生中断,中断发生后,在中断程序里将控制口改为低电平,并将中断时间改为18ms,再过18ms进入下一次定时中断,再将控制口改为高电平,并将定时器初值改为2ms,等待下次中断到来,如此往复实现PWM信号输出到舵机。用修改定时器中断初值的方法巧妙形成了脉冲信号,调整时间段的宽度便可使伺服机灵活运动。 为保证软件在定时中断里采集其他信号,并且使发生PWM信号的程序不影响中断程序的运行(如果这些程序所占用时间过长,有可能会发生中断程序还未结束,下次中断又到来的后果),所以需要将采集信号的函数放在长定时中断过程中执行,也就是说每经过两次中断执行一次这些程序,执行的周期还是20ms。 软件流程如图2所示。

单片机按键控制舵机转动

忆飞工作室 https://www.doczj.com/doc/c55110091.html, 忆飞电子淘宝店欢迎进入 设计者:曾传辉 时间2012年8月13号 手机:134******** QQ:36439133 旺旺:epiapl_cn 程序名称:按键控制舵机控制 程序效果:单片机两个按键控制左右转,转角90度单片 #include #define Sevro_moto_pwm P1_0 //接舵机信号端输入PWM信号调节速度 #define k1 P2_5 //按键控制舵机左转 #define k2 P2_6 //按键控制舵机右转 unsigned char pwm_val_left = 0;//变量定义 unsigned char push_val_left;// =14;//舵机归中,产生约,1.5MS 信号 unsigned int timer=0; //延时基准变量 unsigned char timer1=0; //扫描时间变量 void pwm_Servomoto(void); //函数申明 unsigned int val,val2,fl1,fl2; //变量申明 /************************************************************************/ void delay(unsigned int k) //延时函数 { unsigned int x,y; for(x=0;x

舵机控制型机器人设计要点

课程设计项目说明书 舵机控制型机器人设计 学院机械工程学院 专业班级2013级机械创新班 姓名吴泽群王志波谢嘉恒袁土良指导教师王苗苗 提交日期 2016年4 月1日

华南理工大学广州学院 任务书 兹发给2013级机械创新班学生吴泽群王志波谢嘉恒袁土良 《产品设计项目》课程任务书,内容如下: 1. 题目:舵机控制型机器人设计 2.应完成的项目: 1.设计舵机机器人并实现运动 2.撰写机器人说明书 3.参考资料以及说明: [1] 孙桓.机械原理[M].北京.第六版;高等教育出版社,2001 [2] 张铁,李琳,李杞仪.创新思维与设计[M].国防工业出版社,2005 [3] 周蔼如.林伟健.C++程序设计基础[M].电子工业出版社.北京.2012.7 [4] 唐增宏.常建娥.机械设计课程设计[M].华中科技大学出版社.武汉.2006.4 [5] 李琳.李杞仪.机械原理[M].中国轻工业出版社.北京.2009.8 [6] 何庭蕙.黄小清.陆丽芳.工程力学[M].华南理工大学.广州.2007.1 4.本任务书于2016 年2 月27 日发出,应于2016 年4月2 日前完 成,然后提交给指导教师进行评定。 指导教师(导师组)签发2016年月日

评语: 总评成绩: 指导教师签字: 年月日

目录 摘要 (1) 第一章绪论 (2) 1.1机器人的定义及应用范围 (2) 1.2舵机对机器人的驱动控制 (2) 第二章舵机模块 (3) 2.1舵机 (3) 2.2舵机组成 (3) 2.3舵机工作原理 (4) 第三章总体方案设计与分析 (6) 3.1 机器人达到的目标动作 (6) 3.2 设计原则 (6) 3.3 智能机器人的体系结构 (6) 3.4 控制系统硬件设计 (6) 3.4.1中央控制模块 (7) 3.4.2舵机驱动模块 (7) 3.5机器人腿部整体结构 (8) 第四章程序设计 (9) 4.1程序流程图 (9) 4.2主要中断程序 (9) 4.3主程序 (11) 参考文献 (13) 附录 (14) 一.程序 (14) 二.硬件图 (17)

Arduino教程(提高篇)——舵机的驱动

Arduino教程(提高篇)——舵机的驱动在机器人机电控制系统中,舵机控制效果是性能的重要影响因素。舵机可以在微机电系统和航模中作为基本的输出执行机构,其简单的控制和输出使得单片机系统非常容易与之接口。 舵机是一种位置(角度)伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。目前在高档遥控玩具,如航模,包括飞机模型,潜艇模型;遥控机器人中已经使用得比较普遍。舵机是一种俗称,其实是一种伺服马达。 1.舵机与控制原理 2.servo类介绍 servo类下有以下成员函数 attach()// write()// writeMicroseconds()// read()// attached()// detach()// 普通舵机有3根线:GND(黑)、VCC(红)、Signal(黄),一般情况下,我们建议为舵机单独供电,此处实验为了图方便,用arduino为舵机供电。 3.实例1 需要的器材: arduino控制器、舵机、杜邦线若干 首先将舵机如下图连接: 下载以下例程(程序可以在IDE>File>Examples>Servo>Sweep中找到,我只是做个中文介绍) 1.#include 2.Servo myservo; //创建一个舵机控制对象 3.// 使用Servo类最多可以控制8个舵机 4.intpos = 0; // 该变量用与存储舵机角度位置 5./*~~~~~~~~~~~~~~~~~~~~~~~~~~华丽的分割线~~~~~~~~~~~~~~~~~~~~~~~~~~ */

6.void setup() 7.{ 8.myservo.attach(9); // 该舵机由arduino第九脚控制 9.} 10./*~~~~~~~~~~~~~~~~~~~~~~~~~~华丽的分割线 ~~~~~~~~~~~~~~~~~~~~~~~~~~ */ 11.void loop() 12.{ 13.for(pos = 0; pos< 180; pos += 1) // 从0度到180度运动 14.{ // 每次步进一度 15.myservo.write(pos); // 指定舵机转向的角度 16.delay(15); // 等待15ms让舵机到达指定位置 17.} 18.for(pos = 180; pos>=1; pos-=1) //从180度到0度运动 19.{ 20.myservo.write(pos); // 指定舵机转向的角度 21.delay(15); // 等待15ms让舵机到达指定位置 22.} 23.} 24. 4.实例2 需要的器材: arduino控制器、舵机、电位器、杜邦线若干 首先将舵机如下图连接: 下载以下例程(程序可以在IDE>File>Examples>Servo>Knob中找到) 1.#include 2. 3.Servo myservo; 4.//创建一个舵机控制对象 5.

舵机控制板使用说明(中文)

舵机控制板使用说明V1.2 产品特点 ●采用32位ARM 内核的处理器芯片 ●独创的在线升级机制,用户可以在线升级固件 ●自动识别波特率 ●采用USB和UART通讯接口 ●1us的控制精度(相当于舵机的0.09度) ●可以同时同步控制32个舵机(24路舵机控制板可以同时同步控制24个,16路舵机控制板可以同时 同步控制16个舵机) ●内置512K 存储芯片,可存储上百个动作组 ●功能强大的电脑软件(内置3种语言,简体中文、繁体中文、英语) ●拥有Android手机控制软件 供电 舵机控制板需要2个电源: 舵机电源和芯片电源 舵机电源(正极):VS(图中3号位置的蓝色接线端子的左端) 舵机电源(负极):GND(图中3号位置的蓝色接线端子的中间) 舵机电源的参数根据实际所接舵机的参数而定,如TR213舵机的供电电压是4.8-7.2V,那么舵机电源就可以用电压在4.8-7.2V之间的电源。 芯片电源(正极):VSS(图中3号位置的蓝色接线端子的右端)

芯片电源(负极):GND(图中3号位置的蓝色接线端子的中间) VSS的要求是6.5-12V,如果芯片供电是从VSS端口输入的,那么电源的电压必须是6.5-12V之间。 另外: 1. 图中2号位置的USB接口可以给芯片供电,所以USB接口和VSS端口,任选其一即可。 2. 图中1号位置也可以给芯片供电,标记为5V和GND,5V是正极,GND是负极,供电电源的电压必 须是5V。 3. 图中1、2、3号位置都可以给芯片供电,任选其一即可。 4. 图中4号位置的绿色LED灯是芯片电源正常的指示灯,绿色灯亮,表示芯片供电正常,绿色灯灭,表 示芯片供电异常。 5. 图中5号位置的绿色LED灯是舵机电源正常的指示灯,绿色灯亮,表示舵机供电正常,绿色灯灭,表 示舵机供电异常。 如果需要控制舵机,2个绿色的LED灯都亮是前提条件。

PWM控制舵机 C程序

#include "reg52.h" sbit control_signal=P0^0; sbit turn_left=P3^0; sbit turn_right=P3^1; unsigned char PWM_ON=15 ;//定义高电平时间 /******************************************************************/ /* 延时函数 */ /******************************************************************/ void delay(unsigned int cnt) { while(--cnt); } void display() { if(PWM_ON>=5&&PWM_ON<=7) P1=0xFD; //1灯亮,舵机接近或到达右转极限位置if(PWM_ON>7&&PWM_ON<=10) P1=0xFB; //2灯亮 if(PWM_ON>10&&PWM_ON<=13) P1=0xF7; //3灯亮 if(PWM_ON>13&&PWM_ON<=16) P1=0xEF; //4灯亮,舵机到达中间位置 if(PWM_ON>16&&PWM_ON<=19) P1=0xDF; //5灯亮 if(PWM_ON>19&&PWM_ON<=22) P1=0xBF; //6灯亮 if(PWM_ON>22&&PWM_ON<=25) P1=0x7F; //7灯亮,舵机接近或到达左转极限位置} /******************************************************************/ /* 主函数 */ /******************************************************************/ void main() { //bit Flag; TMOD |=0x01; //定时器设置 0.1ms in 11.0592M crystal TH0=(65536-78)/256; TL0=(65536-78)%256; //定时0.1mS ET0=1;//定时器中断打开 EA=1;//总中断 //IE= 0x82; //打开中断 TR0=1; // PWM_ON=15 //的取值范围是6-25 while(1) { if(turn_left==0) { delay(1000); if(turn_left==0) { while(!turn_left){}

舵机及转向控制原理

舵机及转向控制原理 1、概述 2、舵机的组成 3、舵机工作原理 4、舵机选购 5、舵机使用中应注意的事项 6、辉盛S90舵机简介 7、如何利用程序实现转向 8、51单片机舵机测试程序 1、概述 舵机也叫伺服电机,最早用丁船舶上实现其转向功能,由丁可以通过程序连续控制其转角,因而被广泛应用智能小车以实现转向以及机器人各类关节运动中,如图1、图2所示。

舵机是小车转向的控制机构,具有体积小、力矩大、外部机械设计简单、稳定性高等特点,无论是在硬件设计还是软件设计,舵机设计是小车控制部分重要的组成部分,图3为舵机的外形图。 2、舵机的组成 一般来讲,舵机主要由以下几个部分组成,舵盘、减速齿轮组、位置反馈电位计、直流电机、控制电路等,如图4、图5所示。

变速齿轮组 诃调电位器小型宜流电机 fff 图4舵机的组成示意图 图5舵机组成 舵机的输入线共有三条,如图6所示,红色中间,是电源线,一边黑色的是地线,这辆根线给舵机提供最基本的能源保证,主要是电机的转动消耗。电源有 两种规格,一是4.8V, 一是6.0V,分别对应不同的转矩标准,即输出力矩不同, 6.0V 对应的要大一些,具体看应用条件;另外一根线是控制信号线,Futaba的一般为白色,JR的一般为桔黄色。另外要注意一点,SANW曲某些型号的舵机引线电源线在边上而不是中间,需要辨认。但记住红色为电源,黑色为地线,一般不会搞错。

输出转轴 电源线知 地线GND 控制线 图6舵机的输出线 3、舵机工作原理 控制电路板接受来自信号线的控制信号, 控制电机转动,电机带动一系列齿轮组,减速后传动至输出舵盘。舵机的输出轴和位置反馈电位计是相连的,舵盘 转动的同时,带动位置反馈电位计,电位计将输出一个电压信号到控制电路板,进 行反馈,然后控制电路板根据所在位置决定电机转动的方向和速度,从而达到 目标停止。其工作流程为:控制信号T控制电路板T电机转动T齿轮组减速T舵盘转动T位置反馈电位计T控制电路板反馈。流,才可发挥舵机应有的性能。 舵机的控制信号周期为20MS的脉宽调制(PWM信号,其中脉冲宽度从0.5-2.5MS,相对应的舵盘位置为0—180度,呈线性变化。也就是说,给他提供一定的脉宽,它的输出轴就会保持一定对应角度上,无论外界转矩怎么改变,直到给它提供一个另外宽度的脉冲信号,它才会改变输出角度到新的对应位置上如图7所求。舵机内部有一个基准电路,产生周期为20MS宽度1.5MS的基准信号,有一个比出较器,将外加信号与基准信号相比较,判断出方向和大小,从而生产电机的转动信号。由此可见,舵机是一种位置伺服驱动器,转动范围不能超过180度,适用丁那些需要不断变化并可以保持的驱动器中,比如说机器人的关 节、飞机的舵面等。

舵机控制详解

舵机控制详解 Document number【AA80KGB-AA98YT-AAT8CB-2A6UT-A18GG】

本人学习了一段时间的舵机,将自己所遇到的问题与解决方案和大家分享一下,希望对初学者有所帮助!!!! 一、舵机介绍 1、舵机结构 舵机简单的说就是集成了直流电机、电机控制器和减速器等,并封装在一个便于安装的外壳里的伺服单元。 舵机安装了一个电位器(或其它角度传感器)检测输出轴转动角度,控制板根据电位器的信息能比较精确的控制和保持输出轴的角度。这样的直流电机控制方式叫闭环控制,所以舵机更准确的说是伺服马达,英文 servo。 舵机组成:舵盘、减速齿轮、位置反馈电位计、直流电机、控制电路板等。 舵盘 上壳 齿轮组 中壳 电机 控制电路 控制线 下壳 工作原理:控制信号控制电路板电机转动齿轮组减速 舵盘转动位置反馈电位器控制电路板反馈 简单的工作原理是控制电路接收信号源的控制信号,并驱动电机转动; 齿轮组将电机的速度成大倍数缩小,并将电机的输出扭矩放大响应倍 数,然后输出;电位器和齿轮组的末级一起转动,测量舵机轴转动角 度;电路板检测并根据电位器判断舵机转动角度,然后控制舵机转动 到目标角度或保持在目标角度。 舵机接线方法:三线接线法:(1)黑线(地线) 红线(电源线)两个标准:和6V 蓝线/黄线(信号线) (2)棕线(地线) 红线(电源线)两个标准:和6V

黄线(信号线) 二、舵机PWM信号介绍 1、PWM信号的定义 PWM信号为脉宽调制信号,其特点在于他的上升沿与下降沿之间的时间宽度。具体的时间宽窄协议参考下列讲述。我们目前使用的舵机主要依赖于模型行业的标准协议,随着机器人行业的渐渐独立,有些厂商已经推出全新的舵机协议,这些舵机只能应用于机器人行业,已经不能够应用于传统的模型上面了。 关于舵机PWM信号的基本样式如下图 其PWM格式注意的几个要点: (1)上升沿最少为,为之间; (2)控制舵机的PWM信号周期为20ms; 2.PWM信号控制精度制定 1 DIV = 8uS ; 250DIV=2mS PWM上升沿函数: + N×DIV 0uS ≤ N×DIV ≤ 2mS ≤ +N×DIV ≤ 3、舵机位置控制方法 舵机的转角达到185度,由于采用8为CPU控制,所以控制精度最大为256份。目 8位AT89C52CPU,其数 据分辨率为256,那么经过 舵机极限参数实验,得到应 该将其划分为250份。 那么的宽度为2mS = 2000uS。 2000uS÷250=8uS 则:PWM的控制精度为8us 我们可以以8uS为单位 递增控制舵机转动与定位。 舵机可以转动185度, 那么185度÷250=度, 则:舵机的控制精度为度

相关主题
文本预览
相关文档 最新文档