一种运动控制方法及电子设备与流程

文档序号:11676842阅读:255来源:国知局
一种运动控制方法及电子设备与流程

本发明涉及自动巡航技术,尤其涉及一种适用于自动巡航中的运动控制方法及电子设备。



背景技术:

随着机器人智能化的发展,越来越多的机器人都具有自动巡航功能。自动巡航是指:按照预设策略规划巡航路径,然后,控制机器人按照规划的巡航路径进行移动。然而,这种巡航的前提是考虑到路径为空旷路径,并没有考虑到复杂的路况,例如某些复杂的角落或者某些地方具有障碍物等,机器人无法对障碍物进行躲避,这可能导致巡航失败甚至是损坏机器人。



技术实现要素:

为解决上述技术问题,本发明实施例提供了一种运动控制方法及电子设备。

本发明实施例提供的运动控制方法,包括:

监测第一车轮沿第一方向距离障碍体的第一距离,以及监测第二车轮沿所述第一方向距离障碍体的第二距离,其中,所述第一车轮和所述第二车轮设置于电子设备的两侧;

比较所述第一距离和所述第二距离的大小;

如果所述第一距离大于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向左转动;

如果所述第一距离小于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向右转动。

本发明实施例中,所述比较所述第一距离和所述第二距离的大小之前,所述方法还包括:

获取所述第一距离和所述第二距离中的最小值,判断所述最小值是否大于等于预设长度;

如果所述最小值大于等于所述预设长度,则比较所述第一距离和所述第二距离的大小。

本发明实施例中,所述方法还包括:

如果所述最小值小于所述预设长度,则控制所述第一车轮和/或所述第二车轮沿第二方向转动,直至所述最小值大于等于所述预设长度停止转动。

本发明实施例中,所述控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向左转动,包括:

控制所述第一车轮停止转动,并控制所述第二车轮沿第三方向转动,以使得所述电子设备向左转动;或者,

控制所述第一车轮沿第二方向转动,并控制所述第二车轮沿第三方向转动,以使得所述电子设备向左转动。

本发明实施例中,所述控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向右转动,包括:

控制所述第二车轮停止转动,并控制所述第一车轮沿第三方向转动,以使得所述电子设备向右转动;或者,

控制所述第二车轮沿第二方向转动,并控制所述第一车轮沿第三方向转动,以使得所述电子设备向右转动。

本发明实施例提供的电子设备,包括:第一车轮、第二车轮,所述第一车轮和所述第二车轮设置于电子设备的两侧;

传感器,用于监测第一车轮沿第一方向距离障碍体的第一距离,以及监测第二车轮沿所述第一方向距离障碍体的第二距离;

处理器,用于比较所述第一距离和所述第二距离的大小;如果所述第一距离大于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向左转动;如果所述第一距离小于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向右转动。

本发明实施例中,所述处理器,还用于获取所述第一距离和所述第二距离中的最小值,判断所述最小值是否大于等于预设长度;如果所述最小值大于等于所述预设长度,则比较所述第一距离和所述第二距离的大小。

本发明实施例中,所述处理器,还用于如果所述最小值小于所述预设长度,则控制所述第一车轮和/或所述第二车轮沿第二方向转动,直至所述最小值大于等于所述预设长度停止转动。

本发明实施例中,所述处理器,还用于控制所述第一车轮停止转动,并控制所述第二车轮沿第三方向转动,以使得所述电子设备向左转动;或者,控制所述第一车轮沿第二方向转动,并控制所述第二车轮沿第三方向转动,以使得所述电子设备向左转动。

本发明实施例中,所述处理器,还用于控制所述第二车轮停止转动,并控制所述第一车轮沿第三方向转动,以使得所述电子设备向右转动;或者,控制所述第二车轮沿第二方向转动,并控制所述第一车轮沿第三方向转动,以使得所述电子设备向右转动。

本发明实施例的技术方案中,监测第一车轮沿第一方向距离障碍体的第一距离,以及监测第二车轮沿所述第一方向距离障碍体的第二距离,其中,所述第一车轮和所述第二车轮设置于电子设备的两侧;比较所述第一距离和所述第二距离的大小;如果所述第一距离大于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向左转动;如果所述第一距离小于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向右转动。采用本发明实施例的技术方案实现自动巡航时,可以有效避免电子设备碰撞障碍物的危险,增加了自动巡航的精准度。

附图说明

图1为本发明实施例的运动控制方法的流程示意图一;

图2为本发明实施例的运动控制方法的流程示意图二;

图3为本发明实施例的运动控制方法的流程示意图三;

图4为本发明实施例的路径示意图;

图5为本发明实施例的转动原理示意图一;

图6为本发明实施例的转动原理示意图二;

图7为本发明实施例的电子设备的结构组成示意图一;

图8为本发明实施例的电子设备的结构组成示意图二。

具体实施方式

为了能够更加详尽地了解本发明实施例的特点与技术内容,下面结合附图对本发明实施例的实现进行详细阐述,所附附图仅供参考说明之用,并非用来限定本发明实施例。

图1为本发明实施例的运动控制方法的流程示意图一,如图1所示,所述运动控制方法包括以下步骤:

步骤101:监测第一车轮沿第一方向距离障碍体的第一距离,以及监测第二车轮沿所述第一方向距离障碍体的第二距离,其中,所述第一车轮和所述第二车轮设置于电子设备的两侧。

本发明实施例中,电子设备可以是机器人、平衡车等移动设备。电子设备具有两个车轮,分别为第一车轮和第二车轮,其中,第一车轮为左车轮,第二车轮为右车轮,当然,电子设备还可以包括第三车轮,第三车轮为万向轮。

本发明实施例中,电子设备中的两个车轮上分别安装有超声波装置,通过超声波装置能够检测车轮距离前方障碍物的距离。

这里,第一车轮中的超声波装置的超声波频率和第二车轮中的超声波装置的超声波频率可以相同,也可以不同。

当然,检测距离的装置不局限于是超声波装置,还可以是激光雷达等装置。

本发明实施例中,第一方向是指与两个车轮连线相垂直的方向。如图4所示,电子设备位于s形的路径中,在电子设备运动的过程中,有可能碰触到前方转弯处的路径边缘障碍物,因此,需要结合电子设备距离障碍物的距离进行适应性的转弯。具体地,如图5所示,监测第一车轮沿第一方向距离障碍体的第一距离(ll),以及监测第二车轮沿所述第一方向距离障碍体的第二距离(lr)。

步骤102:比较所述第一距离和所述第二距离的大小。

第一距离大于第二距离的情况如图5所示,即:ll>lr。第二距离大于第一距离的情况如图6所示,即:lr>ll。

步骤103:如果所述第一距离大于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向左转动。

本发明实施例中,如图5所示,如果ll>lr,则表明需要控制电子设备整体向左转,以避免碰触障碍物。具体地,可以通过控制第一车轮不动,第二车轮前进(对应顺时针转动)来使得电子设备整体向左转。还可以通过控制第一车轮后退(对应逆时针转动)且第二车轮前进(对应顺时针转动)来使得电子设备整体向左转。

本发明实施例中,根据第一距离和第二距离来确定两个车轮各自的转动参数,其中,所述转动参数包括以下至少之一:转动速度、转动加速度。

步骤104:如果所述第一距离小于所述第二距离,则控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向右转动。

本发明实施例中,如图6所示,如果lr>ll,则表明需要控制电子设备整体向右转,以避免碰触障碍物。具体地,可以通过控制第二车轮不动,第一车轮前进(对应顺时针转动)来使得电子设备整体向右转。还可以通过控制第二车轮后退(对应逆时针转动)且第一车轮前进(对应顺时针转动)来使得电子设备整体向右转。

本发明实施例中,根据第一距离和第二距离来确定两个车轮各自的转动参数,其中,所述转动参数包括以下至少之一:转动速度、转动加速度。

本发明实施例中,在电子设备运动的过程中,实时监测第一距离和第二距离,并根据第一距离和第二距离及时调整电子设备中两个车轮的转动参数,做出适应性地转弯,以避免触碰障碍物。

图2为本发明实施例的运动控制方法的流程示意图二,如图2所示,所述运动控制方法包括以下步骤:

步骤201:监测第一车轮沿第一方向距离障碍体的第一距离,以及监测第二车轮沿所述第一方向距离障碍体的第二距离,其中,所述第一车轮和所述第二车轮设置于电子设备的两侧。

本发明实施例中,电子设备可以是机器人、平衡车等移动设备。电子设备具有两个车轮,分别为第一车轮和第二车轮,其中,第一车轮为左车轮,第二车轮为右车轮,当然,电子设备还可以包括第三车轮,第三车轮为万向轮。

本发明实施例中,电子设备中的两个车轮上分别安装有超声波装置,通过超声波装置能够检测车轮距离前方障碍物的距离。

这里,第一车轮中的超声波装置的超声波频率和第二车轮中的超声波装置的超声波频率可以相同,也可以不同。

当然,检测距离的装置不局限于是超声波装置,还可以是激光雷达等装置。

本发明实施例中,第一方向是指与两个车轮连线相垂直的方向。如图4所示,电子设备位于s形的路径中,在电子设备运动的过程中,有可能碰触到前方转弯处的路径边缘障碍物,因此,需要结合电子设备距离障碍物的距离进行适应性的转弯。具体地,如图5所示,监测第一车轮沿第一方向距离障碍体的第一距离(ll),以及监测第二车轮沿所述第一方向距离障碍体的第二距离(lr)。

步骤202:获取所述第一距离和所述第二距离中的最小值,判断所述最小值是否大于等于预设长度,是时,执行步骤203;否时,执行步骤204。

具体地,获取所述第一距离和所述第二距离中的最小值可以通过以下公式:min(ll,lr)得到,其中,min表示取最小值运算。

本发明实施例中,预设长度基于所述第一车轮和/或所述第二车轮的半径确定。在一实施方式中,第一车轮和第二车轮的半径相同,均为r。预设长度可以设置为5倍的r,即5r。这样,需要判断min(ll,lr)是否大于等于5r。如果min(ll,lr)≥5r,则表明电子设备距离障碍物不是特别近,可以执行转弯,如果min(ll,lr)<5r,则表明电子设备距离障碍物非常近,不能执行转弯(有触碰的危险)。

步骤203:比较所述第一距离和所述第二距离的大小,如果所述第一距离大于所述第二距离,执行步骤205;如果所述第一距离小于所述第二距离,执行步骤206。

第一距离大于第二距离的情况如图5所示,即:ll>lr。第二距离大于第一距离的情况如图6所示,即:lr>ll。

本发明实施例中,如果ll=lr,则不需要执行转弯,而是执行前进。

步骤204:控制所述第一车轮和/或所述第二车轮沿第二方向转动,直至所述最小值大于等于所述预设长度停止转动,执行步骤203。

这里,第二方向为车轮后退方向(对应逆时针转动)。如果min(ll,lr)<5r,则需要控制ll增大和/或lr增大,即:第一车轮后退或者第二车轮后退或者两个车轮同时后退,直到min(ll,lr)≥5r为止,继续执行步骤203,比较所述第一距离和所述第二距离的大小。

步骤205:控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向左转动。

本发明实施例中,如图5所示,如果ll>lr,则表明需要控制电子设备整体向左转,以避免碰触障碍物。具体地,可以通过控制第一车轮不动,第二车轮前进(对应顺时针转动)来使得电子设备整体向左转。还可以通过控制第一车轮后退(对应逆时针转动)且第二车轮前进(对应顺时针转动)来使得电子设备整体向左转。

本发明实施例中,根据第一距离和第二距离来确定两个车轮各自的转动参数,其中,所述转动参数包括以下至少之一:转动速度、转动加速度。

步骤206:控制所述第一车轮和/或所述第二车轮的转动参数,以使得所述电子设备向右转动。

本发明实施例中,如图6所示,如果lr>ll,则表明需要控制电子设备整体向右转,以避免碰触障碍物。具体地,可以通过控制第二车轮不动,第一车轮前进(对应顺时针转动)来使得电子设备整体向右转。还可以通过控制第二车轮后退(对应逆时针转动)且第一车轮前进(对应顺时针转动)来使得电子设备整体向右转。

本发明实施例中,根据第一距离和第二距离来确定两个车轮各自的转动参数,其中,所述转动参数包括以下至少之一:转动速度、转动加速度。

本发明实施例中,在电子设备运动的过程中,实时监测第一距离和第二距离,并根据第一距离和第二距离及时调整电子设备中两个车轮的转动参数,做出适应性地转弯,以避免触碰障碍物。

图3为本发明实施例的运动控制方法的流程示意图三,如图3所示,所述运动控制方法包括以下步骤:

步骤301:监测第一车轮沿第一方向距离障碍体的第一距离,以及监测第二车轮沿所述第一方向距离障碍体的第二距离,其中,所述第一车轮和所述第二车轮设置于电子设备的两侧。

本发明实施例中,电子设备可以是机器人、平衡车等移动设备。电子设备具有两个车轮,分别为第一车轮和第二车轮,其中,第一车轮为左车轮,第二车轮为右车轮,当然,电子设备还可以包括第三车轮,第三车轮为万向轮。

本发明实施例中,电子设备中的两个车轮上分别安装有超声波装置,通过超声波装置能够检测车轮距离前方障碍物的距离。

这里,第一车轮中的超声波装置的超声波频率和第二车轮中的超声波装置的超声波频率可以相同,也可以不同。

当然,检测距离的装置不局限于是超声波装置,还可以是激光雷达等装置。

本发明实施例中,第一方向是指与两个车轮连线相垂直的方向。如图4所示,电子设备位于s形的路径中,在电子设备运动的过程中,有可能碰触到前方转弯处的路径边缘障碍物,因此,需要结合电子设备距离障碍物的距离进行适应性的转弯。具体地,如图5所示,监测第一车轮沿第一方向距离障碍体的第一距离(ll),以及监测第二车轮沿所述第一方向距离障碍体的第二距离(lr)。

步骤302:比较所述第一距离和所述第二距离的大小。

第一距离大于第二距离的情况如图5所示,即:ll>lr。第二距离大于第一距离的情况如图6所示,即:lr>ll。

步骤303:如果所述第一距离大于所述第二距离,则控制所述第一车轮停止转动,并控制所述第二车轮沿第三方向转动,以使得所述电子设备向左转动。

这里,第三方向为车轮前进方向(对应顺时针转动)。

本发明实施例中,如图5所示,如果ll>lr,则表明需要控制电子设备整体向左转,以避免碰触障碍物。具体地,可以通过控制第一车轮不动,第二车轮前进(对应顺时针转动)来使得电子设备整体向左转。

本发明实施例中,根据第一距离和第二距离来确定两个车轮各自的转动参数,其中,所述转动参数包括以下至少之一:转动速度、转动加速度。

例如:第一距离为30r,第二距离为10r,此时,min(30r,10r)=10r>5r,其中,5r为预设长度,代表需要进行转弯,由于30r大于10r,因此,需要向左转弯,控制左车轮不动,右车轮向前转动(对应顺时针转动)来使得电子设备整体向左转。转动的具体参数可以根据30r和10r来确定,一般,第一距离和第二距离差值越大,则转动的角度越大。

当然,也可以控制第一车轮沿第二方向转动,并控制所述第二车轮沿第三方向转动,以使得所述电子设备向左转动。也即:左车轮后退,右车轮前进,实现向左转动。

步骤304:如果所述第一距离小于所述第二距离,则控制所述第二车轮停止转动,并控制所述第一车轮沿第三方向转动,以使得所述电子设备向右转动。

本发明实施例中,如图6所示,如果lr>ll,则表明需要控制电子设备整体向右转,以避免碰触障碍物。具体地,可以通过控制第二车轮不动,第一车轮前进(对应顺时针转动)来使得电子设备整体向右转。

本发明实施例中,根据第一距离和第二距离来确定两个车轮各自的转动参数,其中,所述转动参数包括以下至少之一:转动速度、转动加速度。

例如:第二距离为30r,第一距离为10r,此时,min(30r,10r)=10r>5r,其中,5r为预设长度,代表需要进行转弯,由于30r大于10r,因此,需要向右转弯,控制右车轮不动,左车轮向前转动(对应顺时针转动)来使得电子设备整体向右转。转动的具体参数可以根据30r和10r来确定,一般,第一距离和第二距离差值越大,则转动的角度越大。

当然,也可以控制所述第二车轮沿第二方向转动,并控制所述第一车轮沿第三方向转动,以使得所述电子设备向右转动。也即:左车轮前进,右车轮后退,实现向右转动。

本发明实施例中,在电子设备运动的过程中,实时监测第一距离和第二距离,并根据第一距离和第二距离及时调整电子设备中两个车轮的转动参数,做出适应性地转弯,以避免触碰障碍物。

图7为本发明实施例的电子设备的结构组成示意图一,如图7所示,所述电子设备包括:第一车轮71、第二车轮72,所述第一车轮71和所述第二车轮72设置于电子设备的两侧;

传感器73,用于监测第一车轮71沿第一方向距离障碍体的第一距离,以及监测第二车轮72沿所述第一方向距离障碍体的第二距离;

处理器74,用于比较所述第一距离和所述第二距离的大小;如果所述第一距离大于所述第二距离,则控制所述第一车轮71和/或所述第二车轮72的转动参数,以使得所述电子设备向左转动;如果所述第一距离小于所述第二距离,则控制所述第一车轮71和/或所述第二车轮72的转动参数,以使得所述电子设备向右转动。

在一实施方式中,所述处理器74,还用于获取所述第一距离和所述第二距离中的最小值,判断所述最小值是否大于等于预设长度;如果所述最小值大于等于所述预设长度,则比较所述第一距离和所述第二距离的大小。

在一实施方式中,所述处理器74,还用于如果所述最小值小于所述预设长度,则控制所述第一车轮71和/或所述第二车轮72沿第二方向转动,直至所述最小值大于等于所述预设长度停止转动。

在一实施方式中,所述处理器74,还用于控制所述第一车轮71停止转动,并控制所述第二车轮72沿第三方向转动,以使得所述电子设备向左转动;或者,控制所述第一车轮71沿第二方向转动,并控制所述第二车轮72沿第三方向转动,以使得所述电子设备向左转动。

在一实施方式中,所述处理器74,还用于控制所述第二车轮72停止转动,并控制所述第一车轮71沿第三方向转动,以使得所述电子设备向右转动;或者,控制所述第二车轮72沿第二方向转动,并控制所述第一车轮71沿第三方向转动,以使得所述电子设备向右转动。

本领域技术人员应当理解,图7所示的电子设备中的各单元的实现功能可参照前述运动控制方法的相关描述而理解。

图8为本发明实施例的电子设备的结构组成示意图二,如图8所示,所述电子设备包括:第一车轮81、第二车轮82,所述第一车轮81和所述第二车轮82设置于电子设备的两侧;

传感器83,用于监测第一车轮81沿第一方向距离障碍体的第一距离,以及监测第二车轮82沿所述第一方向距离障碍体的第二距离;

处理器84,用于比较所述第一距离和所述第二距离的大小;如果所述第一距离大于所述第二距离,则控制所述第一车轮81和/或所述第二车轮82的转动参数,以使得所述电子设备向左转动;如果所述第一距离小于所述第二距离,则控制所述第一车轮81和/或所述第二车轮82的转动参数,以使得所述电子设备向右转动。

在一实施方式中,所述处理器84,还用于获取所述第一距离和所述第二距离中的最小值,判断所述最小值是否大于等于预设长度;如果所述最小值大于等于所述预设长度,则比较所述第一距离和所述第二距离的大小。

在一实施方式中,所述处理器84,还用于如果所述最小值小于所述预设长度,则控制所述第一车轮81和/或所述第二车轮82沿第二方向转动,直至所述最小值大于等于所述预设长度停止转动。

在一实施方式中,所述处理器84,还用于控制所述第一车轮81停止转动,并控制所述第二车轮82沿第三方向转动,以使得所述电子设备向左转动;或者,控制所述第一车轮81沿第二方向转动,并控制所述第二车轮82沿第三方向转动,以使得所述电子设备向左转动。

在一实施方式中,所述处理器84,还用于控制所述第二车轮82停止转动,并控制所述第一车轮81沿第三方向转动,以使得所述电子设备向右转动;或者,控制所述第二车轮82沿第二方向转动,并控制所述第一车轮81沿第三方向转动,以使得所述电子设备向右转动。

在一实施方式中,所述电子设备还包括:存储器85,用于存储第一车轮以及第二车轮的历史转动记录,这样,电子设备可以根据历史转动记录进行逆向运动,方便电子设备撤回原地。

这里,历史转动记录的内容可以包括:各个时刻对应的转动速度和加速度。

本发明实施例所记载的技术方案之间,在不冲突的情况下,可以任意组合。

在本发明所提供的几个实施例中,应该理解到,所揭露的方法和智能设备,可以通过其它的方式实现。以上所描述的设备实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,如:多个单元或组件可以结合,或可以集成到另一个系统,或一些特征可以忽略,或不执行。另外,所显示或讨论的各组成部分相互之间的耦合、或直接耦合、或通信连接可以是通过一些接口,设备或单元的间接耦合或通信连接,可以是电性的、机械的或其它形式的。

上述作为分离部件说明的单元可以是、或也可以不是物理上分开的,作为单元显示的部件可以是、或也可以不是物理单元,即可以位于一个地方,也可以分布到多个网络单元上;可以根据实际的需要选择其中的部分或全部单元来实现本实施例方案的目的。

另外,在本发明各实施例中的各功能单元可以全部集成在一个第二处理单元中,也可以是各单元分别单独作为一个单元,也可以两个或两个以上单元集成在一个单元中;上述集成的单元既可以采用硬件的形式实现,也可以采用硬件加软件功能单元的形式实现。

以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。

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