基于四个定位器的飞机部件位姿调整协同控制方法

摘要

本发明公开了一种基于四个定位器的飞机部件位姿调整协同控制方法。包括如下步骤：1)建立全局坐标系OXYZ，在全局坐标系下计算出飞机部件的当前位姿与目标位姿；2)生成飞机部件的自动调整路径与点动调整路径；3)根据自动调整路径与点动调整路径规划出定位器与飞机部件的球铰联结点的轨迹；4)将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数；5)基于SynqNet总线构建12电机轴同步控制网络，单根电机轴的位置伺服采用全闭环数字控制；6)选择两个定位器，配置两者的关系为主从运动模式。本发明的优点在于：1)可以规划出飞机部件位姿调整的路径；2)可以实现定位器单轴运动的全闭环控制；3)可以实现位姿调整系统的12轴同步运动。