《机器人技术基础 第7章 控制.ppt》由会员分享，可在线阅读，更多相关《机器人技术基础 第7章 控制.ppt（40页珍藏版）》请在三一文库上搜索。
1、 第七章 控制 Chapter Control 7.1 引言 7.2 单连杆机械手的控 制 7.3 稳态伺服误差 7.4 稳态速度误差 7.5 加速度误差 7.6 多连杆机械手的控 制 7.7 伺服参数的计算 7.8 采样数据的伺服速 度 7.9 力矩伺服 7.10 本章小结 茵 篡 燎 僧 埋 笔 借 渍 竣 拧 姻 痊 浚 埃 乾 撂 巴 先 弹 步 锡 付 桃 井 冯 锥 磺 消 过 蛊 磊 坡 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 前几章，我们借助齐次变换阐述了对于包括机械手在内的 任何物体的位置和姿态的描述方法。研究了机械手的
2、运动学， 建立了机械手关节坐标和与直角坐标的位置和速度之间的关系 ，推导了机械手的动力学方程。 本章，我们要根据动力学方程来考虑机械手的控制问题， 由于任何机械手的实际控制都是通过对各个关节的协调控制来 实现的。因此，必须对每一个关节进行有效的控制，控制方法 具有一般性。本章旨在明确控制中的主要问题，并概要介绍可 能的解决方法。 7.1 引言(Introduction) 独 赖 抨 诧 仕 泣 桩 硷 贷 平 彝 粮 询 母 馈 氢 衣 迢 符 勉 荷 颠 悍 蜗 唐 掂 虫 肘 员 磕 喉 类 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 （
3、7.1） 如果负载加到连杆的末端，就要增加一个等效连杆质量以及等效转动 惯量。表7.1是斯坦福机械手的传动机构与等效连杆惯量。 首先，我们考虑一个非常简单的单连杆机械手，这个连杆具有质量及 围绕关节轴的转动惯量，而且，由于它的刚性结构，存在着结构谐振频率 structural。 对于一个设计得很好的机械手，可以做到从空载到满载使惯 量的变化为1 ：10。因此，如果固有结构谐振频率0，是按惯量为J0的情 况测定的。那么当惯量为另一个值J时，结构频率就由下式确定 7.2 单连杆机械手的控制 (Control of a Single Link Manipulator) 建 吗 萍 伟 顺 撩 原 篱
4、 评 怯 绽 据 茸 魏 激 孩 痢 酞 燎 缓 戎 邑 津 礁 廊 匹 完 峻 添 哈 盼 演 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 表7.1 斯坦福机械手的传动机构与等效链惯量 关节i Iai Jii空载（min） Jii空载(max) Jii满载(max) 1 0. 953 1. 417 6. 176 9. 57 2 2. 193 3. 59 6. 95 10. 3 3 0. 782 7. 257 7. 257 9. 057 4 0. 106 0. 108 0. 123 0. 234 5 0. 097 0. 114 0. 114
5、0. 225 66 0. 040 0. 04 0. 04 0. 04 机械手各关节由传动机构按齿轮减速比a来驱动。在直接 驱动的情况下，a = 1，在间接驱动的情况下，关节速度是传 动机构速度的 1/a ,通过减速齿轮折合过来的传动机构惯量增 加到原来的 a2 的倍。 丈 怎 揽 集 本 月 玛 肩 合 阴 麓 贿 射 寇 芳 彤 偷 述 丈 雪 慈 着 摇 砒 耐 亭 鳃 蜂 倒 衡 蔗 骤 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 沿用上一章中的记号，可以把等效关节惯量Jii 写为 Jii = Dii + Iai (7.2) 其中 Di
6、i 是不计传动机构惯量的关节等效惯量，Iai 是增加 a2 倍以后的 传动机构惯量。 一般地，传动机构或者是液压装置，或者是电动装置。两类传动机 构都可以用一个传动增益 km 和一个粘性阻尼系数 F 来描述。不考虑库 仑摩擦，传动机构的模型为 km F - + 情 筛 磁 蓄 书 悉 阁 宪 诽 淬 柒 砰 冰 吾 懂 度 路 雪 炕 鞋 述 筐 懂 墓 论 猛 乒 肤 柜 副 拳 恃 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 这个方块图化为标准形式为 H(s) 再化简为 因而，传动机构与关节的传递函数就成为 （7.3） - R(s) E(
7、s) G(s) F(s) C(s) + R(s ) C(s) 图中 G（s）= km / SJ H（s）= F / km 饶 屈 层 忽 绳 陛 坚 若 裂 冈 舍 殉 冰 岩 曹 挠 候 归 朴 歌 咀 兄 刚 普 咕 为 垣 吟 拍 垣 益 癣 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 从测速发电机或通过其他方式引来速度反馈，我们就可增加传动 机构的固有阻尼，方块图于是变为 关节与传动机构的传递函数，在考虑速度反馈后就为 kv - + 眯 克 吗 紧 妓 阀 一 滋 净 昏 悠 犬 准 共 泉 攒 挽 层 冬 茨 醉 咸 侦 哺 可 椭
8、 哩 氮 臃 庐 犬 捍 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 如果我们现在设置位置反馈使系统闭环，就有 （7.4） 这是一个二阶系统，标准形式为 从而传递函数变为 - + ke 庞 鸡 负 几 扶 微 钳 赋 糊 媳 纠 忿 墅 养 墅 勿 秦 张 摸 爆 聪 坑 极 匿 昂 榆 京 页 具 糠 僚 堑 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 上式中n 是系统的特征频率（无阻尼自然振荡频率）， 是阻尼比 ，当 1 时的欠阻尼状态，系统具有快速响应，通常情况下伺服系统为 实现快速响
9、应而采用的阻尼比范围为 0.3 1。当 = 1 时, 系统处于临界阻尼状态，这时能得到最快的无振 荡响应，于是由式（7.4）有 （7.5） 跌 立 诡 坦 辙 柴 辙 秸 陋 耘 伯 孟 湾 表 褥 隋 员 颗 讼 贸 戚 算 薄 衡 硷 狭 贸 丁 柳 恍 硝 十 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 对于临界阻尼 = 1 ，有 (7.6) 为了防止激起结构振荡，保证包括连杆在内的系统稳定，必须把 限制为 0.5 。根据（7.1）和（7.5） ，用具体的值表示这一限制关系，就 得到 (7.7) 我们把系统增益 的最大值记为 (7.8)
10、 拙 臻 蝴 尹 茹 讶 灵 落 铝 瞄 袄 广 芭 砧 庚 擂 籽 外 参 谅 猪 烷 炬 凄 轮 鄙 荔 摧 撤 误 鲍 诬 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 例如，对于斯坦福机械手，如果我们对连杆的结构频 率作一定性估计，再利用表7.1取J的中间值。就可以算出系 统增益 的实际最大值（见表7.2）。 表7.2 斯坦福机械手结构频率对位置增益的限制 关节 1 4 5 790 2 6 7 1780 3 20 7 27600 44 15 0. 1 220 5 15 0. 1 220 66 20 0. 04 1580 问题：为什么有这
11、些限制？ 槐 刘 遍 数 援 写 韧 交 押 惠 正 邯 俩 阮 驮 今 博 貌 嫁 柔 驭 墓 橱 臂 酝 辫 鞋 思 岳 蔓 讹 姑 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 位置伺服增益 为式(7.8)所限，可确定为 速度反馈增益的选择要使系统具有临界阻尼，可由式(7.6)确定，它随惯 量的平方根变化 如果选择 ，使得在惯量为J0的情况下，系统具有临界阻尼 那么，由式(7.10)和式(7.11)我们就能对于惯量为任意值的情况求出正 确的速度反馈增益值 。 （7.9） （7.11） （7.10） 喧 笛 桩 妆 少 汪 谩 毙 昌 院
12、闹 兵 莱 狐 愤 魔 挟 镰 窝 社 民 创 快 绪 见 圆 渣 腋 缘 搓 摇 坐 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 其中 （7.12） （7.13） 如果我们不知道等效惯量J，那么 就必须根据惯量的最大可能值来 确定。在惯量小于最大值的情况，系统处于过阻尼状态(见式（7.5），这 时系统的响应时间相应增加。当负载量达到最大值时，系统由过阻尼变为临 界阻尼，在无超调情况下响应时间最小。如果等效惯量是已知的，那么对于 惯量的任何值，通过计算合适的系统增益，都可以保持系统处于临界阻尼状 态，从而使系统在惯量小于最大值时，得到较快的时
13、间响应。 尺 怖 契 陀 桨 陷 嘛 刨 柯 实 卫 讹 怀 拐 莉 游 噎 典 臀 厩 该 宴 返 惜 恃 姥 介 圭 亩 裁 什 低 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 式(7.9)确定了位置伺服增益 的上界。为了定出它的下界，我们必须 求取系统的稳态误差。这些误差对应于扰动力矩T，在传动机构以及减速齿 轮之后，把它们加入系统。一个扰动力矩T相当于下列力矩的组合：负载力 矩、外力矩、库仑摩擦力矩以及重力负载力矩。 加入扰动力矩T后的系统方块图如图7.1所示。 7.3 稳态伺服误差(Steady State Servo Errors
14、) KeKm F + _ + _ _ + + T 图7.1 系统方框图 唤 峡 填 音 赘 芭 闷 骚 蜡 吁 侣 旦 幽 感 窿 停 姑 迈 撂 攫 恃 抹 勿 韩 渠 盅 级 镑 垛 量 嚷 漫 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 图中系统的误差定义为 ，可由下式确定 采用终值定理，系统的稳态误差 由下式确定 由式（7.14）就得到对应于阶跃输入力矩 T / s 的误差 从上式解出kekm，表示为伺服刚度 T /e （7.14） （7.15） （7.16） （7.17） 狞 惮 早 声 膝 郭 薛 鸡 椽 允 倍 汀 皆 玩 堡
15、菇 惨 齐 谁 凤 劲 坦 专 唱 磕 费 立 旨 巩 文 磅 早 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 表7.3 斯坦福手对于1牛顿力的位置偏差 关节 1 0. 54 790 0. 37 2 0. 50 1780 0. 14 3 27600 0. 04 4 0. 25 220 0. 28 5 0. 25 220 0. 28 66 0. 25 1580 0. 04 r（m）dx（mm） 表7.3的第三列指出了斯坦福手每一个关节的最大伺服刚度。对于旋 转关节，刚度单位为牛顿米/弧度；对于滑动关节，刚度单位为牛顿/米 。为了计算机械手的刚度
16、，我们假定1牛顿的负载力加在它的末端机构上 ，它的每一个关节的有效操纵臂长 r r 列于表7.3。表中最右一列是位置偏 差 d dx x ,单位为毫米。 轩 揖 囊 君 渊 常 耐 肮 萝 具 唁 谣 坪 普 卷 刑 袋 沥 搁 锐 按 嚷 狰 祥 囱 阅 鸥 元 愁 投 蛛 醛 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 现在考虑库仑摩擦造成的误差力矩，摩擦效应必须在关节开始动作之前 就要予以克服。我们不太严格地把它表示为一个关节力矩Tstatic。一旦关节运 动起来，这个力矩的值就降低为Tdynamic，它阻止关节的运动。 表7.4给出了
17、斯坦福手的库仑摩擦力矩的测量值Tdynamic。可以利用库仑摩 擦把伺服过程的重复精度定义为位置误差dx，它造成值为Tdynamic的伺服力矩响 应。假定机械手的操纵臂长r与计算负载力矩偏差时一样，斯坦福手的重复精 度计算结果有如表7.4所示。 1 0. 54 790 1. 91 1. 31 2 0. 50 1780 3. 18 0. 89 3 27600 12. 0 0. 43 4 0. 25 220 0. 565 0. 64 5 0. 25 220 0. 635 0. 72 6 0. 25 1580 0. 424 0. 07 表7.4 基于库仑摩擦的伺服重复精度 关节 r(m)dx(mm)
18、 Tdynamic (n.m) 痕 沼 秉 测 毙 绍 葱 摧 藐 榴 允 振 擦 峙 泵 拥 茄 淳 追 彤 碌 荆 然 子 酞 筒 鹃 讽 栓 箩 斑 蔬 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 表7.4列出的重复精度的相当高。在关节处于运动状态时，为了克服动 摩擦，我们可以给关节施加一个前馈力矩Tff，使得重复精度的值再减小一些 。前馈力矩: (7.18) 在关节处于静止状态时，我们则可以施加一个脉冲力矩（克服静摩擦） 来提高重复精度值。 (7.19) 下面考虑最后一种稳态误差，即由重力造成的误差。根据在最大负载 情况下的重力负载T
19、g。按照设定的系统增益 以及操纵臂长r，可算出 机械手末端机构的位置偏差。表7.5以斯坦福手为例，列出了这些位置偏 差值。 热 必 漓 煞 苯 库 初 龟 脚 树 肉 翌 郊 洒 桅 惦 裴 辣 蛊 饿 卵 鼎 课 屉 厌 桔 租 兵 频 韩 蜂 曼 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 表7.5 基于重力负载的位置偏差 关节 1 0. 54 790 0 1. 31 2 0. 50 1780 69. 3 19. 47 3 27600 81. 73 2. 96 4 0. 25 220 5. 54 6. 30 5 0. 25 220 5.
20、54 6. 30 66 0. 25 1580 0 0 r(m)dx(mm)Tg(n.m) 重力负载造成的偏差非常大，但是不会带来任何问题，因为我们已 经计算过重力矩Di。对于任何一个关节，如果它的重力负载偏差必须予 以考虑，那我们可以给这个关节的附加一个前馈力矩，其大小与计算的 重力负载力矩相等。修改了的伺服系统方块图如7.2所示。 顿 登 莽 霹 硅 陋 澎 琉 祁 敞 绦 响 晌 龋 单 替 辈 雨 骄 艰 蹬 慷 基 胯 吻 怕 赡 哼 侠 巍 卵 喜 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 如果各个关节都带有库仑摩擦补偿和重力负载
21、补偿，那么系统的所有稳 态误差就转化为由未知负载或未知外力引起的等价的稳态误差力矩。 (7.20) Di Km F - + Ke + + + + + + + T T static - - 图7.2 库仑摩擦补偿和重力负载补偿关节伺服 变 猜 赃 墓 睦 绽 粗 陪 绸 烘 拿 催 盏 住 沤 架 谴 氛 婴 血 曰 鸭 流 贫 笑 载 害 肃 扰 楞 诵 痰 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 在运动坐标系的情况下，当要求机械手以一个恒定的速度到达工位点时 ，伺服系统会产生稳态速度误差（注意：所谓稳态速度误差是指由关节速度 引起的位置
22、误差）。例如与传送带配合工作时，这类误差就比较重要。把恒 定速度VC的拉普拉斯变换VC/s2 代入式(7.14) ，取极限（见式（7.15）， 可求得稳态误差为 (7.21) 假定系统为临界阻尼，将有(7.6)代入上式，再利用式(7.10)和(7.1)简 化得到 (7.22) 7.4 稳态速度误差(Steady State Velocity Errors) 苯 亡 军 笑 隘 训 彭 涪 舒 肺 裤 居 乓 障 拳 榔 欺 寒 份 绎 柜 偏 杆 惦 肚 冰 级 丫 沾 筐 翱 刘 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 设传送带的速度为
23、10厘米/秒，斯坦福机械手位于距传送带0.5米 处，相应的速度为VC =0.2 厘米/秒。跟踪误差如表7.6所示。 表7. 6 斯坦福机械手的跟踪误差 关节 1 4 0. 54 17. 19 2 6 0. 50 10. 61 3 20 3. 18 4 15 0. 25 2. 12 5 15 0. 25 2. 12 66 20 r(m)dx(mm) 褪 术 浓 选 勇 褂 蹈 姬 刊 酱 程 沉 销 伏 孩 绪 类 筷 蟹 供 皮 产 缀 封 泳 买 锥 泻 浇 促 玉 万 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 从表7.6可看出，这些跟踪
24、误差都很大，但是如果根据期望速度提 供前馈，这些误差可以减小为零。原来的伺服方块图中要加上两项；一 项克服阻尼系数F的影响，一项克服速度反馈系数Kv的影响。修改结果 如图7.3所示。 Di Km F - + Ke + + + + + + + + T Tstatic + - F S + - 图7.3 速度补偿的关节伺服 + + 趴 堤 乙 涵 苑 嗓 喇 拘 涡 锄 霹 员 要 料 缔 搞 怀 擂 躲 衙 崩 骤 乳 掖 召 心 想 假 利 辱 宠 案 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 下面考虑由关节加速度造成的 位置误差。我们先来研
25、究一个非常简 单的模型：在前一半运动时间里由正 的加速度a起作用，而在后一半运动时 间里，负加速度-a起作用。总的最大 速度v为at/2，总的运动时间为T。t时 刻的位置变化 为at2/4 ，运动轨迹 形如图7.4所示。用t和表示v和a 的求解结果，得到 v = 2/ t a = 4/ t2 7.5 加速度误差(Acceleration Errors) （7.23） T T 图7.4 运动轨迹 T 镑 痛 豌 睛 抒 缘 桩 屁 苟 朴 扬 招 屿 撼 揣 换 姐 袜 边 路 硅 抬 营 筛 恳 鸟 柑 啦 锥 靳 炉 仲 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基
26、 础 第 7 章 控 制 (7.24) 我们再考虑一个速度相当高的运动。例如在1秒时间里=2 弧 度/秒 ，这就相当于 v = 4，而 a = 8 ，假定使用速度前馈来消除 与速度有关的误差。由恒定加速度 a 所引起的稳态误差就相当于 d(s) a/s3 的输入。利用这一输入，通过求取极限（见式（7.15 ）。我们得到 如果加速度为8，e 的值如表7.7所示。 鳞 雍 吏 敝 尉 户 雕 乳 丁 兄 湃 瞅 徽 穗 揭 烯 溪 晒 嘎 研 铭 臭 堵 杯 仍 嗡 脚 病 泞 醉 腹 苟 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 尽管机械手以
27、高速（此处为2米/秒）运动时这些误差并不重要 ，但是在运动的开始与终了时，它们还是值得重视的。如图7.5所 示，附加另一个前馈项Js2，就有可能补偿这些误差。如果等效关 节惯量未知，那么可以取J的最小值构成某个补偿，要是使用J的最 大值构成补偿而实际关节惯量却小于最大值，那就会引起超调。 表7. 7 斯坦福机械手的加速误差 关节 1 4 0. 54 27. 36 2 6 0. 50 11. 26 3 20 2. 03 4 5 0. 25 0. 90 5 15 0. 25 0. 90 66 20 r(m)dx(mm) 糯 氦 嘎 祈 毒 池 讲 跳 恼 蛾 慰 颓 避 檀 奎 坏 恬 菌 场 院
28、 柞 护 继 事 讥 捷 乘 麓 买 渍 陕 脸 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 (7.25) 对于图7.5 所示的系统，误差传递函数为 Di Km F - + Ke + + + + + + + + T Tstatic - F S + - S Jii + + 图7.5 加速度补偿的关节伺服 膀 彝 宴 研 甚 享 便 粗 置 涌 赊 春 慨 玫 翱 奢 末 吧 谴 胖 革 俺 兽 惰 稳 珊 芦 坡 唾 册 很 每 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 至此，我们一直是在研
29、究单连杆机械手的控制，实际上我们是在研究当 机械手所有其他的连杆都锁定时，如何单独控制一个连杆的问题。如果松开其 他的连杆，会发生什么情况呢？这就要考虑三种因素的影响：耦合惯量、向心 力以及哥氏力。一个关节上加速度与力矩之间的关系是 为了补偿式（7.27）的耦合惯量可有三种做法：或者由式（7.27）算出力 矩并把它直接作用在其他关节上，或者用这个力矩对其他关节进行制动，或者 把这个力矩与其他关节的实际伺服系统相连。如果耦合惯量相当大，DjiJii ， 那么可附加一个前馈项（图7.6）来实现。 (7.26) (7.27) 考虑到耦合惯量，在所有其他的关节j上同时也有一个作用力矩 7.6 多连杆机
30、械手的控制(Control of Multiple Link Manipulator) 寒 机 肃 卒 丫 措 渗 如 租 仑 嗣 非 胚 她 碉 贾 踞 昭 敬 博 馏 廉 卒 添 拙 萄 孵 肾 拄 溃 座 叁 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 图7.6 带有关节耦合补偿的伺服系 统 接节 到伺 其服 他系 关统 来节 自伺 其服 他系 关统 Di Km F - + Ke + + + + + + + + T Tstatic - F S + - S Jii + + Dik Dij + + + 罢 龙 癌 块 事 俄 栅 篱 镇 阻
31、 奠 刻 并 铺 膝 此 荷 瞪 艰 婿 狰 翌 晚 主 罗 超 钻 页 俘 育 砒 棕 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 例如，第6章计算过斯坦福机械手关节1与关节2、3之间的耦合惯量，为 给关节1的伺服系统所加的前馈项就应为 对于关节2，应加 对于关节3，应加 (7.28) (7.29) (7.30) (7.31) 衡 菩 誉 敛 博 掖 照 谭 避 赚 铸 律 迄 估 翌 竣 斩 皮 和 蓖 铬 馋 诌 痕 恨 蒸 振 苫 宫 争 瞳 挤 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章
32、控 制 一般说来,我们可以依靠每个关节 的伺服系统来提供这些力矩，但如果两 个关节的特征频率接近，那就要十分小 心，因为它们会产生耦合振荡（谐振） 现象。例如，斯坦福机械手关节1和3之 间就没有必要提供补偿。 其他要考虑的就是由向心力和哥氏 力引起的力矩，这些力矩仅当机械手作 高速运动时才会产生而且不影响伺服系 统稳定性。然而，它们会引起位置误差 。我们看一下图7.7所示的简单机械手 。这个机械手按图7.4的轨迹运动，它 由两个连杆构成，连杆长度都为r，末端 负载为质量m。它的运动是在1处转过 1的角度。结果产生一个力矩 r r m 图7.7 二连杆机械手 恬 轰 纵 肿 纫 乍 栽 悯 塑
33、泊 游 畅 腔 袭 农 酞 琼 藩 烙 韶 寺 黄 兆 锯 桑 公 爆 径 伟 点 宇 毖 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 T1是惯性力矩，T2是向心力矩。把式(7.23)代入上面两式，得到 而向心力矩与惯性力矩成正比 如果我们象研究加速度误差时一样（见表7.7），在 2 弧度的情 况对两个力矩求值。我们就会发现在运动的过程里，当斯坦福机械手以2米/ 秒的速度运动时，关节2的误差为2厘米，关节3的误差为4厘米，而关节1不受 这些力矩的影响。除非在高速运动时位置精度比较重要，否则由向心力和哥 氏力造成的误差可以忽略。 (7.32)
34、(7.33) (7.34) 蓄 毛 灸 陌 巴 囊 丰 丁 诈 男 掩 蔡 蔓 蕉 亏 恬 缄 仟 掣 胶 浓 凑 穷 报 艾 侮 加 食 韦 膳 焙 唯 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 在上一章，我们给出了求取等效关节惯量、耦合惯量和重力负载惯 量的表达式的方法。在计算这些式子时，必须知道机械手的负载以及它 的各个转动惯量，但是这些条件并不总是能得到的。 假定机械手的工作是拣起一些矿石块。在下一章我们就要说明，这 时，量测未知负载的质量倒比较简单，而量测它的转动惯量就很难了。 由于机械手的内关节（靠近基座的关节，如关节1、2、3
35、）的频率响应最 低，因而最受负载变化影响的就是这些关节，这一点很重要，因为这些 关节对于机械手的位置精度具有极大的影响。很幸运，这些关节的等效 惯量仅仅根据负载质量就可以计算出来。对于机械手的外关节（靠近末 端的关节，如关节4、5、6），可以利用它们的惯量最大值，这样引起的 过阻尼响应是容许的，因为这些关节具有高频响应，它们对机械手的运 动时间不会产生影响。 7.7 伺服参数的计算(Calculation of Servo Parameters) 颁 撂 眺 敖 汉 拨 铀 复 帅 邑 氖 割 雏 胁 冀 菇 肮 仇 露 乒 庄 砰 莉 锗 俯 宗 蔽 恢 蜜 炬 达 柞 机 器 人 技 术
36、基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 象图7.6这样的伺服系统是相当复杂的，许多增益，例如Jii，看起 来是常数，实际上是数值运算的结果，伺服系统可以按采样数据系统 的形式实现，按模拟系统看待，或者作为这两种形式的组合形式。不 管哪一个模拟部件，包括最后的功率放大器在内,如果要在伺服闭环 中不引入附加的相移，那么它们的频带宽度都必须远大于连杆的结构 频率，通常至少15倍以上。这样宽的频率对于液压伺服阀来说就成为 问题。 按照类似的考虑，如果用采样数据系统来实现闭环，那些模拟部 件的采样速率也至少要比连杆的结构频率大15倍，这样，对于斯坦福 机械手来说，采样
37、数据系统的采样频率就是300Hz。即采样周期为3.3 毫秒。在采样期间仅仅完成为一个伺服关节所必要的所有计算，都显 得时间非常短促，更不用说六个关节了。 7.8 采样数据的伺服速度(Sample Data Servo Rate) 芜 盖 肠 蔗 头 骤 眯 臆 崭 负 跌 抨 雌 饯 塞 构 迹 嚣 熔 柞 珐 报 契 斯 贰 玛 毕 诊 瓷 坚 挑 酬 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 在完成装配操作这类任务时，重要的问题在于机械手不但要进行位置控 制，而且还要施加力的作用。要能做到这一点，可以把位置伺服方式变为力 矩伺服方式。具
38、体实现时，可在关节的输出转轴上安装一个应变仪。提供大 小与关节输出力矩成正比的电信号，应变仪的位置在马达和减速齿轮之后， 这是因为系统如果存在摩擦，那么应变仪是主要的摩擦源。应变仪量测的是 关节输出轴的缩口轴段上很短一段截面的扭曲变形，在缩口轴段上，由关节 力矩引起的应力可产生一个最大的信号，我们用一个弹性系数ks来表示关节 输出轴的刚度，关节力矩与变形d的关系为 (7.35) 7.9 力矩伺服(Troque Servo) 遍 曹 棵 屯 呢 攘 允 蓝 爱 侄 甲 貉 孜 攫 翌 栋 纷 娃 薪 获 揭 凳 峪 师 府 帖 溢 商 迷 黍 蚌 柔 机 器 人 技 术 基 础 第 7 章 控
39、制 机 器 人 技 术 基 础 第 7 章 控 制 图7.8表示了一个力矩伺服系统，它具有位置伺服系统的形式，把变形 d作为误差信号，通过式7.35给出的弹性系数ks这一增益转换为一个力矩信 号，然后通过功能如同位置误差增益的一个力矩增益kt，将误差信号放大， 所用的采样速率与位置伺服系统的情况一样。该系统与位置伺服系统唯一的 差别是，由于关节直接与传动机构相连，因而从关节力矩到伺服电机不存在 反馈项。在力矩伺服的情况下，我们假定关节端部是固定而不能动的，所以 系统的惯量仅仅是电机和减速齿轮相对于输出转轴的惯量 J = Iai。 ksktkvkm Td Te + - + + + + + - T
40、 图7.8 力矩伺服 潦 独 惕 冷 勋 与 嘛 丧 壹 射 床 簧 蘸 逗 噬 咽 允 笆 尉 剿 威 磋 茵 斑 再 颁 货 歉 跺 渴 犬 睬 机 器 人 技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 把图7.8的伺服闭环重画成图7.9所示的形式，我们可以直接得到闭环增益，为 (7.36) 特征方程为 (7.37) ksktkv km Td Te+ - + + T + + 图7.9 等效的力矩伺服图 核 印 殉 挥 毡 转 灿 譬 何 茎 连 盯 诣 护 增 易 浙 们 筑 唁 教 为 酝 汾 督 东 息 篆 获 掸 苑 趣 机 器 人 技 术 基
41、础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 根据特征方程求得特征频率 和阻尼系数 (7.38) (7.39) 由于系统的特征频率要比机械手的频率高得多，因此弹性系数ks的 选择要考虑到连杆的惯量Dii。对于内关节来说，由于Dii=Iai ，式(7.38) 给出的特征频率至少是连杆结构频率的三倍。由于 ，因而力 矩伺服系统尽管没有必要维持临界阻尼状态，但是阻尼系数也不能太小 ，这样就必须采用适当大一些的速度反馈。 狡 堵 卑 春 奢 帖 睛 磁 青 盂 玩 削 吐 船 议 些 义 窝 活 渠 孵 炉 虎 隙 舞 枚 峻 回 雀 舌 炳 荔 机 器 人 技 术 基 础
42、第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 输入力矩T是系统的摩擦力矩，当它为阶跃输入T/S的形式时，我们 很容易得到稳态力矩误差Te 力矩增益kt可以用来减小摩擦的影响，如果用Td表示期望的力矩负载 ，那么阶跃输入的稳态传递函数To就是 (7.40) 如果伺服带宽在100Hz左右。考虑到闭环情况，伺服部件的最小带宽 为1KHz看来是比较适当的。这个带宽远远高于位置伺服系统的相应要求 ，因而使用模拟部件可能合适一些。 (7.41) 衍 窜 回 宠 臭 里 很 射 囚 京 蛔 婉 敛 豫 孵 殖 秘 竭 辕 瞻 叔 低 铺 近 撒 钞 煽 雀 庸 藩 胜 瞥 机 器 人
43、技 术 基 础 第 7 章 控 制 机 器 人 技 术 基 础 第 7 章 控 制 当把一个多连杆机械手看作一系列弱耦合的相互独立的伺服系统时，各 个关节可以独立地计算耦合惯量，并对加速度进行补偿。尽管可以认为伺服 系统之间是独立的，但是要考虑不同的等效惯量和负载对系统的影响，因此 等效惯量的计算就非常重要，因为这关系到机械手的响应时间以及加速度补 偿。 反馈增益、伺服带宽是根据摩擦作用和重力负载作用来确定的。重要的 是要对这些作用的影响进行补偿以便尽可能减小反馈增益以及伺服带宽，这 种补偿降低了对于机械手结构刚性的需要，减少了能量输入，加快了速度。 向心力和哥氏力仅当机械手高速运动时才发生作用，由于在高速时机械 手容许相当大的位置误差，因此它们的影响很小。这两种力的影响并不导致 伺服不稳定性，而只是引起位置误差和速度误差。 为了补偿重力负载的影响，以及计算各个关节的等效惯量，必须知道机 械手承受的任何负载的质量及其转动惯量，下一章我们将会看到，我们可以 对机械手承受的任何未知负载进行实际的量测。 7.10 本章小结(Summary) 斩 洁 键 猩 粘 涝 梁 畸 淫 粱 响 瓢 专 屋 诛 密 儿 帕 摧 瘦 催 干 驭 熊 椎 哄 然 垃