可移动装置的控制方法及系统与流程

文档序号:12732222阅读:来源:国知局

技术特征:

1.一种可移动装置的控制方法,用于控制所述可移动装置在第一位置和第二位置之间的运动,包括:

确定可移动装置的中心的位置,所述中心到可移动装置的左轮和右轮的距离相等;

根据所述可移动装置的中心的位置、所述第一位置和所述第二位置的位置,确定所述可移动装置的行走路径;

根据所述行走路径、所述可移动装置的中心速度和所述可移动装置的几何数据,确定所述可移动装置的左轮速度和右轮速度与所述中心速度之间的差值,所述中心速度是所述可移动装置的中心的运动速度;以及

根据所述左轮速度和右轮速度与所述中心速度之间的差值,确定所述可移动装置的左轮速度和右轮速度;以及

根据所述左轮速度和右轮速度对所述可移动装置的运动进行控制。

2.根据权利要求1所述的方法,其中,确定可移动装置的中心的位置包括:

根据通过所述可移动装置上的图像获取单元获取的所述第一位置处布置的图片的图像,确定所述可移动装置的中心相对于所述第一位置的位置。

3.根据权利要求2所述的方法,其中,所述图片包括二维码,不同位置处的二维码是不同的。

4.根据权利要求1所述的方法,其中:

所述可移动装置的中心的位置、所述第一位置和所述第二位置的连线平行于所述可移动装置的运动平面;以及

根据所述可移动装置的中心的位置、所述第一位置和所述第二位置,确定所述可移动装置的行走路径包括:

根据所述第一位置和所述第二位置建立坐标系;

确定所述中心的位置和所述第二位置在所述坐标系中的坐标;以及

采用插值算法在所述中心的位置和所述第二位置之间进行曲线拟合,所得到的曲线即为所述行走路径。

5.根据权利要求4所述的方法,其中,根据所述第一位置和所述第二位置建立坐标系包括:

以所述第一位置为坐标系原点;

以所述第一位置和所述第二位置之间的连线作为横轴;以及

以经过所述原点并垂直于所述横轴的轴线作为纵轴。

6.根据权利要求4所述的方法,其中,所述插值算法包括以下中的任意一种:三次Hermite插值算法、Lagrange插值算法、Newton插值算法或分段插值算法。

7.根据权利要求1所述的方法,其中,根据所述行走路径、所述可移动装置的中心速度和所述可移动装置的几何数据确定所述可移动装置的左轮速度和右轮速度与所述中心速度之间的差值包括:

确定可移动装置的中心经过所述行走路径的弧线的旋转半径;

根据所述可移动装置的中心速度、所述弧线的旋转半径、以及所述可移动装置的左右轮间距,确定所述可移动装置的中心在经过所述弧线时的左轮速度和右轮速度与所述中心速度之间的差值。

8.根据权利要求7所述的方法,其中,确定所述弧线的旋转半径包括:

确定所述弧线的两个端点的坐标和导数;以及

根据所述弧线的两个端点的坐标和导数,确定所述弧线的旋转半径。

9.根据权利要求1所述的方法,其中,所述可移动装置包括机器人和自动驾驶车辆。

10.根据权利要求1所述的方法,其中,可移动装置的中心是以下任意之一:

位于可移动装置上;

位于可移动装置之外;

位于可移动装置的运动平面上;或者

可移动装置的左右轮触地点的连线中点。

11.一种可移动装置的控制系统,用于控制所述可移动装置在第一位置和第二位置之间的运动,包括:

中心确定模块,确定可移动装置的中心的位置,所述中心到可移动装置的左轮和右轮的距离相等;

路径确定模块,根据所述可移动装置的中心的位置、所述第一位置和所述第二位置的位置,确定所述可移动装置的行走路径;

速度差值确定模块,根据所述行走路径、所述可移动装置的中心速度和所述可移动装置的几何数据,确定所述可移动装置的左轮速度和右轮速度与所述中心速度之间的差值,所述中心速度是所述可移动装置的中心的运动速度;以及

左右轮速度确定模块,根据所述左轮速度和右轮速度与所述中心速度之间的差值,确定所述可移动装置的左轮速度和右轮速度;以及

运动控制模块,根据所述左轮速度和右轮速度对所述可移动装置的运动进行控制。

12.根据权利要求11所述的系统,其中,确定可移动装置的中心的位置包括:

根据通过所述可移动装置上的图像获取单元获取的所述第一位置处布置的图片的图像,确定所述可移动装置的中心相对于所述第一位置的位置。

13.根据权利要求12所述的系统,其中,所述图片包括二维码,不同位置处的二维码是不同的。

14.根据权利要求11所述的系统,其中:

所述可移动装置的中心的位置、所述第一位置和所述第二位置的连线平行于所述可移动装置的运动平面;以及

路径确定模块包括:

坐标系模块,根据所述第一位置和所述第二位置建立坐标系;

坐标确定模块,确定所述中心的位置和所述第二位置在所述坐标系中的坐标;以及

拟合模块,采用插值算法在所述中心的位置和所述第二位置之间进行曲线拟合,所得到的曲线即为所述行走路径。

15.根据权利要求14所述的系统,其中,根据所述第一位置和所述第二位置建立坐标系包括:

以所述第一位置为坐标系原点;

以所述第一位置和所述第二位置之间的连线作为横轴;以及

以经过所述原点并垂直于所述横轴的轴线作为纵轴。

16.根据权利要求14所述的系统,其中,所述插值算法包括以下中的任意一种:三次Hermite插值算法、Lagrange插值算法、Newton插值算法或分段插值算法。

17.根据权利要求11所述的系统,其中,速度差值确定模块包括:

旋转半径确定模块,确定可移动装置的中心经过所述行走路径的弧线的旋转半径;

差值计算模块,根据所述可移动装置的中心速度、所述弧线的旋转半径、以及所述可移动装置的左右轮间距,确定所述可移动装置的中心在经过所述弧线时的左轮速度和右轮速度与所述中心速度之间的差值。

18.根据权利要求17所述的系统,其中,确定所述弧线的旋转半径包括:

确定所述弧线的两个端点的坐标和导数;以及

根据所述弧线的两个端点的坐标和导数,确定所述弧线的旋转半径。

19.根据权利要求11所述的系统,其中,所述可移动装置包括机器人或自动驾驶车辆。

20.根据权利要求11所述的系统,其中,可移动装置的中心是以下任意之一:

位于可移动装置上;

位于可移动装置之外;

位于可移动装置的运动平面上;或者

可移动装置的左右轮触地点的连线中点。

21.一种可移动装置的控制系统,用于控制所述可移动装置在第一位置和第二位置之间的运动,包括:

处理器;以及

存储器,存储有可执行指令,所述指令在被处理器执行时,使得处理器执行根据权利要求1~10中任一项所述的方法。

22.一种可移动装置,包括根据权利要求11~21中任意一项所述的控制系统。

23.一种计算机可读存储介质,其上存储有用于执行根据权利要求1~10中任意一项所述的方法的指令。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1