一种智能割草机器人的智能割草方法技术

本发明专利技术公开了一种智能割草机器人的智能割草方法，结合了卫星定位数据，陀螺指向数据，对小车行走路线进行规划，并对小车行进过程中陀螺产生的误差进行修正，使其降低了作业重复率，而且提升了作业效率。通过超声波雷达，摄像头，红外传感器中的至少一种，进行边界识别，降低了用户在作业过程中介入的次数，进一步提升了作业效率。了作业效率。了作业效率。

【技术实现步骤摘要】
一种智能割草机器人的智能割草方法


[0001]本专利技术属于智能机器人控制
，具体涉及一种智能割草机器人的智能割草方法。

技术介绍

[0002]近年来，随着城市绿化面积显著提高，公共绿地定时维护、修建工作日益繁琐。为了提高作业效率，减少劳动力成本，传统手动割草机升级为全智能的智能割草机器人成为研究的热点问题。
[0003]目前市面上很多智能割草机需要埋设边界感应物，不方便大规模野外作业。

技术实现思路

[0004]为解决现有技术存在的缺陷，本专利技术提供一种智能割草机器人的智能割草方法。
[0005]为了解决上述技术问题，本专利技术提供了如下的技术方案：
[0006]本专利技术提供一种智能割草机的智能割草方法，根据用户设定的参数，在作业区域内规划出n条作业线；结合陀螺数据和卫星定位数据，规划出具体的行走路径，并控制割草机靠近或者沿着作业线作业。
[0007]作为本专利技术的一种优选技术方案，割草机靠近或者沿着当前作业线作业过程中，割草机没有获得卫星定位有效数据时，每隔设定距离对割草机器人的运动方向进行调整，该调整过程具体如下：
[0008]设定割草机沿当前作业线作业时的当前位置为a点，a点到当前作业线的垂直线与当前作业线的交点为b点，根据预设距离bc获得c点位置，a点到b点的距离为ab，b点到c点的距离为bc，a点到c点的距离为ac；
[0009]当ab≠0时，调转割草机朝向当前作业线，然后通过陀螺仪获得割草机器人a点的当前朝向，然后获得a点的当前朝向与当前作业线的夹角，该夹角为∠dae；同时获得ac与当前作业线的夹角，该夹角为∠dac，
[0010][0011]若∠dae小于∠dac，则控制割草机器人向靠近当前作业线的方向转向；
[0012]若∠dae大于∠dac，则控制割草机器人向远离当前作业线的方向转向。
[0013]作为本专利技术的一种优选技术方案，割草机在靠近或者沿着当前作业线作业过程中，获得卫星定位的数据有效时，根据预设条件获得参考点1和参考点2的位置，并将参考点1和参考点2构成的直线作为卫星定位参考线,将当前作业线的行数记为n1，其中预设条件为参考点1和参考点2相隔设定距离；然后重新规划出作业区的作业线。
[0014]作为本专利技术的一种优选技术方案，在割草机获得卫星定位参考线后，进行作业过程中，获得卫星定位有效数据时，将此时的位置标记为A点，并通过陀螺仪获得割草机器人A点的朝向，然后利用A点、参考点1和参考点2的卫星定位数据计算出割草机到当前作业线的
垂直距离W2；
[0015]设定A点到当前作业线的垂直线与当前作业线的交点为B点，并根据预设距离BC获得C点位置；根据A点到当前作业线的垂直距离W2、预设距离BC从而获得A点到C点的路径，然后将割草机A点的朝向进行调整，使得割草机从A点行走到C点，进行当前作业线。
[0016]作为本专利技术的一种优选技术方案，将割草机的朝向进行调整，使得割草机从A点行走到C点，该调整过程如下：
[0017]设定A点到当前作业线的垂直线与当前作业线的交点为B点，根据预设距离BC获得C点位置，A点到B点的距离为AB，即W2，B点到C点的距离为BC，A点到C点的距离为AC；
[0018]然后通过陀螺仪获得割草机A点的当前朝向，然后获得A点的当前朝向与当前作业线的夹角，该夹角为∠DAE；同时获得AC与当前作业线的夹角，该夹角为∠DAC，
[0019][0020]若∠DAE小于∠DAC，则控制割草机向靠近当前作业线的方向转向；
[0021]若∠DAE大于∠DAC，则控制割草机向远离当前作业线的方向转向。
[0022]作为本专利技术的一种优选技术方案，根据规划的作业线长度，完成当前作业线作业，或根据传感器感应到边界完成当前作业线作业；然后掉头，靠近或者沿着下一行作业线作业，直到完成作业区作业。
[0023]作为本专利技术的一种优选技术方案，根据传感器感应到边界完成目标作业为采用摄像头、超声波传感器，红外传感器中的至少一个判断边界；
[0024]1)根据摄像头获得的图像信息判断边界
[0025]每行作业线的起点为w，终点为x，起点和终点的距离预设为len,在距离起点w一定距离设置p点，距离终点x一定距离设置q点，从小车位置向当前作业线作垂线，垂点位于p点，q点之间时，且小车车载陀螺指向与当前作业线的夹角在一定范围时，获取小车摄像头图像中靠近未作业区一侧的图像信息，并提取其颜色，纹波，饱和度等信息中的至少一种信息，分析并存储其特征，当小车行驶距离终点距离小于点q到终点x的距离时，将小车获得图像特征信息与已经存储的特征进行比较，存在某种程度差异时，就认为遇到边界，进行下一行作业或者绕行；
[0026]2)利用超声波雷达判断边界
[0027]当超声波雷达检测到障碍物的距离为小于等于L1时，小车进行制动，然后计时，时间为T1，如果超声波雷达监测到障碍物的距离大于L1时，说明障碍物离开，将T1清零，小车继续进行作业；如果时间T1大于预设时间Tsc,就认为遇到边界，小车掉头进行下一行作业，或者绕行；
[0028]3)利用红外传感器判断边界
[0029]当红外传感器感应到前方有人或动物时，小车进行制动，并计时，时间为T2，当人或者动物离开，红外传感器未检测人或者动物时，将T2清零，小车继续进行作业；当T2大于预设时间Tsh时，认为小车遇到边界，进行下一行作业，或者绕行。
[0030]作为本专利技术的一种优选技术方案，因为陀螺指向会随着时间推移而产生误差，所以利用卫星定位的有效数据对陀螺指向进行修正；
[0031]割草机在进行当前行作业的过程中，获得卫星定位有效数据时的位置为G1，
G2...Gn,在任意两个卫星定位点H点、K点之间，小车每移动一段距离设置一个检测点，共设置n个检查点,割草机到达每个检测点时，可以此时的陀螺指向，每个检测点的陀螺指向与作业线的夹角分别为Dir1,Dir2...DirN，然后通过比较获得这些夹角中的最大值与最小值，并计算出最大值与最小值的差值，当此差值小于阈值dirsh时,计算出这些检查点的平均值DirAV，∠EHD等于DirAV；
[0032]Hh垂直直线ST于h点，Kk垂直直线ST于k点，因为参考点1，参考点2，H点都接收到了卫星定位的坐标，根据坐标轴可以计算出此三点构成的三角形的三边边长，进而可以计算出Hh的长度，同理可以计算出Kk的长度，HE垂直Kk于E点，可以得到EK的长度：EK＝Kk
‑
Hh,根据点H，点K的卫星定位的坐标值可以计算出HK的长度，计算出:
[0033]可以利用∠EHK与∠EHD的差值对陀螺的指向进行修正。
[0034]作为本专利技术的一种优选技术方案，当小车陀螺感知的俯仰指向与水平面夹角大于预设阈值时，或者小车陀螺感知到的侧倾指向与水平面夹角大于预设阈值时，小车停止作业，倒退，并发出警报。
[0035]本专利技术相较于现有技术，具有以本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种智能割草机的智能割草方法，其特征在于，根据用户设定的参数，在作业区域内规划出n条作业线；结合陀螺数据和卫星定位数据，规划出具体的行走路径，并控制割草机靠近或者沿着作业线作业。2.根据权利要求1所述的割草机的智能割草方法，其特征在于，割草机靠近或者沿着当前作业线作业过程中，割草机没有获得卫星定位有效数据时，每隔设定距离对割草机器人的运动方向进行调整，该调整过程具体如下：设定割草机沿当前作业线作业时的当前位置为a点，a点到当前作业线的垂直线与当前作业线的交点为b点，根据预设距离bc获得c点位置，a点到b点的距离为ab，b点到c点的距离为bc，a点到c点的距离为ac；当ab≠0时，调转割草机朝向当前作业线，然后通过陀螺仪获得割草机器人a点的当前朝向，然后获得a点的当前朝向与当前作业线的夹角，该夹角为∠dae；同时获得ac与当前作业线的夹角，该夹角为∠dac，若∠dae小于∠dac，则控制割草机器人向靠近当前作业线的方向转向；若∠dae大于∠dac，则控制割草机器人向远离当前作业线的方向转向。3.根据权利要求1所述的割草机的智能割草方法，其特征在于，割草机在靠近或者沿着当前作业线作业过程中，获得卫星定位的数据有效时，根据预设条件获得参考点1和参考点2的位置，并将参考点1和参考点2构成的直线作为卫星定位参考线,将当前作业线的行数记为n1，其中预设条件为参考点1和参考点2相隔设定距离；然后重新规划出作业区的作业线。4.根据权利要求3所述的割草机的智能割草方法，其特征在于，在割草机获得卫星定位参考线后，进行作业过程中，获得卫星定位的有效数据时，将此时的位置标记为A点，并通过陀螺仪获得割草机器人A点的朝向，然后利用A点、参考点1和参考点2的卫星定位数据计算出割草机到当前作业线的垂直距离W2；设定A点到当前作业线的垂直线与当前作业线的交点为B点，并根据预设距离BC获得C点位置；根据A点到当前作业线的垂直距离W2、预设距离BC从而获得A点到C点的路径，然后将割草机A点的朝向进行调整，使得割草机从A点行走到C点，进行当前作业线。5.根据权利要求4所述的割草机的智能割草方法，其特征在于，将割草机的朝向进行调整，使得割草机从A点行走到C点，该调整过程如下：设定A点到当前作业线的垂直线与当前作业线的交点为B点，根据预设距离BC获得C点位置，A点到B点的距离为AB，即W2，B点到C点的距离为BC，A点到C点的距离为AC；然后通过陀螺仪获得割草机A点的当前朝向，然后获得A点的当前朝向与当前作业线的夹角，该夹角为∠DAE；同时获得AC与当前作业线的夹角，该夹角为∠DAC，若∠DAE小于∠DAC，则控制割草机向靠近当前作业线的方向转向；若∠DAE大于∠DAC，则控制割草机向远离当前作业线的方向转向。6.根据权利要求2、3、4任一所述的割草机的智能割草方法，其特征在于，根据规划的作业线长度，完成当前作业线作业，或根据传感器感应到边界完成当前作业线作业；然后掉
...

【专利技术属性】
技术研发人员：王晓辉，
申请(专利权)人：苏州锐动机器人有限公司，
类型：发明
国别省市：