文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 环境科学/食品科学 > 一种新型机器人支撑相动力学建模及可控性分析
侵权投诉

一种新型机器人支撑相动力学建模及可控性分析

从生物研究中受到启发,兼顾机器人的运动能耗问题,设计了一种新型机器人机构———仿袋鼠单腿跳跃机器人。机构设计是在模仿自然界袋鼠骨骼结构的基础上,充分利用产生被动动力学的机械结构来减少机器人的运动能耗,将膝关节设计为弹性被动关节来减少腿的质量和转动惯量,以达到减小驱动力矩的目的。

24机械设计与研究                    第25卷

θθθθm3lc3l2θ3(3+22+21)sin3+

(m2lc2+m3l2+m4l2)l1θθ1sin2

2

Mq+C=0

(5)

其中M,C,q的表达式见式(1)中的说明。

将仿袋鼠单腿跳跃机器人支撑相的平衡点表示为

3333

θθθθ1=θ1, 2=θ2, 3=θ3, 4=θ4

θc3=K2(θ3-θ30)+m3lc3gcos(1+θ2+θ3)+

22

θθm3lc3l2(θ1+θ2)sin3+m3lc3l1θ1sin(2+θ3)

c4=K3(θ4-θ40)

定义该机器人系统的状态变量为

T

θθθθθθθx=[θ1 2 3 4 1 2 3 4]

从式(1)中可以看出,机器人在支撑相包含两个二阶微分方程约束,这是由于机器人在支撑相存在两个被动转动关节θ从力学学者的观点看,一般只把由无滑动1,θ2所导致的。滚动、冰刀滑动、速度随动系统(如舰载垂直起降飞行器)等引起的微分约束系统称为非完整约束系统,然而近20多年来在航天空间机器人、水下欠驱动机器人、微分几何控制领域的研究表明,约束”,约束

[12]

则对应该机器人系统平衡点的平衡状态可表示为

x

3

θθθ=[θ1 2 3 4 0 0 0 0]

T

(1x3,C=

(6)

m11

M=

m21m31m41

m12m22m32m42

m13m23m33m43

mmmm。因此仿袋鼠单腿跳跃机器人支撑相是二阶非完整

 ———常矩阵

约束系统。

3 可控性分析

欠驱动系统或二阶非完整约束系统的控制具有很大的挑战性,这不仅因为欠驱动系统的非线性动力学模型复杂,还因为它不具有全状态反馈线性化的特性。欠驱动系统是否是线性地可控,关系着该系统是否存在光滑的静态状态反馈控制器来实现系统平衡点的渐近稳定控制,因此对欠驱动系统的线性可控性分析有着重大价值。

一般的控制问题可以描述为:通过选择适当的控制输入,在有限的时间内,是否可以控制系统从一给定的初始位置到达所期望的位置。

对于一n自由度仿射系统

m

233

θm11=(m2+m3+m4)l1+2m3lc3l1cos(+θ23)+

32

θ2(m2lc2+m3l2+m4l2)l1cos+(m3+m4)l2+2

θ2m3lc3l2cos+m1lc1+m2l

一种新型机器人支撑相动力学建模及可控性分析

c2+m3lc3+3

J1+J2+J3+J4

33

θθm12=(m2lc2+m3l2+m4l2)l1cos+2m3lc3l2cos+23

332

m3lc3l1cos(θ+θ23)+(m3+m4)l2+

3

222

m2lc2+m3lc3+J2+J3+J4

333

θm13=m3lc3l2cos+m3lc3l1cos(θ+θ323)+

22

m3lc3+J3

2

x=f(x)+

∑g

i=1

i

(x)ui

n

(2)

m14=m24=m44=J4, m21=m12

23

θm22=(m3+m4)l2+2m3lc3l2cos+3

其中,x∈R是状态变量;f(x),gi(x)是R上充分光滑的向量场;ui是控制输入。

定义式(2)的平衡点集为:

m

n

m2lc2+m3lc3+J2+J3+J4

22

θm23=m3lc3l2cos+m3lc3+J33

3

2

ε={(x,u)∈M×IR∶f(x)+

ee

ee

m

∑g

i=1

i

(x)ui=0}

m31=m13, m32=m23m33=m3lc3+J3, m34=0m41=m14, m42=m24, m43=m34C=[c1 c2 c3 c4]

T

ε记(x,u)∈,为x=f(x)+∑gi(x)ui的平衡点,其在平衡

i=1

m

2

点(x,u)的线性化系统为

x=Ax+Bu

m

(3)

=

式中:A+9x

e

i=1

(x)

u9x

9x

(x3)

———各元素都为θ1,θ2,θ3,θ4的线性组合

(xe,ue)e

B=[g1(x),g2(x),…,gm(x)]

e

TT

θθθττq=[θ1 2 3 4],Q=[0 0 1 2]

理论1:系统(3)是可控的,当且仅当

2n-1

rank([B AB … AB])=2n

为了将线性化系统(6)转化为一般仿射系统的形式,定义系统新的输入u=[u1 u2]T,通过线性输入变换:

τ1=m31θ1+m32θ2+m33u1+m34u2+c3τ2=m41θ1+m42θ2+m43u1+m44u2+c4

θ3=u1,θ4=u2

可将线性化系统(6)转化为:

θ1=ξ1+ξ3u1+ξ5u2

系统(2)是线性地可控的,当且仅当系统(3)在系统(2)的任一平衡点都是可控的。

3.1 仿袋鼠单腿跳跃机器人

为了证明仿袋鼠单腿跳跃机器人支撑相的线性可控性,首先必须得到其在平衡点的线性化系统。该机器人支撑相平衡点的获得可通过求解以下方程

(7)(8)

θθθq=[θ1 2 3 4]

T

=0(4)

θ2=ξ2+ξ4u1+ξ6u2

上一页第3页

你可能喜欢

  • 机器人运动学
  • 机器人发展现状
  • 真空吸盘
  • 机器人动力学
  • 机器人结构设计
  • 机器人驱动

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email