一种用于大深度水下机器人姿态调整的配重与压铁布局方法技术

本发明专利技术涉及一种用于大深度水下机器人姿态调整的配重与压铁布局方法。水下机器人的姿态主要包括俯仰、横滚两个角度。水下机器人，特别是自主遥控水下机器人(ARV)具备多种使用模式，可以采样以及搭载额外的有效载荷，其重量和浮力的不同分布会造成水下机器人姿态的变化；当水下机器人起吊、水下航行探测以及回收海面时，由于吸附压铁状态不同，其姿态也不同。姿态角的过大会造成水下机器人航行阻力增大、推进器不匹配、回收时天线信号淹没等问题，因此水下机器人的姿态控制在水下航行控制、水面回收中扮演着重要作用，本姿态计算方法为大深度水下机器人姿态的确定提供了理论计算依据，压铁布局的确定也保证了水下机器人在下潜和海面回收时具备良好的姿态。海面回收时具备良好的姿态。海面回收时具备良好的姿态。

【技术实现步骤摘要】
一种用于大深度水下机器人姿态调整的配重与压铁布局方法


[0001]本专利技术涉及水下机器人
，特别涉及一种用于大深度水下机器人姿态调整的配重与压铁布局方法。

技术介绍

[0002]水下机器人，特别是无缆水下机器人在实际作业时面临多种工况，如起吊、入水，下潜，航行作业，上浮，海面回收。各种工况下，水下机器人载体的配重各有不同，其姿态也不同。水下机器人在水下航行作业时，需要保持良好的姿态，如姿态角度过大，会导致航行阻力增大，传感器失效，甚至通过本身的推进器难以抵消过大的姿态角度，导致潜次的失败。水下机器人起吊时，如果姿态角度过大，会导致水下机器人与潜器底座发生碰撞，难以落位等情况。水下机器人回收至海面，如姿态角度过大，会导致在海面无法航行，通信天线埋没海水无法发出位置信息等。因此需要对水下机器人的水下、起吊姿态进行精准的计算。

技术实现思路

[0003]针对上述问题，本专利技术的目的在于提供一种用于大深度水下机器人姿态调整的配重与压铁布局方法，对水下机器人的水下、起吊姿态进行精准的计算，对于姿态角度过大的，通过配重的布局调整，实现水下机器人水下和起吊时的姿态水平。对于水下机器人海面回收工况，通过对上浮压铁特定位置的布局，实现水下机器人海面回收时的姿态水平。实现对水下机器人水下和起吊姿态的计算以及在海面回收工况下，保证潜器水平时的上浮压铁布局。
[0004]本专利技术的目的是通过以下技术方案来实现的：
[0005]一种用于大深度水下机器人姿态调整的配重与压铁布局方法，结合潜器的布放和回收流程，通过吊钩、配重、压铁布局，实现水下机器人海面回收时姿态水平，水下机器人下潜时减小阻力、提高下潜速度，水下机器人水下运行时和起吊时姿态平稳；包括以下步骤：
[0006]步骤1、定义水下机器人模型的三维坐标系原点(x0，y0，z0)及方向；
[0007]步骤2、计算水下机器人的上浮压铁布局位置，使得水下机器人在无动力上浮过程后能平稳浮在预设的海面切割线；
[0008]步骤3、设计水下机器人的下潜压铁布局位置，计算下潜过程姿态，控制下潜姿态；
[0009]步骤4、根据水下姿态设计水下机器人在水下运行过程中的预置配重和其布局位置，使得水下机器人在水下运行过程中保持姿态平稳；
[0010]步骤5、设计布放起吊钩和回收起吊钩的位置，使得布放起吊和回收起吊过程的姿态平稳。
[0011]所述潜器的布放和回收流程，包括：
[0012]布放起吊：勾取吊钩，控制布放起吊过程中的姿态角平稳；此时水下机器人吸附上浮压铁与下潜压铁；
[0013]下潜：水下机器人入水后，上浮压铁与下潜压铁均吸附在水下机器人上，依靠下潜
压铁的重量，无动力下潜至目标深度，抛掉下潜压铁，此时水下机器人重力浮力平衡；
[0014]水下运行：潜器以平衡姿态执行水下航行任务；
[0015]上浮：待作业完成，抛掉上浮压铁，水下机器人依靠自身浮力，无动力上浮，直至部分漏出海面；
[0016]回收起吊：勾取起吊钩，控制回收起吊过程中的姿态角平稳；此时所述上浮压铁与下潜压铁均被抛载。
[0017]所述上浮压铁位置布局计算的步骤如下：
[0018]步骤2.1：计算海面回收时，水下机器人的正浮力数值；
[0019]根据水下机器人系统的不利因素：内部耐压舱漏水造成的失去浮力值、浮力材损坏造成的浮力减少值、光纤缠绕牵引力值，设定由不利因素累加形成的水下机器人的海面正浮力值；
[0020]步骤2.2：计算水下机器人相对海面线的位置；
[0021]a.在模型中，通过海面切割水下机器人上部浮力材，模拟水下机器人漏出海面不同高度；
[0022]b.切割后，将上部浮力材体积换算成浮力，加上漏出海面设备的损失浮力，得到总浮力损失值；所述漏出海面设备包括天线、起吊钩；
[0023]c.计算不同的切割位置，对应不同的浮力损失值，直至总浮力损失值等于海面正浮力值，从而确定海面切割位置；
[0024]步骤2.3：计算水下机器人上浮压铁位置；
[0025]对海面以上的浮力材、天线、设备，计算浮力中心，确定上浮压铁x和z两个方向的坐标位置；所述上浮压铁吸附在潜器底部外侧，上浮压铁y方向的高度位置依据电磁铁、水下机器人框架位置确定。
[0026]所述下潜压铁位置布局的步骤如下：
[0027]将下潜压铁布局在水下机器人艏部，水下机器人下潜时，由于下潜压铁靠前，水下机器人带有一定角度下潜，艏部低于艉部，减小下潜迎流面积，从而减小下潜阻力，加大下潜速度。
[0028]下潜过程中是按照如下计算的姿态角控制水下机器人下潜过程中的姿态：
[0029]步骤3.1：计算水下机器人下潜过程重心位置(x
c下潜
，y
c下潜
，z
c下潜
)；此时水下机器人下潜过程中吸附着下潜压铁和上浮压铁，计算重心包括上浮压铁和下潜压铁；
[0030]步骤3.2：拟定迎流角度，通过水动力仿真软件，计算当前迎流角度下的压力中心位置(x
p
，y
p
，z
p
)；
[0031]步骤3.3：下潜过程重心与压力中心连线，判断与迎流是否平行，若平行，当前的迎流角度即为水下机器人下潜过程中的姿态角，否则返回步骤3.1重新计算；所述计算的姿态角用于控制水下机器人下潜过程中的姿态。
[0032]所述水下姿态计算步骤如下：
[0033]步骤4.1a：定义水下机器人的配重位置和质量；所述配重为单一配重或不同配重的组合；
[0034]步骤4.1b：计算浮心坐标(x
f
，y
f
，z
f
)；
[0035]式中，x
fi
，y
fi
，z
fi
为第i个计重件的形心位置坐标值，V
i
为第i个计重件的排水体积；此时水下机器人搭载上浮压铁，抛掉下潜压铁；所述计重件不包括下潜压铁，包括潜器上的各个零部件、配重、上浮压铁；各个零部件的位置、质量已知；
[0036]步骤4.1c：计算水下机器人的水下航行重心位置(x
c水下航行
，y
c水下航行
，z
c水下航行
)；此时水下机器人搭载上浮压铁、抛掉下潜压铁，计算重心不包括下潜压铁，包括潜器上的各个零部件、配重、上浮压铁；
[0037]步骤4.1d：计算水下机器人在水下俯仰角水下横滚角所述水下运行过程是按照该俯仰角和横滚角控制机器人的水下运行姿态。
[0038]所述调整潜器在水下运行过程中的预置配重和其布局位置，包括：
[0039]步骤4.2：判断水下俯仰角θ
水下俯仰角
是否满足设定的阈值范围要求，若是则输出当前的配重位置和质量，否则返回步骤4.1a重新计算。
[0040]所述布放起吊姿态计算步骤本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于大深度水下机器人姿态调整的配重与压铁布局方法，其特征在于，结合潜器的布放和回收流程，通过吊钩、配重、压铁布局，实现水下机器人海面回收时姿态水平，水下机器人下潜时减小阻力、提高下潜速度，水下机器人水下运行时和起吊时姿态平稳；包括以下步骤：步骤1、定义水下机器人模型的三维坐标系原点(x0，y0，z0)及方向；步骤2、计算水下机器人的上浮压铁布局位置，使得水下机器人在无动力上浮过程后能平稳浮在预设的海面切割线；步骤3、设计水下机器人的下潜压铁布局位置，计算下潜过程姿态，控制下潜姿态；步骤4、根据水下姿态设计水下机器人在水下运行过程中的预置配重和其布局位置，使得水下机器人在水下运行过程中保持姿态平稳；步骤5、设计布放起吊钩和回收起吊钩的位置，使得布放起吊和回收起吊过程的姿态平稳。2.根据权利要求1所述的用于大深度水下机器人姿态调整的配重与压铁布局方法，其特征在于，所述潜器的布放和回收流程，包括：布放起吊：勾取吊钩，控制布放起吊过程中的姿态角平稳；此时水下机器人吸附上浮压铁与下潜压铁；下潜：水下机器人入水后，上浮压铁与下潜压铁均吸附在水下机器人上，依靠下潜压铁的重量，无动力下潜至目标深度，抛掉下潜压铁，此时水下机器人重力浮力平衡；水下运行：潜器以平衡姿态执行水下航行任务；上浮：待作业完成，抛掉上浮压铁，水下机器人依靠自身浮力，无动力上浮，直至部分漏出海面；回收起吊：勾取起吊钩，控制回收起吊过程中的姿态角平稳；此时所述上浮压铁与下潜压铁均被抛载。3.根据权利要求1所述的用于大深度水下机器人姿态调整的配重与压铁布局方法，其特征在于，所述上浮压铁位置布局计算的步骤如下：步骤2.1：计算海面回收时，水下机器人的正浮力数值；根据水下机器人系统的不利因素：内部耐压舱漏水造成的失去浮力值、浮力材损坏造成的浮力减少值、光纤缠绕牵引力值，设定由不利因素累加形成的水下机器人的海面正浮力值；步骤2.2：计算水下机器人相对海面线的位置；a.在模型中，通过海面切割水下机器人上部浮力材，模拟水下机器人漏出海面不同高度；b.切割后，将上部浮力材体积换算成浮力，加上漏出海面设备的损失浮力，得到总浮力损失值；所述漏出海面设备包括天线、起吊钩；c.计算不同的切割位置，对应不同的浮力损失值，直至总浮力损失值等于海面正浮力值，从而确定海面切割位置；步骤2.3：计算水下机器人上浮压铁位置；对海面以上的浮力材、天线、设备，计算浮力中心，确定上浮压铁x和z两个方向的坐标位置；所述上浮压铁吸附在潜器底部外侧，上浮压铁y方向的高度位置依据电磁铁、水下机
器人框架位置确定。4.根据权利要求1所述的用于大深度水下机器人姿态调整的配重与压铁布局方法，其特征在于，所述下潜压铁位置布局的步骤如下：将下潜压铁布局在水下机器人艏部，水下机器人下潜时，由于下潜压铁靠前，水下机器人带有一定角度下潜，艏部低于艉部，减小下潜迎流面积，从而减小下潜阻力，加大下潜速度。5.根据权利要求1所述的用于大深度水下机器人姿态调整的配重与压铁布局方法，其特征在于，下潜过程中是按照如下计算的姿态角控制水下机器人下潜过程中的姿态：步骤3.1：计算水下机器人下潜过程重心位置(x
c下潜
，y
c下潜
，z
c下潜
)；此时水下机器人下潜过程中吸附着下潜压铁和上浮压铁，计算重心包括上浮压铁和下潜压铁；步骤3.2：拟定迎流角度，通过水动力仿真软件，计算当前迎流角度下的压力中心位置(x
p
，y
p
，z
p
)；步骤3.3：下潜过程重心与压力中心连线，判断与迎流是否平行，若平行，当前的迎流角度即为水下机器人下潜过程中的姿态角，否则返回步骤3.1重新计算；所述计算的姿态角用于控制水下机器人下潜过程中的姿态。6.根据权利要求1所述的用于大深度水下机器人姿态调整的配重与压铁布局方法，其特征在于，所述水下姿态计算步骤如下：步骤4.1a：定义水下机器人的...

【专利技术属性】
技术研发人员：陈聪，王健，陆洋，唐元贵，王福利，陈汐，于得勇，闫兴亚，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：发明
国别省市：