[发明专利]一种柔性六自由度绳牵引的船模水池试验控制方法和系统

摘要

本发明公开一种柔性六自由度绳牵引的船模水池试验控制方法和系统，通过船模绳牵引支撑机构实现绳长控制及船模姿态的精确控制。在该方法中，主回路控制器根据预置的目标姿态角和姿态反馈信号计算船模分别连接的各个牵引绳的绳长调整量，将计算出的每个牵引绳的绳长调整量发送给副回路控制器，副回路控制器根据每个牵引绳的绳长调整量和每个伺服电机的脉冲反馈信号计算出船模分别连接的各个牵引绳的脉冲调整量，将计算出的每个牵引绳的脉冲调整量发送给各个牵引绳对应的驱动器，由驱动器按照脉冲调整量控制对应的伺服电机进行转动，通过伺服电机的转动控制传动机构的运动距离，对牵引绳的绳长变化控制，再通过牵引绳的绳长变化调整船模的当前姿态。

主权项

1.一种柔性六自由度绳牵引的船模水池试验控制方法，其特征在于，船模由电动拖车使用绳牵引并联支撑机构进行牵引运动，所述船模水池试验控制方法包括：/n副回路控制器通过所述船模内配置的姿态角传感器获取到所述船模的初始姿态信号，所述初始姿态信号包括：采集所述船模的初始姿态得到的初始姿态角；/n所述副回路控制器根据所述船模的初始姿态信号和预置的目标姿态角计算所述船模在各个时刻的姿态角；/n所述副回路控制器通过运动学模型将所述船模在各个时刻的姿态角转换为在各个时刻所述船模分别连接的每个牵引绳的脉冲调整量，然后所述副回路控制器将转换得到的每个牵引绳的脉冲调整量发送给各个牵引绳对应的驱动器，由所述驱动器按照所述脉冲调整量控制对应的伺服电机进行转动，从而通过伺服电机的转动控制传动机构的运动距离，实现对牵引绳的绳长变化控制，再通过牵引绳的绳长变化调整所述船模的当前姿态；/n当所述副回路控制器单独控制所述船模的时间结束时，主回路控制器通过所述船模内配置的姿态角传感器获取到所述船模的姿态反馈信号，所述姿态反馈信号包括：采集所述船模当前姿态得到的姿态角；/n所述主回路控制器根据预置的目标姿态角和所述姿态反馈信号计算所述船模分别连接的各个牵引绳的绳长调整量，并将计算出的每个牵引绳的绳长调整量发送给副回路控制器；/n所述副回路控制器从所述主回路控制器获取到所述船模分别连接的每个牵引绳的绳长调整量，以及通过所述每个牵引绳对应的伺服电机分别获取到脉冲反馈信号；/n所述副回路控制器根据所述每个牵引绳的绳长调整量和每个伺服电机的脉冲反馈信号计算出所述船模分别连接的各个牵引绳的脉冲调整量，然后所述副回路控制器将计算出的每个牵引绳的脉冲调整量发送给各个牵引绳对应的驱动器，由所述驱动器按照所述脉冲调整量控制对应的伺服电机进行转动，从而通过伺服电机的转动控制传动机构的运动距离，实现对牵引绳的绳长变化控制，再通过牵引绳的绳长变化调整所述船模的当前姿态。/n