System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技术实现步骤摘要】
本专利技术涉及一种笼养鸡舍内巡检导航方法、清扫导航控制系统及介质导航。属于畜禽养殖装备自动化。
技术介绍
1、中国是农业大国,规模化笼养家禽养殖技术和舍内农用技术装备的快速发展催生了舍内自主移动机器人的诞生,其中承担舍内巡检功能的移动机器人的发展较为迅猛。
2、舍内巡检机器人以其行动灵活、对环境适应性强、可替代人工巡检方式,具有获取舍内全环境分布式信息和某一特殊位置的具体信息的能力,目前笼养禽舍巡检机器人在实际运用中面临着较多问题,例如:
3、1)舍内移动机器人巡检路径规划问题,由于鸡舍环境属于结构化场景,因此巡检路径通常固定,且由于鸡舍面积较大,意味着巡检过程中的路径规划问题不同于一般搜寻最优路径的问题,例如:粒子群算法、遗传算法、人工神经网络法等,目前较少有针对笼养鸡舍环境内巡检机器人的路径规划方法的提出,现有方法也面临着一些实际控制算法问题。
4、2)舍内移动机器人对于初始位姿确定的问题。在舍内环境中,基于惯性器件的航迹推算法往往对起始点的位置与姿态信息的获取要求较高,而在机器人巡检一轮后因为累计误差的存在而失去初始位姿信息,在进入下一次巡检任务后因为与原起始点位姿偏差较大而逐渐偏离原行驶路线的问题,导致无法进行长时间、多轮巡检。
5、3)舍内移动机器人对笼养鸡舍环境中的固定路线的巡检方法,包含路径跟踪问题、多传感器融合测距的问题以及面对多类型障碍物避障算法的问题。在舍内环境中,移动机器人因为作业空间有限,静态障碍物如鸡笼密布、料线、料槽众多、进入过道喂料槽所占空间狭窄,动态
技术实现思路
1、有鉴于此,本专利技术提供了一种笼养鸡舍内巡检导航方法、系统、移动机器人及存储介质,其实现了在环境复杂度较高的笼养鸡舍内稳定的巡检路径跟踪与避障功能;同时,利用移动机器人的传感器装置,补偿了起始位姿矫正的问题,进而解决了多次巡检后可能出现的移动机器人偏离原行驶路径问题,实现了移动机器人在舍内面对多类型障碍物时的巡检导航任务。
2、本专利技术的第一个目的在于提供一种笼养鸡舍内巡检导航方法。
3、本专利技术的第二个目的在于提供一种笼养鸡舍内巡检导航系统。
4、本专利技术的第三个目的在于提供一种移动机器人。
5、本专利技术的第四个目的在于提供一种计算机可读存储介质。
6、本专利技术的第一个目的可以通过采取如下技术方案达到:
7、一种笼养鸡舍内巡检导航方法,所述方法包括:
8、基于示教学习进行路径规划;
9、根据示教过程中记录的一系列动作数据关键点的位姿信息,得到当前点与下一目标点的位置与角度信息;
10、根据当前点偏角与目标点偏角之间的差值执行转角动作,使移动机器人转至与两点之间偏角一致的偏航角;
11、根据两点之间的距离,采用pid算法在行进至目标点过程中矫正目标点与起始点连线的角度,追踪两点之间的直线段;
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、追踪模块,用于根据两点之间的距离,采用pid算法在行进至目标点过程中矫正目标点与起始点连线的角度,追踪两点之间的直线段;
37、避障模块,用于在行进至目标点过程中,当障碍物进入移动机器人探测区域范围内,实现避障;
38、调整模块,用于在抵达目标点后,调整至与动作数据关键点一致的偏航角后完成对本次巡检区域的轨迹跟踪,开始跟踪下一巡检区域的目标点。
39、本专利技术的第三个目的可以通过采取如下技术方案达到:
40、一种移动机器人,包括机器人平台,所述机器人平台上搭载有控制器、测距传感器、位姿传感器和安全触边传感器,所述测距传感器、位姿传感器和安全触边传感器分别与控制器连接;
41、所述测距传感器,用于感知障碍物的距离、大小以及方位;
42、所述位姿传感器,用于估计移动机器人当前时刻的绝对位置与本文档来自技高网...
【技术保护点】
1.一种笼养鸡舍内巡检导航方法,其特征在于,所述方法包括:
2.根据权利要求1所述的笼养鸡舍内巡检导航方法,其特征在于,所述基于示教学习进行路径规划,具体包括:
3.根据权利要求2所述的笼养鸡舍内巡检导航方法,其特征在于,所述对多条子区域的示教轨迹进行修正拟合,具体包括:
4.根据权利要求1所述的笼养鸡舍内巡检导航方法,其特征在于,所述实现避障,具体包括:
5.根据权利要求1所述的笼养鸡舍内巡检导航方法,其特征在于,所述基于示教学习进行路径规划之后,还包括:
6.一种笼养鸡舍内巡检导航系统,其特征在于,所述系统包括:
7.一种移动机器人,包括机器人平台,其特征在于,所述机器人平台上搭载有控制器、测距传感器、位姿传感器和安全触边传感器,所述测距传感器、位姿传感器和安全触边传感器分别与控制器连接;
8.根据权利要求7所述的移动机器人,其特征在于,所述测距传感器包括一个单线机械式激光雷达、六个超声波测距传感器以及四个激光测距传感器;
9.根据权利要求7所述的移动机器人,其特征在于,所述位姿传
10.一种计算机可读存储介质,存储有程序,其特征在于,所述程序被处理器执行时,实现权利要求1-5任一项所述的笼养鸡舍内巡检导航方法。
...【技术特征摘要】
1.一种笼养鸡舍内巡检导航方法,其特征在于,所述方法包括:
2.根据权利要求1所述的笼养鸡舍内巡检导航方法,其特征在于,所述基于示教学习进行路径规划,具体包括:
3.根据权利要求2所述的笼养鸡舍内巡检导航方法,其特征在于,所述对多条子区域的示教轨迹进行修正拟合,具体包括:
4.根据权利要求1所述的笼养鸡舍内巡检导航方法,其特征在于,所述实现避障,具体包括:
5.根据权利要求1所述的笼养鸡舍内巡检导航方法,其特征在于,所述基于示教学习进行路径规划之后,还包括:
6.一种笼养鸡舍内巡检导航系统,其特征在于,所述系统包括:
7.一种移动机器人,包括机器人平台,其特征在于,所述机器人平台上搭载有控制器、测距传感器、位姿传感器和安全触边传...
【专利技术属性】
技术研发人员:张铁民,李看,蒋佳城,邓鸿锋,
申请(专利权)人:华南农业大学,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。