CN106272433B - 自主移动机器人的轨迹定位***及方法 - Google Patents
自主移动机器人的轨迹定位***及方法 Download PDFInfo
- Publication number
- CN106272433B CN106272433B CN201610860722.3A CN201610860722A CN106272433B CN 106272433 B CN106272433 B CN 106272433B CN 201610860722 A CN201610860722 A CN 201610860722A CN 106272433 B CN106272433 B CN 106272433B
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- autonomous mobile
- angle
- omni
- omnidirectional
- 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
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/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
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40519—Motion, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明实施例公开了一种自主移动机器人的轨迹定位***及方法。所述***包括:倾角传感器,用于测量所述自主移动机器人的航向角;全向轮编码器,用于测量所述自主移动机器人的位移量,并且所述全向轮的设置方向与所述自主移动机器人的行进方向之间呈预设夹角;处理器,用于通过将所述位置与目标位置进行比较,得到对应的位置增量,以及根据所述位置增量驱动电动机进行经过补偿的位置移动;电动机,用于在所述处理器的驱动下进行经过补偿的位置移动。本发明实施例提供的自主移动机器人的轨迹定位***及方法显著提高了自主移动机器人的运动精度。
Description
技术领域
本发明实施例涉及机器人技术领域,尤其涉及一种自主移动机器人的轨迹定位***及方法。
背景技术
在工业制造中,机器人已经取得了许多重大的成果,譬如机械臂在汽车、电子工业和医疗行业中有着成功的应用。但这些商用机器人存在着一个根本的缺点:缺少机动性。固定的机械臂其运动范围是有限的,相反自主移动机器人能够灵活地穿梭于整个作业区域。
对于自主移动机器人而言,精确地定位和轨迹控制是提高其作业性能的关键。自主移动机器人在受到外界扰动、摩擦和路面不平整等因素的影响下,会偏离原规划的路径,为此需要实时对自主移动机器人进行定位和纠偏。
发明内容
针对上述技术问题,本发明实施例提供了一种自主移动机器人的轨迹定位***及方法,以提高自主移动机器人的运动精度。
一方面,本发明实施例提供了一种自主移动机器人的轨迹定位***,所述***包括:
倾角传感器,设置在所述自主移动机器人的前端面上,用于测量所述自主移动机器人的航向角;
全向轮编码器,一个增量编码器与设置在底面上的全向轮关联,组成一个全向轮编码器,用于测量所述自主移动机器人的位移量,并且所述全向轮的设置方向与所述自主移动机器人的行进方向之间呈预设夹角;
处理器,与所述倾角传感器及所述全向轮编码器电连接,用于根据所述倾角传感器测量得到的航向角,以及所述全向轮编码器测量得到的位移量,确定所述自主移动机器人当前的位置,并通过将所述位置与目标位置进行比较,根据运动控制模型得到对应的位置增量,以及根据所述位置增量驱动电动机进行经过补偿的位置移动;
电动机,用于在所述处理器的驱动下进行经过补偿的位置移动。
另一方面,本发明实施例还提供了一种自主移动机器人的轨迹定位方法,所述方法包括:
根据两个分别与所述自主移动机器人的行进方向呈预定夹角θ1,θ2布置的全向轮编码的读数ΔU1,ΔU2,确定所述自主移动机器人的位置x,y,同时根据倾角传感器的读数确定所述自主移动机器人的航向角θ;
将所述自主移动机器人的当前位置(x,y,θ)与理想位置(xγ,yγ,θγ)进行比较,得到所述自主移动机器人的轨迹偏差(Δx,Δy,Δθ);
基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,对所述轨迹偏差(Δx,Δy,Δθ)进行补偿。
本发明实施例提供的自主移动机器人的轨迹定位***及方法,通过与机器人的行进方向呈一定角度的设置全向轮,针对该全向轮设置用于测距的全向轮编码器,以及设置用于测量航向角的倾角传感器,在利用与上述全向轮编码器及倾角传感器分别电连接的处理器,使得处理器能够根据上述全向轮编码器输出的读数及所述倾角传感器,利用预定的运动控制模型输出的倾角估计位移补偿量,明显了提高了自主移动机器人的运动精度。
附图说明
通过阅读参照以下附图所作的对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1是本发明第一实施例提供的自主移动机器人的轨迹定位***的结构图;
图2是本发明第一实施例提供的全向轮的布置方位的示意图;
图3A是本发明第一实施例提供的X轴定位精度的对比图;
图3B是本发明第一实施例提供的Y轴定位精度的对比图;
图4是本发明第一实施例提供的自主移动机器人的运动精度的对比图;
图5是本发明第二实施例提供的自主移动机器人的轨迹定位方法的流程图;
图6是本发明第三实施例提供的自主移动机器人的轨迹定位方法中参数确定操作的流程图;
图7是本发明第四实施例提供的自主移动机器人的轨迹定位方法中补偿操作的流程图;
图8是本发明第四实施例提供的全局坐标系与局部坐标系之间的关系示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
第一实施例
本实施例提供了自主移动机器人的轨迹定位***的一种技术方案。在该技术方案中,所述自主移动机器人的轨迹定位***包括:倾角传感器11、全向轮编码器12、处理器13,以及电动机14。
参见图1,所述倾角传感器11用于测量所述自主移动机器人的航向角。具体的,所述倾角传感器11直接测量得到的物理量是所述自主移动机器人的动态横滚角和俯仰角。根据所述倾角传感器11测量得到所述动态横滚角及俯仰角,与所述倾角传感器11直接电连接的所述处理器13能够直接确定所述自主移动机器人的航向角。
优选的,所述倾角传感器11设置在所述自主移动机器人的前端面上。
所述全向轮编码器12与设置在所述自主移动机器人的底面上的全向轮关联。在所述自主移动机器人的底面上设置的全向轮的数量是两个,因此,所述自主移动机器人所包含的全向轮编码器12的数量也是两个。所述全向轮编码器的作用在于测量所述自主移动机器人的位移量。
为了提高所述自主移动机器人的定位精度,所述全向轮以一种特殊的方式被设置在所述自主移动机器人的底面上。图2示出了这种特殊的设置方式。参见图2,在所述自主移动机器人的底面上设置有驱动轮(后轮)21、万向轮(前轮)24以及全向轮22。并且在所述全向轮上还关联设置有全向轮编码器23。所述全向轮22的设置方向与所述自主移动机器人的行进方向之间呈一定的夹角。并且,上述夹角的取值大于0°,小于90°。也就是说,所述全向轮22的设置方向与所述自主移动机器人的行进方向之间呈锐角夹角。换言之,所述全向轮22不再像以往的设置方式那样,与机器人的行进方向平行或者垂直设置。
由于所述全向轮能够沿两个自由度方向滚动,因此上述呈一定角度的全向轮设置方式不会阻碍所述自主移动机器人的移动。而且,优选的,所述全向轮编码器是增量编码器。
另外,在上述的图2中,B表示两个全向轮编码器之间距离的一半,L表示全向轮编码器轴线到机器人驱动轮轴线的距离。
所述处理器13分别与所述倾角传感器11及所述全向轮编码器12电连接。所述处理器13根据所述倾角传感器11测量到的动态横滚角及俯仰角,以及所述全向轮编码器12测量得到的位移量,计算当前所述自主移动机器人的位置增量,也即对所述自主移动机器人进行定位。进一步的,所述处理器13还将计算得到的所述自主移动机器人当前所在的位置与目标位置进行比较,以得到相应的位置补偿量。
更为具体的,沿x轴及沿y轴的位置增量可以通过如下公式给出:
其中,θ1为第一全向轮的设置方向与所述行进方向之间的夹角,θ2为第二全向轮的设置方向与所述行进方向之间的夹角,L为全向轮编码器轴线到机器人驱动轮轴线的距离,B为两个全向轮编码器之间距离的一半,ΔU1为第一全向轮编码器的读数增量,ΔU2为第二全向轮编码器的读数增量,δx为机器人在预定平面直角坐标系的x轴方向上的位置增量,δy为机器人在所述预定平面直角坐标系的y轴方向上的位置增量,δθ为机器人的航向角增量。具体的,上述θ1及θ2的取值都是45°。
在确定了位置增量之后,将所述自主移动机器人所在的位置与目标位置进行比较,以根据给定的运动控制模型确定位置补偿量。而且,所述运动控制模型根据李雅普诺夫稳定判据判定为一致稳定。也就是说,根据所述运动控制模型确定的轨迹误差趋向于收敛。
具体的,在确定了位置增量之后,利用如下公式计算切向误差et、径向误差en,以及角度误差eθ:
其中,θ为所述自主移动机器人的航向角。
确定了上述误差向量之后,根据如下运动控制模型确定电动机的速度及角速度:
其中,vr和ωr为理想的速度和角速度,v和ω为实际修正的速度和角速度。
在将所述全向轮22与所述自主移动机器人的行进方向呈一定角度设置之后,根据本实施例提供的公式计算得到的x轴方向的位置增量及y轴方向的位置增量的数据精度都大大提高。图3A及图3B分别示出的在全向轮的不同设置方式下,x轴方向的位置增量的比较图,以及y轴方向的位置增量的比较图。在采集图3A及图3B示出的数据的试验中,将所述自主移动机器人所述自主移动机器人以300mm/s向上运动3.5米,然后后退返回起始位置。在设置方式一中,所述自主移动机器人的两个全向轮与该机器人的运行方向平行设置,而在设置方式二下,所述自主移动机器人的两个全向轮分别与机器人的运行方向呈45°夹角设置。由图3A及图3B可以明显看出,将所述全向轮呈一定角度设置之后,计算得到的x轴方向及y轴方向上的位置增量的数据精度较高。
所述电动机14与所述处理器13电连接,用于根据所述处理器13输出的驱动信号驱动所述自主移动机器人进行补偿位移。更为具体的,所述电动机14用于根据所述驱动信号中包含的位置补偿量进行补偿位移,以便对之前的位移误差进行补偿。
在将全向轮与所述自主移动机器人的行进方向呈一定角度设置之后,计算得到的位置增量对外界扰动、摩擦和路面不平整等因素的影响较为鲁棒,而且由于对机器人的位置误差进行了补偿,因而能够大幅提高自主移动机器人的运动精度。参见图4,在对位置误差进行补偿之后,所述自主移动机器人的位置误差大幅降低。
本实施例通过倾角传感器测量航向角,通过全向轮编码器测量距离,根据上述航向角及距离对所述自主移动机器人进行定位,并且根据所述自主移动机器人当前的位置与目标位置之间的差异进行位置补偿,从而大大提高了自主移动机器人的运动精度。
第二实施例
本实施例提供了自主移动机器人的轨迹定位方法的一种技术方案。在该技术方案中,所述自主移动机器人的轨迹定位方法包括:根据两个分别与所述自主移动机器人的行进方向呈预定夹角θ1,θ2布置的全向轮编码的读数ΔU1,ΔU2,确定所述自主移动机器人的位置x,y,同时根据倾角传感器的读数确定所述自主移动机器人的航向角θ;将所述自主移动机器人的当前位置(x,y,θ)与理想位置(xγ,yγ,θγ)进行比较,得到所述自主移动机器人的轨迹偏差(Δx,Δy,Δθ);基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,对所述轨迹偏差(Δx,Δy,Δθ)进行补偿。
参见图5,所述自主移动机器人的轨迹定位方法包括:
S51,根据两个分别与所述自主移动机器人的行进方向呈预定夹角θ1,θ2布置的全向轮编码的读数ΔU1,ΔU2,确定所述自主移动机器人的位置x,y,同时根据倾角传感器的读数确定所述自主移动机器人的航向角θ。
在获取到所述全向轮编码器的读数ΔU1及ΔU2,以及获取到所述倾角传感器采集到的航向角θ之后,首先根据如下公式计算所述自主移动机器人在时间段Δt内的位置增量δx,δy:
其中,θ1为第一全向轮的设置方向与所述行进方向之间的夹角,θ2为第二全向轮的设置方向与所述行进方向之间的夹角,L为全向轮编码器轴线到机器人驱动轮轴线的距离,B为两个全向轮编码器之间距离的一半,ΔU1为第一全向轮编码器的读数增量,ΔU2为第二全向轮编码器的读数增量,δx为机器人在预定平面直角坐标系的x轴方向上的位置增量,δy为机器人在所述预定平面直角坐标系的y轴方向上的位置增量,δθ为机器人的航向角增量。
在确定了时间段Δt内的位置增量δx,δy之后,通过对上述位置增量的积分获得所述自主移动机器人的当前位置x,y。
S52,将所述自主移动机器人的当前位置(x,y,θ)与理想位置(xγ,yγ,θγ)进行比较,得到所述自主移动机器人的轨迹偏差(Δx,Δy,Δθ)。
具体的,根据如下几个公式计算所述自主移动机器人的轨迹偏差:
Δx=xr-x
Δy=yr-y
Δθ=θr-θ
进而得到自主移动机器人在局部坐标系下的切向、径向和角度误差:
S53,基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型如下,对所述轨迹偏差(Δx,Δy,Δθ)进行补偿。
其中,vr和ωr为理想的速度与角速度,v和ω为实际修正后的速度与角速度。
基于该运动控制模型,令k1=k3=2ζa且k2=(a2-ω2)/vr,可以得到如下线性化误差的动态方程:
则矩阵A(t)的特征方程可以写为:
p(λ)=(λ+2ζa)(λ2+2ζaλ+a2)
取a和为正值,则特征方程的根均具有负实部,根据李雅普诺夫稳定判据,该控制方法是渐进稳定的。
具体的,根据所述运动控制模型,基于所述轨迹偏差修正实际向自主移动机器人下发的速度与角速度,最后重新计算左右轮的转速并下发给电动机。
本实施例通过根据两个分别与所述自主移动机器人的行进方向呈预定夹角布置的全向轮编码的读数,确定所述自主移动机器人的位置,同时根据倾角传感器的读数确定所述自主移动机器人的航向角,将所述自主移动机器人的当前位置与理想位置进行比较,得到所述自主移动机器人的轨迹偏差,以及基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,对所述轨迹偏差进行补偿,明显了提高了自主移动机器人的运动精度。
第三实施例
本实施例以本发明上述实施例为基础,进一步的提供了所述自主移动机器人的轨迹定位方法中参数确定操作的一种技术方案。在该技术方案中,根据两个分别与所述自主移动机器人的行进方向呈预定夹角θ1,θ2布置的全向轮编码的读数ΔU1,ΔU2,确定所述自主移动机器人的位置x,y,同时根据倾角传感器的读数确定所述自主移动机器人的航向角θ包括:对所述自主移动机器人建立平面直角坐标系;实时读取两个所述全向轮编码器以及所述倾角传感器在时间段Δt内的数值增量,分别记录为ΔU1,ΔU2及δθ;根据所述全向轮编码器的读数,计算所述自主移动机器人在时间段Δt内在所述平面直角坐标系的X轴及Y轴上分别的位置增量δx,δy;通过对所述位置增量δx,δy的积分,得到所述自主移动机器人的当前位置x,y,同时根据所述倾角传感器的读数确定所述自主移动机器人当前的航向角θ。
参见图6,根据两个分别与所述自主移动机器人的行进方向呈预定夹角布置的全向轮编码的读数,确定所述自主移动机器人的位置,同时根据倾角传感器的读数确定所述自主移动机器人的航向角包括:
S61,对所述自主移动机器人建立平面直角坐标系。
尽管所述自主移动机器人所在的运动平面有时会出现不平整的情况,但是,其大致上的形状呈平整的平面。为了能够准确的描述所述自主移动机器人的位置,针对所述运动平面,预先建立一个平面直角坐标系。在建立了上述平面直角坐标系之后,所述自主移动机器人的位置就可以用所述平面直角坐标系内的位置点进行准确的描述。
S62,实时读取两个所述全向轮编码器以及所述倾角传感器在时间段Δt内的数值增量,分别记录为ΔU1,ΔU2及δθ。
其中,ΔU1是两个全向轮编码器中的第一全向轮编码器输出的位置增量,而ΔU2则是第二全向轮编码器输出的位置增量。δθ是所述倾角传感器输出的角度数值的增量。
S63,根据所述全向轮编码器的读数,计算所述自主移动机器人在时间段Δt内在所述平面直角坐标系的x轴及y轴上分别的位置增量δx,δy。
具体的,根据如下公式计算所述自主移动机器人在x轴及y轴上分别的位置增量δx,δy:
其中,θ1为第一全向轮的设置方向与所述行进方向之间的夹角,θ2为第二全向轮的设置方向与所述行进方向之间的夹角,L为全向轮编码器轴线到机器人驱动轮轴线的距离,B为两个全向轮编码器之间距离的一半,ΔU1为第一全向轮编码器的读数增量,ΔU2为第二全向轮编码器的读数增量,δx为机器人在预定平面直角坐标系的x轴方向上的位置增量,δy为机器人在所述预定平面直角坐标系的y轴方向上的位置增量,δθ为机器人的航向角增量。
S64,通过对所述位置增量δx,δy的积分,得到所述自主移动机器人的当前位置x,y,同时根据所述倾角传感器的读数确定所述自主移动机器人当前的航向角θ。
本实施例通过对所述自主移动机器人建立平面直角坐标系,实时读取两个所述全向轮编码器以及所述倾角传感器在时间段Δt内的数值增量,根据所述全向轮编码器的读数,计算所述自主移动机器人在时间段Δt内在所述平面直角坐标系的x轴及y轴上分别的位置增量,通过对所述位置增量的积分,得到所述自主移动机器人的当前位置,同时根据所述倾角传感器的读数确定所述自主移动机器人当前的航向角,实现了对所述自主移动机器人的定位。
第四实施例
本实施例以本发明上述实施例为基础,进一步的提供了所述自主移动机器人的轨迹定位方法中补偿操作的一种技术方案。在该技术方案中,基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,对所述轨迹偏差进行补偿包括:将所述自主移动机器人在全局坐标系下的轨迹误差转换到所述自主移动机器人的局部坐标系下,得到切向误差、法向误差以及角度误差;基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,修正实际向所述自主移动机器人下发的速度和角速度;按照所述运动控制模型执行运动命令,重新计算左右驱动轮的转速并下发给电动机。
参见图7,基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,对所述轨迹偏差进行补偿包括:
S71,将所述自主移动机器人在全局坐标系下的轨迹误差转换到所述自主移动机器人的局部坐标系下,得到切向误差、法向误差以及角度误差。
图8示出了全局坐标系(xG,yG)与局部坐标系(xR,yR)之间的位置关系。参见图8,所述全局坐标系是在所述自主移动机器人的运动平面上建立的平面直角坐标系。该坐标系的原点定位并不依据所述自主移动机器人的位置而改变。所述局部坐标虽然也是在所述运动平面上建立的平面直角坐标系,但是其坐标原点是所述自主移动机器人上的固定位置点,而且其xR轴的指向以所述自主移动机器人的运行方向为准。
由于要依据在所述全局坐标系下计算得到的轨迹误差,对所述自主移动机器人进行下一步的动作控制,需要将上述绝对的轨迹误差转换为能够直接用于对所述自主移动机器人进行控制的控制量,因此,需要将所述轨迹误差转换至所述局部坐标系下。在上述转换中,除了对原始的坐标取值进行平移之外,还需要对坐标值进行进一步的旋转。
S72,基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,修正实际向所述自主移动机器人下发的速度和角速度。
具体的,所述运动控制模型具有如下形式:
其中,vr和ωr为理想的速度和角速度,v和ω为实际修正的速度和角速度,et、en、eθ分别表示切向误差、径向误差,以及角度误差。
S73,按照所述运动控制模型执行运动命令,重新计算左右驱动轮的转速并下发给电动机。
修正了速度和角速度之后,可以依据修正后的速度和角速度,计算左驱动轮及右驱动轮的转速,再依据重新计算的转速驱动电动机,使所述自主移动机器人依据修正后的速度和角速度进行位置移动。
本实施例通过将所述自主移动机器人在全局坐标系下的轨迹误差转换到所述自主移动机器人的局部坐标系下,得到切向误差、法向误差以及角度误差,基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,修正实际向所述自主移动机器人下发的速度和角速度,以及按照所述运动控制模型执行运动命令,重新计算左右驱动轮的转速并下发给电动机,实现了自主移动机器人的经过补偿的位置移动,显著的提高了机器人的运动精度。
以上所述仅为本发明的优选实施例,并不用于限制本发明,对于本领域技术人员而言,本发明可以有各种改动和变化。凡在本发明的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种自主移动机器人的轨迹定位***,其特征在于,包括:
倾角传感器,设置在所述自主移动机器人的前端面上,用于测量所述自主移动机器人的航向角;
全向轮编码器,一个增量编码器与设置在底面上的全向轮相关联,组成一个全向轮编码器,用于测量所述自主移动机器人的位移量,并且所述全向轮的设置方向与所述自主移动机器人的行进方向之间呈预设夹角;
处理器,与所述倾角传感器及所述全向轮编码器电连接,用于根据所述倾角传感器测量得到的航向角,以及所述全向轮编码器测量得到的位移量,确定所述自主移动机器人当前的位置,并通过将所述位置与目标位置进行比较,根据运动控制模型得到对应的位置补偿量,以及根据所述位置补偿量驱动电动机进行经过补偿的位置移动;
电动机,用于在所述处理器的驱动下进行经过补偿的位置移动;
所述全向轮编码器包括:两个分别独立设置的全向轮编码器;
所述全向轮编码器包括:增量编码器和全向轮;
所述运动控制模型由如下公式给出:
其中,vr和ωr为理想的速度和角速度,v和ω为实际修正的速度和角速度,et为切向误差,en为径向误差,eθ为角度误差;
沿x轴及沿y轴的位置增量可以通过如下公式给出:
θ1为第一全向轮的设置方向与所述行进方向之间的夹角,θ2为第二全向轮的设置方向与所述行进方向之间的夹角,L为全向轮编码器轴线到机器人驱动轮轴线的距离,B为两个全向轮编码器之间距离的一半,ΔU1为第一全向轮编码器的读数增量,ΔU2为第二全向轮编码器的读数增量,δx为机器人在预定平面直角坐标系的x轴方向上的位置增量,δy为机器人在所述预定平面直角坐标系的y轴方向上的位置增量,δθ为机器人的航向角增量。
2.根据权利要求1所述的***,其特征在于,所述倾角传感器采用惯性导航技术测量所述自主移动机器人的动态横滚角和俯仰角,通过合理地安装,将倾角传感器的横滚角转化为所述自主移动机器人的航向角。
3.根据权利要求1所述的***,其特征在于,所述预设夹角的取值大于0°,小于90°。
4.一种自主移动机器人的轨迹定位方法,其特征在于,包括:
对所述自主移动机器人建立平面直角坐标系;
实时读取两个分别与所述自主移动机器人的行进方向呈预定夹角θ1,θ2布置的全向轮编码器以及倾角传感器在时间段Δt内的数值增量,分别记录为ΔU1,ΔU2及δθ;
根据所述全向轮编码器的读数,计算所述自主移动机器人在时间段Δt内在所述平面直角坐标系的x轴及y轴上分别的位置增量δx,δy;
通过对所述位置增量δx,δy的积分,得到所述自主移动机器人的当前位置x,y,同时根据所述倾角传感器的读数确定所述自主移动机器人当前的航向角θ;
将所述自主移动机器人的当前位置(x,y,θ)与理想位置(xγ,yγ,θγ)进行比较,得到所述自主移动机器人的轨迹偏差(Δx,Δy,Δθ);
基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,对所述轨迹偏差(Δx,Δy,Δθ)进行补偿。
5.根据权利要求4所述的方法,其特征在于,基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,对所述轨迹偏差进行补偿包括:
将所述自主移动机器人在全局坐标系下的轨迹误差转换到所述自主移动机器人的局部坐标系下,得到切向误差、法向误差以及角度误差;
基于李雅普诺夫稳定判据,建立使轨迹误差收敛的运动控制模型,修正实际向所述自主移动机器人下发的速度和角速度;
按照所述运动控制模型执行运动命令,重新计算左右驱动轮的转速并下发给电动机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610860722.3A CN106272433B (zh) | 2016-09-28 | 2016-09-28 | 自主移动机器人的轨迹定位***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610860722.3A CN106272433B (zh) | 2016-09-28 | 2016-09-28 | 自主移动机器人的轨迹定位***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106272433A CN106272433A (zh) | 2017-01-04 |
CN106272433B true CN106272433B (zh) | 2019-03-26 |
Family
ID=57715674
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610860722.3A Active CN106272433B (zh) | 2016-09-28 | 2016-09-28 | 自主移动机器人的轨迹定位***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106272433B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107656500B (zh) * | 2017-10-16 | 2019-11-12 | 广东智爱机器人科技有限公司 | 基于数值加速度控制的全方位移动机器人轨迹跟踪方法 |
CN109974746B (zh) * | 2017-12-27 | 2020-11-24 | 深圳市优必选科技有限公司 | 全向轮里程校准方法及机器人 |
CN108469626A (zh) * | 2018-02-09 | 2018-08-31 | 山东四维卓识信息技术有限公司 | 一种填筑压实机械数字化施工精准定位导航方法 |
CN110231816A (zh) * | 2018-03-05 | 2019-09-13 | 中南大学 | 控制机器人行走的方法、装置、机器人和存储介质 |
CN108501976B (zh) * | 2018-03-29 | 2020-02-14 | 西安科技大学 | 一种单轨道移动机器人的自主平稳制动***及制动方法 |
CN110793421A (zh) * | 2019-11-14 | 2020-02-14 | 珠海丽亭智能科技有限公司 | 一种可变长机器人拉伸长度测量装置 |
CN113305838B (zh) * | 2021-05-26 | 2022-04-29 | 深圳市优必选科技股份有限公司 | 按摩运动控制方法、装置、机器人控制设备及存储介质 |
CN114035540B (zh) * | 2021-10-26 | 2024-03-22 | 嘉兴市敏硕智能科技有限公司 | 全向移动平台误差自校准方法、***、装置及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1499324A (zh) * | 2002-11-06 | 2004-05-26 | 中国科学院自动化研究所 | 一种机器人位置和姿态的推算定位方法及装置 |
CN101612733A (zh) * | 2008-06-25 | 2009-12-30 | 中国科学院自动化研究所 | 一种分布式多传感器移动机器人*** |
CN102083352A (zh) * | 2008-04-24 | 2011-06-01 | 进展机器人有限公司 | 用于机器人使能的移动产品的定位、位置控制和导航***的应用 |
CN102596517A (zh) * | 2009-07-28 | 2012-07-18 | 悠进机器人股份公司 | 移动机器人定位和导航控制方法及使用该方法的移动机器人 |
CN204844150U (zh) * | 2015-07-17 | 2015-12-09 | 徐州工业职业技术学院 | 一种自动精确定位移动机器人 |
CN105300378A (zh) * | 2015-09-17 | 2016-02-03 | 哈尔滨工程大学 | 一种室内移动机器人导航定位方法 |
CN205396265U (zh) * | 2016-03-11 | 2016-07-27 | 中科新松有限公司 | 用于高空作业设备的安全防护装置及爬壁机器人 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9504367B2 (en) * | 2013-11-20 | 2016-11-29 | Samsung Electronics Co., Ltd. | Cleaning robot and method for controlling the same |
-
2016
- 2016-09-28 CN CN201610860722.3A patent/CN106272433B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1499324A (zh) * | 2002-11-06 | 2004-05-26 | 中国科学院自动化研究所 | 一种机器人位置和姿态的推算定位方法及装置 |
CN102083352A (zh) * | 2008-04-24 | 2011-06-01 | 进展机器人有限公司 | 用于机器人使能的移动产品的定位、位置控制和导航***的应用 |
CN101612733A (zh) * | 2008-06-25 | 2009-12-30 | 中国科学院自动化研究所 | 一种分布式多传感器移动机器人*** |
CN102596517A (zh) * | 2009-07-28 | 2012-07-18 | 悠进机器人股份公司 | 移动机器人定位和导航控制方法及使用该方法的移动机器人 |
CN204844150U (zh) * | 2015-07-17 | 2015-12-09 | 徐州工业职业技术学院 | 一种自动精确定位移动机器人 |
CN105300378A (zh) * | 2015-09-17 | 2016-02-03 | 哈尔滨工程大学 | 一种室内移动机器人导航定位方法 |
CN205396265U (zh) * | 2016-03-11 | 2016-07-27 | 中科新松有限公司 | 用于高空作业设备的安全防护装置及爬壁机器人 |
Also Published As
Publication number | Publication date |
---|---|
CN106272433A (zh) | 2017-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106272433B (zh) | 自主移动机器人的轨迹定位***及方法 | |
CN108534679B (zh) | 一种筒形件轴线位姿的无靶标自动测量装置及方法 | |
CN106289327B (zh) | 一种差分移动机器人里程计标定方法 | |
CN108917604B (zh) | 一种法向测量装置及其标定方法 | |
CN106382934A (zh) | 一种高精度移动机器人定位***和方法 | |
CN108393929A (zh) | 一种机械手臂位置精度测量装置及方法 | |
CN104390612A (zh) | 用于Stewart平台构型的六自由度并联机器人基准位姿标定方法 | |
CN103968790A (zh) | 测量装置的可变建模 | |
CN205981099U (zh) | 一种用于工件非接触移动测量的测量小车 | |
CN105277129A (zh) | 一种动态非接触轨道轨距测量***及其方法 | |
CN102126162A (zh) | 一种数控机床加工在线测量方法 | |
CN106493725A (zh) | 一种基于全向从动轮和编码器的工业机器人定位装置 | |
CN103727939A (zh) | 一种双轴旋转的姿态测量***及其测量方法 | |
CN105928946B (zh) | 检测设备的补偿方法 | |
CN105572679A (zh) | 一种二维扫描型激光雷达的扫描数据修正方法及*** | |
CN105737735A (zh) | 便携式自校准末端执行器重复定位精度测量装置及方法 | |
CN105648860A (zh) | 城市轨道交通用轨道板的测量调整***及其测量调整方法 | |
CN103837115B (zh) | 三维姿态测算方法及装置 | |
CN104597846B (zh) | 一种多轴联动管道插补全闭环运动控制方法 | |
KR101103906B1 (ko) | 홀 센서를 이용한 모바일 로봇의 위치 오차 추정 및 보정 방법 | |
CN111174696A (zh) | 一种基于ccd传感器的激光辅助校准方法及装置 | |
CN106949908A (zh) | 一种高精度空间运动轨迹姿态追踪测量修正方法 | |
CN108073163B (zh) | 利用二维码反馈值补偿确定机器人精确位置的控制方法 | |
US20220288731A1 (en) | Linkage turntable and decoupling control method thereof | |
CN103594398B (zh) | 一种用于多自由度倒装键合过程的芯片控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230315 Address after: Room 126, 750 Zhubai Road, Nanhui new town, Pudong New Area, Shanghai, 201306 Patentee after: SHANGHAI XINSONG ROBOT CO.,LTD. Address before: Room 101, West, building 11, 351 jinzang Road, Pudong New Area, Shanghai, 201206 Patentee before: SIASUN Co.,Ltd. |