一种潜水器六自由度运动实时测量系统技术方案

本发明专利技术属于潜水作业技术领域，公开了一种潜水器六自由度运动实时测量系统,包括：测量软件，用于预览、捕捉、数据处理和回放；调整摄像头的位置和参数，对标记点识别；显控软件，用于接收并解析测量软件发送的实时运动数据，并为各类潜水器控制算法的调试提供软件接口；通信网络，用于实现全系统的数据互联，提供到公网以及第三方设备的扩展接口；刚体坐标系，建立在测量软件中；用标记点代表被测对象，在观测空间中建立三维坐标，为刚体坐标系。本发明专利技术测量过程和结果与潜水器型号无关，省去因潜水器型号变化增加的额外工作；系统基于商用传感器和软件开发，数据刷新快，测量精度高，操作简单，后期易于升级。

【技术实现步骤摘要】
一种潜水器六自由度运动实时测量系统
本专利技术属于潜水作业
，尤其涉及一种潜水器六自由度运动实时测量控制系统。
技术介绍
目前，业内常用的现有技术是这样的：潜水器由于其工作时间长、作业范围大的特性而日益成为人类进行海洋探索和海洋资源开发的重要工具，在科研、商业及军事领域得到了广泛的应用。目前，用于海洋探测开发的潜水器主要分为载人潜水器和无人潜水器，无人潜水器又包括遥控潜水器和自治潜水器两种。在各类潜水器的研制过程中，水池试验是进行潜水器运动控制研究的重要手段，通过测量潜水器在水池中的运动参数对控制器的设计进行指导和修正，使得潜水器达到预期的控制指标。综上所述，现有技术存在的问题是：(1)水池试验中，对潜水器运动参数的测量主要通过潜水器自身搭载的传感器完成，这使得潜水器必需在全系统集成结束之后才能进行水池试验，增长了研发周期，(2)对于某些传感器来说水池条件不满足其使用所需的环境条件，例如对于多普勒测速仪，如果水池深度和宽度条件不满足使用要求，将无法获得正确的数据反馈。(3)对于某些传感器随时间推移存在累积误差。例如惯性导航传感器每小时的累积误差高达几百米，这已远超水池的主尺度。(4)各类潜水器所搭载传感器的型号和接口各不相同，为了得到正确的传感器数据，每台潜水器都要进行大量的调试工作。解决上述技术问题的难度和意义：难度：很难寻找到一种适合潜水器水池试验的通用技术手段和硬件设备，并能为潜水器控制计算机或控制器提供符合工业通信标准的六自由度数据接口。意义：本专利技术缩短潜水器的研制周期，避免潜水器水池试验对所搭载传感器的依赖，省去因传感器型号不同而产生的调试工作，为潜水器控制系统提供实时运动状态信息。
技术实现思路
针对现有技术存在的问题，本专利技术提供了一种潜水器六自由度运动实时测量控制系统及控制方法。本专利技术提供一种基于商用传感器的非接触式六自由度实时测量系统，提供完备的六自由度数据，操作简便，数据更新快，潜水器只要配置了执行机构即可进行水池实验，缩短研发周期。本专利技术是这样实现的，一种潜水器六自由度运动实时测量系统，包括：测量软件，用于预览、捕捉、数据处理和回放；调整摄像头的位置和参数，对标记点识别；显控软件，用于接收并解析测量软件发送的实时运动数据，并为各类潜水器控制算法的调试提供软件接口；通信网络，用于实现全系统的数据互联，提供到公网以及第三方设备的扩展接口；刚体坐标系，建立在测量软件中；用标记点代表被测对象，在观测空间中建立三维坐标，为刚体坐标系。进一步，测量软件还用于测量刚体的运动，对测得的原始数据根据各标记点的运动轨迹计算得出刚体质心的六自由度运动参数，并按照规定的数据格式通过TCP/IP协议经网络传输给显控计算机。进一步，测量软件包括：预览模块，用于对标记点识别，并在软件窗口显示标记点和摄像头的相对位置，指导摄像头的布放和参数调整，建立相应的刚体坐标系。进一步，测量软件进一步包括：捕捉模块，用于记录一次测量中刚体的原始运动数据，对采样频率、捕捉时间参数均进行设置。进一步，测量软件进一步包括：数据处理模块，用于对原始数据的处理，根据刚体的质心和各标记点的运动轨迹计算得出刚体的六自由度运动参数；还用于工作于文件模式或实时模式，文件模式下数据处理结果自动保存至指定目录，实时模式下，数据处理结果通过网络实时传输给显控计算机或第三方软件。进一步，回放模块，用于对历史数据或测量工程文件的后处理和分析，自动生成数据图表。进一步，显控软件包括：数据接收模块，用于接收测量软件出书的数据并通过调用网络控制完成；数据解析模块，用于进行数据的错误校验、头尾识别和运动参数的提取；调试接口，用于为各类控制算法的输入参数和输出参数提供端口。进一步，建立刚体坐标系中，在测量软件中计算刚体在坐标系中的运动，得到被测对象的运动信息；选中一个标记点为基准点，设置为刚体坐标系的原点或以基准点为参照输入位置偏移值确定坐标原点的位置；从坐标原点连线到各标记点，选取其中一条线为基准，设置为X坐标轴或以基准为参照输入角度偏移值确定X坐标；依此类推，确定Y和Z坐标轴，完成刚体坐标系的定义。本专利技术的另一目的在于提供一种搭载所述潜水器六自由度运动实时测量系统的潜水器六自由度运动实时测量装置，所述潜水器六自由度运动实时测量装置包括：测量服务器，用于运行测量软件；调整摄像头的位置和参数，使粘贴于刚体全部标记点被识别；测量软件计算得出刚体的六自由度数据，并按照某种格式传输给显控计算机；摄像头，用于测量刚体的运动，实时记录标记点在刚体坐标系统中的运动轨迹，各摄像头测得的原始数据由无线网络传输给测量服务器中的测量软件；显控计算机，用于解析六自由度数据帧，并实时显示，同时将六自由度数据共享给潜水器的控制器，进行运动控制算法的调试；刚体，为潜水器，用于搭载标记点。进一步，摄像头至少两个，且具有相同的接口。综上所述，本专利技术的优点及积极效果为：本专利技术提供一种基于商用传感器的非接触式六自由度实时测量系统，提供完备的六自由度数据，操作简便，数据更新快，潜水器只要配置了执行机构即可进行水池实验，缩短研发周期.本专利技术基于对标记点的光学捕捉完成测量，测量的精度和效果只取决于光噪声大小、摄像头感光元件精度以及软件的后处理能力，与水池主尺度并无关联。本专利技术基于摄像头捕捉的标记点位置实时处理生成被测量对象的六自由度数据，各时刻的测量相互独立，因此无累积误差。本专利技术体现在光学测量系统应用于潜水器运动的测量。测量手段不依赖于潜水器本身所搭载的传感器，使得潜水器运动控制性能的研究工作不受潜水器本身研发周期的影响；测量过程和结果与潜水器型号无关，省去因潜水器型号变化增加的额外工作；系统基于商用传感器和软件开发，数据刷新快，测量精度高，操作简单，后期易于升级；数据传输介质为网络，可将系统接入公网或专用网络，实现对系统的远程访问和控制，将数据共享给有需求的研究人员。本系统与传统组合导航方式的对比附图说明图1是本专利技术实施例提供的潜水器六自由度运动实时测量装置示意图。图2是本专利技术实施例提供的潜水器六自由度运动实时测量装置实物示意图。图中：1、网络集线器；2、测量服务器；3、显控计算机；4、摄像头(不少于两只，根据需要可增加)；5、摄像头无线接入点；6、陆地单元无线接入点；7、光学标记点。图3是本专利技术实施例提供的四个白色圆点即为摄像头识别到的标记点图。具体实施方式为了使本专利技术的目的、技术方案及优点更加清楚明白，以下结合实施例，对本专利技术进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本专利技术，并不用于限定本专利技术。六自由度－物体在空间具有六个自由度，即沿X、Y、Z三个直角坐标轴方向的移动自由度和绕这三个坐标轴的转动自由度。如图1，本专利技术实施例提供的潜水器六自由度运动实时测量装置包括：测量服务器，用于运行测量软件；调整摄像头的位置和参数，使粘贴于刚体全部标记点被识别；测量软件计算得出刚体的六自由度数据，并按照某种格式传输给显控计算机；摄像头，用于测量刚体的运动，各摄像头测得的原始数据由无线网络传输给测量服务器中的测量软件；显控计算机，用于解析六自由度数据帧，并实时显示，同时将六自由度数据共享给潜水器的控制器，进行运动控制算法的调试；刚体，为潜水器，用于搭载标记点。图2是本专利技术实施例提本文档来自技高网...

【技术保护点】
1.一种潜水器六自由度运动实时测量系统，其特征在于，所述潜水器六自由度运动实时测量系统包括：测量软件，用于预览、捕捉、数据处理和回放；调整摄像头的位置和参数，对标记点识别；显控软件，用于接收并解析测量软件发送的实时运动数据，并为各类潜水器控制算法的调试提供软件接口；通信网络，用于实现全系统的数据互联，提供到公网以及第三方设备的扩展接口；刚体坐标系，建立在测量软件中；用标记点代表被测对象，在观测空间中建立三维坐标，为刚体坐标系。

【技术特征摘要】
1.一种潜水器六自由度运动实时测量系统，其特征在于，所述潜水器六自由度运动实时测量系统包括：测量软件，用于预览、捕捉、数据处理和回放；调整摄像头的位置和参数，对标记点识别；显控软件，用于接收并解析测量软件发送的实时运动数据，并为各类潜水器控制算法的调试提供软件接口；通信网络，用于实现全系统的数据互联，提供到公网以及第三方设备的扩展接口；刚体坐标系，建立在测量软件中；用标记点代表被测对象，在观测空间中建立三维坐标，为刚体坐标系。2.如权利要求1所述的潜水器六自由度运动实时测量系统，其特征在于，测量软件还用于测量刚体的运动，对测得的原始数据根据各标记点的运动轨迹计算得出刚体质心的六自由度运动参数，并按照规定的数据格式通过TCP/IP协议经网络传输给显控计算机。3.如权利要求1所述的潜水器六自由度运动实时测量系统，其特征在于，测量软件包括：预览模块，用于对标记点识别，并在软件窗口显示标记点和摄像头的相对位置，指导摄像头的布放和参数调整，建立相应的刚体坐标系。4.如权利要求1所述的潜水器六自由度运动实时测量系统，其特征在于，测量软件进一步包括：捕捉模块，用于记录一次测量中刚体的原始运动数据，对采样频率、捕捉时间参数均进行设置。5.如权利要求1所述的潜水器六自由度运动实时测量系统，其特征在于，测量软件进一步包括：数据处理模块，用于对原始数据的处理，根据刚体的质心和各标记点的运动轨迹计算得出刚体的六自由度运动参数；还用于工作于文件模式或实时模式，文件模式下数据处理结果自动保存至指定目录，实时模式下，数据处理结果通过网络实时传输给显控计算机或第三方软件。6...

【专利技术属性】
技术研发人员：王彪，罗瑞龙，罗高生，郭威，姜哲，
申请(专利权)人：上海海洋大学，
类型：发明
国别省市：上海,31