赵德安, 罗吉, 孙月平, 洪剑青, 张军. 河蟹养殖自动作业船导航控制系统设计与测试[J]. 农业工程学报, 2016, 32(11): 181-188. DOI: 10.11975/j.issn.1002-6819.2016.11.026
    引用本文: 赵德安, 罗吉, 孙月平, 洪剑青, 张军. 河蟹养殖自动作业船导航控制系统设计与测试[J]. 农业工程学报, 2016, 32(11): 181-188. DOI: 10.11975/j.issn.1002-6819.2016.11.026
    Zhao Dean, Luo Ji, Sun Yueping, Hong Jianqing, Zhang Jun. Design and experiment of navigation control system of automatic operation boat in river crab culture[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(11): 181-188. DOI: 10.11975/j.issn.1002-6819.2016.11.026
    Citation: Zhao Dean, Luo Ji, Sun Yueping, Hong Jianqing, Zhang Jun. Design and experiment of navigation control system of automatic operation boat in river crab culture[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(11): 181-188. DOI: 10.11975/j.issn.1002-6819.2016.11.026

    河蟹养殖自动作业船导航控制系统设计与测试

    Design and experiment of navigation control system of automatic operation boat in river crab culture

    • 摘要: 针对河蟹养殖过程中存在的水草清理难度大、喂料投饵不均匀、人力成本高等问题,该文设计了一种基于ARM(advanced RISC machine)和GPS/INS(global positioning system/inertial navigation system)组合导航的多功能全自动河蟹养殖作业船导航控制系统。该系统由明轮驱动船、ARM主控制器、GPS/INS组合导航装置等组成。为降低传统的基于有限目标点航道位置计算方法的复杂度并减小船体偏离航道的误差,该文提出了一种基于实时插点的航道位置计算方法,实时地解算出当前时刻的目标位置,并设计了相应的转弯及航道切换策略。针对明轮船具有非线性、大时滞、欠阻尼的运动特点,设计了基于模糊PID(proportion integration differentiation)的航向、航速双闭环运动控制算法;基于嵌入式Linux操作系统,设计了船载子系统软件,并编写了上位机监控程序对船载子系统的运行状态进行实时监控。利用河蟹养殖作业船试验平台进行了航速及自动导航试验,并对有限目标点和实时插点的航道位置计算方法的控制效果进行了对比。试验结果表明:船体速度响应较快,超调量不超过5%,稳态误差可控制在3%以内;采用有限点的航道位置计算方法时,船体在转弯与直行时偏离航道的最大误差分别为2.12和1.52m;采用实时插点的航道位置计算方法时,船体在转弯与直行时偏离航道的最大误差分别为0.36和0.09m,分别下降了83.02%和94.08%,船体的控制精度得到了全面的改善。该文可以为多功能河蟹养殖作业船的研究提供重要参考。

       

      Abstract: In China, the current river crab culture mainly depends on human labor, which brings some problems such as aquatic plant cleaning difficulty, nonuniform feeding and high labor cost. In order to solve the problems above, this paper proposed a multi-functional automatic river crab culture operation boat based on ARM (advanced RISC machine) and GPS/INS (global positioning system/inertial navigation system) integrated navigation. The system was mainly composed of ARM controller, GPS/INS integrated navigation devices, GPRS (general packet radio service) communication device, aquatic plant cleaning device, automatic feeding device and paddle wheel driving device. In automatic navigation mode, the ARM controller firstly received and processed the navigation data including position, course and speed from the GPS/INS devices. PWM (pulse width modulation) module and GPIO (general purpose input output) module were called to control the boat sailing, aquatic plant cleaning and automatic feeding simultaneously. The host computer communicated with the ARM controller via GPRS device to monitor the real-time operating status of the ship borne subsystem remotely. In order to simplify the complexity of the traditional calculation method of channel position based on finite target points and reduce channel deviation error of the boat, this paper proposed a new calculation method based on real-time inserting points. This method calculated the current target position of the boat real-timely according to the position of the boat and the turning points of current channel. A new turning and channel switching strategy was also presented in this paper to improve the boat work efficiency and prevent the boat from deviating from the channel because of the high speed. Considering the movement characteristics such as non-linearity, big delay and underdamping of the boat, the course-speed dual-loop control algorithm was designed based on fuzzy PID (proportion integration differentiation). In order to enhance the stability and portability of the system, the ship borne subsystem was designed based on embedded Linux operating system, and the monitoring program of host computer was developed based on Visual Studio 2010 platform and SQL (structured query language) Server 2008 database. With the purpose of demonstrating the effectiveness of the proposed system, the speed response and automatic navigation tests were performed in Jiangsu University in September 2015. In the speed response test, the target speed of the boat was set to 35 cm/s and the host computer would record and display the speed response curve of the boat from the stagnation to the target speed. Results showed that the speed overshoot was no more than 5% and the steady-state error could be kept within 3%. The boat responded quickly and it could greatly meet the speed regulation requirements. In the automatic navigation test, the boat was initially driven by manual control to obtain the position of 4 turning points of channel. After that, the automatic navigation tests based on finite target point and real-time inserting point method were carried out respectively. The host computer would record and display the position and channel deviation error of the boat during the test. Results showed that the maximal channel deviation errors based on finite point method at corner and straight were 2.12 and 1.52 m respectively while the maximal channel deviation errors were 0.36 and 0.09 m based on real-time inserting point method. The maximal channel deviation error based on real-time inserting point method decreased by 83.02% and 94.08% respectively compared with that based on finite point method. Through the analysis above we can see the accuracy of automatic navigation system has been fully improved. The multi-functional automatic river crab culture operation boat has the advantages of high work efficiency and low labor cost and the research can be considered as an efficient reference in river crab culture in the future.

       

    /

    返回文章
    返回