CN112706165A - 一种面向轮式移动机械臂的跟踪控制方法及系统 - Google Patents
一种面向轮式移动机械臂的跟踪控制方法及系统 Download PDFInfo
- Publication number
- CN112706165A CN112706165A CN202011525772.9A CN202011525772A CN112706165A CN 112706165 A CN112706165 A CN 112706165A CN 202011525772 A CN202011525772 A CN 202011525772A CN 112706165 A CN112706165 A CN 112706165A
- Authority
- CN
- China
- Prior art keywords
- information
- mechanical arm
- driving signal
- jacobian matrix
- neural network
- 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
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/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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
-
- 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/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种面向轮式移动机械臂的跟踪控制方法及系统,该方法包括:S1、给定初值信息并输入预定义的目标轨迹信息;S2、根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号;S3、根据驱动信号控制轮式移动机械臂的运动并反馈实际信息;S4、基于第二零化神经网络和实际信息估算雅可比矩阵并返回步骤S2重新计算驱动信号。该系统包括:初始化模块、驱动信号模块、控制模块和雅可比矩阵模块。本发明可在不需要知道轮式移动操作机械臂的模型参数的情况下,实现对该机器人的追踪控制。本发明作为一种面向轮式移动机械臂的跟踪控制方法及系统,可广泛应用于机械臂控制领域。
Description
技术领域
本发明属于机械臂控制领域,尤其涉及一种面向轮式移动机械臂的跟踪控制方法及系统。
背景技术
现有方案为了实现控制跟踪,在求解轮式移动操作机械臂的逆运动学问题之前,需要为其建立准确的运动学模型。该方案有以下缺点:首先,建立运动学模型的过程比较繁琐且运算量较大;其次,当需要将控制算法应用到不同的轮式移动操作机械臂的时候,每次都需要为不同的轮式移动操作机械臂建立一个运动学模型,因此该控制方案在不同机器人上的可移植性较差;最后,当记录的机器人模型参数和真实的模型参数之间存在一定差异的时候,会大大影响运动学建模的准确度,从而影响控制算法的有效性。
发明内容
为了解决上述技术问题,本发明的目的是提供一种面向轮式移动机械臂的跟踪控制方法及系统,可以在不需要知道轮式移动操作机械臂的模型参数(即运动学模型未知)的情况下,求解轮式移动操作机械臂的逆运动学问题,实现对该机器人的追踪控制。
本发明所采用的第一技术方案是一种面向轮式移动机械臂的跟踪控制方法,包括以下步骤:
S1、给定初值信息并输入预定义的目标轨迹信息;
S2、根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号;
S3、根据驱动信号控制轮式移动机械臂的运动并反馈实际信息;
S4、基于第二零化神经网络和实际信息估算雅可比矩阵并返回步骤S2重新计算驱动信号。
进一步,所述初值信息包括车轮转动角度初值、机械臂关节角度初值和雅可比阵初值,所述实际信息包括机械臂末端执行器的位置信息、机械臂末端执行器的速度信息、机械臂末端执行器的加速度信息,机械臂基部速度信息和机械臂基部加速度信息。
进一步,所述根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号这一步骤,其具体包括:
根据预定义的目标轨迹信息和机械臂末端执行器的位置信息构建第一误差函数;
构建第一零化神经网络并将第一误差函数代入第一零化神经网络,得到第一微分方程;
将第一微分方程进行变换,得到驱动信号的微分方程;
进一步,所述第一微分方程表达式如下:
上式中,是rd(t)的时间导数,表示机械臂基部速度信息,J(t)表示估算的雅可比矩阵,表示驱动信息,常数γ=1是零化神经网络模型的设计参数,rd(t)表示预定义的目标轨迹信息,ra(t)表示机械臂末端执行器的位置信息。
进一步,所述驱动信号的微分方程表达式如下:
进一步,所述根据驱动信号控制轮式移动机械臂的运动并反馈实际信息这一步骤,其具体包括:
根据驱动信号q(t)来控制轮式移动操作机械臂的运动,使其末端执行器在任务空间中追踪预定义的轨迹;
进一步,所述基于第二零化神经网络和实际信息估算雅可比矩阵并返回步骤S2重新计算驱动信号这一步骤,其具体包括:
定义第二误差函数并将第二误差函数输入到第二零化神经网络,得到第二微分方程;
对第二微分方程进行变换得到关于雅可比矩阵的微分方程;
根据雅可比矩阵初值、实时反馈信息、驱动信号的微分方程和关于雅可比矩阵的微分方程得到估算的雅可比矩阵;
返回步骤S2重新计算驱动信号。
进一步,所述第二微分方程的表达式如下:
进一步,所述关于雅可比矩阵的微分方程的表达式如下:
本发明所采用的第二技术方案是:一种面向轮式移动机械臂的跟踪控制系统,包括以下模块:
初始化模块,用于给定初值信息并输入预定义的目标轨迹信息;
驱动信号模块,用于根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号;
控制模块,用于根据驱动信号控制轮式移动机械臂的运动并反馈实际信息;
雅可比矩阵模块,用于基于第二零化神经网络和实际信息估算雅可比矩阵并返回重新计算驱动信号。
本发明方法及系统的有益效果是:本发明可在不需要知道轮式移动操作机械臂的模型参数(即运动学模型未知)的情况下,求解轮式移动操作机械臂的逆运动学问题,实现对该机器人的追踪控制,此外,本发明提出的控制方案不需要建立机器人的运动学模型,因此很容易将其应用到不同类型和结构的轮式移动操作机械臂,并且机器人模型参数的不确定性不会影响到本发明提出的控制方案的有效性。
附图说明
图1是本发明具体实施例一种面向轮式移动机械臂的跟踪控制方法的步骤流程图;
图2是本发明具体实施例一种面向轮式移动机械臂的跟踪控制系统的结构框图;
图3是本发明具体实施例在任务空间中的预定义的目标轨迹和末端执行器的实际轨迹;
图4是本发明具体实施例控制系统的数据处理示意图。
具体实施方式
下面结合附图和具体实施例对本发明做进一步的详细说明。对于以下实施例中的步骤编号,其仅为了便于阐述说明而设置,对步骤之间的顺序不做任何限定,实施例中的各步骤的执行顺序均可根据本领域技术人员的理解来进行适应性调整。
参照图1和图4,本发明提供了一种面向轮式移动机械臂的跟踪控制方法,该方法包括以下步骤:
S1、给定初值信息并输入预定义的目标轨迹信息;
S2、根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号;
S3、根据驱动信号控制轮式移动机械臂的运动并反馈实际信息;
S4、基于第二零化神经网络和实际信息估算雅可比矩阵并返回步骤S2重新计算驱动信号。
进一步作为本方法的优选实施例,所述初值信息包括车轮转动角度初值、机械臂关节角度初值和雅可比阵初值,所述实际信息包括机械臂末端执行器的位置信息、机械臂末端执行器的速度信息、机械臂末端执行器的加速度信息,机械臂基部速度信息和机械臂基部加速度信息。
预定义的目标轨迹信息的表达式如下:
其中ι=0.2米表示目标轨迹的半径,Td=20秒表示追踪任务的周期,目标轨迹rd(t)在任务空间中的示意图如图3所示,将这些信息作为控制系统的输入信息。
进一步作为本方法优选实施例,所述根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号这一步骤,其具体包括:
具体地,首先,轮式移动操作机械臂的运动学方程可以用下式表示:
在(3)式两边同时对时间求导t可以得到:
根据预定义的目标轨迹信息和机械臂末端执行器的位置信息构建第一误差函数;
具体地,根据t时刻目标轨迹rd(t)和末端执行器的实际轨迹ra(t)定义一个向量值误差函数:e(t)=rd(t)-ra(t)。
构建第一零化神经网络并将第一误差函数代入第一零化神经网络,得到第一微分方程;
将第一微分方程进行变换,得到驱动信号的微分方程;
进一步作为本发明的优选实施例,所述第一微分方程表达式如下:
上式中,是rd(t)的时间导数,表示机械臂基部速度信息,J(t)表示估算的雅可比矩阵,表示驱动信息,常数γ=1是零化神经网络模型的设计参数,rd(t)表示预定义的目标轨迹信息,ra(t)表示机械臂末端执行器的位置信息。
进一步作为本发明优选实施例,所述驱动信号的微分方程表达式如下:
进一步作为本发明优选实施例,所述根据驱动信号控制轮式移动机械臂的运动并反馈实际信息这一步骤,其具体包括:
根据驱动信号q(t)来控制轮式移动操作机械臂的运动,使其末端执行器在任务空间中追踪预定义的轨迹;
进一步作为本方法的优选实施例,所述基于第二零化神经网络和实际信息估算雅可比矩阵并返回步骤S2重新计算驱动信号这一步骤,其具体包括:
定义第二误差函数并将第二误差函数输入到第二零化神经网络,得到第二微分方程;
具体地,定义第二误差函数:
第二零化神经网络:
对第二微分方程进行变换得到关于雅可比矩阵的微分方程;
根据雅可比矩阵初值、实时反馈信息、驱动信号的微分方程和关于雅可比矩阵的微分方程得到估算的雅可比矩阵;
返回步骤S2重新计算驱动信号。
进一步作为本方法的优选实施例,所述第二微分方程的表达式如下:
进一步作为本方法的优选实施例,所述关于雅可比矩阵的微分方程的表达式如下:
如图2所示,一种面向轮式移动机械臂的跟踪控制系统,包括以下模块:
初始化模块,用于给定初值信息并输入预定义的目标轨迹信息;
驱动信号模块,用于根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号;
控制模块,用于根据驱动信号控制轮式移动机械臂的运动并反馈实际信息;
雅可比矩阵模块,用于基于第二零化神经网络和实际信息估算雅可比矩阵并返回重新计算驱动信号。
上述系统实施例中的内容均适用于本方法实施例中,本方法实施例所具体实现的功能与上述系统实施例相同,并且达到的有益效果与上述系统实施例所达到的有益效果也相同。
以上是对本发明的较佳实施进行了具体说明,但本发明创造并不限于所述实施例,熟悉本领域的技术人员在不违背本发明精神的前提下还可做作出种种的等同变形或替换,这些等同的变形或替换均包含在本申请权利要求所限定的范围内。
Claims (10)
1.一种面向轮式移动机械臂的跟踪控制方法,其特征在于,包括以下步骤:
S1、给定初值信息并输入预定义的目标轨迹信息;
S2、根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号;
S3、根据驱动信号控制轮式移动机械臂的运动并反馈实际信息;
S4、基于第二零化神经网络和实际信息估算雅可比矩阵并返回步骤S2重新计算驱动信号。
2.根据权利要求1所述一种面向轮式移动机械臂的跟踪控制方法,其特征在于,所述初值信息包括车轮转动角度初值、机械臂关节角度初值和雅可比阵初值,所述实际信息包括机械臂末端执行器的位置信息、机械臂末端执行器的速度信息、机械臂末端执行器的加速度信息,机械臂基部速度信息和机械臂基部加速度信息。
7.根据权利要求6所述一种面向轮式移动机械臂的跟踪控制方法,其特征在于,所述基于第二零化神经网络和实际信息估算雅可比矩阵并返回步骤S2重新计算驱动信号这一步骤,其具体包括:
定义第二误差函数并将第二误差函数输入到第二零化神经网络,得到第二微分方程;
对第二微分方程进行变换得到关于雅可比矩阵的微分方程;
根据雅可比矩阵初值、实时反馈信息、驱动信号的微分方程和关于雅可比矩阵的微分方程得到估算的雅可比矩阵;
返回步骤S2重新计算驱动信号。
10.一种面向轮式移动机械臂的跟踪控制系统,其特征在于,包括以下模块:
初始化模块,用于给定初值信息并输入预定义的目标轨迹信息;
驱动信号模块,用于根据初值信息、预定义的目标轨迹信息和实际信息并基于第一零化神经网络求解逆运动学问题,得到驱动信号;
控制模块,用于根据驱动信号控制轮式移动机械臂的运动并反馈实际信息;
雅可比矩阵模块,用于基于第二零化神经网络和实际信息估算雅可比矩阵并返回重新计算驱动信号。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011525772.9A CN112706165A (zh) | 2020-12-22 | 2020-12-22 | 一种面向轮式移动机械臂的跟踪控制方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011525772.9A CN112706165A (zh) | 2020-12-22 | 2020-12-22 | 一种面向轮式移动机械臂的跟踪控制方法及系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN112706165A true CN112706165A (zh) | 2021-04-27 |
Family
ID=75545052
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011525772.9A Pending CN112706165A (zh) | 2020-12-22 | 2020-12-22 | 一种面向轮式移动机械臂的跟踪控制方法及系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112706165A (zh) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113341728A (zh) * | 2021-06-21 | 2021-09-03 | 长春工业大学 | 一种抗噪型归零神经网络的四轮移动机械臂轨迹跟踪控制方法 |
| CN113650014A (zh) * | 2021-08-18 | 2021-11-16 | 中山大学 | 一种基于回声状态网络的冗余机械臂追踪控制方法 |
| CN114102612A (zh) * | 2022-01-24 | 2022-03-01 | 河北工业大学 | 一种机器人末端路径轮廓误差控制方法 |
| CN115026813A (zh) * | 2022-05-26 | 2022-09-09 | 中山大学 | 基于类小脑模型的机械臂视觉伺服控制方法及系统 |
| CN115922711A (zh) * | 2022-12-01 | 2023-04-07 | 中山大学 | 一种双机械臂的类脑同步追踪控制方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20140276953A1 (en) * | 1999-09-17 | 2014-09-18 | Intuitive Surgical Operations, Inc. | Systems and methods for tracking a path using the null-space |
| CN107957730A (zh) * | 2017-11-01 | 2018-04-24 | 华南理工大学 | 一种无人飞行器稳定飞行控制方法 |
| CN107984472A (zh) * | 2017-11-13 | 2018-05-04 | 华南理工大学 | 一种用于冗余度机械臂运动规划的变参神经求解器设计方法 |
| CN110977992A (zh) * | 2020-01-02 | 2020-04-10 | 中山大学 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
| CN111168680A (zh) * | 2020-01-09 | 2020-05-19 | 中山大学 | 一种基于神经动力学方法的软体机器人控制方法 |
-
2020
- 2020-12-22 CN CN202011525772.9A patent/CN112706165A/zh active Pending
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20140276953A1 (en) * | 1999-09-17 | 2014-09-18 | Intuitive Surgical Operations, Inc. | Systems and methods for tracking a path using the null-space |
| CN107957730A (zh) * | 2017-11-01 | 2018-04-24 | 华南理工大学 | 一种无人飞行器稳定飞行控制方法 |
| CN107984472A (zh) * | 2017-11-13 | 2018-05-04 | 华南理工大学 | 一种用于冗余度机械臂运动规划的变参神经求解器设计方法 |
| CN110977992A (zh) * | 2020-01-02 | 2020-04-10 | 中山大学 | 一种面向机械臂的无运动学模型轨迹跟踪方法及一种机械臂系统 |
| CN111168680A (zh) * | 2020-01-09 | 2020-05-19 | 中山大学 | 一种基于神经动力学方法的软体机器人控制方法 |
Non-Patent Citations (1)
| Title |
|---|
| XIAO LIN: "Solving time-varying inverse kinematics problem of wheeled mobile manipulators using Zhang neural network with exponential convergence", 《NONLINEAR DYNAMICS》 * |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113341728A (zh) * | 2021-06-21 | 2021-09-03 | 长春工业大学 | 一种抗噪型归零神经网络的四轮移动机械臂轨迹跟踪控制方法 |
| CN113341728B (zh) * | 2021-06-21 | 2022-10-21 | 长春工业大学 | 一种抗噪型归零神经网络的四轮移动机械臂轨迹跟踪控制方法 |
| CN113650014A (zh) * | 2021-08-18 | 2021-11-16 | 中山大学 | 一种基于回声状态网络的冗余机械臂追踪控制方法 |
| CN113650014B (zh) * | 2021-08-18 | 2022-05-17 | 中山大学 | 一种基于回声状态网络的冗余机械臂追踪控制方法 |
| CN114102612A (zh) * | 2022-01-24 | 2022-03-01 | 河北工业大学 | 一种机器人末端路径轮廓误差控制方法 |
| CN115026813A (zh) * | 2022-05-26 | 2022-09-09 | 中山大学 | 基于类小脑模型的机械臂视觉伺服控制方法及系统 |
| CN115922711A (zh) * | 2022-12-01 | 2023-04-07 | 中山大学 | 一种双机械臂的类脑同步追踪控制方法 |
| CN115922711B (zh) * | 2022-12-01 | 2025-04-22 | 中山大学 | 一种双机械臂的类脑同步追踪控制方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112706165A (zh) | 一种面向轮式移动机械臂的跟踪控制方法及系统 | |
| Wilson et al. | Relative end-effector control using cartesian position based visual servoing | |
| JP2769947B2 (ja) | マニピュレータの位置・姿勢制御方法 | |
| CN112894812A (zh) | 一种面向机械臂的视觉伺服轨迹跟踪控制方法及系统 | |
| US8560122B2 (en) | Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same | |
| CN106123890A (zh) | 一种多传感器数据融合的机器人定位方法 | |
| CN115847420B (zh) | 一种针对运动目标的机械臂视觉跟踪控制方法及系统 | |
| CN112743541B (zh) | 一种无力/力矩传感器机械臂软浮动控制方法 | |
| CN111546334B (zh) | 一种减小轮廓误差的工业机器人在线位姿误差补偿方法 | |
| Tsakiris et al. | Extending visual servoing techniques to nonholonomic mobile robots | |
| CN114131617B (zh) | 一种工业机器人的智能柔顺控制方法和装置 | |
| CN114434441B (zh) | 基于自适应动态规划的移动机器人视觉伺服跟踪控制方法 | |
| Xu et al. | Uncalibrated visual servoing of mobile manipulators with an eye-to-hand camera | |
| CN112621746A (zh) | 带死区的pid控制方法及机械臂视觉伺服抓取系统 | |
| Sharma et al. | A framework for robot motion planning with sensor constraints | |
| CN111168680A (zh) | 一种基于神经动力学方法的软体机器人控制方法 | |
| CN112650217B (zh) | 一种基于评估函数的机器人轨迹跟踪策略动态优化方法 | |
| Siradjuddin et al. | Image Based Visual Servoing of a 7 DOF robot manipulator using a distributed fuzzy proportional controller | |
| CN114952838A (zh) | 一种基于末端测量反馈的机械臂关节轨迹规划方法 | |
| CN118219260A (zh) | 一种动态场景下移动机械臂的运动控制方法及其应用 | |
| CN108247636B (zh) | 并联机器人闭环反馈控制方法、系统及存储介质 | |
| CN112684793B (zh) | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 | |
| Cong et al. | Visual servoing control schemes of 4 DOF robot manipulators | |
| CN115519545B (zh) | 一种基于运动学模型的双闭环多机搬运控制方法及其系统、装置 | |
| Wang et al. | Visual regulation of a nonholonomic wheeled mobile robot with two points using Lyapunov functions |
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 | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210427 |
|
| RJ01 | Rejection of invention patent application after publication |