ZHAO Zhuangzhuang, ZHANG Guozhong, LUO Chengming, et al. Path tracking algorithm of the dual motor tracked chassis considering skid and slip[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2024, 40(12): 46-54. DOI: 10.11975/j.issn.1002-6819.202401021
    Citation: ZHAO Zhuangzhuang, ZHANG Guozhong, LUO Chengming, et al. Path tracking algorithm of the dual motor tracked chassis considering skid and slip[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2024, 40(12): 46-54. DOI: 10.11975/j.issn.1002-6819.202401021

    Path tracking algorithm of the dual motor tracked chassis considering skid and slip

    • Track skid and slip often occur, when the tracking chassis work in soft soil and uneven field. The accuracy of curved path tracking can inevitably deteriorate in automatic navigation. In this work, path tracking was designed to consider the track skid and slip in field conditions. Firstly, the coefficient of turning radius correction was derived to describe the skid and slip characteristics using the kinematic model of the tracked chassis. Then, the lateral and heading deviations were determined by the look-ahead model. Finally, a three-input fuzzy controller was established with the controller inputs of lateral deviation, heading deviation and turning radius correction coefficient. A dual-motor tracked chassis was designed to validate the model. The control hardware included two brushless DC motors, a motor driver, an STM32 microcontroller, and two photoelectric rotary encoders. In navigation, the position, heading and angular velocity of the chassis were measured by a high-precision RTK-GNSS and an MTi-30 inertial sensor. The measurement values were sent to the upper-level computer using a serial port. The path tracking was carried out to calculate the control signal, and then sent into the lower-level microcontroller. The tracking of the reference path was realized by the motor driver of the lower-level microcontroller on both sides. A field experiment was conducted on automatic navigation to verify the performance of a three-input fuzzy controller. The field was selected with a lot of weeds, where the soil was wet and sticky with a moisture content of 22.4%. There was the low flatness with some pits, bulges and hardened soil blocks that scattered throughout the whole field. The speed of the chassis was set to 0.6 m/s in navigation. The look-ahead distance proportional coefficient of the look-ahead model was set to 1.5. An initial lateral deviation of about 1000 cm was set for the correction. The results showed that the average response time of the control system was 6.79 s, while the average distance was 4.08 m. The tracking test of the U-shaped path was performed on the three-input fuzzy controller. The maximum absolute deviation, average absolute deviation and standard deviation of the straight-line and curve tracking section were 12.0 and 21.3 cm, 3.6 and 8.6 cm, as well as 4.4 and 8.4 cm, respectively. The curve tracking with the three-input fuzzy controller was compared with the conventional one, in order to further determine the path tracking accuracy under track skid and slip. The maximum absolute deviation, average absolute deviation and standard deviation of the conventional and three-input fuzzy controller were 31.1 and 22.4 cm, 8.3 and 7.4 cm, as well as 10.2 and 9.1 cm, respectively. Compared with the conventional, the three-input fuzzy controller was improved by 27.95%, 10.84 % and 10.78 %, respectively, in the maximum absolute deviation, average absolute deviation and standard deviation. The better control performance of the navigation system was achieved in the three-input fuzzy controller, indicating the reduced influence of track skid and slip. This finding can also provide a strong reference for the high-precision navigation of tracked chassis in soft soil environments in the field.
    • loading

    Catalog

      /

      DownLoad:  Full-Size Img  PowerPoint
      Return
      Return