自控实验双足机器人行走膝关节力矩控制Word文件下载.docx
《自控实验双足机器人行走膝关节力矩控制Word文件下载.docx》由会员分享，可在线阅读，更多相关《自控实验双足机器人行走膝关节力矩控制Word文件下载.docx（6页珍藏版）》请在冰豆网上搜索。
引言
从1962年美国研制出第一台工业机器人至今已有四十多年的历史。
机器人的研究一直以来都是各个国家吵得火热的话题。
同时，由于它的研究是一项有关机械、电路电子、计算机、控制工程、人工智能以及其他各个学科与科技的综合展示，机器人的技术发展从某一方面也代表了国家科技技术的水平。
美国机器人工业协会对机器人的定义是：
“机器人是一种可再编程的多功能操作机，通过可变的程序流程，以完成多样化的任务”。
我国著名的机器人专家蒋新松则给出了更为简洁的定义：
“机器人是一种具有拟人功能的机械电子装置”。
双足机器人是机器人研究中的一个重要分支，由于它更具有拟人性，可以
适应一些并不十分理想的地形与环境，因而能够更好地为人类服务及工作，科技工作者研究双足机器人的热情自然也从来未曾减少过。
在机器人研究方面，我国相比之美国与日本这种科技大国起步较晚。
早在上个世纪中下旬，便有很多行走机器人诞生于欧美和日本。
虽然我国现已有许多科技人员投入到了对机器人的研究中，也获得了一些成果，但仍处于初级水平，有待加大马力迎头赶上。
正常人体的运动结构十分复杂，因而对于双足步行机器人动态行走的研究则更具有复杂性。
本文则正对双足机器人动态行走过程中的膝关节这一部位进行针
对性研究，通过对双足机器人膝关节控制器的设计以达到控制其力矩的目的，最终使机器人能够平稳地沿直线行走。
文章流程如下：
1.首先对被控对象进行分析，同时建立数学模型
2.其次根据建立的模型求得开环传递函数G（s）
3.然后分析并设计控制器，得到闭环传递函数Φ（s）
4.最后进行计算机仿真验证结果以及对系统稳定性进行分析
1.建立被控对象数学模型
由于仿人体的双足机器人动态行走需要髋部、膝关节已经踝关节等各部位
的协调工作，但我们所学的知识具有一定的局限性，因而我们仅对膝关节进行研究同时将其简化为一个刚体模型，而行走状态为简单的匀速直线运动。
首先，根据现有知识，我们得到一个简易的机器人腿部模型，如下图所示：
其中右图为机器人进入开始行走状态时腿部以及膝关节的示意图，θ角为腿部抬起后机器人大腿部分的倾斜角（即与垂直方向的夹角）。
我们在机器人膝盖部位安装一个控制电机为其腿部的前行提供一个控制力
矩。
根据简化后的腿部模型，我们可以得到双足机器人动态行走时膝关节力矩平
衡公式：
Jm
dw（t）
fmw（t）Mm（t）
（1）
dt
即
d2（t）
fm
d（t）
Kaua
（t）
2
（2）
其中，Jm（Kggm2）为电动机和负载折合到控制电机轴上的转动惯量；
fm（Ngm/（radgs1））为电动机和负载折合到控制电机轴上的粘性摩擦系
数；
Mm（t）为电枢电流产生的电磁转矩。
2.分析被控对象特性
根据已得出的公式
（1）
（2），计算出系统的开环传递函数：
G（s）k1
s（Ts1）
其执行部分如下：
小电流Uc通过放大器形成大电流Uc'
，在经过控制电机与一个积分环节网络得到最终的输出角度θ。
在设定在超调量%=5%，调节时间ts=0.3s的情况下，解得T=0.1s，k1=5
因而，系统的开环传递函数为：
G（s）
5
s（0.1s1）
3.设计控制器
控制器方框图如下：
a）比例-微分校正系统PID用以产生提前修正作用来改善系统性能。
b）
k为电压放大器，将输入角度转化为电压信号
Uc。
c）
反馈回路k2为角度传感器，使膝关节转过的角度得以反馈回输入指令，
k2=1。
闭环传递函数：
50
（s）
10s50
1G（s）s2
4.仿真验证
利用matlab软件进行仿真验证，得到如下结果：
单位阶跃响应曲线：
验证结果：
最终得到PID校正系统kp=0.5065，ki=0.0086
稳定性分析：
系统稳定的充分必要条件是系统闭环特征方程的所有根都具有负的实部，或者说所有闭环特征根均位于左半平面内。
系统的闭环特征方程：
D（s）Ts3
s2
k
ks
kk
p1
i1
求得系统的特征根分别为4.99150.4896i,0.0171
奈奎斯特图：
故该系统稳定性良好
5.结论
在针对被控对象的整个研究分析以及控制器的设计中，我们的优点以及有待改进的方面如下：
1）可取之处：
a）我们对复杂的问题进行了简单的处理，使得原本较为抽象的问题被具体化，更加容易理解；
b）超调量%=5%，调节时间ts=0.3s，反应速度快；
c）控制器简单、实用，使用PID校正可以提前达到修正的目的。
2）有待改进之处：
由于我们在研究指出对系统模型进行了简化，使得一些原本存在的问题被忽
略，同时我们仅考虑了双足机器人膝关节这一部分的情况，而未考虑到更加切合实际的髋部、膝关节以及踝关节共同作用的情况，问题则被理想化。
3）未来研究方向：
对于自动控制原理学习的起步使得我们在研究问题的知识储备量上受到局
限，未来我们将会学习以及更好地运用这些知识，因而在我们的学习研究能力得到进一步提升后可以考虑更加符合运动实际的综合性问题。
参考文献
[1]胡寿松，自动控制原理，北京：
科学出版社，2007。
[2]卢京潮，自动控制原理，西安：
西北工业大学出版社，2004。
[3]刘刚，二杆机械臂的动力学建模与仿真，沈阳工程学院学报，第
4卷第2
期：
2008.4。
升级会员 