CN105598968B - 一种并联机械臂的运动规划与控制方法 - Google Patents
一种并联机械臂的运动规划与控制方法 Download PDFInfo
- Publication number
- CN105598968B CN105598968B CN201610053919.6A CN201610053919A CN105598968B CN 105598968 B CN105598968 B CN 105598968B CN 201610053919 A CN201610053919 A CN 201610053919A CN 105598968 B CN105598968 B CN 105598968B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- parallel mechanical
- end effector
- parallel
- rate
- 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
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 27
- 238000000034 method Methods 0.000 title claims abstract description 24
- 239000012636 effector Substances 0.000 claims abstract description 31
- 230000008859 change Effects 0.000 claims description 33
- 238000013461 design Methods 0.000 claims description 9
- 238000013507 mapping Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 abstract description 2
- 238000007796 conventional method Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1623—Parallel manipulator, Stewart platform, links are attached to a common base and to a common platform, plate which is moved parallel to the base
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种并联机械臂的运动规划和控制方法,包括如下步骤:步骤一,规划并联机械臂末端执行器预期的运动轨迹;步骤二,根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式;步骤三,基于步骤一与步骤二构建误差函数并结合张动力学计算各驱动杆相应的长度变化率;步骤四,将步骤三的求解结果传递给下位机控制器驱动机械臂运动。本发明解决了传统方法中参数难以确定的问题,且能够有效控制末端执行器的轨迹,可操作性高,在工程领域中具有良好的应用前景。
Description
技术领域
本发明涉及并联机械臂运动规划及控制领域,更具体的说是一种并联机械臂的运动规划与控制方法。
背景技术
并联机械臂由动平台和静平台通过两个或两个以上分支并联而成,为多路闭环机构。并联机械臂因其具有精度高、惯性小、刚度大、承载能力高等特性,得到了业界的重视与研究,相继开发出了具有重大应用价值Stewart并联机械臂与Delta并联机械臂等,而对并联机械臂的运动规划与控制则是工业应用中十分重要的研究内容之一。
目前并联机械臂的运动规划与控制方法通常采用PID法。PID法是最为广泛应用的控制方法,由于设计简单可行,应用十分广泛。但不足的是,PID法三个参数的调整是一直以来未能得到有效解决的难题,这三个参数的设置往往会消耗操作人员大量的时间,降低办事的效率。
发明内容
本发明所要解决的技术问题是克服现有技术的不足,提供一种设计简单、易于操作且能实现有效控制的并联机械臂的运动规划与控制方法。
为解决现有技术问题,本发明采用的技术方案是:
一种并联机械臂的运动规划与控制方法,包括如下步骤:
步骤一,规划并联机械臂末端执行器预期的运动轨迹,其中包括期望位姿rd与期望位姿变化率
步骤二,根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式其中为各驱动杆的长度变化率,为末端执行器的实际位姿变化率,f(·)为并联机械臂由笛卡尔空间到关节空间的非线性映射函数;
步骤三,基于步骤一与步骤二构建末端执行器实际位姿r的误差函数e=r-rd,并结合张动力学的线性设计公式其中λ作为控制所述方法的收敛速度的正实数,得到根据并联机械臂速度层运动学关系式计算各驱动杆相应的长度变化率为
步骤四,将步骤三的求解结果传递给下位机控制器驱动机械臂运动。
本发明通过设置四个步骤来控制机械臂运动,整个过程简单且易于操作,避免了以往操作复杂且难以控制的情形。
所述步骤一中规划并联机械臂末端执行器预期的运动轨迹包括设定末端执行器的期望位姿rd与期望位姿变化率通过末端执行器的期望位姿rd与期望位姿变化率也即可以确定并联机械臂末端执行器预期的运动轨迹。
所述步骤二中根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式通过该关系式,将各驱动杆的长度变化率和末端执行器的位姿变化率联系起来,利用末端执行器的位姿变化率就可以计算得到各驱动杆的长度变化率。
进一步的,所述步骤三基于步骤一与步骤二所得的末端执行器的期望位姿rd、期望位姿变化率和并联机械臂速度层运动学关系式构建误差函数e=r-rd;结合张动力学的线性设计公式,即其中λ为正实数,作为收敛因子用于控制该法的收敛速度,计算得到各驱动杆相应的长度变化率对应地,各驱动杆相应的长度变化率在计算机数字离散控制***中为其中kτ为离散时刻,τ为控制采样间隔。这样,只需要确定参数λ,就可以得到各驱动杆相应的长度变化率。
进一步的,通过步骤四将步骤三的求解结果传递给下位机控制器驱动机械臂运动,由于各驱动杆相应的长度变化对应着机械臂不同的运动,从而实现对机械臂运动的控制。
与现有技术相比,本发明的方法设计简单,张动力学的线性设计公式的引入可以保证误差函数的收敛,确保控制的高精度,而且该方法只有一个参数λ需要确定,易于操作,有效避免了传统方法参数较多难以控制的情形,在实际应用中有重要作用和广阔前景。
附图说明
图1为本发明实施例的流程图。
图2为本发明实施例的仿真Stewart并联机械臂的模型图。
图3为本发明实施例的仿真Stewart并联机械臂的目标轨迹与实际轨迹图。
图4为本发明实施例的仿真Stewart并联机械臂的轨迹误差图。
图5为本发明实施例的仿真Stewart并联机械臂的驱动杆长度变化图。
具体实施方式
以下结合附图对本发明做进一步的解释说明。附图仅用于示例性说明,不能理解为对本发明的限制;为了更好说明本实施例,附图某些部件会有省略、放大或缩小;对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。
如图1所示的一种并联机械臂运动规划与控制方法,包括:步骤一,规划并联机械臂末端执行器预期的运动轨迹,其中包括末设定端执行器的期望位姿rd与期望位姿变化率步骤二,根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式其中为各驱动杆的长度变化率,为末端执行器的实际位姿变化率,f(·)为并联机械臂由笛卡尔空间到关节空间的非线性映射函数;步骤三,基于步骤一与步骤二构建误差函数并结合张动力学的线性设计公式计算各驱动杆相应的长度变化率,构建误差函数e=r-rd,其中r为末端执行器的实际位姿,并结合张动力学的线性设计公式,即其中λ为收敛因子用于控制该法的收敛速度,便可计算得到各驱动杆相应的长度变化率对应地,各驱动杆相应的长度变化率在计算机数字离散控制***中为其中kτ为离散时刻,τ为控制采样间隔,这样,只需要确定参数λ,就可以得到各驱动杆相应的长度变化率;步骤四,将步骤三的求解结果传递给下位机控制器驱动机械臂运动。
如图2所示,该机械臂由静平台(FP)、动平台(MP)、末端执行器和六根驱动杆(L1,L2,L3,L4,L5,L6)组成(在不特别说明的情况下,所有的坐标表示都是基于静平台坐标系)。该并联机械臂速度层运动学关系式为其中 代表位置的变化率,代表姿态的变化率,A具体为:
其中,为各驱动杆末端指向首端的向量,且i=1,2,...,6。末端为驱动杆与静平台的连接点,首端为驱动杆与动平台的连接点。为各驱动杆的长度,且有||di||2=ui,||·||2表示2范数。为末端执行器相对于静平台坐标系的旋转矩阵。为驱动杆首端相对于动平台坐标系的位置。并且A可分为两个矩阵,具体为A=[A1A2],其中A1与末端执行器的位置相关,而A2与末端执行器的姿态相关。
基于一种并联机械臂运动规划和控制方法,给定末端执行器任务为画出一个空间中的无穷大符号。不考虑末端执行器的姿态,规划并联机械臂的运动:设定并联机械臂的初始位姿为rd(0)=[0,0,1]T,期望位姿变化率为:
由于不考虑末端执行器的姿态,该并联机械臂速度层运动学关系式可简化为基于一种并联机械臂运动规划和控制方法,把收敛因子λ的值设为1000,便可计算并得到仿真Stewart并联机械臂各驱动杆相应的长度变化率为在计算机数字离散控制***中则为最后把各驱动杆的长度变化率传递给仿真下位机控制器,驱动仿真Stewart并联机械臂进行运动。
如图3所示,实线为仿真Stewart并联机械臂末端执行器的目标轨迹,而虚线则为仿真Stewart并联机械臂末端执行器的实际轨迹。从图中可知目标轨迹与实际轨迹几乎完全重合,说明利用该方法可以实现对机械臂的运动实现精确控制,极少出现偏差。
如图4所示,其中实线e1表示仿真Stewart并联机械臂末端执行器在x方向的误差,虚线e2表示仿真Stewart并联机械臂末端执行器在y方向的误差,点线e3表示仿真Stewart并联机械臂末端执行器在z方向上的误差。其中在任务执行期间,三个方向的误差皆小于等于2×10-6米,具有较高精度。
如图5所示,其中,u1、u2、u3、u4、u5、u6分别表示仿真Stewart并联机械臂驱动杆L1、L2、L3、L4、L5和L6的长度。在任务执行期间,各个驱动杆的长度不断变化,对应机械臂出现各种不同的运动。
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。在上述说明的基础上还可以做出其它不同形式的变化或变动,这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (2)
1.一种并联机械臂的运动规划与控制方法,其特征在于,包括以下步骤:
步骤一,规划并联机械臂末端执行器预期的运动轨迹,其中包括期望位姿rd与期望位姿变化率
步骤二,根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式其中为各驱动杆的长度变化率,为末端执行器的实际位姿变化率,f(·)为并联机械臂由笛卡尔空间到关节空间的非线性映射函数;
步骤三,基于步骤一与步骤二构建末端执行器实际位姿r的误差函数e=r-rd,并结合张动力学的线性设计公式其中λ作为控制所述方法的收敛速度的正实数,得到根据并联机械臂速度层运动学关系式计算各驱动杆相应的长度变化率为
步骤四,将步骤三的求解结果传递给下位机控制器驱动机械臂运动。
2.根据权利要求1所述的并联机械臂的运动规划与控制方法,其特征在于,所述各驱动杆长度变化率在计算机数字离散控制***中为其中kτ为离散时刻,τ为控制采样间隔。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610053919.6A CN105598968B (zh) | 2016-01-26 | 2016-01-26 | 一种并联机械臂的运动规划与控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610053919.6A CN105598968B (zh) | 2016-01-26 | 2016-01-26 | 一种并联机械臂的运动规划与控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105598968A CN105598968A (zh) | 2016-05-25 |
CN105598968B true CN105598968B (zh) | 2018-08-24 |
Family
ID=55979572
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610053919.6A Active CN105598968B (zh) | 2016-01-26 | 2016-01-26 | 一种并联机械臂的运动规划与控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105598968B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105945955B (zh) * | 2016-07-26 | 2017-07-18 | 耿跃峰 | 一种自动机械臂 |
CN106970594B (zh) * | 2017-05-09 | 2019-02-12 | 京东方科技集团股份有限公司 | 一种柔性机械臂的轨迹规划方法 |
CN108247636B (zh) * | 2018-01-24 | 2020-01-24 | 北京机械设备研究所 | 并联机器人闭环反馈控制方法、***及存储介质 |
CN110193826B (zh) * | 2019-02-22 | 2021-06-04 | 浙江树人学院(浙江树人大学) | 工业机器人轨迹跟踪及运动规划方法 |
CN110531698B (zh) * | 2019-08-16 | 2022-03-11 | 达闼机器人有限公司 | 机械臂路径规划方法、装置及机械臂 |
CN110977992B (zh) * | 2020-01-02 | 2020-10-16 | 中山大学 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂*** |
CN113561187B (zh) * | 2021-09-24 | 2022-01-11 | 中国科学院自动化研究所 | 机器人控制方法、装置、电子设备及存储介质 |
CN114851168B (zh) * | 2022-05-13 | 2024-03-26 | 中山大学 | 关节受限冗余并联机械臂的运动规划和控制方法、***及机器人 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5179525A (en) * | 1990-05-01 | 1993-01-12 | University Of Florida | Method and apparatus for controlling geometrically simple parallel mechanisms with distinctive connections |
US6581437B2 (en) * | 2000-05-12 | 2003-06-24 | Alberta Research Council Inc. | Motion platform and method of use |
GB0706663D0 (en) * | 2007-04-04 | 2007-05-16 | Univ Bristol | Analysis of parallel manipulators |
CN101804627B (zh) * | 2010-04-02 | 2011-12-07 | 中山大学 | 一种冗余度机械臂运动规划方法 |
CN101890718B (zh) * | 2010-06-01 | 2011-12-07 | 中山大学 | 一种冗余度机械臂运动规划的初始化方法 |
CN101927495B (zh) * | 2010-08-25 | 2013-04-17 | 中山大学 | 一种冗余度机械臂重复运动规划方法 |
CN102915031B (zh) * | 2012-10-25 | 2015-08-12 | 中国科学技术大学 | 并联机器人运动学参数的智能自标定*** |
CN102968665B (zh) * | 2012-12-05 | 2015-11-25 | 苏州大学 | 并联机器人的正运动学求解方法 |
CN103231381B (zh) * | 2013-05-03 | 2015-10-21 | 中山大学 | 一种冗余度机械臂的新型加速度层重复运动规划方法 |
-
2016
- 2016-01-26 CN CN201610053919.6A patent/CN105598968B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105598968A (zh) | 2016-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105598968B (zh) | 一种并联机械臂的运动规划与控制方法 | |
CN112757306B (zh) | 一种机械臂逆解多解选择和时间最优轨迹规划算法 | |
JPH0820894B2 (ja) | 産業用ロボツトの動作制御方法 | |
CN110053044B (zh) | 一种并联机器人串类水果夹取无模型自适应光滑滑模阻抗控制方法 | |
CN111230882B (zh) | 水果分拣并联机器人夹持机构的自适应变阻抗控制方法 | |
CN109940615B (zh) | 一种面向双臂机械手同步重复运动规划的终态网络优化方法 | |
JP2019135076A (ja) | 軌道生成方法および軌道生成装置 | |
CN111890349A (zh) | 一种四自由度机械臂运动规划方法 | |
CN108908347A (zh) | 一种面向冗余移动机械臂容错型重复运动规划方法 | |
CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
CN110695994B (zh) | 一种面向双臂机械手协同重复运动的有限时间规划方法 | |
CN114055467B (zh) | 基于五自由度机器人的空间位姿在线仿真*** | |
Gaber et al. | Design and position control of arm manipulator; experimentally and in MATLAB SimMechanics | |
CN112847373B (zh) | 一种机器人轨迹同步控制方法、计算机可读存储介质 | |
CN113103262A (zh) | 机器人控制装置和用于控制机器人的方法 | |
CN110587611A (zh) | 电视机组装线的机械臂控制方法 | |
CN112571411B (zh) | 用于电视机智能生产线的两用机械臂 | |
CN114840947A (zh) | 一种带约束的三自由度机械臂动力学模型 | |
Setlak et al. | Dynamics of the designed robotic manipulator in the CAD program | |
Fernandez et al. | Multi-surface admittance control approach applied on robotic assembly of large-scale parts in aerospace manufacturing | |
TWI808852B (zh) | 六軸機器手臂深度學習穩定控制方法 | |
CN112571412B (zh) | 一种智能制造设备的控制*** | |
Liao et al. | Kinematic simulation and analysis of robot based on MATLAB | |
CN112621761B (zh) | 一种面向通信时滞的机械臂***多级优化协调控制方法 | |
Rajan et al. | Foundation Studies for an alternate approach to motion planning of dynamic systems |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |