CN114889749A - 一种水波主动适应水上作业机器人及其水波适应方法 - Google Patents

一种水波主动适应水上作业机器人及其水波适应方法 Download PDF

Info

Publication number
CN114889749A
CN114889749A CN202210633766.8A CN202210633766A CN114889749A CN 114889749 A CN114889749 A CN 114889749A CN 202210633766 A CN202210633766 A CN 202210633766A CN 114889749 A CN114889749 A CN 114889749A
Authority
CN
China
Prior art keywords
point
buoyancy
water
buoy
steering engine
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202210633766.8A
Other languages
English (en)
Other versions
CN114889749B (zh
Inventor
胡明
赵易达
杨景
吴建国
赵德明
高兴文
王丙旭
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang Sci Tech University ZSTU
Original Assignee
Zhejiang Sci Tech University ZSTU
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zhejiang Sci Tech University ZSTU filed Critical Zhejiang Sci Tech University ZSTU
Priority to CN202210633766.8A priority Critical patent/CN114889749B/zh
Publication of CN114889749A publication Critical patent/CN114889749A/zh
Application granted granted Critical
Publication of CN114889749B publication Critical patent/CN114889749B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B22/00—Buoys
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B43/00—Improving safety of vessels, e.g. damage control, not otherwise provided for
    • B63B43/02—Improving safety of vessels, e.g. damage control, not otherwise provided for reducing risk of capsizing or sinking
    • B63B43/10—Improving safety of vessels, e.g. damage control, not otherwise provided for reducing risk of capsizing or sinking by improving buoyancy
    • B63B43/14—Improving safety of vessels, e.g. damage control, not otherwise provided for reducing risk of capsizing or sinking by improving buoyancy using outboard floating members
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B22/00—Buoys
    • B63B2022/006—Buoys specially adapted for measuring or watch purposes
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
    • Y02E10/00—Energy generation through renewable energy sources
    • Y02E10/30—Energy from the sea, e.g. using wave energy or salinity gradient

Landscapes

  • Chemical & Material Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Combustion & Propulsion (AREA)
  • Mechanical Engineering (AREA)
  • Ocean & Marine Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种水波主动适应水上作业机器人及其水波适应方法，通过机身本体、机械臂、浮力组件和控制器的结合，实现浮力组件整体的水波主动适应；通过浮力组件中浮筒、球铰、力传感器、舵机、摇杆和绳索与控制器结合，实现浮筒单独的水波主动适应；通过多个力传感器获得水面对浮力组件不同位置的作用力，控制舵机对浮力组件和/或浮筒的位姿进行调整，实现有水波情况下保持机身本体稳定平衡的能力，能使安装在机身本体上的采集器保持相对稳定的工作状态。此外，本发明考虑到机器人的工作便利性，通过旋翼组件实现了飞行功能。

Description

一种水波主动适应水上作业机器人及其水波适应方法
技术领域
本发明属于水上作业机器人技术领域，具体涉及一种具有水波主动适应能力、减小水波对水上作业影响的机器人及其水波适应方法。
背景技术
水上作业机器人广泛应用于水域质量、环境监测领域，目前水域数据采集主要是通过水上机器人运行到水域中央区域进行采集。实践表明，数据采集误差主要体现为采集自身误差与采集环境效应误差。采集自身误差产生因素有仪器误差、载体振动等，采集环境效应有水波效应、水流效应等，其中水波效应是对采集精度造成影响的重要环境因素。
水波对数据采集的影响，主要是指在采集过程中，造成测量载体发生纵向晃动以及竖直升降等位姿改变，使采集器不能保持相对稳定的工作状态，继而造成数据采集的动态误差。介于水波本身的特性，对采集的数据进行滤波来消除水波的影响是件不易的事。故目前规定，为减少水波效应，水上作业机器人不能在有较大风浪环境下工作。
发明内容
本发明的目的是针对现有技术的不足，提供一种水波主动适应水上作业机器人及其适应方法。
本发明提供的技术方案是：
本发明一种水波主动适应水上作业机器人，包括机身本体、机械臂、旋翼组件和浮力组件；所述的机械臂包括舵机一、舵机二、连接件一、连接件二和连接件三；所述舵机一的机座通过连接件一与机身本体固定，连接件二与舵机一的输出轴固定；舵机二的机座通过连接件三与连接件二固定；所述舵机一的输出轴竖直设置，舵机二的输出轴水平设置；所述的浮力组件包括浮筒、球铰和脚踝套筒组件；所述的浮筒包括气垫和固定在气垫上的浮筒架；浮筒架上固定有多个力传感器；所述的球铰包括梁、球头和球壳；所述的球头与浮筒架通过三根梁固定连接，并与球壳构成球面副；所述的梁上固定有孔环；所述的脚踝套筒组件包括套筒、舵机三、舵机架和摇杆；所述的套筒通过球壳架与球壳固定；套筒内固定有三个舵机架，每个舵机架上固定有一个舵机三；每个舵机三的输出轴与一根摇杆一端固定，每根摇杆另一端与一根梁上的孔环通过一根绳索连接；绳索穿过球壳架开设的过孔。所述的机械臂设有阵列排布的四个，每个机械臂中舵机二的输出轴与一个浮力组件的套筒通过连接件四固定。每个浮力组件的球头上设有一个旋翼组件；所述的旋翼组件包括电机、电机架和旋翼；所述的电机架内置在球头中，并与球头固定；所述电机的机座与电机架固定；所述的旋翼与电机的输出轴固定。
该水波主动适应水上作业机器人的水波适应方法，具体如下：
浮力组件上的力传感器实时检测力的变化，并将检测信号传给控制器，控制器根据各浮力组件上力传感器的检测值，计算得到各浮力组件所受浮力大小；其中，某个浮力组件所受浮力大小为该浮力组件上各力传感器的检测值均值；所有浮力组件所受浮力均小于
Figure BDA0003681136590000021
时，视为无水波经过该水波主动适应水上作业机器人，其中，G0为该水波主动适应水上作业机器人整机的重力，η为误差值，在0.01～0.05之间取值。
若某个浮力组件所受浮力大于
Figure BDA0003681136590000022
视为有水波经过该浮力组件，该浮力组件被向上抬升，导致机身本体倾斜，此时，控制器控制与该浮力组件连接的机械臂中舵机二，使该浮力组件外摆并抬高，减小浮力组件排水体积，直到该浮力组件所受浮力小于
Figure BDA0003681136590000023
而某个浮力组件所受浮力小于
Figure BDA0003681136590000024
时，视为水波已经越过该浮力组件，此时，控制器控制与该浮力组件连接的机械臂中舵机二，使该浮力组件内摆并降低；其中，浮力组件外摆或内摆过程中，该浮力组件中各舵机三调整浮筒位姿，使浮筒始终保持竖直状态，浮力组件外摆时，浮筒内摆且与整个浮力组件摆角相等，浮力组件内摆时，浮筒外摆且与整个浮力组件摆角相等。而当某个浮力组件中有两个力传感器的检测值差值超过阈值，且该浮力组件未在抬高或降低过程中，也未处于抬高状态时，控制器控制该浮力组件中各舵机三调整浮筒位姿，使浮筒位于力传感器检测值较大的一侧向上倾斜，位于力传感器检测值较小的一侧向下倾斜，以此使该浮力组件各侧所受浮力大小相等。
优选地，机械臂中舵机二的转动角度k计算如下：
浮力组件受水波影响过程中浮力变化值ΔFM表达式为：
ΔFM＝ρgΔVM＝ρgSMΔhM
式中，ρ为工作环境中水的密度，g为重力加速度，ΔVM为浮力组件受水波影响过程中排水体积的改变量，SM为浮筒竖直状态下在水平面上的投影面积大小，ΔhM为浮筒的高度变化量；由于ΔFM通过浮筒上各力传感器在水波影响过程中检测值变化直接计算得到，且SM已知，求得ΔhM；
根据三角函数，求解得到机械臂中舵机二的转动角度k：
Figure BDA0003681136590000031
式中，lNP为点N与点P的距离，其中，N为机械臂调整前浮筒的几何中心位置，P为舵机二与连接件四连接处中心轴线在竖直面的投影。
优选地，舵机三调整浮筒位姿的过程如下：
某个舵机三带动对应摇杆向上摆动时，通过对应绳索拉动对应的梁，从而带动浮筒对应侧向上倾斜；某个舵机三带动对应摇杆向下摆动时，对应绳索放松，浮筒对应侧向下倾斜。
优选地，舵机三的转角d计算如下：
浮筒某一侧在水波影响过程中受力变化值ΔFo表达式为：
ΔFo＝ρgΔVO
其中，ΔVo为浮筒一侧在水波影响前后排水体积的改变量，计算式为：
Figure BDA0003681136590000032
式中，r1为浮筒外径，r2为浮筒内径，x和y分别为浮筒上的点在水平面上相互垂直的两个轴上的坐标，z为浮筒上的点在竖直轴上的坐标；
将ΔVO计算式代入ΔFO表达式中，且由于ΔFO通过浮筒上某个力传感器在水波影响过程中检测值变化直接得到，则求解得到浮筒受水波影响时所需调整的角度a。
设d为摇杆所需转动的角度，D为浮力组件调整前梁与绳索连接点，A为浮力组件调整后梁与绳索连接点，C为浮力组件调整前摇杆与绳索连接点，B为浮力组件调整后摇杆与绳索连接点，F为舵机与摇杆连接处中心轴线在竖直面上的投影，G为球铰的回转中心；c为点A与点G连线AG和点D与点G连线DG之间的夹角，c＝a，e为点A与点F连线AF和点B与点F连线BF之间的夹角，f为点C与点F连线CF和点A与点F连线AF之间的夹角，g为点A与点G连线AG和点F与点G连线FG之间的夹角，h为点A与点G连线AG和点C与点G连线CG之间的夹角，则点C与点F连线CF和点B与点F连线BF之间的夹角d计算如下：
Figure BDA0003681136590000033
其中，点A与点F的距离
Figure BDA0003681136590000034
点A与点C的距离
Figure BDA0003681136590000035
g＝j-c＝j-a，h＝i-c＝i-a，j为点D与点G连线DG和点F与点G连线FG之间的夹角，i为点D与点G连线DG和点C与点G连线CG之间的夹角，j、i为已知量；lBF为点B与点F的距离，lFC为点F与点C的距离，lBF＝lFC；lFC为点F与点C的距离，为已知量；lAB为点A与点B的距离，lAB＝lCD；lCD为点C与点D的距离，为已知量；lAG为点A与点G的距离，lAG＝lDG；lDG为点D与点G的距离，为已知量；lGF为点G与点F的距离，为已知量；lGC为点G与点C的距离，为已知量。
优选地，机身本体上固定有摄像头或雷达；在水面上摄像头或雷达检测到障碍物时，控制器控制舵机一旋转，带动旋翼组件和浮力组件躲避障碍物；该水波主动适应水上作业机器人通过四个旋翼组件飞行到达或离开水面，在飞行过程中摄像头或雷达检测到障碍物时，舵机一旋转带动旋翼组件和浮力组件躲避障碍物。
本发明具有的有益效果：
本发明通过机身本体、机械臂、浮力组件和控制器的结合，实现了浮力组件整体的水波主动适应；通过浮力组件中浮筒、球铰、力传感器、舵机、摇杆和绳索与控制器结合，实现了浮筒单独的水波主动适应；通过多个力传感器获得水面对浮力组件不同位置的作用力，控制舵机对浮力组件和/或浮筒的位姿进行调整，实现了有水波情况下保持机身本体稳定平衡的能力，能使安装在机身本体上的采集器保持相对稳定的工作状态。此外，本发明考虑到机器人的工作便利性，通过旋翼组件实现了飞行功能。
附图说明
图1为本发明水上作业机器人的整体结构立体图。
图2为本发明中机械臂、浮力组件和旋翼组件的装配立体图。
图3为本发明中脚踝套筒组件的结构立体图。
图4为本发明中旋翼组件的装配半剖视图。
图5为本发明对水波的其中一种主动适应过程姿态变化示意图。
图6为本发明受水波影响时主动调整舵机二转角的计算解析图。
图7为本发明受水波影响前后浮力组件的姿态变化示意图。
图8为本发明受水波影响时主动调整舵机三转角的计算解析图。
具体实施方式
下面结合附图对本发明作进一步说明。
如图1、2、3和4所示，一种水波主动适应水上作业机器人，包括机身本体1、机械臂2、旋翼组件6和浮力组件4；机械臂2包括舵机一11、舵机二14、连接件一10、连接件二12和连接件三13；舵机一11的机座通过连接件一10与机身本体1固定，连接件二12与舵机一11的输出轴固定；舵机二14的机座通过连接件三13与连接件二12固定；舵机一11的输出轴竖直设置，舵机二14的输出轴水平设置；浮力组件4包括浮筒7、球铰5和脚踝套筒组件3；浮筒7包括气垫24和固定在气垫24上的浮筒架22；浮筒架22上固定有多个力传感器18；球铰5包括梁21、球头20和球壳17；球头20与浮筒架22通过三根梁21固定连接，并与球壳17构成球面副；梁21上固定有孔环19；脚踝套筒组件3包括套筒16、舵机三26、舵机架27和摇杆25；套筒16通过球壳架28与球壳17固定；套筒16内固定有三个舵机架27，每个舵机架27上固定有一个舵机三26；每个舵机三26的输出轴与一根摇杆25一端固定，每根摇杆25另一端与一根梁21上的孔环19通过一根绳索连接；绳索穿过球壳架28开设的过孔。机械臂2设有阵列排布的四个，每个机械臂2中舵机二14的输出轴与一个浮力组件4的套筒16通过连接件四15固定。每个浮力组件4的球头20上设有一个旋翼组件6；旋翼组件6包括电机29、电机架30和旋翼23；电机架29内置在球头18中，并与球头18固定；电机29的机座与电机架30固定；旋翼23与电机29的输出轴固定(可以通过联轴器31连接)。
其中，舵机一11、舵机二14、舵机三26和电机29均经驱动器与控制器连接，由控制器控制，力传感器18的信号输出端与控制器8连接；控制器8固定在机身本体1上，并与上位机无线通讯；控制器8、舵机一11、舵机二14、舵机三26和电机29均由电源供电。
作为一个优选，机身本体1由固定在一起的两块受力板9组成，具体地，两块受力板9可以通过连接块固定，也可以直接通过机械臂2中舵机一11的机座固定。
该水波主动适应水上作业机器人的水波适应方法，具体如下：
浮力组件上的力传感器实时检测力的变化，并将检测信号传给控制器，控制器根据各浮力组件上力传感器的检测值，计算得到各浮力组件所受浮力大小；其中，某个浮力组件所受浮力大小为该浮力组件上各力传感器的检测值均值；所有浮力组件所受浮力均小于
Figure BDA0003681136590000051
时，认为无水波经过该水波主动适应水上作业机器人，其中，G0为该水波主动适应水上作业机器人整机的重力，η为误差值，在0.01～0.05之间取值。
如图5所示，若某个浮力组件所受浮力大于
Figure BDA0003681136590000052
认为有水波经过该浮力组件，该浮力组件被向上抬升，导致机身本体1倾斜，此时，控制器控制与该浮力组件连接的机械臂中舵机二14，使该浮力组件外摆并抬高，减小浮力组件排水体积，直到该浮力组件所受浮力小于
Figure BDA0003681136590000053
保证机身本体的平稳状态；而某个浮力组件所受浮力小于
Figure BDA0003681136590000054
时，认为水波已经越过该浮力组件，此时，控制器控制与该浮力组件连接的机械臂中舵机二14，使该浮力组件内摆并降低；其中，浮力组件外摆或内摆过程中，该浮力组件中各舵机三26调整浮筒7位姿，使浮筒7始终保持竖直状态，浮力组件外摆时，浮筒7内摆且与整个浮力组件摆角相等，浮力组件内摆时，浮筒7外摆且与整个浮力组件摆角相等。而当某个浮力组件中有两个力传感器的检测值差值超过阈值，且该浮力组件未在抬高或降低过程中，也未处于抬高状态时，控制器控制该浮力组件中各舵机三26调整浮筒7位姿，使浮筒7位于力传感器检测值较大的一侧向上倾斜，位于力传感器检测值较小的一侧向下倾斜，以此使该浮力组件各侧所受浮力大小相等，进一步保证机身本体的平稳状态。
作为一个优选，机械臂中舵机二14的转动角度k计算如下：
如图6所示，用长方形代表浮筒，线段代表机械臂，实线代表机械臂调整前位姿，虚线代表机械臂调整后位姿；设N和M分别为机械臂调整前、后浮筒的几何中心位置，P为舵机二与连接件四15连接处中心轴线在竖直面的投影；浮力组件受水波影响过程中浮力变化值ΔFM表达式为：
ΔFM＝ρgΔVM＝ρgSMΔhM
式中，ρ为工作环境中水的密度，g为重力加速度，ΔVM为浮力组件受水波影响过程中排水体积的改变量，SM为浮筒竖直状态下在水平面上的投影面积大小，ΔhM为浮筒的高度变化量；由于ΔFM通过浮筒上各力传感器18在水波影响过程中检测值变化直接计算得到，且SM已知，求得ΔhM；
根据三角函数，求解得到机械臂中舵机二14的转动角度k：
Figure BDA0003681136590000061
式中，lNP为点N与点P的距离，为已知量。
作为一个优选，舵机三26调整浮筒7位姿的过程如下：
某个舵机三26带动对应摇杆25向上摆动时，通过对应绳索拉动对应的梁21，从而带动浮筒对应侧向上倾斜；某个舵机三26带动对应摇杆25向下摆动时，对应绳索放松，浮筒对应侧向下倾斜。
作为一个优选，舵机三26的转角d计算如下：
如图7所示，用长方形代表浮筒，箭头代表波浪作用力方向，实线代表浮力组件调整前的状态，虚线代表浮力组件调整后的状态；设l1为浮筒调整前的对称横截面在竖直面上的投影，l′1为浮筒调整后的对称横截面在竖直面上的投影，l2为浮筒调整前的对称纵截面在竖直面上的投影，l3为水波波面在与浮筒相交处的切面在竖直面上的投影，O为浮筒调整前的几何中心，a为浮筒受水波影响时所需调整的角度，d为摇杆所需转动的角度，D为浮力组件调整前梁21与绳索连接点，A为浮力组件调整后梁21与绳索连接点，C为浮力组件调整前摇杆与绳索连接点，B为浮力组件调整后摇杆与绳索连接点，E为浮筒调整前上表面与对称纵截面交线在竖直面上的投影，F为舵机与摇杆连接处中心轴线在竖直面上的投影，G为球铰5的回转中心；浮筒受水波影响一侧上摆减少排水体积，另一侧下摆增大排水体积，最终使得浮筒两侧受力平衡；浮筒某一侧在水波影响过程中受力变化值ΔFO表达式为：
ΔFo＝ρgΔVO
其中，ΔVO为浮筒一侧在水波影响前后排水体积的改变量，计算式为：
Figure BDA0003681136590000071
式中，r1为浮筒外径，r2为浮筒内径，x和y分别为浮筒上的点在水平面上相互垂直的两个轴上的坐标，z为浮筒上的点在竖直轴上的坐标；
将ΔVO计算式代入ΔFO表达式中，且由于ΔFO通过浮筒上某个力传感器18在水波影响过程中检测值变化直接得到，则求解得到浮筒受水波影响时所需调整的角度a。
如图8所示，设c为点A与点G连线AG和点D与点G连线DG之间的夹角，c＝a，e为点A与点F连线AF和点B与点F连线BF之间的夹角，f为点C与点F连线CF和点A与点F连线AF之间的夹角，g为点A与点G连线AG和点F与点G连线FG之间的夹角，h为点A与点G连线AG和点C与点G连线CG之间的夹角，则点C与点F连线CF和点B与点F连线BF之间的夹角d计算如下：
Figure BDA0003681136590000072
其中，点A与点F的距离
Figure BDA0003681136590000073
点A与点C的距离
Figure BDA0003681136590000074
g＝j-c＝j-a，h＝i-c＝i-a，j为点D与点G连线DG和点F与点G连线FG之间的夹角，i为点D与点G连线DG和点C与点G连线CG之间的夹角，j、i均为浮力组件本身的结构参数，为已知量；lBF为点B与点F的距离，lFC为点F与点C的距离，lBF＝lFC，lFC为点F与点C的距离，为浮力组件本身的结构参数，为已知量；lAB为点A与点B的距离，lAB＝lCD，lCD为点C与点D的距离，为浮力组件本身的结构参数，为已知量；lAG为点A与点G的距离，lAG＝lDG，lDG为点D与点G的距离，为浮力组件本身的结构参数，为已知量；lGF为点G与点F的距离，为浮力组件本身的结构参数，为已知量；lGC为点G与点C的距离，为浮力组件本身的结构参数，为已知量。
作为一个优选，机身本体1上固定有与控制器连接的摄像头或雷达；摄像头或雷达检测到障碍物时，控制器控制舵机一旋转，带动旋翼组件6和浮力组件4躲避障碍物。该水波主动适应水上作业机器人通过四个旋翼组件6飞行到达或离开水面，在飞行过程中摄像头或雷达检测到障碍物时，也通过舵机一旋转带动旋翼组件6和浮力组件4躲避障碍物。

Claims (6)

1.一种水波主动适应水上作业机器人，包括机身本体、机械臂、旋翼组件和浮力组件，其特征在于：所述的机械臂包括舵机一、舵机二、连接件一、连接件二和连接件三；所述舵机一的机座通过连接件一与机身本体固定，连接件二与舵机一的输出轴固定；舵机二的机座通过连接件三与连接件二固定；所述舵机一的输出轴竖直设置，舵机二的输出轴水平设置；所述的浮力组件包括浮筒、球铰和脚踝套筒组件；所述的浮筒包括气垫和固定在气垫上的浮筒架；浮筒架上固定有多个力传感器；所述的球铰包括梁、球头和球壳；所述的球头与浮筒架通过三根梁固定连接，并与球壳构成球面副；所述的梁上固定有孔环；所述的脚踝套筒组件包括套筒、舵机三、舵机架和摇杆；所述的套筒通过球壳架与球壳固定；套筒内固定有三个舵机架，每个舵机架上固定有一个舵机三；每个舵机三的输出轴与一根摇杆一端固定，每根摇杆另一端与一根梁上的孔环通过一根绳索连接；绳索穿过球壳架开设的过孔；所述的机械臂设有阵列排布的四个，每个机械臂中舵机二的输出轴与一个浮力组件的套筒通过连接件四固定；每个浮力组件的球头上设有一个旋翼组件；所述的旋翼组件包括电机、电机架和旋翼；所述的电机架内置在球头中，并与球头固定；所述电机的机座与电机架固定；所述的旋翼与电机的输出轴固定。
2.根据权利要求1所述一种水波主动适应水上作业机器人的水波适应方法，其特征在于：该方法具体如下：
浮力组件上的力传感器实时检测力的变化，并将检测信号传给控制器，控制器根据各浮力组件上力传感器的检测值，计算得到各浮力组件所受浮力大小；其中，某个浮力组件所受浮力大小为该浮力组件上各力传感器的检测值均值；所有浮力组件所受浮力均小于
Figure FDA0003681136580000011
时，视为无水波经过该水波主动适应水上作业机器人，其中，G0为该水波主动适应水上作业机器人整机的重力，η为误差值，在0.01～0.05之间取值；
若某个浮力组件所受浮力大于
Figure FDA0003681136580000012
视为有水波经过该浮力组件，该浮力组件被向上抬升，导致机身本体倾斜，此时，控制器控制与该浮力组件连接的机械臂中舵机二，使该浮力组件外摆并抬高，减小浮力组件排水体积，直到该浮力组件所受浮力小于
Figure FDA0003681136580000013
而某个浮力组件所受浮力小于
Figure FDA0003681136580000014
时，视为水波已经越过该浮力组件，此时，控制器控制与该浮力组件连接的机械臂中舵机二，使该浮力组件内摆并降低；其中，浮力组件外摆或内摆过程中，该浮力组件中各舵机三调整浮筒位姿，使浮筒始终保持竖直状态，浮力组件外摆时，浮筒内摆且与整个浮力组件摆角相等，浮力组件内摆时，浮筒外摆且与整个浮力组件摆角相等；而当某个浮力组件中有两个力传感器的检测值差值超过阈值，且该浮力组件未在抬高或降低过程中，也未处于抬高状态时，控制器控制该浮力组件中各舵机三调整浮筒位姿，使浮筒位于力传感器检测值较大的一侧向上倾斜，位于力传感器检测值较小的一侧向下倾斜，以此使该浮力组件各侧所受浮力大小相等。
3.根据权利要求2所述一种水波主动适应水上作业机器人的水波适应方法，其特征在于：机械臂中舵机二的转动角度k计算如下：
浮力组件受水波影响过程中浮力变化值ΔFM表达式为：
ΔFM＝ρgΔVM＝ρgSMΔhM
式中，ρ为工作环境中水的密度，g为重力加速度，ΔVM为浮力组件受水波影响过程中排水体积的改变量，SM为浮筒竖直状态下在水平面上的投影面积大小，ΔhM为浮筒的高度变化量；由于ΔFM通过浮筒上各力传感器在水波影响过程中检测值变化直接计算得到，且SM已知，求得ΔhM；
根据三角函数，求解得到机械臂中舵机二的转动角度k：
Figure FDA0003681136580000021
式中，lNP为点N与点P的距离，其中，N为机械臂调整前浮筒的几何中心位置，P为舵机二与连接件四连接处中心轴线在竖直面的投影。
4.根据权利要求2所述一种水波主动适应水上作业机器人的水波适应方法，其特征在于：舵机三调整浮筒位姿的过程如下：
某个舵机三带动对应摇杆向上摆动时，通过对应绳索拉动对应的梁，从而带动浮筒对应侧向上倾斜；某个舵机三带动对应摇杆向下摆动时，对应绳索放松，浮筒对应侧向下倾斜。
5.根据权利要求2所述一种水波主动适应水上作业机器人的水波适应方法，其特征在于：舵机三的转角d计算如下：
浮筒某一侧在水波影响过程中受力变化值ΔFO表达式为：
ΔFO＝ρgΔVO
其中，ΔVO为浮筒一侧在水波影响前后排水体积的改变量，计算式为：
Figure FDA0003681136580000022
式中，r1为浮筒外径，r2为浮筒内径，x和y分别为浮筒上的点在水平面上相互垂直的两个轴上的坐标，z为浮筒上的点在竖直轴上的坐标；
将ΔVO计算式代入ΔFO表达式中，且由于ΔFO通过浮筒上某个力传感器在水波影响过程中检测值变化直接得到，则求解得到浮筒受水波影响时所需调整的角度a；
设d为摇杆所需转动的角度，D为浮力组件调整前梁与绳索连接点，A为浮力组件调整后梁与绳索连接点，C为浮力组件调整前摇杆与绳索连接点，B为浮力组件调整后摇杆与绳索连接点，F为舵机与摇杆连接处中心轴线在竖直面上的投影，G为球铰的回转中心；c为点A与点G连线AG和点D与点G连线DG之间的夹角，c＝a，e为点A与点F连线AF和点B与点F连线BF之间的夹角，f为点C与点F连线CF和点A与点F连线AF之间的夹角，g为点A与点G连线AG和点F与点G连线FG之间的夹角，h为点A与点G连线AG和点C与点G连线CG之间的夹角，则点C与点F连线CF和点B与点F连线BF之间的夹角d计算如下：
Figure FDA0003681136580000031
其中，点A与点F的距离
Figure FDA0003681136580000032
点A与点C的距离
Figure FDA0003681136580000033
g＝j-c＝j-a，h＝i-c＝i-a，j为点D与点G连线DG和点F与点G连线FG之间的夹角，i为点D与点G连线DG和点C与点G连线CG之间的夹角，j、i为已知量；lBF为点B与点F的距离，lFC为点F与点C的距离，lBF＝lFC；lFC为点F与点C的距离，为已知量；lAB为点A与点B的距离，lAB＝lCD；lCD为点C与点D的距离，为已知量；lAG为点A与点G的距离，lAG＝lDG；lDG为点D与点G的距离，为已知量；lGF为点G与点F的距离，为已知量；lGC为点G与点C的距离，为已知量。
6.根据权利要求2至5中任一项所述一种水波主动适应水上作业机器人的水波适应方法，其特征在于：机身本体上固定有摄像头或雷达；在水面上摄像头或雷达检测到障碍物时，控制器控制舵机一旋转，带动旋翼组件和浮力组件躲避障碍物；该水波主动适应水上作业机器人通过四个旋翼组件飞行到达或离开水面，在飞行过程中摄像头或雷达检测到障碍物时，舵机一旋转带动旋翼组件和浮力组件躲避障碍物。
CN202210633766.8A 2022-06-07 2022-06-07 一种水波主动适应水上作业机器人的水波适应方法 Active CN114889749B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210633766.8A CN114889749B (zh) 2022-06-07 2022-06-07 一种水波主动适应水上作业机器人的水波适应方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210633766.8A CN114889749B (zh) 2022-06-07 2022-06-07 一种水波主动适应水上作业机器人的水波适应方法

Publications (2)

Publication Number Publication Date
CN114889749A true CN114889749A (zh) 2022-08-12
CN114889749B CN114889749B (zh) 2023-07-07

Family

ID=82728687

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210633766.8A Active CN114889749B (zh) 2022-06-07 2022-06-07 一种水波主动适应水上作业机器人的水波适应方法

Country Status (1)

Country Link
CN (1) CN114889749B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115639629A (zh) * 2022-10-27 2023-01-24 自然资源部第一海洋研究所 一种运动平台对短波辐射传感器影响的评估系统及方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080032571A1 (en) * 2006-08-02 2008-02-07 Gregory Dudek Amphibious robotic device
CN102556318A (zh) * 2012-01-12 2012-07-11 河北工业大学 一种仿生水黾机器人
CN205594452U (zh) * 2016-05-03 2016-09-21 何维燊 多功能水上机器人
CN108313241A (zh) * 2018-03-16 2018-07-24 西北工业大学 基于rov平台的电磁吸附水下工作机器人
CN111186267A (zh) * 2020-01-17 2020-05-22 重庆大学 水陆两栖仿生六足机器人
CN111251797A (zh) * 2020-02-21 2020-06-09 深圳大学 一种两栖机器人
CN112061342A (zh) * 2020-08-21 2020-12-11 南京灵雀智能制造有限公司 适用于水上急救机器人浮力约束装置、急救机器人及工作方法
CN114162274A (zh) * 2021-12-31 2022-03-11 杭州电子科技大学 一种自驱动仿生水上染色机器人及水体表面流动检测方法
CN114194341A (zh) * 2021-12-20 2022-03-18 杭州电子科技大学 一种水上自驱摄影机器人及其使用方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080032571A1 (en) * 2006-08-02 2008-02-07 Gregory Dudek Amphibious robotic device
CN102556318A (zh) * 2012-01-12 2012-07-11 河北工业大学 一种仿生水黾机器人
CN205594452U (zh) * 2016-05-03 2016-09-21 何维燊 多功能水上机器人
CN108313241A (zh) * 2018-03-16 2018-07-24 西北工业大学 基于rov平台的电磁吸附水下工作机器人
CN111186267A (zh) * 2020-01-17 2020-05-22 重庆大学 水陆两栖仿生六足机器人
CN111251797A (zh) * 2020-02-21 2020-06-09 深圳大学 一种两栖机器人
CN112061342A (zh) * 2020-08-21 2020-12-11 南京灵雀智能制造有限公司 适用于水上急救机器人浮力约束装置、急救机器人及工作方法
CN114194341A (zh) * 2021-12-20 2022-03-18 杭州电子科技大学 一种水上自驱摄影机器人及其使用方法
CN114162274A (zh) * 2021-12-31 2022-03-11 杭州电子科技大学 一种自驱动仿生水上染色机器人及水体表面流动检测方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115639629A (zh) * 2022-10-27 2023-01-24 自然资源部第一海洋研究所 一种运动平台对短波辐射传感器影响的评估系统及方法
CN115639629B (zh) * 2022-10-27 2023-11-10 自然资源部第一海洋研究所 一种运动平台对短波辐射传感器影响的评估系统及方法

Also Published As

Publication number Publication date
CN114889749B (zh) 2023-07-07

Similar Documents

Publication Publication Date Title
JP5072566B2 (ja) 津波・波浪観測用ブイ
US10823709B2 (en) Methods and apparatus for realigning and re-adhering a hanging crawler vehicle on a non-level surface
CN109358654B (zh) 一种水空两栖搜救支援无人飞行器系统
CN114889749A (zh) 一种水波主动适应水上作业机器人及其水波适应方法
CN106043616B (zh) 船舶纵向动态减摇方法与装置
CN108750120B (zh) 一种植保无人飞机喷头主动平衡装置及调节方法
CN107161882B (zh) 一种新型的主动补偿吊机系统
CN113192404B (zh) 适用自然水体的深海采矿系统自航拖曳模拟器及模拟方法
CN215323203U (zh) 无人船平衡及远程可视化监控装置
CN114611206B (zh) 一种动力定位船的环境最优艏向定位方法
CN111055282A (zh) 一种海洋颠簸环境下零件修造加工的自稳定辅助结构
CN116639273A (zh) 一种无人机测绘数据采集装置及其采集方法
CN111896554A (zh) 一种用于表面微型貌检测的常压储罐爬壁机器人
CN109956020B (zh) 带有激光辅助导航系统的农用无人空气动力船及导航方法
CN113310471B (zh) 一种高稳定性的高精度地理信息测绘装置
CN217624017U (zh) 水上作业机器人
CN114030579B (zh) 一种无人船稳定控制方法及推进装置
CN117022578A (zh) 高速船舶抗浪增稳水动力自适应控制方法及实现装置
CN112078683B (zh) 融合式抗横风系统、设备及其方法
CN110416916B (zh) 用于巡检机器人在风载荷下的姿态调控方法及调控机构
CN114771831A (zh) 一种水、空两栖无人飞行器及其控制方法
CN114397905B (zh) 一种倾转旋翼机倾转过渡风洞飞行实验方法与系统
JP2022095292A (ja) 無人航空機および無人航空機の操縦方法
CN113009923A (zh) 一种用于双关节机器鱼的复合避障方法和装置
CN209186571U (zh) 一种吊点调节机构

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant