CN101526801A - 履带式移动机械手的广义系统统一动力学建模方法 - Google Patents
履带式移动机械手的广义系统统一动力学建模方法 Download PDFInfo
- Publication number
- CN101526801A CN101526801A CN200910068500A CN200910068500A CN101526801A CN 101526801 A CN101526801 A CN 101526801A CN 200910068500 A CN200910068500 A CN 200910068500A CN 200910068500 A CN200910068500 A CN 200910068500A CN 101526801 A CN101526801 A CN 101526801A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- theta
- partiald
- crawler
- mobile manipulator
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Abstract
本发明公开了一种履带式移动机械手的广义系统统一动力学建模方法。其核心包括:利用绝对坐标计算履带式移动机械手的动能和势能;运用机器人的拉格朗日动力学方法对履带式移动机械手进行了统一的动力学建模;由于移动机械手是一个复杂的系统,且移动平台具有非完整约束,因此将上述模型改写为广义系统下的统一动力学模型,应用广义系统的控制理论对其进行研究。本发明避免了以往研究移动式机器人时对移动平台和机械手分别建模,分别控制而忽略其耦合和相互影响所带来的误差,同时理论性强,思路清晰,编程容易实现,达到了对这类移动机械手精确控制的目的。
Description
【技术领域】:
本发明涉及移动机械手的控制技术领域。
本方法主要涉及一种移动机械手的统一动力学建模方法,特别是用广义系统理论对一类非完整移动机器人进行动力学建模和控制,可用于实体移动机械手的控制器设计。
【背景技术】:
履带式移动机械手系统是由一个机械手固定在一个履带式移动平台上构成。目前,机械手已被广泛应用于流水生产线产品的抓取操作上。移动机械手同时具有移动和操作两大功能。平台的移动扩大了机械手的工作空间,使机械手具有几乎无限大的操作空间且能以更加适合的姿态来执行任务。
一.建立动力学模型是实时控制的需要
移动机器人的数学模型包括运动学模型和动力学模型两部分。建立动力学模型是实时控制的需要,利用它可以实现最优控制,达到良好的动态性能和最优指标。目前对于移动机械手的控制大多集中在运动学方面,控制输入为系统的速度,此类控制方法存在如下问题:(1)完全速度跟踪假设在实际中并不成立;(2)忽略了移动机械手所受干扰对控制系统的影响。这种运动学控制器在系统运动速度不大,无干扰或干扰很小的情况下还基本能够保证系统的性能,但当系统的运动速度增大,不确定性较强的情况下,很难保证控制性能。移动机械手的不确定性主要来自两个方面:(1)移动平台与操作手的相互耦合作用而引起的模型的不精确;(2)由于动态的、非结构化的环境因素使移动机械手受到的随机干扰,如地面的不规则,轮子的滑动等。
系统的实际控制输入是由驱动器产生的,从动力层面考虑系统的控制问题与实际相符,设计动力学控制器将会使系统性能和可实现性极大提高。
二.机械手和移动平台的强耦合作用要求设计移动机械手的统一控制器
目前,国内外对移动机械手的控制主要采取分别控制的思想。其代表性研究有:(1)YamamotoY用“首选操作区”的概念实现了机械手末端跟踪一个运动物体的表面,其实质是仅考虑机械手一个子系统的控制;(2)GoldenbergAA为移动机械手的两个子系统分别设计了基于神经网络的控制器,提出了需要较少控制参数的鲁棒阻尼控制;(3)Chung J H利用非线性交互控制进行运动学冗余度求解,分别设计了用于机械手控制的鲁棒自适应控制器和用于移动载体的线性化控制器。上述分散控制的方法可以降低控制器设计的难度,但由于工业机械手质量大,运动速度快,运动过程中会产生很大的耦合力作用在移动平台上;同时移动平台的运动也会干扰机械手的控制,影响控制精度。为此有学者尝试将移动机械手看成一个整体进行控制。其代表性的研究有:(1)Jagannathan S通过建立离散的模糊逻辑系统来逼近整个系统的动力学模型,实现移动载体和机械手的位置和速度跟踪。其优点是可以部分克服动力学耦合和外部扰动的影响,但其不足之处是必须满足持续的激励条件;(2)Yamamoto Y利用非线性反馈对耦合进行集中补偿,但实验证明这种补偿对于由平台移动引起的跟踪误差效果较好,但很难补偿由于机械手的运动引起的跟踪误差。
目前,对履带式移动机械手采用统一的运动学和动力学建模加以控制的研究很少,已有方法对移动平台的非完整约束也缺乏有效的措施,为了解决上述问题,本发明提供了一种履带式移动机械手的广义系统统一动力学建模方法。
【发明内容】:
本发明目的是克服现有技术存在的上述不足,提供一种履带式移动机械手的广义系统统一动力学建模方法。
本发明所采用的技术方案是:首先利用绝对坐标计算履带式移动机械手的动能和势能;接着运用机器人的拉格朗日动力学方法对履带式移动机械手进行统一的动力学建模;最后基于移动机械手的复杂性及移动平台具有非完整约束,将上述模型改写为广义系统下的统一动力学模型,应用广义系统的控制理论对其进行建模和研究。
具体建模方法如下:
第一、归纳移动机械手的结构模型,即按照传统的方法提取待研究的移动机械手的主要特征,
得出其结构图,并将其放入绝对坐标系中;
第二、确定各个关节的质心绝对坐标(xci,yci,zci);
第三、计算整个系统的动能
其中,用0表示履带式移动平台的参数;i=1-n分别表示机械手的n个关节,
I为第i关节的转动惯量;Ωi为第i关节的角速度,
vi为第i关节的质心绝对线速度,即
对履带式移动平台,设其质心坐标为xF,yF,则:
kl,kr分别表示左右履带相对于地面实际位移滑动参数,这两个参数的目的是为了引入对履带-地面之间相互作用的一个估计;
第四、计算势能
第五、计算拉格朗日函数L=K-P;
第六、编程实现
第七、建立广义系统模型
(1)、step6等式右边整理可得:
其中q=(xF,yF,θP,θ1,θ2,θ3,θ4).,
(2)、将2整理为
(3)、考虑非完整约束
建立广义系统模型
其中:
本发明的优点和积极效果:
本发明方法主要涉及一种移动机械手的统一动力学建模方法,特别是用广义系统理论对一类非完整移动机器人进行动力学建模和控制,其优势在于:(1)可以有效克服原来方法中分别对移动平台和机械手进行控制时,由于忽略移动平台和机械手之间的耦合力而造成的控制误差;(2)说明书中给出的程序框图可以应用于任何类型的移动机械手动力学建模,使建模方法模式化,方便实施;(3)将非完整约束用广义系统的代数方程来表示,可以直接用广义系统已有的控制方法直接对这类移动机械手设计控制器,有效的克服了非完整约束所带来的控制难度。将此方法应用于天津理工大学的一个履带式移动机械手上,控制效果比较理想(见实施例1)。
【附图说明】:
图1是本发明所用机器人的结构示意图;
图2是本发明的程序框图;
图3是采用本发明的方法建立模型后,用反馈线性化控制时得到的控制力矩,其中,
图3-A,是移动平台上机械手的关节1的输入力矩图;
图3-B,是移动平台上机械手的关节2的输入力矩图;
图3-C,是移动平台上机械手的关节3的输入力矩图;
图3-D,是移动平台上机械手的关节4的输入力矩图;
图3-E,是移动平台右轮的输入力矩图;
图3-F,是移动平台左轮的输入力矩图;
图4是采用本发明的方祛建立模型后,用反馈线性化控制时得到的关节跟踪曲线,其中,
图4-A,是移动平台上机械手的关节1跟踪阶跃响应的曲线;
图4-B,是移动平台上机械手的关节2跟踪阶跃响应的曲线;
图4-C,是移动平台上机械手的关节3跟踪阶跃响应的曲线;
图4-D,是移动平台上机械手的关节4跟踪阶跃响应的曲线;
图4-E,是移动平台从起始点(-1,0)开始跟踪(0,0)为圆心,半径为2的圆的曲线。
【具体实施方式】:
本发明提供的履带式移动机械手的广义系统统一动力学建模方法的具体步骤如下:
第一、归纳移动机械手的结构模型,即按照传统的方法提取待研究的移动机械手的主要特征,得出其结构图,并将其放入绝对坐标系中;
第二、确定各个关节的质心绝对坐标(xci,yci,zci);
第三、计算整个系统的动能
其中,用0表示履带式移动平台的参数;i=1-n分别表示机械手的n个关节,
I为第i关节的转动惯量;Ωi为第i关节的角速度,
vi为第i关节的质心绝对线速度,即
对履带式移动平台,设其质心坐标为xF,yF,则:
kl,kr分别表示左右履带相对于地面实际位移滑动参数,这两个参数的目的是为了引入对履带一地面之间相互作用的一个估计;
第四、计算势能
第五、计算拉格朗日函数L=K-P;
第六、编程实现
第七、建立广义系统模型
(1)、step6等式右边整理可得:
其中q=(xF,yF,θP,θ1,θ2,θ3,θ4).,
(2)、将2整理为
(3)、考虑非完整约束
建立广义系统模型
其中:
实施例1:
具体参数如下:
车体几何参数:r=0.105;kl=1;kr=1;lf=0.09;b=0.205;l0=0.6;
机械手几何参数:l1=0.1;l2=0.6;l3=0.35;l4=0.1;
机械手质心位置:pc1=0.07/0.1;pc2=0.27/0.6;pc3=0.112/0.35;pc4=0.031/0.1;
移动机械手各关节质心高度:zc0=0.25;ll0=0.25;ll1=0.6;zc1=ll1+pc1*l1;
移动机械手各关节质量:m0=25;m1=6.84;m2=3.24;m3=1.54;m4=1.74;
重力加速度:g=9.8
移动机械手各关节转动惯量:j0=0.5512;j1=0.077;j2=0.18;j3=0.035;j4=0.005
用说明书所述的方法建立广义系统统一动力学模型后,直接加入统一的PID协调控制器, 取kp=diag(50 50 50 30 30 30 30),kd=diag(100 100 100 100 100 100 100),即可得到图3,图4的控制效果。克服了以往控制中分别对移动平台和机械手建模,分别设计控制器时,由于忽略移动平台和机械手之间的耦合力而造成的控制误差。
Claims (1)
1、一种履带式移动机械手的广义系统统一动力学建模方法,其特征在于该方法包括:
第一、归纳移动机械手的结构模型,即按照传统的方法提取待研究的移动机械手的主要特征,得出其结构图,并将其放入绝对坐标系中;
第二、确定各个关节的质心绝对坐标(xci,yci,zci);
第三、计算整个系统的动能
其中,用0表示履带式移动平台的参数;i=1-n分别表示机械手的n个关节,
I为第i关节的转动惯量;Ωi为第i关节的角速度,
vi为第i关节的质心绝对线速度,即
对履带式移动平台,设其质心坐标为xF,yF,则:
kl,kr分别表示左右履带相对于地面实际位移滑动参数,这两个参数的目的是为了引入对履带-地面之间相互作用的一个估计;
第四、计算势能
第五、计算拉格朗日函数L=K-P;
第六、编程实现
第七、建立广义系统模型
(1)、step6等式右边整理可得:
其中q=(xF,yF,θP,θ1,θ2,θ3,θ4).,
(2)、将2整理为
(3)、考虑非完整约束
建立广义系统模型
其中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200910068500A CN101526801A (zh) | 2009-04-17 | 2009-04-17 | 履带式移动机械手的广义系统统一动力学建模方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200910068500A CN101526801A (zh) | 2009-04-17 | 2009-04-17 | 履带式移动机械手的广义系统统一动力学建模方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN101526801A true CN101526801A (zh) | 2009-09-09 |
Family
ID=41094691
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200910068500A Pending CN101526801A (zh) | 2009-04-17 | 2009-04-17 | 履带式移动机械手的广义系统统一动力学建模方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101526801A (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102495550A (zh) * | 2011-11-21 | 2012-06-13 | 湖南湖大艾盛汽车技术开发有限公司 | 并联机器人的正、逆动力学响应分析与控制方法 |
CN102508436A (zh) * | 2011-11-21 | 2012-06-20 | 湖南大学 | 机械手摩擦力动力学精确分析与控制应用方法 |
CN104808512A (zh) * | 2015-03-03 | 2015-07-29 | 北京空间飞行器总体设计部 | 一种航天器多级驱动刚柔耦合响应的获取方法 |
CN105242533A (zh) * | 2015-09-01 | 2016-01-13 | 西北工业大学 | 一种融合多信息的变导纳遥操作控制方法 |
CN105904461B (zh) * | 2016-05-16 | 2017-10-31 | 西北工业大学 | 一种基于径向基函数的神经网络自适应遥操作控制方法 |
CN110509276A (zh) * | 2019-08-28 | 2019-11-29 | 哈尔滨工程大学 | 一种机场跑道检测机器人的运动建模及参数辨识方法 |
CN112847351A (zh) * | 2020-12-31 | 2021-05-28 | 重庆电子工程职业学院 | 一种基于指数趋近率的并联机器人轨迹跟踪控制方法 |
CN112975965A (zh) * | 2021-02-24 | 2021-06-18 | 深圳市优必选科技股份有限公司 | 仿人机器人的解耦控制方法、装置和仿人机器人 |
CN113352321A (zh) * | 2021-05-12 | 2021-09-07 | 中核工程咨询有限公司 | 巡检机器人的控制方法、装置和巡检机器人 |
CN116184860A (zh) * | 2023-04-27 | 2023-05-30 | 北京国领智能科技有限公司 | 磁吸履带式爬壁机器人动力学建模与控制方法 |
-
2009
- 2009-04-17 CN CN200910068500A patent/CN101526801A/zh active Pending
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102495550A (zh) * | 2011-11-21 | 2012-06-13 | 湖南湖大艾盛汽车技术开发有限公司 | 并联机器人的正、逆动力学响应分析与控制方法 |
CN102508436A (zh) * | 2011-11-21 | 2012-06-20 | 湖南大学 | 机械手摩擦力动力学精确分析与控制应用方法 |
CN102495550B (zh) * | 2011-11-21 | 2013-07-10 | 湖南湖大艾盛汽车技术开发有限公司 | 并联机器人的正、逆动力学响应分析与控制方法 |
CN102508436B (zh) * | 2011-11-21 | 2014-07-16 | 湖南大学 | 机械手摩擦力动力学精确分析与控制应用方法 |
CN104808512B (zh) * | 2015-03-03 | 2017-05-31 | 北京空间飞行器总体设计部 | 一种航天器多级驱动刚柔耦合响应的获取方法 |
CN104808512A (zh) * | 2015-03-03 | 2015-07-29 | 北京空间飞行器总体设计部 | 一种航天器多级驱动刚柔耦合响应的获取方法 |
CN105242533A (zh) * | 2015-09-01 | 2016-01-13 | 西北工业大学 | 一种融合多信息的变导纳遥操作控制方法 |
CN105904461B (zh) * | 2016-05-16 | 2017-10-31 | 西北工业大学 | 一种基于径向基函数的神经网络自适应遥操作控制方法 |
CN110509276A (zh) * | 2019-08-28 | 2019-11-29 | 哈尔滨工程大学 | 一种机场跑道检测机器人的运动建模及参数辨识方法 |
CN112847351A (zh) * | 2020-12-31 | 2021-05-28 | 重庆电子工程职业学院 | 一种基于指数趋近率的并联机器人轨迹跟踪控制方法 |
CN112975965A (zh) * | 2021-02-24 | 2021-06-18 | 深圳市优必选科技股份有限公司 | 仿人机器人的解耦控制方法、装置和仿人机器人 |
CN112975965B (zh) * | 2021-02-24 | 2022-07-29 | 深圳市优必选科技股份有限公司 | 仿人机器人的解耦控制方法、装置和仿人机器人 |
CN113352321A (zh) * | 2021-05-12 | 2021-09-07 | 中核工程咨询有限公司 | 巡检机器人的控制方法、装置和巡检机器人 |
CN116184860A (zh) * | 2023-04-27 | 2023-05-30 | 北京国领智能科技有限公司 | 磁吸履带式爬壁机器人动力学建模与控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101526801A (zh) | 履带式移动机械手的广义系统统一动力学建模方法 | |
CN106094835B (zh) | 前轮驱动车式移动机器人的动态编队控制方法 | |
CN105320129B (zh) | 一种无人驾驶自行车轨迹跟踪控制的方法 | |
CN106125728B (zh) | 一种四驱轮式移动机器人轨迹跟踪控制方法 | |
CN103240739B (zh) | 一种移动机械臂分散集中自主切换控制方法 | |
Yu et al. | Analysis and experimental verification for dynamic modeling of a skid-steered wheeled vehicle | |
CN102030263A (zh) | 基于运动规划的桥式吊车自适应控制方法 | |
Bin et al. | The kinematics model of a two-wheeled self-balancing autonomous mobile robot and its simulation | |
CN110045598B (zh) | 一种悬臂式掘进机井下行进路径跟踪控制方法 | |
CN105652869A (zh) | 一种基于cmac和pid的全向移动机器人及移动控制方法 | |
CN104793497A (zh) | 基于多体系统离散时间传递矩阵法的机器人动力学建模方法 | |
Korayem et al. | Maximum load-carrying capacity of autonomous mobile manipulator in an environment with obstacle considering tip over stability | |
Petrov et al. | Adaptive steering control for autonomous lane change maneuver | |
CN104528528A (zh) | 基于消摆信号的桥式起重机非线性控制方法 | |
CN102880062B (zh) | 基于非线性模型预测的智能小车2.5维视觉伺服控制方法 | |
Shen et al. | A lateral control method for wheel-footed robot based on sliding mode control and steering prediction | |
My et al. | Modeling and computation of real-time applied torques and non-holonomic constraint forces/moment, and optimal design of wheels for an autonomous security robot tracking a moving target | |
Yang et al. | Path tracking control of an articulated road roller with sideslip compensation | |
Song et al. | Stability-constrained mobile manipulation planning on rough terrain | |
Yang et al. | Control methods of mobile robot rough-terrain trajectory tracking | |
Liu et al. | Coordinated motion control and event-based obstacle-crossing for four wheel-leg independent motor-driven robotic system | |
CN204819543U (zh) | 一种集控式多机器人运动控制系统 | |
Ghabcheloo et al. | Modeling and motion control of an articulated-frame-steering hydraulic mobile machine | |
Sun et al. | Fuzzy-model-based H∞ dynamic output feedback control with feedforward for autonomous vehicle path tracking | |
Li et al. | MPC-based trajectory tracking control of unmanned underwater tracked bulldozer considering track slipping and motion smoothing |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Open date: 20090909 |