CN108724195A - 一种针对机器人的耦合前馈控制方法 - Google Patents
一种针对机器人的耦合前馈控制方法 Download PDFInfo
- Publication number
- CN108724195A CN108724195A CN201810726741.6A CN201810726741A CN108724195A CN 108724195 A CN108724195 A CN 108724195A CN 201810726741 A CN201810726741 A CN 201810726741A CN 108724195 A CN108724195 A CN 108724195A
- Authority
- CN
- China
- Prior art keywords
- joint
- motor
- feedforward
- coupled
- controller
- 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.)
- Granted
Links
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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开了一种针对机器人的耦合前馈控制方法,包括以下步骤:步骤一、机器人各关节伺服驱动器与一个PID反馈控制器和一个速度、加速度前馈控制器相连;步骤二、对除被控关节电机以外的其他关节电机期望转角作一阶、二阶微分并将一阶微分乘以对应速度前馈增益、二阶微分乘以对应加速度前馈增益,求和得到耦合前馈控制指令;步骤三、将步骤一得到的反馈控制指令、前馈控制指令与步骤二得到的耦合前馈控制指令相加,输出给被控关节电机的伺服驱动器。采用本方法可无需复杂的动力学运算便实时补偿关节间的耦合扰动,进而提高机器人在高速度、高加速度应用场合的运动控制精度。
Description
技术领域
本发明涉及机器人技术和自动化领域,尤其涉及一种机器人耦合前馈控制方法。
背景技术
工业机器人位置环控制器普遍采用PID控制器。这种控制器结构简单、鲁棒性强、可靠性高,在工业控制过程中占有主导地位。考虑到反馈控制存在一定的滞后性,在PID控制器的基础上添加速度、加速度前馈控制器实现复合控制,可显著提高伺服系统的跟随精度。通常在低速度、低加速度的情况下,采用上述基于复合控制策略的分散控制结构,可以取得较为理想的控制效果。然而,机器人属于多关节耦合系统,在高速度、高加速度的应用场合,关节间的耦合作用制约了控制品质的进一步提高。因此,亟需一种适用于工业机器人的耦合前馈控制方法,将其他关节速度、加速度引起的扰动通过前馈的形式补偿,以满足机器人高速、高精度的应用需求。
发明内容
本发明的目的在于克服已有技术的缺点,提供一种可有效提高机器人末端执行器的运动控制精度的耦合前馈控制方法。
本发明的一种针对机器人的耦合前馈控制方法,包括以下步骤:
(a)将机器人各关节控制电机分别与一个伺服驱动器相连并且将每一个伺服驱动器分别与各关节控制电机的前馈控制器和反馈控制器以及耦合前馈控制器相连,所述的反馈控制器采用PID控制器,前馈控制器采用速度、加速度前馈控制器;
所述的前馈控制器根据与被控关节相连的电机期望位置值计算得到每个电机的前馈控制指令;
所述的反馈控制器根据与被控关节相连的电机输出的电机的实际位置值得到每个电机的反馈控制指令;
所述的耦合前馈控制器读取与被控关节相连以外的其他关节相连的电机期望位置θdi(i=1,2,…,n且i≠j)并根据下式计算得到耦合前馈控制指令;
针对共有n个驱动关节的机器人,当被控关节为关节j时,对关节i(i≠j,i≤n)电机期望转角分别作一阶、二阶微分并将一阶微分乘以对应速度前馈增益、二阶微分乘以对应加速度前馈增益,二者求和得到关节i对关节j的耦合前馈补偿指令,则其他n-1个关节对关节j的耦合前馈补偿为:
式中,aij与bij分别表示关节i作用于关节j的加速度前馈增益与速度前馈增益,与分别表示关节i电机的期望角加速度与期望角速度;
(b)将所述的前馈控制指令、反馈控制指令以及耦合前馈控制指令求和通过与被控关节相连的伺服驱动器输出给电机。
本发明的优点在于,无需复杂的动力学运算便可实时补偿关节间的耦合扰动,算法简单,易于实现,可进一步提高各关节高速度、高加速度运行时的运动控制精度。
附图说明
图1为本发明的针对机器人的耦合前馈控制方法结构框图;
图2以并联机构的一个关节为例的耦合前馈控制结构框图。
具体实施方式
为了使本发明的技术方案更加清晰,以下结合附图对本发明做进一步详细说明。应当理解,此处所述的具体实例仅用以解释本发明,但并不限定于本例。
本发明的一种针对机器人的耦合前馈控制方法(如图1所示),包括以下步骤:
(a)将机器人各关节控制电机分别与一个伺服驱动器相连并且将每一个伺服驱动器分别与各关节控制电机的前馈控制器和反馈控制器以及耦合前馈控制器相连,所述的反馈控制器采用PID控制器,前馈控制器采用速度、加速度前馈控制器;
所述的前馈控制器根据与被控关节相连的电机期望位置值θdj计算得到每个电机的前馈控制指令;
所述的反馈控制器根据与被控关节相连的电机输出的电机的实际位置值θaj得到每个电机的反馈控制指令;
所述的耦合前馈控制器读取与被控关节相连以外的其他关节相连的电机期望位置θdi(i=1,2,…,n且i≠j)并根据下式计算得到耦合前馈控制指令;
针对共有n个驱动关节的机器人,当被控关节为关节j时,对关节i(i≠j,i≤n)电机期望转角分别作一阶、二阶微分并将一阶微分乘以对应速度前馈增益、二阶微分乘以对应加速度前馈增益,二者求和得到关节i对关节j的耦合前馈补偿指令,则其他n-1个关节对关节j的耦合前馈补偿为:
式中,aij与bij分别表示关节i作用于关节j的加速度前馈增益与速度前馈增益,可以通过工程试凑法得到。与分别表示关节i电机的期望角加速度与期望角速度。
电机期望角速度和角加速度值可以采用现有的方法计算得到,作为本发明的一种方法:根据各驱动关节电机插补运算后的插补点队列建立缓存队列,采用中心差分法计算各关节电机在每个插补点的期望角速度和角加速度,并存储于全局变量寄存器中以供高速读写。
(b)将所述的前馈控制指令、反馈控制指令以及耦合前馈控制指令求和通过与被控关节相连的伺服驱动器输出给电机。
以专利CN104985596A所公开的一种含转动支架的五自由度混联机器人中的并联机构为例,对本发明的具体实施方式说明如下。
针对本例中共有3个驱动关节的并联机构,关节控制电机分别与一个伺服驱动器相连并且将每一个伺服驱动器分别与各关节控制电机的前馈控制器和反馈控制器以及耦合前馈控制器相连,所述的反馈控制器采用PID控制器,前馈控制器采用速度、加速度前馈控制器;
当被控关节为关节1时,对关节2、关节3的电机的期望转角分别作一阶、二阶微分并乘以对应速度前馈增益和加速度前馈增益,二者求和得到关节2、3对关节1的耦合前馈补偿指令,则关节2、3对关节1的耦合前馈补偿为(如图2所示):
式中,a21与b21分别表示关节2作用于关节1的加速度前馈增益与速度前馈增益,与分别表示关节2电机的期望角加速度与期望角速度。a31与b31分别表示关节3作用于关节1的加速度前馈增益与速度前馈增益,与分别表示关节3电机的期望角加速度与期望角速度。
将所述的前馈控制指令、反馈控制指令以及耦合前馈控制指令求和通过与被控关节相连的伺服驱动器输出给电机。
Claims (2)
1.一种针对机器人的耦合前馈控制方法,其特征在于包括以下步骤:
(a)将机器人各关节控制电机分别与一个伺服驱动器相连并且将每一个伺服驱动器分别与各关节控制电机的前馈控制器和反馈控制器以及耦合前馈控制器相连,所述的反馈控制器采用PID控制器,前馈控制器采用速度、加速度前馈控制器;
所述的前馈控制器根据与被控关节相连的电机期望位置值计算得到每个电机的前馈控制指令;
所述的反馈控制器根据与被控关节相连的电机输出的电机的实际位置值得到每个电机的反馈控制指令;
所述的耦合前馈控制器读取与被控关节相连以外的其他关节相连的电机期望位置θdi(i=1,2,…,n且i≠j)并根据下式计算得到耦合前馈控制指令;
针对共有n个驱动关节的机器人,当被控关节为关节j时,对关节i(i≠j,i≤n)电机期望转角分别作一阶、二阶微分并将一阶微分乘以对应速度前馈增益、二阶微分乘以对应加速度前馈增益,二者求和得到关节i对关节j的耦合前馈补偿指令,则其他n-1个关节对关节j的耦合前馈补偿为:
式中,aij与bij分别表示关节i作用于关节j的加速度前馈增益与速度前馈增益,与分别表示关节i电机的期望角加速度与期望角速度;
(b)将所述的前馈控制指令、反馈控制指令以及耦合前馈控制指令求和通过与被控关节相连的伺服驱动器输出给电机。
2.根据权利要求1所述的针对机器人的耦合前馈控制方法,其特征在于:电机期望角速度和角加速度值的计算方法为:根据各驱动关节电机插补运算后的插补点队列建立缓存队列,采用中心差分法计算各关节电机在每个插补点的期望角速度和角加速度,并存储于全局变量寄存器中以供高速读写。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810726741.6A CN108724195B (zh) | 2018-07-04 | 2018-07-04 | 一种针对机器人的耦合前馈控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810726741.6A CN108724195B (zh) | 2018-07-04 | 2018-07-04 | 一种针对机器人的耦合前馈控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108724195A true CN108724195A (zh) | 2018-11-02 |
CN108724195B CN108724195B (zh) | 2021-10-19 |
Family
ID=63926216
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810726741.6A Active CN108724195B (zh) | 2018-07-04 | 2018-07-04 | 一种针对机器人的耦合前馈控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108724195B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112462694A (zh) * | 2020-12-03 | 2021-03-09 | 上海维宏电子科技股份有限公司 | 基于总线伺服控制系统实现速度前馈补偿处理的方法、系统、装置、处理器及存储介质 |
US11179855B2 (en) | 2018-12-30 | 2021-11-23 | Ubtech Robotics Corp Ltd | Acceleration compensation method for humanoid robot and apparatus and humanoid robot using the same |
CN113864387A (zh) * | 2021-10-20 | 2021-12-31 | 上海新纪元机器人有限公司 | 一种主动减震机构控制方法、系统和存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4943759A (en) * | 1987-06-18 | 1990-07-24 | Fanuc Ltd. | Multiple-articulated robot control apparatus |
CN103175530A (zh) * | 2013-03-04 | 2013-06-26 | 北京航空航天大学 | 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 |
CN105137764A (zh) * | 2015-10-15 | 2015-12-09 | 清华大学 | 一种具有快速响应及鲁棒性能的并联机器人运动控制方法 |
CN105196294A (zh) * | 2015-10-29 | 2015-12-30 | 长春工业大学 | 采用位置测量的可重构机械臂分散控制系统及控制方法 |
CN106313044A (zh) * | 2016-09-20 | 2017-01-11 | 华南理工大学 | 一种工业机器人前馈力矩补偿方法 |
CN107831669A (zh) * | 2017-11-24 | 2018-03-23 | 江苏大学 | 混联式汽车电泳涂装输送机构的前馈补偿优化分数阶pid控制方法 |
-
2018
- 2018-07-04 CN CN201810726741.6A patent/CN108724195B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4943759A (en) * | 1987-06-18 | 1990-07-24 | Fanuc Ltd. | Multiple-articulated robot control apparatus |
CN103175530A (zh) * | 2013-03-04 | 2013-06-26 | 北京航空航天大学 | 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 |
CN105137764A (zh) * | 2015-10-15 | 2015-12-09 | 清华大学 | 一种具有快速响应及鲁棒性能的并联机器人运动控制方法 |
CN105196294A (zh) * | 2015-10-29 | 2015-12-30 | 长春工业大学 | 采用位置测量的可重构机械臂分散控制系统及控制方法 |
CN106313044A (zh) * | 2016-09-20 | 2017-01-11 | 华南理工大学 | 一种工业机器人前馈力矩补偿方法 |
CN107831669A (zh) * | 2017-11-24 | 2018-03-23 | 江苏大学 | 混联式汽车电泳涂装输送机构的前馈补偿优化分数阶pid控制方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11179855B2 (en) | 2018-12-30 | 2021-11-23 | Ubtech Robotics Corp Ltd | Acceleration compensation method for humanoid robot and apparatus and humanoid robot using the same |
CN112462694A (zh) * | 2020-12-03 | 2021-03-09 | 上海维宏电子科技股份有限公司 | 基于总线伺服控制系统实现速度前馈补偿处理的方法、系统、装置、处理器及存储介质 |
CN112462694B (zh) * | 2020-12-03 | 2022-02-08 | 上海维宏电子科技股份有限公司 | 基于总线伺服控制系统实现速度前馈补偿处理的方法、系统、装置、处理器及存储介质 |
CN113864387A (zh) * | 2021-10-20 | 2021-12-31 | 上海新纪元机器人有限公司 | 一种主动减震机构控制方法、系统和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN108724195B (zh) | 2021-10-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109159151B (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和系统 | |
CN110421547B (zh) | 一种基于估计动力学模型的双臂机器人协同阻抗控制方法 | |
CN112757306B (zh) | 一种机械臂逆解多解选择和时间最优轨迹规划算法 | |
CN108724195A (zh) | 一种针对机器人的耦合前馈控制方法 | |
JPH0549284A (ja) | 同期形交流サーボモータの速度制御方法 | |
TWI558089B (zh) | 多軸馬達同動控制系統及其方法 | |
KR101269272B1 (ko) | 모터제어장치 | |
JPH0683403A (ja) | 適応pi制御方式 | |
JPS58143981A (ja) | 産業用ロボツトの制御方法 | |
CN101523313A (zh) | 伺服控制装置 | |
WO2013132946A1 (ja) | サーボ制御装置及びサーボ制御方法 | |
JP3981773B2 (ja) | ロボット制御装置 | |
CN102087482A (zh) | 光刻机工件台同步运动误差校正控制系统 | |
US4665352A (en) | Apparatus and method for controlling an industrial robot | |
KR100359577B1 (ko) | 다축로보트의제어장치 | |
JP2005186235A (ja) | ロボットの制御装置 | |
CN112783099B (zh) | 分数阶复合控制方法和永磁同步电动机速度伺服系统 | |
Baeten et al. | Combining force control and visual servoing for planar contour following | |
Cheng et al. | Synchronization controller synthesis of multi-axis motion system | |
JP2000218577A (ja) | ロボット制御装置 | |
CN109773781B (zh) | 一种无传感器的工业机器人直线软浮动控制方法 | |
CN115107035B (zh) | 一种机器人单关节人工免疫系统监控的混合控制方法 | |
CN1633629A (zh) | 伺服系统的控制方法 | |
JPH11231940A (ja) | ロボットの制御装置 | |
Farrage et al. | Adaptive sliding mode contouring control with a nonlinear sliding surface for feed drive systems |
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 |