机动手术操作支撑装置的自适应平衡控制系统和方法

摘要

本发明提供一种机动手术操作支撑装置的自适应平衡控制系统和方法，该系统包括位姿测量机构、四自由度并联机构和控制系统，其中：位姿测量机构安装于机动手术操作支撑装置所搭载的平台上并用于测量该平台的位姿信号；四自由度并联机构包括上平台、下平台和连接于前述两平台之间的四个主动支链和一个从动支链，控制机构基于机动手术操作支撑装置的理想位姿信号和测得的平台位姿信号的偏差获取主动支链的位置信号，并与实际测量的主动支链位置信号比较，基于该比较结果控制主动支链运动。本发明可实现实时全方位的稳定，克服舰船体横摇、纵摇和垂荡的影响而保持机动手术操作支撑装置的平稳；而且采用反馈调节智能控制，稳定性好，执行效率高。

主权项

一种机动手术操作支撑装置的自适应平衡控制系统，其特征在于，包括位姿测量机构、四自由度并联机构和控制系统，其中：位姿测量机构安装于机动手术操作支撑装置所搭载的平台上并用于测量该平台的位姿信号，该位姿信号包括横摇角度、纵摇角度和垂荡距离；四自由度并联机构包括上平台、下平台和连接于前述两平台之间的四个主动支链和一个从动支链，下平台固定在机动手术操作支撑装置所搭载的平台上，机动手术操作支撑装置固定在上平台上，每个主动支链可驱动上平台，从动支链的一端固定于下平台且另一端通过球链与上平台连接；控制机构基于机动手术操作支撑装置的理想位姿信号和位姿测量机构测得的平台位姿信号的偏差获取四自由度并联机构的四个主动支链的位置信号，并与实际测量的四个主动支链的位置信号比较，基于该比较结果控制主动支链运动；前述机动手术操作支撑装置为一机动手术台。