CN107398903B - 工业机械手臂执行端的轨迹控制方法 - Google Patents
工业机械手臂执行端的轨迹控制方法 Download PDFInfo
- Publication number
- CN107398903B CN107398903B CN201710787000.4A CN201710787000A CN107398903B CN 107398903 B CN107398903 B CN 107398903B CN 201710787000 A CN201710787000 A CN 201710787000A CN 107398903 B CN107398903 B CN 107398903B
- Authority
- CN
- China
- Prior art keywords
- time
- execution end
- constraint condition
- mechanical arm
- position variable
- 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
- 238000000034 method Methods 0.000 title claims abstract description 21
- 239000011159 matrix material Substances 0.000 claims abstract description 14
- 238000005457 optimization Methods 0.000 claims abstract description 13
- 238000012545 processing Methods 0.000 claims abstract description 6
- 230000001133 acceleration Effects 0.000 claims description 8
- 238000004422 calculation algorithm Methods 0.000 claims description 4
- 230000006870 function Effects 0.000 description 14
- 238000004364 calculation method Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 238000011217 control strategy Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 238000010422 painting Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
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/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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40523—Path motion planning, path in space followed by tip of robot
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
Description
技术领域
本发明涉及工业控制领域,且特别涉及一种工业机械手臂执行端的轨迹控制方法。
背景技术
工业机械手臂在焊接、喷漆、堆垛、装配中应用广泛,已经成为工业生产中必不可少的一种智能化设备。工业机器人是一个十分复杂的多输入多输出非线性***,具有时变、强耦合和非线性的动力学特征。负载变化、机械扰动等不确定性因素的影响,使其控制更加复杂。工业4.0的快速发展,需要高品质的工业机器人为之服务。针对稳定性与高效性的控制策略成为工业机器人研究的难点。
运动不连续及控制伺服频繁切换动作,皆有可能造成工业机械手臂执行端运动轨迹产生抖动现象,此抖动有可能会引起执行部件的机械磨损与高频动态响应失效。目前多数工业机器人的控制策略是对独立关节进行PID控制,这种控制方法的主要缺点是反馈增益是预先确定的常量,它不能在有效载荷变化的情况下改变反馈增益,机器人关节高速旋转时,其动力学效应十分明显。
发明内容
本发明为了克服现有工业机器人控制策略动力学效应明显,提供一种控制精度高且无抖动的工业机械手臂执行端运动轨迹的控制方法。
为了实现上述目的,本发明提供一种工业机械手臂执行端的轨迹控制方法,该方法包括:
步骤S1、获取工业机械手臂执行端的机械结构参数,根据机械结构参数确定雅克比矩阵并初始网格化精度ε;
步骤S2、根据加工要求确定工业机械手臂执行端的运动轨迹,起始点为Xstart,终点为Xterminal,其中X={x,y,z,ωx,ωy,ωz}为操作空间k时刻的位置变量;
步骤S5、工业机械手臂执行端根据k+1时刻实际操作空间位置变量Xk+1和k时刻关节空间的输入控制量uk进行轨迹运动;
其中,目标函数为:
约束条件包括:
第三约束条件:qmin≤q≤qmax;以及
第四约束条件:umin≤uk≤umax;
其中,为k+1时刻实际操作空间位置变量Xk+1的微分,为k+1时刻的参考位置变量的微分;Ts是状态反馈间隔时间,关节空间的输入控制量为执行端内关节电机角速度的加速度;离散雅可比矩阵Jk=J(qk);为工业机械手臂执行端运动速度的上限;qmin为关节电机运动角度下限值;qmax为关节电机运动角度上限值;umin为执行端加速度下限值,umax为执行端加速度上限值。
根据本发明的一实施例,采用二分网格优化算法对目标函数进行优化逼近,具体步骤如下:
步骤S42、在第四约束条件的约束下以间隔Δu对uk进行等间距划分;
根据本发明的一实施例,所述雅克比矩阵为:
其中q={q1,q2,…,qi}为关节空间角度变量,(x,y,z)为执行端坐标,(ωx,ωy,ωz)为执行端旋转角度。
根据本发明的一实施例,所述机械结构参数包括工业机械手臂执行端的自由度、关节旋转角度以及臂长。
根据本发明的一实施例,工业机械手臂执行端的运动轨迹为弧线或直线。
综上所述,本发明提供的工业机械手臂执行端的轨迹控制方法,通过工业机械手臂执行端的机械结构参数进行建模并结合加工要求所确定的运动轨迹来预测下一时刻执行端的位置,最后以该预测位置为参数进行目标函数的约束优化来获得执行端的输入控制量。这种控制方式以执行端的机械结构参数和当前位置作为变量来实时计算下一个空间位置的参数,计算实时性非常的强,与实际的运动轨迹符合度非常的高,机械手臂的控制精度高,有效减少了机械手臂执行端在运动过程中的动力学效应,运动更加的稳定、高效。
为让本发明的上述和其它目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合附图,作详细说明如下。
附图说明
图1所示为本发明一实施例提供的工业机械手臂执行端的轨迹控制方法的流程图。
具体实施方式
如图1所示,本实施例提供的工业机械手臂执行端的轨迹控制方法始于步骤S1、获取工业机械手臂执行端的机械结构参数,根据机械结构参数确定雅克比矩阵并初始网格化精度ε。于本实施例中,工业机械手臂执行端的机械结构参数包括工业机械手臂执行端的自由度、关节旋转角度以及臂长。然而,本发明对此不作任何限定。根据机械结构参数所确定的雅克比矩阵如下:
其中q={q1,q2,…,qi}为关节空间角度变量,(x,y,z)为执行端坐标,(ωx,ωy,ωz)为执行端旋转角度。
步骤S2、根据加工要求确定工业机械手臂执行端的运动轨迹,起始点为Xstart,终点为Xterminal,其中X={x,y,z,ωx,ωy,ωz}为操作空间k时刻的位置变量。工业机械手臂执行端的运动轨迹为弧线或直线,具体根据带加工产品的形状而定。于本实施例中,执行完步骤S1后执行步骤S2。然而,本发明对此不作任何限定。于其它实施例中,可先执行步骤S2,再执行步骤S1;或者同时执行步骤S2和S1。
约束条件包括:
第三约束条件:qmin≤q≤qmax;以及
第四约束条件:umin≤uk≤umax;
其中,为k+1时刻实际操作空间位置变量Xk+1的微分,为k+1时刻的参考位置变量的微分;Ts是状态反馈间隔时间,关节空间的输入控制量为执行端内关节电机角速度的加速度;离散雅可比矩阵Jk=J(qk);为工业机械手臂执行端运动速度的上限;qmin为关节电机运动角度下限值;qmax为关节电机运动角度上限值;umin为执行端加速度下限值,umax为执行端加速度上限值。
于本实施例中,采用二分网格优化算法对目标函数进行优化逼近,具体步骤如下:
步骤S42、在第四约束条件的约束下以间隔Δu对uk进行等间距划分。
如当在步骤S43中以间隔Δu和Δu/2对uk进行等间距划分时均没有查找到符合条件的格点,再以Δu/4进行划分,此时二分网格的划分次数为3次,故在步骤S45中l等于3。
之后,执行步骤S5、工业机械手臂执行端根据k+1时刻实际操作空间位置变量Xk+1和k时刻关节空间的输入控制量uk进行轨迹运动。
本实施例提供的工业机械手臂执行端的轨迹控制方法以执行端的实时数据来计算下一时刻的输入控制量,控制具有很好的实时性和准确性。进一步的,二分网格优化算法计算准确且计算量小,可有效避免占用过量CPU与内存资源,适合在嵌入式控制***上实现,可满足现有的工业机械控制***,具有很好的兼容性。
综上所述,本发明提供的工业机械手臂执行端的轨迹控制方法,通过工业机械手臂执行端的机械结构参数进行建模并结合加工要求所确定的运动轨迹来预测下一时刻执行端的位置,最后以该预测位置为参数进行目标函数的约束优化来获得执行端的输入控制量。这种控制方式以执行端的机械结构参数和当前位置作为变量来实时计算下一个空间位置的参数,计算实时性非常的强,与实际的运动轨迹符合度非常的高,机械手臂的控制精度高,有效减少了机械手臂执行端在运动过程中的动力学效应,运动更加的稳定、高效。
虽然本发明已由较佳实施例揭露如上,然而并非用以限定本发明,任何熟知此技艺者,在不脱离本发明的精神和范围内,可作些许的更动与润饰,因此本发明的保护范围当视权利要求书所要求保护的范围为准。
Claims (5)
1.一种工业机械手臂执行端的轨迹控制方法,其特征在于,包括:
步骤S1、获取工业机械手臂执行端的机械结构参数,根据机械结构参数确定雅克比矩阵并初始网格化精度ε;
步骤S2、根据加工要求确定工业机械手臂执行端的运动轨迹,起始点为Xstart,终点为Xterminal,其中X={x,y,z,ωx,ωy,ωz}为操作空间k时刻的位置变量;
步骤S5、工业机械手臂执行端根据k+1时刻实际操作空间位置变量Xk+1和k时刻关节空间的输入控制量uk进行轨迹运动;
其中,目标函数为:
约束条件包括:
第三约束条件:qmin≤q≤qmax;以及
第四约束条件:umin≤uk≤umax;
2.根据权利要求1所述的工业机械手臂执行端的轨迹控制方法,其特征在于,采用二分网格优化算法对目标函数进行优化逼近,具体步骤如下:
步骤S42、在第四约束条件的约束下以间隔Δu对uk进行等间距划分;
4.根据权利要求1所述的工业机械手臂执行端的轨迹控制方法,其特征在于,所述机械结构参数包括工业机械手臂执行端的自由度、关节旋转角度以及臂长。
5.根据权利要求1所述的工业机械手臂执行端的轨迹控制方法,其特征在于,工业机械手臂执行端的运动轨迹为弧线或直线。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710787000.4A CN107398903B (zh) | 2017-09-04 | 2017-09-04 | 工业机械手臂执行端的轨迹控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710787000.4A CN107398903B (zh) | 2017-09-04 | 2017-09-04 | 工业机械手臂执行端的轨迹控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107398903A CN107398903A (zh) | 2017-11-28 |
CN107398903B true CN107398903B (zh) | 2020-06-30 |
Family
ID=60397464
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710787000.4A Active CN107398903B (zh) | 2017-09-04 | 2017-09-04 | 工业机械手臂执行端的轨迹控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107398903B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109623810B (zh) * | 2018-11-26 | 2022-04-22 | 南京航空航天大学 | 一种机器人平滑的时间最优轨迹规划的方法 |
CN109434838B (zh) * | 2018-12-25 | 2020-07-24 | 北方工业大学 | 线驱动连续机器人内窥操作的协同运动规划方法及*** |
CN116141341B (zh) * | 2023-04-21 | 2023-08-08 | 之江实验室 | 满足笛卡尔空间约束的五自由度机械臂指向动作实现方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103231381A (zh) * | 2013-05-03 | 2013-08-07 | 中山大学 | 一种冗余度机械臂的新型加速度层重复运动规划方法 |
JP2014014876A (ja) * | 2012-07-05 | 2014-01-30 | Canon Inc | ロボット制御装置、及びロボット制御方法 |
CN106272443A (zh) * | 2016-11-01 | 2017-01-04 | 上海航天控制技术研究所 | 多自由度空间机械臂非完整路径规划方法 |
CN106647282A (zh) * | 2017-01-19 | 2017-05-10 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
CN106926238A (zh) * | 2017-02-16 | 2017-07-07 | 香港理工大学深圳研究院 | 基于突加度的多冗余度机械臂***的协同控制方法与装置 |
CN106970594A (zh) * | 2017-05-09 | 2017-07-21 | 京东方科技集团股份有限公司 | 一种柔性机械臂的轨迹规划方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7403826B2 (en) * | 2004-12-01 | 2008-07-22 | Canadian Space Agency | Method and system for torque/force control of hydraulic actuators |
JP5774361B2 (ja) * | 2011-04-28 | 2015-09-09 | 本田技研工業株式会社 | 軌道計画方法、軌道計画システム及び軌道計画・制御システム |
EP2954986B1 (de) * | 2014-06-10 | 2020-05-06 | Siemens Aktiengesellschaft | Vorrichtung und Verfahren zum Steuern und Regeln eines Mehrkörpersystems |
-
2017
- 2017-09-04 CN CN201710787000.4A patent/CN107398903B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014014876A (ja) * | 2012-07-05 | 2014-01-30 | Canon Inc | ロボット制御装置、及びロボット制御方法 |
CN103231381A (zh) * | 2013-05-03 | 2013-08-07 | 中山大学 | 一种冗余度机械臂的新型加速度层重复运动规划方法 |
CN106272443A (zh) * | 2016-11-01 | 2017-01-04 | 上海航天控制技术研究所 | 多自由度空间机械臂非完整路径规划方法 |
CN106647282A (zh) * | 2017-01-19 | 2017-05-10 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
CN106926238A (zh) * | 2017-02-16 | 2017-07-07 | 香港理工大学深圳研究院 | 基于突加度的多冗余度机械臂***的协同控制方法与装置 |
CN106970594A (zh) * | 2017-05-09 | 2017-07-21 | 京东方科技集团股份有限公司 | 一种柔性机械臂的轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107398903A (zh) | 2017-11-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109159151B (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和*** | |
Lam et al. | Model predictive contouring control | |
CN112757306B (zh) | 一种机械臂逆解多解选择和时间最优轨迹规划算法 | |
Wen et al. | Elman fuzzy adaptive control for obstacle avoidance of mobile robots using hybrid force/position incorporation | |
CN107398903B (zh) | 工业机械手臂执行端的轨迹控制方法 | |
CN113552877A (zh) | 用于机器人优化动作规划的初始参考生成 | |
CN115157238B (zh) | 一种多自由度机器人动力学建模和轨迹跟踪方法 | |
CN105598968B (zh) | 一种并联机械臂的运动规划与控制方法 | |
CN111553239A (zh) | 一种机器人关节视觉伺服控制方法、终端设备及存储介质 | |
Ghasemi et al. | Adaptive switch image-based visual servoing for industrial robots | |
CN111965976B (zh) | 基于神经网络观测器的机器人关节滑模控制方法及*** | |
Zeng et al. | High-speed trajectory tracking based on model predictive control for omni-directional mobile robots | |
Bejar et al. | Deep reinforcement learning based neuro-control for a two-dimensional magnetic positioning system | |
CN114274147B (zh) | 目标跟踪控制方法及装置、机械臂控制设备和存储介质 | |
Yang et al. | Predictive control strategy based on extreme learning machine for path-tracking of autonomous mobile robot | |
CN114571444A (zh) | 一种基于Q-learning的扒渣机器人阻抗控制方法 | |
Liu et al. | Direction and trajectory tracking control for nonholonomic spherical robot by combining sliding mode controller and model prediction controller | |
CN107145640B (zh) | 中性浮力实验中漂浮基座与机械臂的动态标度规划方法 | |
Zhou et al. | Position-based visual servoing control for multi-joint hydraulic manipulator | |
CN114986498A (zh) | 一种移动操作臂协同控制方法 | |
Kang et al. | Kinematic path‐tracking of mobile robot using iterative learning control | |
Tangpattanakul et al. | Optimal trajectory of robot manipulator using harmony search algorithms | |
CN114840947A (zh) | 一种带约束的三自由度机械臂动力学模型 | |
Wang et al. | Jerk-optimal trajectory planning for stewart platform in joint space | |
CN114378830A (zh) | 一种机器人腕关节奇异规避方法及*** |
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 |