CN108762077B - 一种具有通信约束的移动机器人滚动时域估计方法 - Google Patents
一种具有通信约束的移动机器人滚动时域估计方法 Download PDFInfo
- Publication number
- CN108762077B CN108762077B CN201810548971.8A CN201810548971A CN108762077B CN 108762077 B CN108762077 B CN 108762077B CN 201810548971 A CN201810548971 A CN 201810548971A CN 108762077 B CN108762077 B CN 108762077B
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- time domain
- quantization
- rolling time
- packet loss
- 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 29
- 238000005096 rolling process Methods 0.000 title claims abstract description 27
- 230000006854 communication Effects 0.000 title claims abstract description 22
- 238000004891 communication Methods 0.000 title claims abstract description 19
- 238000013139 quantization Methods 0.000 claims abstract description 29
- 238000013461 design Methods 0.000 claims abstract description 7
- 238000005259 measurement Methods 0.000 claims description 23
- 239000000126 substance Substances 0.000 claims description 16
- 230000005540 biological transmission Effects 0.000 claims description 6
- 238000005457 optimization Methods 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000012938 design process Methods 0.000 abstract description 3
- 238000005516 engineering process Methods 0.000 description 5
- 238000011160 research Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
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
一种具有通信约束的移动机器人滚动时域估计方法,包括以下步骤:1)考虑网络丢包和数据量化的影响,将移动机器人路径跟踪问题建模为一类具有随机变量和参数不确定的跟踪误差状态空间模型;2)设计滚动时域估计性能指标函数;3)利用min‑max设计准则和随机系统方法,给出状态估计器的参数化设计过程。本发明提供了一种可以有效解决具有数据丢包和信息量化的移动机器人路径跟踪系统的状态估计方法。
Description
技术领域
本发明涉及网络化移动机器人路径跟踪控制系统和系统状态估计问题,尤其涉及的是有数据丢包和量化的网络移动机器人路径跟踪控制系统的滚动时域估计方法。
背景技术
随着科学技术和控制技术的发展,移动机器人由于其结构灵巧、环境适应能力强等优点,已被广泛应用于科研、军事、工业、民用以及物流等领域。路径跟踪作为移动机器人运动控制中的三大基本问题之一,一直备受广泛关注。对路径跟踪控制的研究,不仅限于移动机器人领域,还涉及数控机床跟踪磨削、飞机和轮船的航迹控制等领域。因此,针对移动机器人路径跟踪控制技术的研究,不仅可以丰富移动机器人运动控制的理论成果,还可以满足多领域对运动控制技术越来越高的要求,具有重大的理论和工程意义。此外,通过引入网络遥操作技术,延展了移动机器人的能力范围,可以有效满足人类无法直接进入特定场合作业的需求。
在移动机器人的位姿状态中,对于航向角的精确测量往往比较困难。专业测量航向角的传感器虽然能够测得较为精确的数据,然而其价格昂贵,不利于在实际中推广使用。常用的设计方法是使用普通的惯性传感器来测量移动机器人的航向角,同时以摄像头的测量数据为辅助来获取更高的精确度。然而,普通的惯性传感器在使用过程中会随着时间的推移出现数据漂移,导致其测量精度降低无法满足有效控制的需要。为了避免数据漂移和测量误差对控制精度的影响,本发明采用滚动时域估计方法,利用摄像头获得的坐标信息估计跟踪系统的状态估计值。另外,在远程路径跟踪系统中,机器人的实时姿态信息通过车载传感器进行采集,如霍尔传感器、惯性传感器以及视觉传感器等。考虑到车载控制芯片的运算处理能力有限,通常需要将这些信息通过无线传输的方式上传至上位机系统进行处理,上位机端设有状态估计器和反馈控制器分别用于估计系统状态和计算控制输入。然而,在无线传输的过程中,通信信道容易受到外界扰动的影响,且传感器数据的传输速率过快容易导致通信信道的拥塞。此外,无线网络的数据包具有编码长度约束,从而不可避免的存在数据丢包和信息量化的问题。为此,有必要考虑丢包和量化等网络因素对路径跟踪系统的估计性能影响。
发明内容
为了克服现有移动机器人在通信约束(丢包、量化等)影响下的路径跟踪状态估计问题,本发明通过将该问题建模为一类具有随机变量和参数不确定的跟踪误差模型,利用滚动时域估计方法,并采用min-max设计准则和随机系统方法,给出了状态估计器的参数化设计过程。该估计器一方面可在控制系统存在无效状态数据的时刻给出相应的估计值,另一方面针对系统状态数据的测量噪声也可以起到有效的抑制作用。
本发明解决其技术问题所采用的技术方案是:
一种具有通信约束的移动机器人滚动时域方法,包括以下步骤:
1)建立具有通信约束的移动机器人模型,定义xe和ye为移动机器人位置跟踪误差状态量,αe为方位角跟踪误差状态量,v和ω分别为移动机器人的线速度和角速度,vr和ωr分别为移动机器人的参考线速度和角速度,则移动机器人路径跟踪系统的离散时间线性误差模型为:
x(k+1)=Adx(k)+Bdu(k) (1)
考虑移动机器人与服务器端通信过程中存在数据丢包和信息量化的问题,采用伯努利随机过程来描述数据丢包,
测量输出信息采用对数量化器进行量化,定义如下,
且该对数量化器具有以下性质:
q(ξ)-ξ=Δkξ (5)
||Δk||≤γ (6)
其中,Δk为量化误差;
为了使得估计状态平滑而有利于控制器的设计,当测量数据包丢失时则采用了上一时刻测量输出的策略,结合以上丢包和量化模型,则具有通信约束和噪声影响的移动机器人跟踪误差系统描述如下:
结合式(5),进一步状态增广得
2)定义滚动时域估计性能指标函数
将滚动时域估计问题转化为等价的最大-最小化问题:
约束条件:
进一步,所述步骤3)中,控制器的设计步骤如下:
3.2:迭代开始:令l=0,选取λ的初始值λl;
本发明的技术构思为:首先,考虑网络丢包和数据量化的影响,将移动机器人路径跟踪问题建模为一类具有随机变量和参数不确定的跟踪误差状态空间模型。然后,利用滚动时域估计方法,并采用min-max设计准则和随机系统方法,给出了状态估计器的参数化设计过程。最后,给出了具有参数依赖的估计器参数的求解步骤。
本发明的有益效果主要表现在:通过将网络丢包和数据量化问题建模为一类具有随机变量和参数不确定的跟踪误差模型,易于分析丢包和量化等通信约束的影响;给出了最优估计器的性能指标函数,通过对性能指标求期望有效消除了随机变量因子的影响,便于求解计算;结合鲁棒最小二乘调节方法求解估计器参数,有效解决了通信约束下移动机器人的路径跟踪状态估计问题。
附图说明
图1是移动机器人路径跟踪误差模型示意图。
图2是具有通信约束条件下所设计的移动机器人鲁棒预测跟踪控制算法的原理图。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1和图2,一种具有通信约束的移动机器人滚动时域方法,包括以下步骤:
1)建立具有通信约束的移动机器人路径跟踪误差运动学模型
为了方便起见,移动机器人路径跟踪参考轨迹取为圆形轨迹,则在平衡点处(x=0,u=0)线性化该系统,得移动机器人路径跟踪连续状态空间模型如下,
以T为采样周期对式(2)进行离散化,则移动机器人路径跟踪系统的离散时间线性误差模型为:
x(k+1)=Adx(k)+Bdu(k) (1)
考虑移动机器人与服务器端通信过程中存在数据丢包和信息量化的问题,采用伯努利随机过程来描述数据丢包,
测量输出信息采用对数量化器进行量化,定义如下,
且该对数量化器具有以下性质:
q(ξ)-ξ=Δkξ (5)
||Δk||≤γ (6)
其中,Δk为量化误差;
为了使得估计状态平滑而有利于控制器的设计,当测量数据包丢失时则采用了上一时刻测量输出的策略,结合以上丢包和量化模型,则具有通信约束和噪声影响的移动机器人跟踪误差系统描述如下:
结合式(5),进一步状态增广得
2)定义滚动时域估计性能指标函数
将滚动时域估计问题转化为等价的最大-最小化问题:
约束条件:
根据以上结果,控制器的设计步骤如下:
3.2:迭代开始:令l=0,选取λ的初始值λl;
Claims (2)
1.一种具有通信约束的移动机器人滚动时域估计方法,其特征在于:所述方法包括以下步骤:
1)建立具有通信约束的移动机器人模型,定义xe和ye为移动机器人位置跟踪误差状态量,αe为方位角跟踪误差状态量,v和ω分别为移动机器人的线速度和角速度,vr和ωr分别为移动机器人的参考线速度和角速度,则移动机器人路径跟踪系统的离散时间线性误差模型为:
x(k+1)=Adx(k)+Bdu(k) (1)
考虑移动机器人与服务器端通信过程中存在数据丢包和信息量化的问题,采用伯努利随机过程来描述数据丢包,
测量输出信息采用对数量化器进行量化,定义如下,
且该对数量化器具有以下性质:
q(ξ)-ξ=Δkξ (5)
||Δk||≤γ (6)
其中,Δk为量化误差;
为了使得估计状态平滑而有利于控制器的设计,当测量数据包丢失时则采用了上一时刻测量输出的策略,结合以上丢包和量化模型,则具有通信约束和噪声影响的移动机器人跟踪误差系统描述如下:
结合式(5),进一步状态增广得
2)定义滚动时域估计性能指标函数
将滚动时域估计问题转化为等价的最大-最小化问题:
约束条件:
2.如权利要求1所述的具有通信约束的移动机器人滚动时域估计方法,其特征在于:所述步骤3)中,控制器的设计步骤如下:
3.2:迭代开始:令l=0,选取λ的初始值λl;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810548971.8A CN108762077B (zh) | 2018-05-31 | 2018-05-31 | 一种具有通信约束的移动机器人滚动时域估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810548971.8A CN108762077B (zh) | 2018-05-31 | 2018-05-31 | 一种具有通信约束的移动机器人滚动时域估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108762077A CN108762077A (zh) | 2018-11-06 |
CN108762077B true CN108762077B (zh) | 2021-02-26 |
Family
ID=64001152
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810548971.8A Active CN108762077B (zh) | 2018-05-31 | 2018-05-31 | 一种具有通信约束的移动机器人滚动时域估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108762077B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110007601B (zh) * | 2019-05-06 | 2022-03-25 | 广东工业大学 | 一种双边遥操作系统的控制装置和设备 |
US11124196B2 (en) * | 2019-07-02 | 2021-09-21 | Mitsubishi Electric Research Laboratories, Inc. | Receding horizon state estimator |
CN111578931B (zh) * | 2020-05-21 | 2022-03-04 | 中国人民解放军海军航空大学 | 基于在线滚动时域估计的高动态飞行器自主姿态估计方法 |
CN116893619B (zh) * | 2023-08-29 | 2024-04-09 | 江南大学 | 一种工业机器人量化迭代学习控制方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007334843A (ja) * | 2006-06-12 | 2007-12-27 | Naoto Fukushima | システムの最適制御方法 |
CN102625338B (zh) * | 2012-03-12 | 2015-04-22 | 浙江工业大学 | 一种具有数据包丢失的无线传感器网络滚动时域信噪比估计方法 |
CN105116900B (zh) * | 2015-08-28 | 2017-07-25 | 浙江工业大学 | 基于Nash迭代的分布式多移动机器人编队控制方法 |
CN105116899B (zh) * | 2015-08-28 | 2017-07-28 | 浙江工业大学 | 基于eso的分布式多移动机器人编队控制方法 |
-
2018
- 2018-05-31 CN CN201810548971.8A patent/CN108762077B/zh active Active
Non-Patent Citations (2)
Title |
---|
Björn Olofsson,etc.Path-tracking velocity control for robot manipulators with actuator constraints.《Mechatronics》.2017, * |
基于滚动时域优化的轮式移动机器人路径跟踪问题研究;刘洋,等;《控制理论与应用》;20170601;424-432 * |
Also Published As
Publication number | Publication date |
---|---|
CN108762077A (zh) | 2018-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108762077B (zh) | 一种具有通信约束的移动机器人滚动时域估计方法 | |
CN109597864B (zh) | 椭球边界卡尔曼滤波的即时定位与地图构建方法及系统 | |
CN107563044B (zh) | 基于在线安全学习的四旋翼无人机路径跟踪控制方法 | |
CN110988894B (zh) | 一种面向港口环境的多源数据融合的无人驾驶汽车实时定位方法 | |
CN108803601B (zh) | 一种具有通信约束的移动机器人鲁棒预测跟踪控制方法 | |
CN110209180B (zh) | 一种基于HuberM-Cubature卡尔曼滤波的无人水下航行器目标跟踪方法 | |
CN116661469B (zh) | 机器人轨迹误差修正方法及系统 | |
CN108226887B (zh) | 一种观测量短暂丢失情况下的水面目标救援状态估计方法 | |
CN111750865A (zh) | 一种用于双功能深海无人潜器导航系统的自适应滤波导航方法 | |
CN110967017B (zh) | 一种用于双移动机器人刚体协作搬运的协同定位方法 | |
CN109857127B (zh) | 训练神经网络模型以及飞行器姿态解算的方法、装置 | |
CN110375773B (zh) | Mems惯导系统姿态初始化方法 | |
CN115562299A (zh) | 一种移动机器人的导航方法、装置、移动机器人及介质 | |
CN114660587A (zh) | 基于Jerk模型的跳跃滑翔弹道目标跟踪方法及系统 | |
Dai et al. | Unsupervised feature fusion combined with neural network applied to UAV attitude estimation | |
Aghli et al. | Online system identification and calibration of dynamic models for autonomous ground vehicles | |
CN113296515A (zh) | 一种双独立电驱动车辆显式模型预测路径跟踪方法 | |
Li et al. | Online trajectory optimization for UAV in uncertain environment | |
Wei et al. | Neural network based extended kalman filter for localization of mobile robots | |
Bakirci et al. | Improving position-time trajectory accuracy in vehicle stop-and-go scenarios by using a mobile robot as a testbed | |
Zhao et al. | Active Learning Gaussian Process Model Predictive Control Method for Quadcopter | |
Yin et al. | A positioning algorithm based on improved adaptive unscented Kalman filter | |
Lu et al. | Analysis and evaluation of MEMS-IMU attitude estimation algorithm | |
CN116625407B (zh) | 一种智能微姿态测量方法与系统 | |
Xu et al. | Multi-Sensor Fusion Framework Based on GPS State Detection |
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 |