小型履带式油菜播种机导航免疫PID控制器设计

    Design of navigation immune controller of small crawler-type rape seeder

    • 摘要: 针对适应于长江中下游地区稻茬田土壤黏湿、小田块的轻简化播种机智能化问题,设计了一种基于免疫PID的小型履带式油菜播种机导航控制器。以小型履带式油菜播种机为基础,利用电磁铁对其转向系统进行电控改装,采用高精度北斗定位模块和电子罗盘进行组合导航,获取履带式播种机的位置和航向信息作为导航控制器的输入,设计了小型履带式油菜播种机自动导航控制系统。建立了履带式油菜播种机运动学模型和转向角传递函数,利用Matlab仿真和实地导航试验对常规PID控制和免疫PID控制进行了对比试验。仿真表明:在相同参数条件下,与常规PID相比,免疫PID控制具有响应快、超调量小、平均跟踪误差小等特点;路面试验表明:当播种机速度为0.50 m/s时,免疫PID控制器直线跟踪的平均绝对偏差为4.2 cm,最大跟踪偏差为12.0 cm。田间试验表明:当播种机速度为0.50 m/s时,免疫PID控制器直线跟踪平均绝对偏差为5.8 cm,最大偏差不超过15.2 cm,能够较好地满足播种机导航作业要求,该研究可为履带式播种机的自主导航提供了技术参考。

       

      Abstract: The middle and lower reaches of the Yangtze River are the main producing areas of winter rapeseed in China. However, due to the effects of harvesting agricultural crops, heavy soil compaction, small field, the mechanization level of rapeseed is low. The level of intelligent seeding needs to be improved. In this paper, a navigation controller for small crawler-type seeder based on immune PID was designed to solve the problem of intelligent seeding in the middle and lower reaches of the Yangtze River where the soil is sticky, the field is small. The small crawler-type rape seeder automatic navigation control system was designed. It used the small crawler-type rape seeder as the platform, and its steering system was modified by electromagnet. The high-precision BeiDou positioning module and the electronic compass was used for combined navigation to obtain the position and heading information of the crawler-type rape seeder as the input of the navigation controller. The immune PID controller was a nonlinear P controller that could adjust the proportional coefficient according to the feedback in real time. The control process was as follows. First, the plane coordinates of the start and end points of the straight path to be tracked were artificially set, and the main controller automatically calculated the distance of the target heading the start point and the end point. The weighted average algorithm was used to filter the longitude and latitude coordinates collected four times to get the current position. The controller calculated the distance deviation from the current position to the set route by the point-to-line distance formula. Taking the filtered distance deviation as an input, the target heading was calculated using the target heading correction formula distance deviation. Then, the course deviation (the deviation between the corrected target heading and the heading acquired by the electronic compass in real time) was used as an input of the immune PID controller, and the immune PID controller determined the Duty Ratio as the output u to act on the steering mechanism, achieving control of the steering of the track-type seeder. In addition, according to the characteristics of the tracked vehicle, the steering of the small crawler-type rape seeder was analyzed, and its steering model and steering angle transfer function were established. The immune PID controller was verified by Matlab simulation and experiment. Under the same parameters, the simulation showed that, compared with the conventional PID control, the immune PID control had the characteristics of fast response, small overshoot and small average tracking error. The pavement experiment showed that when the vehicle speed was 0.50 m/s, the average absolute deviation of the linear tracking of the immune PID controller was 4.2 cm, and the maximum deviation was not more than 11.9 cm. The field experiment showed that when the vehicle speed was 0.50 m/s, the average absolute deviation of the linear tracking of the immune PID controller was 5.8 cm, and the maximum deviation was not more than 15.2 cm, which was 32.6% and 18.1% higher than the conventional PID. It could better meet the requirements of the seeder navigation operation. This research provides a technical reference for the autonomous navigation of the crawler-type rape seeder.

       

    /

    返回文章
    返回