陈立坡. 混联自稳跟踪平台及控制系统设计与试验[J]. 农业工程学报, 2018, 34(1): 22-27. DOI: 10.11975/j.issn.1002-6819.2018.01.04
    引用本文: 陈立坡. 混联自稳跟踪平台及控制系统设计与试验[J]. 农业工程学报, 2018, 34(1): 22-27. DOI: 10.11975/j.issn.1002-6819.2018.01.04
    Chen Lipo. Design and experiment of hybrid stabilized tracking platform and its control system[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2018, 34(1): 22-27. DOI: 10.11975/j.issn.1002-6819.2018.01.04
    Citation: Chen Lipo. Design and experiment of hybrid stabilized tracking platform and its control system[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2018, 34(1): 22-27. DOI: 10.11975/j.issn.1002-6819.2018.01.04

    混联自稳跟踪平台及控制系统设计与试验

    Design and experiment of hybrid stabilized tracking platform and its control system

    • 摘要: 为克服舰船摇摆所带来的影响,拓宽电视跟踪设备的使用环境,该文提出了一种五自由度具有2层结构的自稳跟踪平台。上层为两自由度的跟踪平台,采用串联式U-U结构,即U型外框绕外环轴(铅垂)旋转,U形内框绕内环轴(水平)旋转;下层为三自由度的自稳平台,采用并联式3UPS/PU结构,3个UPS为驱动分支,中间PU为约束分支。分别建立了跟踪平台和自稳平台的数学模型,推导了跟踪平台引导算法和自稳平台运动学反解算法。试验结果表明:当选用0.5 Hz、5.1?幅值的正弦曲线作为目标跟踪曲线时,自稳跟踪平台跟踪精度优于0.02?;自稳平台的稳定频率优于1 Hz(双十,幅值1.5?);以频率0.1 Hz,幅值30?进行正弦摇摆时,动态自稳精度优于0.3?。该研究将跟踪功能和自稳功能相结合,可为渔船定点撒网、收网以及农作物精准种植、收割等设备的开发提供参考。

       

      Abstract: Abstract: In the process of navigation, because of the influence of the waves, ships will generate the movement of rolling, pitching, heading, and so on. This movement will disturb the using of the TV (television) tracking equipment and change the direction and bring some danger to equipment and personnel. In order to overcome the effects of ship swaying, and broaden the application scope of TV tracking equipment, a novel five-degree-of-freedom stabilized tracking platform using two-layer structure is introduced, which is of great significance and illustrates a good prospect of application. The upper layer is the two-degree-of-freedom tracking platform, which uses the series structure of U-U (the U-shaped outer frame revolving around the outer ring axis and the U-shaped inner frame revolving around the inner ring axis). It can ensure that the TV tracking equipment is aimed at the dynamic target in real time. The down layer is the three-degree-of-freedom stabilized platform, which uses the parallel structure of 3UPS/PU because of its characteristics of good stiffness, large carrying capacity, high precision, compact conformation, and so on. But control algorithm complexity and poor real-time performance cause the low accuracy of the stable platform, which seriously affects the further development of the stable platform of parallel mechanism. So the RTX(real-time extension) operating system is combined in order to improve the real-time performance of the control system. The stabilized platform can effectively isolate the disturbance of ships and provide a stable erection platform for TV tracking equipment. UPS is the driving branch and PU is the constraint branch. The upper platform's radius is 500 mm. The down platform's radius is 700 mm. The height of stabilized platform is 900 mm. The angle of adjacent spherical joints is 120° on the upper platform. The angle of adjacent spherical hinges is 120° on the down platform. Mathematical models of tracking platform and stabilized platform are established respectively and the algorithm of tracking platform guidance and the kinematics of stabilized platform are derived. A set of IMU(inertial measurement unit) is installed on the outer frame of the tracking platform, which can dynamically acquire the position of the tracking platform. GPS (global position system) signal source is installed on the target and the target information is transmitted to the tracking platform computer through the wireless network. By guiding the solution method, the rolling and pitching angle of the tracking platform are calculated. And then computer controls the outer frame and inner frame axis to achieve dynamic tracking. Now the control strategy of the stable platform of parallel mechanism is based on kinematics or dynamics. By contrast, the control strategy based on kinematics is easier to implement and has a better real-time performance. So the control strategy of the stable platform of parallel mechanism uses the one based on kinematics. The stabilized platform has the motions of 2 directions i.e. rolling and pitching. The sensitive component installed on stabilized platform is aware of the ship's rolling, pitching attitude and other parameters. These motion parameters are transmitted to the motion control computer. The motion control computer calculates through the real-time kinematics, and the motion quantity of the electric cylinder is obtained and the control instruction is generated. The control instruction is output after signal conditioning by the servo control unit, which drives the movement of the servo system to realize the desired movement attitude. At the same time, the servo control unit can collect the displacement of the electric cylinder in real time, realize the monitoring and protection of the self-stabilized platform, and display the various information. Experimental results show that tracking accuracy of tracking platform is better than that of 0.02°, stable frequency of stabilized platform is better than that of 1 Hz, and dynamic stability precision is better than that of 0.3°. It confirms the self-stability and tracking performance of the designed platform. This study combines the tracking function with the stabilizing function, which can provide reference for the development of other ship-borne and vehicle-mounted equipment.

       

    /

    返回文章
    返回