EDN China > 设计实例 > 嵌入式系统 > MCU(单片机应用) > 正文
? 2016博客大赛-不限主题,寻找电子导师,大奖升级??

(多图) 基于PIC单片机的仿生机器鱼的舵机控制

21ic 丁俐 余瑾 吴垠 王伟东?? 2010年08月04日 ?? 收藏0

  仿生机器鱼实验平台属于教育部和北京邮电大学共同出资支持的一项“国家级大学生创新性实验计划”项目,是一个集光、机、电、流体、智能于一体的实验平台,研究内容包括:仿生机器鱼机械结构的研究,推荐效率的研究以及控制性能的研究。

  1 仿生机器鱼平台简介:

  设计制作的机器鱼模仿鲹科鱼类的外形,头部采用刚性结构的塑料材料。其形状采用流线型,模仿真鱼鱼头的形状和大小比例。在鱼头的内部空间里安装电源及控制电路,并在鱼头两侧鱼眼处及在头前部的偏下侧安装了3 个红外传感器,构成了一个探测左、前、右三个方向的传感器网络,让鱼具有自助避障的功能。

  使用铝合金制作的鱼骨架把三个舵机串联起来,鱼骨架支撑起套于舵机外面的橡胶鱼皮,便构成了了机器鱼的鱼身这个三关节的驱动系统。使用铝合金制作的连接件将鱼身通过螺纹连接的方式固定在在刚性鱼头上,鱼身的橡胶鱼皮使用热熔胶粘在鱼头上,这样便构成了机器鱼的整体结果。具体如图1 所示。实验证明,这种方法简单易行,且方便拆卸和组装。

机器鱼的整体结果

  机器鱼技术指标:巡游速度:1.2~1.5m./s;全电量巡游距离:4.5~5.5 千米;转弯半径:15~20cm。

  2.系统组成及工作原理:

  从功能上看,整个鱼体的系统可以分成三大块,分别是:感知区,决策区,行为区。感知区对应着多红外传感器网络和无限传输模块,而决策区指的是主控芯片(MCU),动作区对应着舵机串联组成的三关节驱动系统。具体如图2所示。本系统的最重要的工作集中在对多舵机的协调控制,因此主要围绕舵机的控制工作进行细致详尽的介绍。

系统结构框图

  3 舵机的控制

  3.1 舵机的工作原理:

  舵机主要由以下几个部分组成:舵盘、减速齿轮组、比例电位器(位置反馈电位计)、直流电机(马达)、控制电路板等。其工作原理:控制电路板接受来自信号线的控制信号,控制直流电机转动,直流电机带动一系列齿轮组,其齿轮组的输出轴与一个线性的比例电位器相连,该电位器把输出轴转过的角度θ 转换成比例的电压反馈给控制电路,控制电路将其与输入的控制脉冲信号比较,产生纠偏脉冲,并驱动马达正向或反向地转动,使齿轮组的输出位置与期望值相符,令纠正脉冲趋于为0,从而达到使舵机精确定位的目的。舵机是一个典型闭环反馈系统,其工作原理由图3 所示。

舵机工作原理图

  舵机的输入线共有三条,红色中间,是电源线,一边黑色的是地线,这两根线给舵机提供最基本的能源保证,主要是电机的转动消耗。电源有两种规格,一是4.8V,一是6.0V,分别对应不同的转矩标准,另外一根线是控制信号线,一般为白色。

  3.2 单舵机和多舵机的角度控制

  3.2.1 单舵机的角度控制:

  由舵机的工作原理可知,给舵机输入一个周期在20ms 左右,脉冲宽度在0.5ms 至2.5ms 之间的周期性脉冲信号,驱动舵机输出轴达到-90°到90° 之间的转角,呈线性变化。并且无论外界转矩怎样改变,舵机的输出轴都会保持在一个相对应的角度上,直到给它提供一个另外宽度的脉冲信号,才会改变输出角度到新的对应的位置上。通过编程,借助单片机的输出端口得到需要的周期性脉冲信号。

  程序示例:(晶振为:4MHZ,脉冲从PORTDbits.RD0 输出)

程序

  从上面的程序可知,通过改变delay 函数的形参j,可以根据需要,得到具有相应脉冲宽度和周期的脉冲信号。例如,改变以上程序段的1 至4 行为:

程序

  得到输出脉冲宽度为1ms,周期为20ms 的脉冲信号,然后借助for 循环,将能得到所需要的周期性脉冲信号,驱动舵机输出轴达到-90°到90° 之间的转角。


上一页12下一页
?? ?? ??


打开微信“扫一扫”,打开网页后点击屏幕右上角分享按钮

1.扫描左侧二维码
2.点击右上角的分享按钮
3.选择分享给朋友
?? ??

PIC单片机? 机器鱼? 舵机控制?

相关文章

我来评论
美国的游客
美国的游客 ??? (您将以游客身份发表,请登录 | 注册)
?
有问题请反馈