一种水下剖面监测机器人控制器及自动轨迹跟踪控制方法

摘要

本发明涉及一种水下剖面监测机器人控制器，包括置于船载控制箱内的控制器A和置于水下机器人仪器舱内的控制器B两部分，二者通过铠装的脐带电缆进行通信，控制器A实时采集船载控制器控制面板的遥控控制指令，并将控制指令按照自定义的通信协议进行编码和组装成帧，经由通信模块发送到水下控制器B；水下控制器B实时接收船载控制器A发送的协议帧，并进行协议解码，按照协议格式解析出控制指令，进而控制继电器驱动板上的对应的继电器的开关动作，从而实现对水下机器人运动姿态的控制。本发明采用有限时间轨迹跟踪控制技术实现水下机器人对预定轨迹点的跟踪，能够实现水下剖面监测机器人的大范围、高精度运动和姿态控制。