笼养鸡舍巡检机器人惯性导航系统设计与试验研究

    Design and test of the inertial navigation system for inspection robots in caged chicken coop

    • 摘要: 针对笼养鸡舍内鸡笼密度大、网状结构的鸡笼回波信号弱、路径狭窄导致的巡检机器人障碍物感知难度大、导航控制精度低的问题,该研究设计了一套基于多传感器感知的笼养鸡舍巡检机器人惯性导航系统,实现了巡检机器人在笼养鸡舍内真实作业环境下的自主导航避障和示教轨迹跟踪。首先,针对笼养鸡舍内的真实作业环境,通过对超声波传感器阵列进行优化布局,采用滑动窗口检测方法处理多超声波传感器阵列感知的数据,以提升巡检机器人障碍物感知灵敏度和精度。然后提出了基于红外传感器数据差分的位姿矫正算法,实现了巡检机器人在笼养鸡舍内的相对位姿矫正。最后提出了基于位置点和航向角约束的示教轨迹跟踪方法,通过采集机器人示教轨迹的关键点位姿信息,实现了巡检机器人的示教轨迹跟踪。试验结果表明,该研究提出的基于多传感器感知的滑动窗口检测方法,障碍物距离感知误差不超过3.5 cm,差分法位姿矫正算法的最大横向偏差不超过6 cm,最大角度偏差不超过3.89°,不同速度下轨迹跟踪的最大位置平均偏差不超过4.03 cm,最大位置标准差不超过1.20 cm,最大角度平均偏差不超过3.15°,最大角度标准差不超过1.13°。该研究提出的基于多传感器感知的笼养鸡舍导航避障和示教轨迹跟踪方法,实现了笼养鸡舍内真实环境下机器人的巡检可靠避障、精准自主导航,所设计的惯性导航系统适应性强,稳定性好,成本低,为笼养鸡舍自主巡检、自主作业以及笼养鸡养殖产业智慧化发展提供了技术支撑。

       

      Abstract: To address the challenges of obstacle perception and low navigation control accuracy caused by high cage density, weak echo signals from net-like structures, and narrow paths in caged chicken coops, an inertial navigation system is designed in this research based on multi-sensor perception for caged chicken coop inspection robots, which realizes autonomous navigation, obstacle avoidance, and teaching trajectory tracking of inspection robots in real working environments in caged chicken coops. Firstly, an ultrasonic sensor array was designed and optimized for the real and complex working environment in the caged chicken coop. The sliding window detection method was used to process the data sensed by multiple ultrasonic sensors, which improved the sensitivity and accuracy of the inspection robot in detecting obstacles on the side of the egg collector and feeder at the entrance of the aisle. Then, a pose correction algorithm based on infrared sensor data difference was proposed, which solved the cumulative error problem of inertial navigation by using the difference in obstacle distance between the two infrared sensors at the tail of the robot through the difference method, and achieved relative pose correction of the inspection robot in the caged chicken coop. Finally, a teaching trajectory tracking method based on position point and heading angle constraints was proposed. By collecting key point pose information on the robot's teaching trajectory and tracking it, the teaching trajectory tracking of the inspection robot in the caged chicken coop was achieved. The experimental results showed that the multi-sensor sensing and sliding window obstacle detection method proposed in this research has a good sensing effect on the hollow area on the side of the egg collector and the feeder at the entrance of the aisle. The obstacle distance sensing error was no more than 3 cm, and the inspection robot could enter the aisle entrance stably at a speed of 0.1-0.3 m/s and conducted inspections through the narrow area of the feeder. The differential pose correction algorithm using infrared sensors could correct poses under different angle errors, with a maximum lateral deviation of no more than 6 cm and a maximum angle deviation of no more than 3.89° after correction. This method effectively corrected the cumulative error of the inertial navigation of the inspection robot, and the inspection robot could smoothly enter the next aisle for operation after using the correction algorithm. The average deviation of the maximum position by using the teaching trajectory tracking method based on position point and heading angle constraints at different speeds was no more than 4.03 cm, the standard deviation of the maximum position was no more than 1.20 cm, the average deviation of the maximum angle was no more than 3.15°, and the standard deviation of the maximum angle was no more than 1.13°. The result showed that the obstacle avoidance navigation and teaching trajectory tracking method based on multi-sensor perception can achieve reliable obstacle avoidance and accurate autonomous navigation for robot inspection in the environment of the caged chicken coop. The proposed inertial navigation system has strong adaptability, good stability, and low cost, providing technical support for autonomous inspection and operation of caged chicken coops, as well as the intelligent development of the chicken breeding industry.

       

    /

    返回文章
    返回