本发明涉及自移动设备控制,尤其涉及一种自移动设备转弯控制方法及自移动设备。
背景技术:
1、自移动设备在进行工作的时候,可以一边行走并进行相应的工作,例如割草、清扫积雪等。
2、现有的自移动设备在清扫或割草时的转向方式是原地转弯,例如割草机在进行割草时,由于履带式的结构,自移动设备较重,车头较大,且草地的阻力偏大,原地旋转较大的扭力会将草扭断且将草皮扭起。
技术实现思路
1、本发明的主要目的在于提供一种自移动设备转弯控制方法及自移动设备,旨在解决现有技术控制自移动设备转弯效果差的技术问题。
2、为实现上述目的,本发明提供了一种自移动设备转弯控制方法,所述方法包括以下步骤:
3、获取自移动设备行走的整体区域;
4、根据所述整体区域确定初始待转弯点;
5、在所述自移动设备到达所述初始待转弯点时,控制所述自移动设备后退至目标待转弯点;
6、在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯,到达所述整体区域中的目标点。
7、可选地,所述在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯,到达所述整体区域中的目标点,包括:
8、获取自移动设备在转弯时的当前位置点坐标、所述初始待转弯点、所述目标待转弯点、目标点的位置坐标;
9、根据所述当前位置点坐标和所述初始待转弯点的位置坐标计算自移动设备倾角;
10、通过所述自移动设备倾角采用二分法计算自移动设备当前进度;
11、通过所述自移动设备当前进度、所述初始待转弯点、所述目标待转弯点以及目标点的位置坐标计算预设转弯路径;
12、在所述目标待转弯点控制所述自移动设备按照所述预设转弯路径进行转弯,到达所述整体区域中的目标点。
13、可选地,所述在所述目标待转弯点控制所述自移动设备按照所述预设转弯路径进行转弯,到达所述整体区域中的目标点,包括:
14、在所述目标待转弯点控制所述自移动设备按照所述预设转弯路径进行转弯,到达第一路径点;
15、计算所述第一路径点与目标点之间的距离;
16、获取自移动设备行走的整体区域中各行走路径之间的路径距离;
17、通过所述第一路径点与目标点之间的距离以及所述路径距离计算第一后退距离;
18、控制所述自移动设备根据所述第一后退距离后退至第二路径点;
19、在所述第二路径点控制所述自移动设备按照所述预设转弯路径进行转弯,到达所述整体区域中的目标点。
20、可选地,所述在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯,到达所述整体区域中的目标点,包括:
21、获取自移动设备的当前线速度和自移动设备当前进度;
22、将所述当前线速度调整为目标线速度;
23、根据所述自移动设备当前进度以及所述目标线速度计算自移动设备角速度;
24、根据所述目标线速度和所述自移动设备角速度控制在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯。
25、可选地,所述根据所述自移动设备当前进度以及所述目标线速度计算自移动设备角速度,包括:
26、根据所述自移动设备当前进度计算所述自移动设备在转弯时到达第一位置点和第二位置点的位置值以及相对于所述自移动设备在转弯时的当前位置点的弧度;
27、通过所述弧度以及所述第一位置点和第二位置点的位置值计算转弯半径;
28、根据所述目标线速度和所述转弯半径计算自移动设备角速度。
29、可选地,所述根据所述目标线速度和所述转弯半径计算自移动设备角速度,包括:
30、获取自移动设备的当前车身朝向、当前车身位置以及自移动设备在转弯时的目标位置;
31、通过所述当前车身朝向和所述目标位置计算车身朝向与目标位置所在直线之间的夹角,得到角度偏差;
32、计算所述当前车身位置与所述目标位置之间的差值,得到位置偏差;
33、根据所述目标线速度、所述转弯半径、所述角度偏差以及所述位置偏差计算自移动设备角速度。
34、可选地,所述在所述自移动设备到达所述初始待转弯点时,控制所述自移动设备后退至目标待转弯点,包括:
35、在所述自移动设备到达所述初始待转弯点时,获取自移动设备行走的整体区域中各行走路径之间的路径距离;
36、通过所述路径距离计算第二后退距离;
37、控制所述自移动设备后退至所述第二后退距离,到达目标待转弯点。
38、可选地,所述根据所述整体区域确定初始待转弯点,包括:
39、将所述整体区域进行划分,得到多条行走路径数据;
40、根据所述整体区域得到自移动设备行走的边界点数据;
41、通过多条行走路径数据以及所述边界点数据确定初始待转弯点。
42、此外,为实现上述目的,本发明还提出一种自移动设备转弯控制装置,所述自移动设备转弯控制装置包括:
43、获取模块,用于获取自移动设备行走的整体区域;
44、确定模块,用于根据所述整体区域确定初始待转弯点;
45、控制模块,用于在所述自移动设备到达所述初始待转弯点时,控制所述自移动设备后退至目标待转弯点;
46、所述控制模块,还用于在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯,到达所述整体区域中的目标点。
47、此外,为实现上述目的,本发明还提出一种自移动设备所述自移动设备包括:车头、车身、行走设备和控制器,所述车头可拆卸连接于所述车身,所述行走设备和所述控制器设置于所述车身,所述控制器用于控制所述行走设备进行转弯,所述控制器可运行自移动设备转弯控制程序,所述自移动设备转弯控制程序配置为实现上文所述的自移动设备转弯控制方法的步骤。
48、本发明通过获取自移动设备行走的整体区域;根据所述整体区域确定初始待转弯点;在所述自移动设备到达所述初始待转弯点时,控制所述自移动设备后退至目标待转弯点;在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯,到达所述整体区域中的目标点,通过控制自移动设备先后退再转弯,提高转弯效果,避免对草地造成不可逆转的伤害。
1.一种自移动设备转弯控制方法,其特征在于,所述方法包括:
2.如权利要求1所述的自移动设备转弯控制方法,其特征在于,所述在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯,到达所述整体区域中的目标点,包括:
3.如权利要求2所述的自移动设备转弯控制方法,其特征在于,所述在所述目标待转弯点控制所述自移动设备按照所述预设转弯路径进行转弯,到达所述整体区域中的目标点,包括:
4.如权利要求1所述的自移动设备转弯控制方法,其特征在于,所述在所述目标待转弯点控制所述自移动设备按照预设转弯路径进行转弯,到达所述整体区域中的目标点,包括:
5.如权利要求4所述的自移动设备转弯控制方法,其特征在于,所述根据所述自移动设备当前进度以及所述目标线速度计算自移动设备角速度,包括:
6.如权利要求5所述的自移动设备转弯控制方法,其特征在于,所述根据所述目标线速度和所述转弯半径计算自移动设备角速度,包括:
7.如权利要求1所述的自移动设备转弯控制方法,其特征在于,所述在所述自移动设备到达所述初始待转弯点时,控制所述自移动设备后退至目标待转弯点,包括:
8.如权利要求1至7中任一项所述的自移动设备转弯控制方法,其特征在于,所述根据所述整体区域确定初始待转弯点,包括:
9.一种自移动设备转弯控制装置,其特征在于,所述自移动设备转弯控制装置包括:
10.一种自移动设备,其特征在于,所述自移动设备包括:车头、车身、行走设备和控制器,所述车头可拆卸连接于所述车身,所述行走设备和所述控制器设置于所述车身,所述控制器用于控制所述行走设备进行转弯,所述控制器可运行自移动设备转弯控制程序,所述自移动设备转弯控制程序配置为实现如权利要求1至8中任一项所述的自移动设备转弯控制方法的步骤。