CN112147894B - 基于运动学和动力学模型的轮式移动机器人主动控制方法 - Google Patents
基于运动学和动力学模型的轮式移动机器人主动控制方法 Download PDFInfo
- Publication number
- CN112147894B CN112147894B CN202011009743.7A CN202011009743A CN112147894B CN 112147894 B CN112147894 B CN 112147894B CN 202011009743 A CN202011009743 A CN 202011009743A CN 112147894 B CN112147894 B CN 112147894B
- Authority
- CN
- China
- Prior art keywords
- model
- mobile robot
- kinematic
- disturbance
- representing
- 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
Images
Classifications
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开基于运动学和动力学模型的轮式移动机器人主动控制方法,由基于运动学模型的运动学控制器和降阶广义比例积分观测器I,基于动力学模型的动力学控制器和降阶广义比例积分观测器II四部分组成。其中,运动学控制器包括机器人线速度和角速度的设计。降阶广义比例积分观测器I对速度状态和运动学模型中的集总扰动进行估计,降阶广义比例积分观测器II对动力学模型中的集总扰动进行估计。通过对速度状态估计,减少传感器的使用,降低成本。通过对扰动估计并进行前馈补偿,提高控制系统的扰干扰能力。本发明所提出的控制方法能够使得系统在模型不确定和外部干扰的情况下实现对轮式移动机器人轨迹跟踪控制。
Description
技术领域
本发明涉及移动机器人的轨迹跟踪控制领域,具体的,涉及基于运动学和动力学模型的轮式移动机器人主动控制方法。
背景技术
轮式移动机器人广泛地应用于工农业、服务业、国防、宇航探索等领域,对人类社会地生产和生活产生了积极而深远地影响。
轮式移动机器人是一种典型地多输入多输出耦合欠驱动非线性系统,其控制问题具有挑战性。一方面,应该考虑实际系统的非线性特性,如摩擦、间隙、执行器饱和等;另一方面,实际系统会受到外部干扰,这些因素造成实际系统与理想数学模型出现较大的偏差。设计的控制器需要想办法消除上述因素对系统的影响,这对运动控制带来了更大的挑战。
发明内容
有鉴于此,本发明的目的是提供基于运动学和动力学模型的轮式移动机器人主动控制方法,能够使得系统在参数有界变化和外界扰动的情况下实现对机器人的轨迹跟踪控制。
本发明的目的是通过以下技术方案实现的:
基于运动学和动力学模型的轮式移动机器人主动控制方法,
基于移动机器人受到模型不确定性和外部扰动的影响,建立移动机器人运动学模型和动力学模型;
根据运动学模型,设计运动学控制器,获取虚拟线速度和角速度;
根据运动学控制器和当前移动机器人的实际位置轨迹,设计降阶广义比例积分观测器I,对速度状态和运动学模型中的集总扰动进行估计,并将集总扰动进行前馈补偿,消除扰动对系统控制性能的影响;
根据虚拟线速度和角速度与机器人实际的线速度和角速度的偏差以及动力学模型,设计动力学控制器,确定移动机器人左、右轮电机的控制转矩;
根据动力学控制器和当前的移动机器人实际速度,设计降阶广义比例积分观测器II,对动力学模型中的集总扰动估计,并进行前馈补偿,消除扰动对系统控制性能的影响。
进一步,所述运动学模型为:
其中,x表示在固定参考坐标系X轴方向的位置,y表示在固定参考坐标系Y轴方向的位置,θ表示方向角,v表示线速度,w表示角速度,vs,vt,ws分别表示纵向滑动速度,横向滑动速度以及滑动角速度;
对所述运动学模型做出变形,可以得到下面的基于微分平坦的运动学模型:
其中:
令
将上式代入所述基于微分平坦的运动学模型中,可得下式:
其中,
a1,a2表示所述运动学模型中的集总扰动。
进一步,所述动力学模型为:
其中:d1,d2表示动力学模型中的集总扰动,m表示移动机器人的质量,J表示移动机器人的转动惯量,u1和u2均表示动力学模型的中间项。
进一步,所述运动学控制器为:
其中:表示给定参考轨迹的二阶导数, 表示给定参考轨迹的一阶导数,表示对在固定参考坐标系下X轴方向速度的估计,表示对在固定参考坐标系下Y轴方向速度的估计,表示对运动学模型中集总干扰的估计,L1,L0表示控制器的增益。
进一步,所述虚拟线速度和角速度的获取方式为:
进一步,所述降阶广义比例积分观测器I具体为:
进一步,所述动力学控制器为:
进一步,获取所述移动机器人左、右轮电机的控制转矩具体为:
其中:τ1,τ2为左右轮的控制力矩,用来驱动电机产生相应的速度。
进一步,所述降阶广义比例积分观测器II为:
本发明的有益效果是:
本发明有基于运动学模型的运动学控制器和降阶广义比例积分观测器I,基于动力学模型的动力学控制器和降阶广义比例积分观测器II四部分组成。运动学控制器包括机器人线速度和角速度的设计,目的是保证机器人的运动轨迹能够跟踪期望的轨迹;动力学控制器的目的是保证能够提供与虚拟速度同样大小的实际速度,从而保证闭环系统的稳定性。两个降阶广义比例积分观测器用来观测扰动,作为前馈项引入。本发明所设计的主动控制方法能够使得系统在参数有界变化和外界扰动的情况下实现对机器人的轨迹跟踪控制。仿真实验表明提出的方法具有较好的鲁棒性。
本发明的其他优点、目标和特征在某种程度上将在随后的说明书中进行阐述,并且在某种程度上,基于对下文的考察研究对本领域技术人员而言将是显而易见的,或者可以从本发明的实践中得到教导。本发明的目标和其他优点可以通过下面的说明书来实现和获得。
附图说明
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步的详细描述,其中:
附图1为本发明流程图;
附图2为当系统受到扰动影响时,轮式移动机器人在推荐控制方法和ESOBC控制方法下的跟踪轨迹,
其中(a)为在ESOBC控制方法下的跟踪轨迹,其中(a1)为ESOBC控制方法下的位置跟踪结果,(a2)为ESOBC控制方法下的ex随时间的变化,(a3)为ESOBC控制方法下的ey随时间的变化;
(b)在本发明所述的方法下的跟踪轨迹,其中(b1)为本发明所述的方法下的位置跟踪结果,(b2)为本发明所述的方法下的ex随时间的变化,(b3)为本发明所述的方法下的ey随时间的变化;
图3当系统受到扰动影响时,本方法中运动学控制器的控制输入曲线,
其中(a)为虚拟速度随时间的变化,(b)为虚拟角速度随时间的变化;
图4当系统受到扰动影响时,本方法中动力学控制器的控制输入曲线,
其中(a)为左轮电机的控制转矩随时间变化,(b)为右轮电机的控制转矩随时间变化;
图5当系统受到扰动影响时,降阶广义比例积分观测器I对集总扰动和速度状态的估计,
其中(b)为降阶广义比例积分观测器I对速度状态的估计,(b1)为在实际坐标系下X轴的速度和移动机器人的速度的估计;在实际坐标系下Y轴的速度和移动机器人的速度的估计;
具体实施方式
以下将参照附图,对本发明的优选实施例进行详细的描述。应当理解,优选实施例仅为了说明本发明,而不是为了限制本发明的保护范围。
实施例1
本实施例提出了基于运动学和动力学模型的轮式移动机器人主动控制方法,如图1所示,主动控制方法具体为:
基于移动机器人受到模型不确定性和外部扰动的影响,建立移动机器人运动学模型和动力学模型。
移动机器人运动学模型的建立过程为:
移动机器人的运动学建模如式(1)所示:
其中,x表示在固定参考坐标系X轴方向的位置,y表示在固定参考坐标系Y轴方向的位置,θ表示方向角,v表示线速度,w表示角速度,vs,vt,ws分别表示纵向滑动速度,横向滑动速度以及滑动角速度。
对上面的运动学模型做适当的变形,可以得到下面的基于微分平坦的运动学模型:
其中:
令
将(6)代入(2)中,可得:
其中:
机器人的动力学模型的建立过程为:
移动机器人的运动学建模如式(9)所示:
针对式(9)进行变形,得到式(10)。
其中:
令:
可得:
其中:d1,d2表示动力学模型中的集总扰动,m表示移动机器人的质量,J表示移动机器人的转动惯量。
获取移动机器人实际移动轨迹x,y,计算与给定参考轨迹xr,yr的偏差ex,ey。
根据运动学模型,设计运动学控制器,获取虚拟线速度和虚拟角速度。
虚拟线速度和角速度的获取方式为:
其中:
运动学控制器可表示为式(18)
其中:表示给定参考轨迹的二阶导数, 表示给定参考轨迹的一阶导数,表示对在固定参考坐标系下X轴方向速度的估计,表示对在固定参考坐标系下Y轴方向速度的估计,表示对运动学模型中集总干扰的估计,L1,L0表示控制器的增益。
降阶广义比例积分观测器I为:
根据虚拟线速度和角速度以及机器人实际的线速度和角速度的偏差以及动力学模型,设计动力学控制器,确定移动机器人左、右轮电机的控制转矩τ1,τ2。
移动机器人左、右电机的控制转矩τ1,τ2经过输入变换得到,具体为:
动力学控制器可表示为:
根据动力学控制器和当前的移动机器人实际速度,设计降阶广义比例积分观测器II,对动力学模型中的集总扰动估计,并进行前馈补偿,消除扰动对系统控制性能的影响。
降阶广义比例积分观测器II可表示为:
实施例2
本实施例测试了本发明提出的基于运动学和动力学模型的轮式移动机器人主动控制方法的精度,如图2所示,系统在10秒后受到正弦形式的纵向滑动速度(幅值:0.16m/s,频率:2rad/s),横向滑动速度(幅值:0.12m/s,频率:1rad/s)外部扰动以及模型不确定性扰动(d1=1000sin(2πt)e-(t-5),d2=2000cos(2πt)e-(t-5))的影响时,与ESOBC控制方法相比,轮式移动机器人在推荐的控制方法下能够更好的跟踪参考轨迹,具有更好的抗干扰能力。
如图3所示,当系统受到扰动影响时,推荐控制方法中运动学控制器的控制输入曲线的范围是合理的。
如图4所示,当系统受到扰动影响时,推荐控制方法中动力学控制器的控制输入曲线的范围是合理。
如图5所示,当系统受到扰动影响时,降阶广义比例积分观测器I能够很好的对速度状态和集总扰动进行估计。
如图6所示,当系统受到扰动影响时,降阶广义比例积分观测器II能够很好的对集总扰动进行估计。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (7)
1.基于运动学和动力学模型的轮式移动机器人主动控制方法,其特征在于:
基于移动机器人受到模型不确定性和外部扰动的影响,建立移动机器人运动学模型和动力学模型;
根据运动学模型,设计运动学控制器,获取虚拟线速度和角速度;
根据运动学控制器和当前移动机器人的实际位置轨迹,设计降阶广义比例积分观测器I,对速度状态和运动学模型中的集总扰动进行估计,并将集总扰动进行前馈补偿,消除扰动对系统控制性能的影响;
根据虚拟线速度和角速度与机器人实际的线速度和角速度的偏差以及动力学模型,设计动力学控制器,确定移动机器人左、右轮电机的控制转矩;
根据动力学控制器和当前的移动机器人实际速度,设计降阶广义比例积分观测器II,对动力学模型中的集总扰动估计,并进行前馈补偿,消除扰动对系统控制性能的影响;
所述降阶广义比例积分观测器I具体为:
所述降阶广义比例积分观测器II为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011009743.7A CN112147894B (zh) | 2020-09-23 | 2020-09-23 | 基于运动学和动力学模型的轮式移动机器人主动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011009743.7A CN112147894B (zh) | 2020-09-23 | 2020-09-23 | 基于运动学和动力学模型的轮式移动机器人主动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112147894A CN112147894A (zh) | 2020-12-29 |
CN112147894B true CN112147894B (zh) | 2022-12-09 |
Family
ID=73896112
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011009743.7A Active CN112147894B (zh) | 2020-09-23 | 2020-09-23 | 基于运动学和动力学模型的轮式移动机器人主动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112147894B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114172243B (zh) * | 2021-12-14 | 2024-04-19 | 南京工程学院 | 基于gpi控制器的水下航行器无线充电系统及控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109521786A (zh) * | 2019-01-23 | 2019-03-26 | 南京邮电大学 | 基于比例积分观测器的四旋翼无人机滑模姿态控制方法 |
CN109597310A (zh) * | 2019-02-01 | 2019-04-09 | 东南大学 | 一种基于扰动观测器的轮式移动机器人轨迹跟踪方法 |
CN111216131A (zh) * | 2020-01-21 | 2020-06-02 | 重庆邮电大学 | 基于柔性执行器驱动的机器人串级抗干扰控制方法及系统 |
-
2020
- 2020-09-23 CN CN202011009743.7A patent/CN112147894B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109521786A (zh) * | 2019-01-23 | 2019-03-26 | 南京邮电大学 | 基于比例积分观测器的四旋翼无人机滑模姿态控制方法 |
CN109597310A (zh) * | 2019-02-01 | 2019-04-09 | 东南大学 | 一种基于扰动观测器的轮式移动机器人轨迹跟踪方法 |
CN111216131A (zh) * | 2020-01-21 | 2020-06-02 | 重庆邮电大学 | 基于柔性执行器驱动的机器人串级抗干扰控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN112147894A (zh) | 2020-12-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Boukattaya et al. | Adaptive nonsingular fast terminal sliding-mode control for the tracking problem of uncertain dynamical systems | |
Yao et al. | Adaptive robust control of DC motors with extended state observer | |
Wahrburg et al. | Cartesian contact force estimation for robotic manipulators using Kalman filters and the generalized momentum | |
CN110673472B (zh) | 基于神经网络补偿死区反演误差的自适应鲁棒控制方法 | |
CN108628172B (zh) | 一种基于扩张状态观测器的机械臂高精度运动控制方法 | |
Hashemi et al. | Model-based PI–fuzzy control of four-wheeled omni-directional mobile robots | |
CN108453732B (zh) | 控制体系封闭机器人自适应动态力/位置混合控制方法 | |
CN112558468B (zh) | 基于双观测器的发射平台自适应鲁棒输出反馈控制方法 | |
CN110829933B (zh) | 基于发射平台的神经网络输出反馈自适应鲁棒控制方法 | |
Khan et al. | Singular perturbation-based adaptive integral sliding mode control for flexible joint robots | |
CN112147894B (zh) | 基于运动学和动力学模型的轮式移动机器人主动控制方法 | |
Zhang et al. | Variable gain based composite trajectory tracking control for 4-wheel skid-steering mobile robots with unknown disturbances | |
CN116560375A (zh) | 基于神经网络观测器的轮式移动机器人轨迹跟踪控制方法 | |
CN112936277A (zh) | 一种水下机器人-机械手系统固定时间轨迹跟踪方法 | |
CN109048995B (zh) | 一种三自由度Delta并联机器人的非线性关节摩擦力补偿方法 | |
Jiao et al. | Disturbance observer-based backstepping control for quadrotor UAV manipulator attitude system | |
CN116382332A (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN112051736B (zh) | 一种基于单控制器的轨迹跟踪控制系统 | |
Wang et al. | A novel prescribed performance controller with unknown dead-zone and impactive disturbance | |
CN112214038B (zh) | 多输入多输出非线性系统的线性自抗扰控制系统及其应用 | |
Mahapatro et al. | Extended state observer based control of flexible link manipulator in presence of unknown payload dynamics | |
Miah et al. | Universal dynamic tracking control law for mobile robot trajectory tracking | |
Hoang et al. | Trajectory tracking control of the nonholonomic mobile robot using torque method and neural network | |
Liao et al. | Adaptive robust control of skid steer mobile robot with independent driving torque allocation | |
Wahrburg et al. | Flexdmp–extending dynamic movement primitives towards flexible joint robots |
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 |