奚小波, 史扬杰, 单翔, 张琦, 金亦富, 龚俊杰, 张剑峰, 张瑞宏. 基于Bezier曲线优化的农机自动驾驶避障控制方法[J]. 农业工程学报, 2019, 35(19): 82-88. DOI: 10.11975/j.issn.1002-6819.2019.19.010
    引用本文: 奚小波, 史扬杰, 单翔, 张琦, 金亦富, 龚俊杰, 张剑峰, 张瑞宏. 基于Bezier曲线优化的农机自动驾驶避障控制方法[J]. 农业工程学报, 2019, 35(19): 82-88. DOI: 10.11975/j.issn.1002-6819.2019.19.010
    Xi Xiaobo, Shi Yangjie, Shan Xiang, Zhang Qi, Jin Yifu, Gong Junjie, Zhang Jianfeng, Zhang Ruihong. Obstacle avoidance path control method for agricultural machinery automatic driving based on optimized Bezier[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(19): 82-88. DOI: 10.11975/j.issn.1002-6819.2019.19.010
    Citation: Xi Xiaobo, Shi Yangjie, Shan Xiang, Zhang Qi, Jin Yifu, Gong Junjie, Zhang Jianfeng, Zhang Ruihong. Obstacle avoidance path control method for agricultural machinery automatic driving based on optimized Bezier[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(19): 82-88. DOI: 10.11975/j.issn.1002-6819.2019.19.010

    基于Bezier曲线优化的农机自动驾驶避障控制方法

    Obstacle avoidance path control method for agricultural machinery automatic driving based on optimized Bezier

    • 摘要: 动力换挡拖拉机的产生促进农机自动驾驶向着无人化方向发展,农机的自动避障成为需要解决的关键问题。该文针对最短切线路径曲线曲率不连续、跟踪控制精度差及农机运动模型精度低等缺点,采用三阶Bezier曲线优化法形成连续平滑农机避障路径,通过链式控制理论建立农机运动线性控制模型,利用PI控制器进行转角补偿,并进行了控制方法的仿真和犁耕作业试验。仿真结果表明:农机行驶的航向误差角在-0.06~0.06 rad,横向位置误差小于13 cm,前轮转向角变化平缓,没有显著突变,说明该方法控制精度较高,农机能够按预设轨迹行驶。犁耕作业试验结果表明:Bezier曲线部分的避障精度为5.21 cm,曲线路径的跟踪控制效果较好;避障后农机继续沿直线行驶的精度为1.98 cm,说明该方法可保证农机在避障后恢复直线自动驾驶。研究结果表明,该避障路径控制方法在不平整犁耕地中具有较好的鲁棒性和适应性,可满足拖拉机作业的避障要求。

       

      Abstract: Abstract: The generation of power shift tractor promotes the automatic driving of agricultural machinery to the direction of unmanned, and the automatic obstacle avoidance of agricultural machinery has become a key issue to be solved. Most of the existing obstacle avoidance path planning adopts the shortest tangent method, which has the advantages of fast and simple path generation and short track, but the curvature of the path curve is discontinuous and there are corner inflection points, which make the tractor front wheel angle suddenly change and affect the obstacle avoidance accuracy. In this paper, for the curvature discontinuity of the shortest tangent path curve, poor tracking control accuracy and low precision of agricultural machinery model, the third-order bezier curve optimization method was used to form a continuous smooth agricultural machine obstacle avoidance path. The optimized curve curvature was continuous and the obstacle avoidance path was smooth with no turning points, which was conducive to the control of agricultural machinery driving. The linear control model of agricultural machinery movement was established by chain control theory, and the PI controller was used for corner compensation to improve the accuracy of agricultural machinery obstacle avoidance. The simulation of the path tracking control method was completed. The simulation results showed that the heading error angle of the agricultural machinery was mostly in the range of -0.06-0.06 rad, the lateral position error was less than 13 cm, and the front wheel steering angle changed gently with no significant mutation, indicating that the control method of the obstacle avoidance path control method had a high precision, and the agricultural machinery can drive according to the preset trajectory. The ploughing operation test was carried out, and the Dongfanghong LF954-C power shift tractor was used, which can automatically start, stop, shift, and implement the lifting operation of the farm. The tractor was equipped with the Beidou agricultural autopilot with the straight running accuracy of ±2.5 cm. Ultrasonic radar and image recognition technology were used to perceive obstacles in the working environment. The farm implement was a 250 cm wide plow. A haystack obstacle was set on the machine working path with a contour radius smaller than the minimum turning radius of the tractor. The results of the plowing operation test showed that the machine can automatically complete the straight-line driving, farm implement lifting, automatic obstacle avoidance, farm implement falling, and continuous straight-line operation. The obstacle avoidance accuracy of the bezier curve was 5.21 cm, and the tracking control effect of the curve path was well. The accuracy of the agricultural machine continuing to travel in a straight line after obstacle avoidance was 1.98 cm, which indicated that the path tracking control method can ensure the tractor straight-line automatic driving after obstacle avoidance. The above results showed that the obstacle avoidance path and control method showed good robustness and adaptability in uneven ploughing land and can meet the obstacle avoidance requirements of tractor operation.

       

    /

    返回文章
    返回