高精度差分车回充功能控制方法技术

本发明专利技术提供了一种高精度差分车回充功能控制方法，首先识别出终点坐标在世界坐标系下的坐标，然后对识别到的坐标进行滤波处理，消除误差，最后根据实时的目标点位计算出机器人应当发给底层控制的线速度v和角速度ω，直到车成功到终点。本发明专利技术提出了一种新的运动控制方法可以弥补全局定位不足而导致的导航对桩不精准，从而降低了对做全局定位的传感器的精度要求，兼备了运动方式的简洁，运动高精度以及运动对空间的低要求。及运动对空间的低要求。及运动对空间的低要求。

【技术实现步骤摘要】
高精度差分车回充功能控制方法


[0001]本专利技术涉及移动机器人运动控制领域，具体是一种高精度差分车回充功能控制方法。

技术介绍

[0002]近年来，移动机器人与自动驾驶领域技术兴起并取得长足发展。市面上销售的轮式移动机器人或者复合机器人中，按照轮驱动方式动力来源主要分为差速模型，阿克曼模型和全向模型三种。其中差速模型由于其驱动方式简单，且运动方式灵活，被广泛应用到各种商业场景中，例如，无人仓储，医疗轮椅，3C，室内外清洁等。
[0003]移动机器人涉及的基本技术有传感器技术、信息处理技术、自动化控制技术、导航技术。其中的导航控制模块要根据不同的使用方式，不同的地面路面以及不同的障碍物情况调整控制方式以及精度要求。自动回充功能作为产品功能模块中比较重要的一部分更是对控制方式和精度有着非常高的要求，其中的对桩运动控制算法要在满足够精度的情况下尽量使得运动路径精简。
[0004]普遍的双轮差速移动机器人回充对桩系统主要有以下两种：
[0005]1.在全局定位精度足够高的情况下直接使用通用导航局部规划算法实现对桩，其对于全局精度要求非常高。而在全局定位精度不高的情况下，一般的导航控制算法会因为定位跳动而导致对桩精度不足，或者在终点处反复尝试导致过程不够简洁。
[0006]2.利用多组红外传感器施行实时定位，从而控制机器人精准定位到充电桩的位置。但这种方法对传感器稳定性要求过高。

技术实现思路

[0007]本专利技术为了解决现有技术的问题，提供了一种满足了在传感器精度不是很高的情况下实现了对桩的精准控制。
[0008]本专利技术采用如下控制装置，在充电桩点位上面部署一个二维码或者提供一个固定几何形状的信息如V型槽等，同时机器人上面要配有相应的感知传感器如相机，二维码等，通过相机或者激光雷达传感器实时获取二维码或者几何形状的位置信息。
[0009]本专利技术包括以下步骤：
[0010]1)识别：识别出终点坐标在世界坐标系下的坐标；
[0011]2)滤波：对步骤1)识别到的坐标进行滤波处理，消除误差；
[0012]所述滤波过程参照扩展卡尔曼滤波，具体有以下几个步骤：
[0013]2.1)建立第k次迭代的先验状态向量第k次迭代的输入向量u
k
，状态转移矩阵F
k
，输入转移矩阵B
k
和观测转移矩阵H：
[0014]u
k
＝[v ω]T
[0015][0016][0017]H＝I3[0018]2.2)给出过程噪声的协方差矩阵Q
k
和观测噪声的协方差矩阵R
k
：
[0019][0020]2.3)状态转换关系更新下一步预测值：
[0021][0022]P
k
＝F
k
P
k
‑1F
kT
+Q
k
[0023]其中，为第k+1次迭代的后验状态向量，P
k
为第k时刻的后验估计协方差矩阵；
[0024]2.4)根据观测计算卡尔曼增益K
k
：
[0025][0026]2.5)应用观测值修正预测值，并将其中的状态修正值作为滤波的输出并作为下一次迭代的输入进行下一次迭代：
[0027][0028]P
k'
＝(I
‑
K
k
H)P
k
[0029]其中，为第k+1次迭代的后验状态向量，z
k
为第k次迭代的观测向量，由传感器给出，P
k'
为第k时刻的后验估计协方差矩阵。
[0030]3)运动控制：根据实时的目标点位计算出机器人应当发给底层控制的线速度v和角速度ω，直到车成功到终点，具体方法如下：
[0031]3.1)根据机器人距离目标沿线的横向误差计算跟随距离；
[0032]l
d
＝|y
rg
|+l
control
[0033]其中，I
d
为前视距离，y
rg
为目标点在世界坐标系下的y坐标，l
control
为调整参数，通过调整l
control
以控制跟随的效果；
[0034]3.2)根据跟随距离计算出机器人中心点与追踪点之间的连线在世界坐标系下的朝向δ；
[0035][0036]3.3)根据δ和机器人在世界坐标系下的朝向θ
wr
计算出机器人中心点与追踪点之间的连线与机器人朝向之间的夹角β；
[0037]β＝δ+θ
wr
[0038]3.4)根据β计算出车的控制点的速度朝向，使得当控制点朝着此方向前进一段时
间后，机器人的中心带刚好经过预瞄点，即机器人最前方或者最后方的正中心点；
[0039][0040]其中，θ为机器人控制点的速度的朝向在机器人坐标系下的表示，l为控制点距离中心的长度，v为车中心点在世界坐标系下的速度，k
control
为控制强度；
[0041]3.5)在得到θ后根据几何关系计算出车的角速度ω，旋转半径R，然后计算中心点速度v：
[0042][0043][0044]v＝ωR
[0045]其中，v
c
为控制点在世界坐标系下的速度。
[0046]本专利技术有益效果在于：
[0047]1.本专利技术提出了一种新的运动控制方法可以弥补全局定位不足而导致的导航对桩不精准，从而降低了对做全局定位的传感器的精度要求。
[0048]2.基于本方法可以在看不到特征的时候依然保持正确的行进方向。
[0049]3.本方法的运动控制可以兼容前进和后退两种运动方式。
[0050]4.本方法兼备了运动方式的简洁，运动高精度以及运动对空间的低要求。
附图说明
[0051]为了更清楚地说明本专利技术实施例中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图。
[0052]图1为回充功能控制系统结构简图；
[0053]图2为回充功能控制系统控制流程图；
[0054]图3为滤波流程图；
[0055]图4(a)为根据跟随距离计算出机器人中心点与追踪点之间的连线在世界坐标系下的朝向δ示意图；
[0056]图4(b)为根据δ和机器人在世界坐标系下的朝向θ
wr
计算出机器人中心点与追踪点之间的连线与机器人朝向之间的夹角β示意图；
[0057]图4(c)为根据β计算出车的控制点的速度朝向示意图。
具体实施方式
[0058]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种高精度差分车回充功能控制方法，其特征在于包括以下步骤：1)识别：识别出终点坐标在世界坐标系下的坐标；2)滤波：对步骤1)识别到的坐标进行滤波处理，消除误差；3)运动控制：根据实时的目标点位计算出机器人应当发给底层控制的线速度v和角速度ω，直到车成功到终点，具体方法如下：3.1)根据机器人距离目标沿线的横向误差计算跟随距离；l
d
＝|y
rg
|+l
control
其中，l
d
为前视距离，y
rg
为目标点在世界坐标系下的y坐标，l
control
为调整参数，通过调整l
control
以控制跟随的效果；3.2)根据跟随距离计算出机器人中心点与追踪点之间的连线在世界坐标系下的朝向δ；3.3)根据δ和机器人在世界坐标系下的朝向θ
wr
计算出机器人中心点与追踪点之间的连线与机器人朝向之间的夹角β；β＝δ+θ
wr
3.4)根据β计算出车的控制点的速度朝向，使得当控制点朝着此方向前进一段时间后，机器人的中心带刚好经过预瞄点，即机器人最前方或者最后方的正中心点；其中，θ为机器人控制点的速度的朝向在机器人坐标系下的表示，l为控制点距离中心的长度，v为车中心点在世界坐标系下的速度，k
control
为控制强度；3.5)在得到θ后根据几何关系计算出车的角速度ω，旋转半径R，然后计算中心点速度v：v：v＝ωR其中，v
c
为控制点在世界坐标系下的速度。2.根据权利要求1所述的高精度差分车回充功能控制方法，其特征在于：步骤2)所述滤波过程参照扩展卡尔曼滤波，具体有以下几个步骤：2.1)建立第k次迭代的先验状态向量第k次迭代的输...

【专利技术属性】
技术研发人员：张鸿博，
申请(专利权)人：深圳亿嘉和科技研发有限公司，
类型：发明
国别省市：