The autonomous navigation system of feed-pushing robots is one of the key technologies for the intelligent breeding of dairy cows, and its accuracy has a significant influence on the quality of feed-pushing operations. Currently, the navigation methods of feed-pushing robots in the complex environment of cattle barns mainly include visual, LiDAR, and geomagnetic navigation, but there are still problems relating to low navigation accuracy. An autonomous navigation system based on ultra-wideband (UWB) positioning utilizing the dynamic forward-looking distance pure pursuit algorithm is proposed in this paper. First, six anchor nodes were arranged in the corners and central feeding aisle of a 30 × 86 m rectangular standard barn to form a rectangular positioning area. Then, utilizing the 9ITL-650 feed-pushing robot as a platform and integrating UWB wireless positioning technology, a global coordinate system for the cattle barn was established, and the expected path was planned. Finally, the pure pursuit model was improved based on the robot’s two-wheel differential kinematics model, and a dynamic forward-looking distance pure pursuit controller based on PID regulation was designed to construct a comprehensive autonomous navigation control system. Subsequently, field experiments were conducted in the cattle barn. The experimental results show that the static positioning accuracy of the UWB system for the feed-pushing robot was less than 16 cm under no-line-of-sight conditions in the cattle barn. At low speeds, the robot was subjected to linear tracking comparative experiments with forward-looking distances of 50, 100, 150, and 200 cm. The minimum upper-line distance of the dynamic forward-looking distance model was 205.43 cm. In the steady-state phase, the average lateral deviation was 3.31 cm, with an average standard deviation of 2.58 cm and the average root mean square error (RMSE) of 4.22 cm. Compared with the fixed forward-looking distance model, the average lateral deviation, the standard deviation, and the RMSE were reduced by 42.83%, 37.07%, and 42.90%, respectively. The autonomous navigation experiments conducted on the feed-pushing robot at travel speeds of 6, 8, and 10 m/min demonstrated that the maximum average lateral deviation was 7.58 cm, the maximum standard deviation was 8.22 cm, and the maximum RMSE was 11.07 cm, meeting the autonomous navigation requirements for feed-pushing operations in complex barn environments. This study provides support for achieving high-precision autonomous navigation control technology in complex environments.
Read full abstract