CN108972548B - 一种移动平台-机械臂系统建模方法 - Google Patents

一种移动平台-机械臂系统建模方法 Download PDF

Info

Publication number
CN108972548B
CN108972548B CN201810695959.XA CN201810695959A CN108972548B CN 108972548 B CN108972548 B CN 108972548B CN 201810695959 A CN201810695959 A CN 201810695959A CN 108972548 B CN108972548 B CN 108972548B
Authority
CN
China
Prior art keywords
mobile platform
mechanical arm
coordinate system
representing
point
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.)
Active
Application number
CN201810695959.XA
Other languages
English (en)
Other versions
CN108972548A (zh
Inventor
张智军
孔令东
朱徐鹏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN201810695959.XA priority Critical patent/CN108972548B/zh
Publication of CN108972548A publication Critical patent/CN108972548A/zh
Application granted granted Critical
Publication of CN108972548B publication Critical patent/CN108972548B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种移动平台‑机械臂系统建模方法，具体步骤包括：(1)构造二次规划问题的速度层运动学方程式；(2)定义与移动平台相关的坐标系以及末端机械臂执行器的齐次位置表达式；(3)构造机械臂的正运动学方程式；(4)构造移动平台‑机械臂系统的总运动学方程式；(5)求解系统的齐次变换矩阵；(6)求解系统的雅可比矩阵；(7)将步骤(6)求解得到的雅可比矩阵代入步骤(1)中的二次规划问题运动学方程式，得到末端机械臂执行器的运动规划，完成移动平台‑机械臂系统的建模。本发明为基于目标系统的模型构建方法，具有建模准确、思路清晰、逻辑性强、方法简明等优点。

Description

一种移动平台-机械臂系统建模方法
技术领域
本发明涉及系统建模领域，尤其涉及一种移动平台-机械臂系统建模方法。
背景技术
冗余度机械臂是指自由度数量多于完成任务所必须的自由度数量的机械臂。由于具有更多的自由度，该种类型的机械臂在完成末端执行器的各种任务的同时，还可以完成诸如障碍物躲避、关节角极限约束、机械臂奇异状态等额外工作。利用这样一种冗余特性，越来越多的冗余度机械臂被应用在工业制造和生产生活的各个方面。随着机械臂制造水平的不断提高和新兴医疗产业的不断涌现，近年来，搭载有冗余度机械臂的移动平台逐渐出现在人们的视野当中。一些新颖的、高度智能化的移动平台-机械臂系统应运而生，这些系统逐渐朝着集成化、一体化的方向发展，形成了诸如残疾人康复系统等的现代智能化医疗及康复系统。上述移动平台-机械臂系统可以对患有残疾或瘫痪等疾病的病人提供医疗帮助，并协助其处理和完成日常生活所需的各种操作。随着对该产业投入的不断增大以及市场需求的逐渐提高，对移动平台-机械臂系统各方面的要求也在不断上升，这就需要我们透彻地分析移动平台-机械臂系统的物理模型特性，以便更好地在该系统模型的架构和基础上设计和分析各种性质，进而完成人们期望的目标。
发明内容
本发明的目的在于提供一种移动平台-机械臂系统建模方法。本发明为基于目标系统的模型构建方法，在充分考虑了目标模型系统的物理、数学特征及其参数的情况下，运用物理模型建立与数学模型代入相结合的方法，求解得到该目标系统的运动规划并完成该系统的建模，具有建模准确、思路清晰、逻辑性强、方法简明等特点。
本发明的目的能够通过以下技术方案实现：
一种移动平台-机械臂系统建模方法，具体步骤包括：
(1)根据末端机械臂执行器的运动学模型，构造二次规划问题的速度层运动学方程式；
(2)根据移动平台-机械臂系统的物理特性及模型参数，定义与移动平台相关的坐标系以及末端机械臂执行器的齐次位置表达式；
(3)根据步骤(2)中定义的齐次位置表达式，结合机械臂的D-H模型，构造机械臂的正运动学方程式；
(4)根据步骤(2)中定义的坐标系和步骤(3)中的机械臂正运动学方程式，构造移动平台-机械臂系统的总运动学方程式；
(5)根据步骤(4)中的移动平台-机械臂系统的总运动学方程式，求解系统的齐次变换矩阵；
(6)根据步骤(4)中的总运动学方程式和步骤(5)得到的系统的齐次变换矩阵，求解系统的雅可比矩阵；
(7)将步骤(6)求解得到的雅可比矩阵代入步骤(1)中的二次规划问题运动学方程式，得到末端机械臂执行器的运动规划，完成移动平台-机械臂系统的建模。
具体地，所述步骤(1)中，对于含冗余度的末端机械臂执行器，其期望的目标适用于如下二次规划问题的速度层运动学方程式：
Figure BDA0001713587930000021
其中，
Figure BDA0001713587930000022
表示末端机械臂执行器的雅可比矩阵，m表示移动机械臂系统的工作空间，n表示移动机械臂系统的控制变量矢量。
Figure BDA0001713587930000023
表示在速度层的期望目标轨迹；
Figure BDA0001713587930000024
代表目标模型系统所结合的控制矢量。
在本发明中，所述控制矢量由移动平台左右驱动轮的2个旋转角速度以及冗余度机械臂的6个关节角速度所构成。
具体地，在所述步骤(2)中，根据移动平台-机械臂系统的物理特性及模型参数，定义与移动平台相关的坐标系分别为：
(Ⅰ)定义移动平台-机械臂系统的工作空间坐标系，即世界坐标系
Figure BDA0001713587930000025
(Ⅱ)定义原点固结在移动平台轮轴中Po点的坐标系
Figure BDA0001713587930000026
(Ⅲ)定义原点固结在移动平台上Pc点的坐标系
Figure BDA0001713587930000027
(Ⅳ)定义原点固结在末端机械臂执行器上的坐标系
Figure BDA0001713587930000028
其中，Po为移动平台对称轴与两驱动轮轴线的交点；Pc为机械臂在移动平台上的安装位置所在的点。
具体地，在所述步骤(2)中，依据实际移动平台-机械臂系统的物理特征，可以定义末端机械臂执行器的齐次位置表达式
Figure BDA0001713587930000029
具体地，在所述步骤(3)中，根据步骤(2)中末端机械臂执行器的齐次位置表达式，结合机械臂的D-H模型，得到机械臂的正运动学方程式，表示方式如下：
Figure BDA00017135879300000210
其中，
Figure BDA0001713587930000031
表示末端执行器在移动平台坐标系
Figure BDA0001713587930000032
下的齐次坐标；
Figure BDA0001713587930000033
分别表示冗余度机械臂6个关节的齐次变换矩阵。
具体地，在所述步骤(4)中，根据各坐标系的关系和机械臂的正运动学方程即公式(2)，可以得到移动平台-机械臂系统的总运动学方程式，表示为：
Figure BDA0001713587930000034
其中，
Figure BDA0001713587930000035
表示在世界坐标系
Figure BDA0001713587930000036
下的末端执行器的齐次坐标；
Figure BDA0001713587930000037
为表示机械臂移动平台坐标系
Figure BDA0001713587930000038
与世界坐标系
Figure BDA0001713587930000039
转换关系的齐次变换矩阵。
具体地，在所述步骤(5)中，对在移动平台轮轴中点坐标系
Figure BDA00017135879300000310
中的点Po做运动学分析，得到如下的关系式：
Figure BDA00017135879300000311
Figure BDA00017135879300000312
其中，wr表示移动平台驱动轮的半径；
Figure BDA00017135879300000313
表示移动平台的方向角速度；
Figure BDA00017135879300000314
表示移动平台左驱动轮的旋转角速度；
Figure BDA00017135879300000315
表示移动平台右驱动轮的旋转角速度。
Figure BDA00017135879300000316
表示点Po在移动平台轮轴中点坐标系
Figure BDA00017135879300000317
中的速度向量，
Figure BDA00017135879300000318
为Xo轴方向上的速度分量，
Figure BDA00017135879300000319
为Yo轴方向上的速度分量，
Figure BDA00017135879300000320
为Zo轴方向上的速度分量。
对在移动平台轮轴中点坐标系
Figure BDA00017135879300000321
中的Pc点做运动学分析，得到如下的关系式：
Figure BDA00017135879300000322
其中，
Figure BDA00017135879300000323
表示点Pc在移动平台轮轴中点坐标系
Figure BDA00017135879300000324
中的速度向量，
Figure BDA00017135879300000325
为Xc轴方向上的速度分量，
Figure BDA00017135879300000326
为Yc轴方向上的速度分量，
Figure BDA00017135879300000327
为Zc轴方向上的速度分量，Rc为点Pc到坐标系
Figure BDA00017135879300000328
原点的距离，α为Rc与Xo轴的夹角。
Rc，sinα，cosα以及xoc，yoc，zoc的几何关系具体表示为：
Rccosα＝xoc(7)
Rcsinα＝yoc(8)
zoc在XoYo平面上为零。
其中，(xoc，yoc，zoc)为Pc点在移动平台坐标系
Figure BDA0001713587930000041
中的坐标。所述坐标是固定值，由机械臂在移动平台上的安装位置所决定。
将公式(7)和(8)代入公式式(6)，并依照式(4)和式(5)中所陈述的关系，可以得到如下关系式：
Figure BDA0001713587930000042
通过左乘旋转变换矩阵，将在移动平台轮轴中点坐标系
Figure BDA0001713587930000043
中点Pc的速度表达式转化到世界坐标系
Figure BDA0001713587930000044
中，可以得到如下转换关系：
Figure BDA0001713587930000045
Figure BDA0001713587930000046
其中，
Figure BDA0001713587930000047
表示点Pc在世界坐标系w中的速度向量，
Figure BDA0001713587930000048
为Xc轴方向上的速度分量，
Figure BDA0001713587930000049
为Yc轴方向上的速度分量，
Figure BDA00017135879300000410
为Zc轴方向上的速度分量。φ表示移动平台的方向角，定义为移动平台对称轴与世界坐标系
Figure BDA00017135879300000411
中Z轴之间的夹角；b表示移动平台的驱动轮与移动平台对称轴之间的距离。
通过对
Figure BDA00017135879300000412
和
Figure BDA00017135879300000413
求积分，得到机械臂在移动平台上的安装位置所在点Pc在世界坐标系
Figure BDA00017135879300000414
中的表达式wPc以及移动平台的方向角φ。
通过以上各流程及工作，可以得到移动平台的运动学模型，即如下的齐次变换矩阵
Figure BDA00017135879300000415
Figure BDA00017135879300000416
其中，(xwc，ywc，zwc)表示点Pc在世界坐标系
Figure BDA00017135879300000417
中的坐标。
具体地，在所述步骤(6)中，结合总运动学方程wPend和齐次变换矩阵
Figure BDA00017135879300000418
求解得到移动平台-机械臂系统末端执行器的雅可比矩阵，表示为：
Figure BDA00017135879300000419
其中，齐次变换矩阵
Figure BDA0001713587930000051
是移动平台的运动学方程，齐次变换矩阵
Figure BDA0001713587930000052
是机械臂的运动学方程；6Pend表示机械臂末端执行器的位置向量。
进一步地，在移动平台的运动学方程和机械臂的运动学方程的解析形式都已得到的情况下，对总运动学方程求解关于控制矢量θ的偏导数，即可求得末端机械臂执行器的雅可比矩阵，计算公式为：
Figure BDA0001713587930000053
具体地，在所述步骤(7)中，将求解得到的末端机械臂执行器的雅可比矩阵代入二次规划问题的运动学方程式中，即可得到末端机械臂执行器的运动规划并完成移动平台-机械臂系统的建模。
本发明相较于现有技术，具有以下的有益效果：
1、本发明为基于目标系统的模型构建方法，在充分考虑了目标模型系统的物理、数学特征及其参数的情况下，运用物理模型建立与数学模型代入相结合的方法，求解得到目标系统的运动规划并完成系统的建模。本发明的方法具有建模准确、思路清晰、逻辑性强以及方法简单明了等优点。
附图说明
图1为本实例中的移动平台-机械臂系统建模方法的流程图；
图2-(a)为本实例中机械臂的示意图；
图2-(b)为本实施例中移动平台-机械臂系统示意图；
图3为本实例中的移动平台的运动学模型示意图；
图4为本实施例中机械臂在移动平台上的安装位置所在点Pc在移动轮椅平台轮轴中点Po的坐标系
Figure BDA0001713587930000054
中的位置示意图。
其中，1-冗余度机械臂、2-冗余度机械臂的末端执行器、3-移动平台-机械臂系统中冗余度机械臂部分、4-移动平台-机械臂系统中移动平台部分。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述，但本发明的实施方式不限于此。
实施例
如图1所示为一种移动平台-机械臂系统建模方法的具体流程图，所述方法的具体步骤包括：
(1)根据末端机械臂执行器的运动学模型，构造二次规划问题的速度层运动学方程式；
对于含冗余度的末端机械臂执行器，其期望的目标适用于如下二次规划问题的速度层运动学方程式：
Figure BDA0001713587930000061
其中，
Figure BDA0001713587930000062
表示末端机械臂执行器的雅可比矩阵，m表示移动机械臂系统的工作空间，n表示移动机械臂系统的控制变量矢量。
Figure BDA0001713587930000063
表示在速度层的期望目标轨迹。
在本实施例中，移动平台-机械臂系统的工作空间为三维坐标空间，即m＝3；控制变量为8个，即n＝8。
Figure BDA0001713587930000064
代表目标模型系统所结合的控制矢量，在本发明中，所述控制矢量由移动平台左右驱动轮的2个旋转角速度以及冗余度机械臂的6个关节角速度所构成。
(2)根据移动平台-机械臂系统的物理特性及模型参数，定义与移动平台相关的坐标系以及末端机械臂执行器的齐次位置表达式；
如图2所示为本发明所述的机械臂及移动平台-机械臂系统的示意图。其中，图2-(a)为机械臂示意图，该冗余度机械臂共包含6个关节，如图中标注“1”所示；该冗余度机械臂的末端执行器如图中标注“2”所示。图2-(b)为移动平台-机械臂系统示意图，该系统包含两个主要部分，冗余度机械臂部分如图中标注“3”所示；移动平台部分如图中标注“4”所示。该移动平台共包含有2个主动轮和4个从动轮。移动平台左右驱动轮的2个旋转角速度以及冗余度机械臂的6个关节角速度构成了该移动平台-机械臂系统的8个控制变量。
如图3所示为移动平台的运动学模型示意图。根据移动平台-机械臂系统的物理特性及模型参数，定义与移动平台相关的坐标系分别为：
(I)定义移动平台-机械臂系统的工作空间坐标系，即世界坐标系
Figure BDA0001713587930000065
(II)定义原点固结在移动平台轮轴中点Po的坐标系
Figure BDA0001713587930000066
(III)定义原点固结在移动平台上Pc点的坐标系
Figure BDA0001713587930000067
(IV)定义原点固结在末端机械臂执行器上的坐标系
Figure BDA0001713587930000068
其中，Po为移动平台对称轴与两驱动轮轴线的交点；Pc为机械臂在移动平台上的安装位置所在的点。
依据实际移动平台-机械臂系统的物理特征，可以定义末端机械臂执行器的齐次位置表达式
Figure BDA0001713587930000071
(3)根据步骤(2)中定义的齐次位置表达式，结合机械臂的D-H模型，构造机械臂的正运动学方程式；
根据步骤(2)中末端机械臂执行器的齐次位置表达式，结合机械臂的D-H模型，得到机械臂的正运动学方程式，表示方式如下：
Figure BDA0001713587930000072
其中，
Figure BDA0001713587930000073
表示末端执行器在移动平台坐标系
Figure BDA0001713587930000074
下的齐次坐标；
Figure BDA0001713587930000075
分别表示冗余度机械臂6个关节的齐次变换矩阵。
(4)根据步骤(2)中定义的坐标系和步骤(3)中的机械臂正运动学方程式，构造移动平台-机械臂系统的总运动学方程式；
具体地，在所述步骤(4)中，根据各坐标系的关系和机械臂的正运动学方程即公式(2)，可以得到移动平台-机械臂系统的总运动学方程式，表示为：
Figure BDA0001713587930000076
其中，
Figure BDA0001713587930000077
表示在世界坐标系
Figure BDA0001713587930000078
下的末端执行器的齐次坐标；
Figure BDA0001713587930000079
为机械臂相对于世界坐标系
Figure BDA00017135879300000710
与移动平台坐标系
Figure BDA00017135879300000711
的齐次变换矩阵。
(5)根据步骤(4)中的移动平台-机械臂系统的总运动学方程式，求解系统的齐次变换矩阵；
具体地，在所述步骤(5)中，对在移动平台轮轴中点坐标系
Figure BDA00017135879300000712
中的点Po做运动学分析，得到如下的关系式：
Figure BDA00017135879300000713
Figure BDA00017135879300000714
其中，wr表示移动平台驱动轮的半径；
Figure BDA00017135879300000715
表示移动平台的方向角速度；
Figure BDA00017135879300000716
表示移动平台左驱动轮的旋转角速度；
Figure BDA00017135879300000717
表示移动平台右驱动轮的旋转角速度。
Figure BDA00017135879300000718
表示点Po在移动平台轮轴中点坐标系
Figure BDA00017135879300000719
中的速度向量，
Figure BDA00017135879300000720
为Xo轴方向上的速度分量，
Figure BDA00017135879300000721
为Yo轴方向上的速度分量，
Figure BDA00017135879300000722
为Zo轴方向上的速度分量。
对在移动平台轮轴中点坐标系
Figure BDA00017135879300000723
中的点Pc做运动学分析，得到如下的关系式：
Figure BDA0001713587930000081
其中，
Figure BDA0001713587930000082
表示点Pc在移动平台轮轴中点坐标系
Figure BDA0001713587930000083
中的速度向量，
Figure BDA0001713587930000084
为Xc轴方向上的速度分量，
Figure BDA0001713587930000085
为Yc轴方向上的速度分量，
Figure BDA0001713587930000086
为Zc轴方向上的速度分量，Rc为点Pc到坐标系
Figure BDA0001713587930000087
原点的距离，α为Rc与Xo轴的夹角。
Rc，sinα，cosα以及xoc，yoc，zoc的几何关系具体表示为：
Rccosα＝xoc(7)
Rcsinα＝yoc(8)
其中，(xoc，yoc，zoc)为点Pc在移动平台坐标系
Figure BDA0001713587930000088
中的坐标。所述坐标是固定值，由机械臂在移动平台上的安装位置所决定。机械臂在移动平台上的安装位置所在点Pc在移动平台轮轴中点坐标系
Figure BDA0001713587930000089
中的位置示意图如图4所示。
将公式(7)和(8)代入公式式(6)，并依照式(4)和式(5)中所陈述的关系，可以得到如下关系式：
Figure BDA00017135879300000810
通过左乘旋转变换矩阵，将在移动平台轮轴中点坐标系
Figure BDA00017135879300000811
中点Pc的速度表达式转化到世界坐标系
Figure BDA00017135879300000812
中，可以得到如下转换关系：
Figure BDA00017135879300000813
Figure BDA00017135879300000814
其中，
Figure BDA00017135879300000815
表示点Pc在世界坐标系
Figure BDA00017135879300000816
中的速度向量，
Figure BDA00017135879300000817
为Xc轴方向上的速度分量，
Figure BDA00017135879300000818
为Yc轴方向上的速度分量，
Figure BDA00017135879300000819
为Zc轴方向上的速度分量。φ表示移动平台的方向角，定义为移动平台对称轴与世界坐标系
Figure BDA00017135879300000820
中Z轴之间的夹角；b表示移动平台的驱动轮与移动平台对称轴之间的距离。
通过对
Figure BDA00017135879300000821
和
Figure BDA00017135879300000822
求积分，得到机械臂在移动平台上的安装位置所在点Pc在世界坐标系
Figure BDA0001713587930000091
中的表达式wPc以及移动平台的方向角φ。
通过以上各流程及工作，可以得到移动平台的运动学模型，即如下的齐次变换矩阵
Figure BDA0001713587930000092
Figure BDA0001713587930000093
其中，(xwc，ywc，zwc)表示点Pc在世界坐标系
Figure BDA0001713587930000094
中的坐标。
(6)根据步骤(4)中的总运动学方程式和步骤(5)得到的系统的齐次变换矩阵，求解系统的雅可比矩阵；
具体地，在所述步骤(6)中，结合总运动学方程wPend和齐次变换矩阵
Figure BDA0001713587930000095
求解得到移动平台-机械臂系统末端执行器的雅可比矩阵，表示为：
Figure BDA0001713587930000096
其中，齐次变换矩阵
Figure BDA0001713587930000097
是移动平台的运动学方程，齐次变换矩阵
Figure BDA0001713587930000098
是机械臂的运动学方程；6Pend表示机械臂末端执行器的位置向量。
进一步地，在移动平台的运动学方程和机械臂的运动学方程的解析形式都已得到的情况下，对总运动学方程求解关于控制矢量θ的偏导数，即可求得末端机械臂执行器的雅可比矩阵，计算公式为：
Figure BDA0001713587930000099
(7)将步骤(6)求解得到的雅可比矩阵代入步骤(1)中的二次规划问题运动学方程式，得到末端机械臂执行器的运动规划，完成移动平台-机械臂系统的建模。
具体地，在所述步骤(7)中，将求解得到的末端机械臂执行器的雅可比矩阵代入二次规划问题的运动学方程式中，即可得到末端机械臂执行器的运动规划并完成移动平台-机械臂系统的建模。
上述实施例为本发明较佳的实施方式，但本发明的实施方式并不受上述实施例的限制，其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化，均应为等效的置换方式，都包含在本发明的保护范围之内。

Claims (8)

1.一种移动平台-机械臂系统建模方法，其特征在于，所述方法的具体步骤包括：
(1)根据末端机械臂执行器的运动学模型，构造二次规划问题的速度层运动学方程式；
(2)根据移动平台-机械臂系统的物理特性及模型参数，定义与移动平台相关的坐标系以及末端机械臂执行器的齐次位置表达式；
(3)根据步骤(2)中定义的齐次位置表达式，结合机械臂的D-H模型，构造机械臂的正运动学方程式；
(4)根据步骤(2)中定义的坐标系和步骤(3)中的机械臂正运动学方程式，构造移动平台-机械臂系统的总运动学方程式；
(5)根据步骤(4)中的移动平台-机械臂系统的总运动学方程式，求解系统的齐次变换矩阵；
(6)根据步骤(4)中的总运动学方程式和步骤(5)得到的系统的齐次变换矩阵，求解系统的雅可比矩阵；
(7)将步骤(6)求解得到的雅可比矩阵代入步骤(1)中的二次规划问题运动学方程式，得到末端机械臂执行器的运动规划，完成移动平台-机械臂系统的建模；
在所述步骤(5)中，对在移动平台轮轴中点坐标系
Figure FDA00024902754100000111
中的点Po做运动学分析，得到如下的关系式：
Figure FDA0002490275410000011
Figure FDA0002490275410000012
其中，wr表示移动平台驱动轮的半径；
Figure FDA0002490275410000013
表示移动平台的方向角速度；
Figure FDA0002490275410000014
表示移动平台左驱动轮的旋转角速度；
Figure FDA0002490275410000015
表示移动平台右驱动轮的旋转角速度；
Figure FDA0002490275410000016
表示点Po在移动平台轮轴中点坐标系
Figure FDA00024902754100000112
中的速度向量，
Figure FDA0002490275410000017
为Xo轴方向上的速度分量，
Figure FDA0002490275410000018
为Yo轴方向上的速度分量，
Figure FDA0002490275410000019
为Zo轴方向上的速度分量；
对在移动平台轮轴中点坐标系
Figure FDA00024902754100000110
中的点Pc做运动学分析，得到如下的关系式：
Figure FDA0002490275410000021
其中，
Figure FDA0002490275410000022
表示点Pc在移动平台轮轴中点坐标系
Figure FDA0002490275410000023
中的速度向量，
Figure FDA0002490275410000024
为Xc轴方向上的速度分量，
Figure FDA0002490275410000025
为Yc轴方向上的速度分量，
Figure FDA0002490275410000026
为Zc轴方向上的速度分量，Rc为点Pc到坐标系
Figure FDA0002490275410000027
原点的距离，α为Rc与Xo轴的夹角；
Rc，sinα，cosα以及xoc，yoc，zoc的几何关系具体表示为：
Rccosα＝xoc (7)
Rcsinα＝yoc (8)
zoc在XoYo平面上为零；
其中，(xoc，yoc，zoc)为Pc点在移动平台坐标系
Figure FDA00024902754100000221
中的坐标；所述坐标是固定值，由机械臂在移动平台上的安装位置所决定；
将公式(7)和(8)代入公式(6)，并依照式(4)和式(5)中所陈述的关系，得到如下关系式：
Figure FDA0002490275410000028
通过左乘旋转变换矩阵，将在移动平台轮轴中点坐标系
Figure FDA0002490275410000029
中点Pc的速度表达式转化到世界坐标系
Figure FDA00024902754100000210
中，得到如下转换关系：
Figure FDA00024902754100000211
Figure FDA00024902754100000212
其中，φ表示移动平台的方向角，定义为移动平台对称轴与世界坐标系
Figure FDA00024902754100000213
中Z轴之间的夹角；b表示移动平台的驱动轮与移动平台对称轴之间的距离；
Figure FDA00024902754100000214
表示点Pc在世界坐标系
Figure FDA00024902754100000215
中的速度向量，
Figure FDA00024902754100000216
为Xc轴方向上的速度分量，
Figure FDA00024902754100000217
为Yc轴方向上的速度分量，
Figure FDA00024902754100000218
为Zc轴方向上的速度分量；
通过对
Figure FDA00024902754100000219
和
Figure FDA00024902754100000220
求积分，得到机械臂在移动平台上的安装位置所在点Pc在世界坐标系
Figure FDA00024902754100000312
中的表达式wPc以及移动平台的方向角φ；
通过以上各流程及工作，得到移动平台的运动学模型，即如下的齐次变换矩阵
Figure FDA0002490275410000031
Figure FDA0002490275410000032
其中，(xwc，ywc，zwc)表示点Pc在世界坐标系
Figure FDA0002490275410000033
中的坐标。
2.根据权利要求1所述的一种移动平台-机械臂系统建模方法，其特征在于，所述步骤(1)中，对于含冗余度的末端机械臂执行器，其期望的目标适用于如下二次规划问题的速度层运动学方程式：
Figure FDA0002490275410000034
其中，
Figure FDA0002490275410000035
表示末端机械臂执行器的雅可比矩阵，m表示移动机械臂系统的工作空间，n表示移动机械臂系统的控制变量矢量；
Figure FDA0002490275410000036
表示在速度层的期望目标轨迹，
Figure FDA0002490275410000037
代表目标模型系统所结合的控制矢量，所述控制矢量由移动平台左右驱动轮的2个旋转角速度以及冗余度机械臂的6个关节角速度所构成。
3.根据权利要求1所述的一种移动平台-机械臂系统建模方法，其特征在于，在所述步骤(2)中，根据移动平台-机械臂系统的物理特性及模型参数，定义与移动平台相关的坐标系分别为：
(I)定义移动平台-机械臂系统的工作空间坐标系，即世界坐标系
Figure FDA0002490275410000038
(II)定义原点固结在移动平台轮轴中点Po的坐标系
Figure FDA0002490275410000039
(III)定义原点固结在移动平台上Pc点的坐标系
Figure FDA00024902754100000310
(IV)定义原点固结在末端机械臂执行器上的坐标系ε；
其中，Po为移动平台对称轴与两驱动轮轴线的交点；Pc为机械臂在移动平台上的安装位置所在的点。
4.根据权利要求1所述的一种移动平台-机械臂系统建模方法，其特征在于，在所述步骤(2)中，依据实际移动平台-机械臂系统的物理特征，定义末端机械臂执行器的齐次位置表达式
Figure FDA00024902754100000311
5.根据权利要求1所述的一种移动平台-机械臂系统建模方法，其特征在于，在所述步骤(3)中，根据步骤(2)中的末端机械臂执行器的齐次位置表达式，结合机械臂的D-H模型，得到机械臂的正运动学方程式，表示方式如下：
Figure FDA0002490275410000041
其中，
Figure FDA0002490275410000042
表示末端执行器在移动平台坐标系
Figure FDA0002490275410000043
下的齐次坐标；
Figure FDA0002490275410000044
分别表示冗余度机械臂6个关节的齐次变换矩阵。
6.根据权利要求1所述的一种移动平台-机械臂系统建模方法，其特征在于，在所述步骤(4)中，根据各坐标系的关系和机械臂的正运动学方程即公式(2)，可以得到移动平台-机械臂系统的总运动学方程式，表示为：
Figure FDA0002490275410000045
其中，
Figure FDA0002490275410000046
表示在世界坐标系
Figure FDA0002490275410000047
下的末端执行器的齐次坐标；
Figure FDA0002490275410000048
为机械臂相对于世界坐标系
Figure FDA0002490275410000049
与移动平台坐标系
Figure FDA00024902754100000410
的齐次变换矩阵。
7.根据权利要求1所述的一种移动平台-机械臂系统建模方法，其特征在于，在所述步骤(6)中，结合总运动学方程wPend和齐次变换矩阵
Figure FDA00024902754100000411
求解得到移动平台-机械臂系统末端执行器的雅可比矩阵，表示为：
Figure FDA00024902754100000412
其中，齐次变换矩阵
Figure FDA00024902754100000413
是移动平台的运动学方程，齐次变换矩阵
Figure FDA00024902754100000414
是机械臂的运动学方程；6Pend表示机械臂末端执行器的位置向量。
8.根据权利要求7所述的一种移动平台-机械臂系统建模方法，其特征在于，在移动平台的运动学方程和机械臂的运动学方程的解析形式都已得到的情况下，对总运动学方程求解关于控制矢量θ的偏导数，即可求得末端机械臂执行器的雅可比矩阵，计算公式为：
Figure FDA00024902754100000415
CN201810695959.XA 2018-06-29 2018-06-29 一种移动平台-机械臂系统建模方法 Active CN108972548B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810695959.XA CN108972548B (zh) 2018-06-29 2018-06-29 一种移动平台-机械臂系统建模方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810695959.XA CN108972548B (zh) 2018-06-29 2018-06-29 一种移动平台-机械臂系统建模方法

Publications (2)

Publication Number Publication Date
CN108972548A CN108972548A (zh) 2018-12-11
CN108972548B true CN108972548B (zh) 2020-09-22

Family

ID=64539078

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810695959.XA Active CN108972548B (zh) 2018-06-29 2018-06-29 一种移动平台-机械臂系统建模方法

Country Status (1)

Country Link
CN (1) CN108972548B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109866224B (zh) * 2019-03-22 2022-04-12 武汉工程大学 一种机器人雅可比矩阵计算方法、装置及存储介质
CN110900613A (zh) * 2019-12-18 2020-03-24 合肥科大智能机器人技术有限公司 一种面向移动机器人的不停车控制方法及系统
CN111844040A (zh) * 2020-07-23 2020-10-30 兰州大学 一种附带机械臂的电动轮椅的运动规划方法
CN117621053B (zh) * 2023-11-09 2024-05-31 中国矿业大学 一种用于带式输送机拆卸机器人的建模方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20080035739A (ko) * 2006-10-20 2008-04-24 민계의 로봇동작 설계방법
CN107966907A (zh) * 2017-11-30 2018-04-27 华南理工大学 一种应用于冗余度机械臂的障碍物躲避解决方法
CN107984472A (zh) * 2017-11-13 2018-05-04 华南理工大学 一种用于冗余度机械臂运动规划的变参神经求解器设计方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20080035739A (ko) * 2006-10-20 2008-04-24 민계의 로봇동작 설계방법
CN107984472A (zh) * 2017-11-13 2018-05-04 华南理工大学 一种用于冗余度机械臂运动规划的变参神经求解器设计方法
CN107966907A (zh) * 2017-11-30 2018-04-27 华南理工大学 一种应用于冗余度机械臂的障碍物躲避解决方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
9DOF全方位移动机械臂运动学及其控制系统研究;于振中等;《高技术通讯》;20110816;第21卷(第1期);第1-7页 *
GAMMA300型七自由度机械臂建模与仿真;柏滢;《中国优秀硕士学位论文全文数据库 信息科技辑》;20150715(第07期);第1-67页 *
可重构式轮臂移动机器人的设计与仿真研究;武秋红;《中国优秀硕士学位论文全文数据库 信息科技辑》;20120615(第06期);全文 *
模块化移动机械臂运动规划与控制;史先鹏;《中国博士学位论文全文数据库 信息科技辑》;20100915(第09期);全文 *

Also Published As

Publication number Publication date
CN108972548A (zh) 2018-12-11

Similar Documents

Publication Publication Date Title
CN108972548B (zh) 一种移动平台-机械臂系统建模方法
US8322468B2 (en) Robot apparatus and method of controlling the same, and computer program
JP3207728B2 (ja) 冗長マニピュレータの制御方法
JP5114019B2 (ja) エフェクタの軌道を制御するための方法
CN111694361B (zh) 基于改进趋近律滑模控制的钢结构柔性探伤机器人轨迹跟踪方法
CN107966907B (zh) 一种应用于冗余度机械臂的障碍物躲避解决方法
CN110561440B (zh) 一种冗余度机械臂加速度层多目标规划方法
Aracil et al. Parallel robots for autonomous climbing along tubular structures
CN108908347B (zh) 一种面向冗余移动机械臂容错型重复运动规划方法
CN108381555B (zh) 一种飞行作业机器人冗余度机械臂下位控制器的设计方法
CN106844951B (zh) 基于分段几何法求解超冗余机器人逆运动学的方法及系统
CN113043286B (zh) 一种多自由度机械臂实时避障路径规划系统及方法
CN111309002A (zh) 一种基于矢量的轮式移动机器人避障方法及系统
Spong et al. Control in robotics
Zhang et al. A vector-based constrained obstacle avoidance scheme for wheeled mobile redundant robot manipulator
CN116330267A (zh) 一种基于工业机器人腕部奇异点计算的控制方法
Xue et al. Gait planning and control of hexapod robot based on velocity vector
CN113985738A (zh) 非凸约束的全向四轮移动机械臂重复运动的梯度神经网络协同控制
Tu et al. Calibration method of Mecanum wheeled mobile robot odometer
Luo et al. On-line adaptive control for minimizing slippage error while mobile platform and manipulator operate simultaneously for robotics mobile manipulation
Chung et al. 4 Design of the chained form manipulator
Kalaycioglu et al. Coordinated Motion and Force Control of Multi-Rover Robotics System with Mecanum Wheels
Pan et al. Mobile Composite Robotic Arm Modelling and External Coupling Control
Ha et al. Wireless-communicated computed-torque control of a SCARA robot and two-dimensional input shaping for a spherical pendulum
Kacprzak et al. Trajectory planning of the humanoid manipulator

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant