CN103885404A - 水下机器人四螺旋桨推进器控制方法 - Google Patents

水下机器人四螺旋桨推进器控制方法 Download PDF

Info

Publication number
CN103885404A
CN103885404A CN201410080503.4A CN201410080503A CN103885404A CN 103885404 A CN103885404 A CN 103885404A CN 201410080503 A CN201410080503 A CN 201410080503A CN 103885404 A CN103885404 A CN 103885404A
Authority
CN
China
Prior art keywords
lef
rig
bac
fro
sense
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
CN201410080503.4A
Other languages
English (en)
Other versions
CN103885404B (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.)
QINGDAO ROBOTFISH MARINE TECHNOLOGY Co Ltd
Original Assignee
QINGDAO ROBOTFISH MARINE TECHNOLOGY Co Ltd
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 QINGDAO ROBOTFISH MARINE TECHNOLOGY Co Ltd filed Critical QINGDAO ROBOTFISH MARINE TECHNOLOGY Co Ltd
Priority to CN201410080503.4A priority Critical patent/CN103885404B/zh
Publication of CN103885404A publication Critical patent/CN103885404A/zh
Application granted granted Critical
Publication of CN103885404B publication Critical patent/CN103885404B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Manipulator (AREA)

Abstract

本发明提供了一种水下机器人四螺旋桨推进器控制方法,水下机器人上位机检测三维摇杆的实时位置将其转化成相应的参数通过485通信发给下位机,下位机接收到上位机发来的控制信息后,判断三维摇杆的三维运动参数up_dow,fro_bac,lef_rig,根据三维摇杆的命令参数控制四个推进器的推力大小以及方向,从而实现水下机器人在水中的运动控制;下位机通过判断第一维运动参数控制水下机器人的上升和下潜运动,通过判断第二和第三维运动参数,控制水下机器人直线前进、直线后退、左转弯、右转弯、左前方前进、右前方前进、左后方后退、右后方后退,有效的提高了水下机器人的控制精度和控制效率,很好的满足了操作人员的需要。

Description

水下机器人四螺旋桨推进器控制方法
技术领域
本发明属于水下机器人自动化控制技术领域,特别是涉及一种水下机器人的四螺旋桨推进器控制方法。
背景技术
随着我国海洋渔业的发展,人类自身的条件已经不能满足水下工作的需要,水下机器人的出现,在人类开发、探索海洋资源以及水产养殖方面都发挥着越来越重要的作用。
目前,国外已经有了一系列商业化的水下机器人产品,1960年世界上第一台水下机器人诞生,取名为“CURV1”,世界上第一台用于商业的水下机器人是美国的RCV-225,它主要应用于近海的开发作业,体积小,质量轻,有四个推进器可以实现潜体的前进、后退及上升、下降功能,但是水下机器人由于其复杂的水下环境,加上本身机器人形状的不规则性,往往很难建立准确的数学模型,加上水流等因素的影响,水下机器人的运动控制方法就需要较好的适应性。为了适应复杂的水下环境,通过上位机有效的控制下位机,就目前发展情况来看,仍需要建立一套比较有效的控制方法,通过控制动力大小来控制水下机器人在水下的运动方式,这样也可以提高水下机器人的控制精度和控制效率。
发明内容
本发明针对上述技术问题,提出了一种水下机器人四螺旋桨推进器控制方法,该方法能够实现上位机对下位机的动力大小以及方向控制,不仅提高了水下工作效率,而且可以让水下机器人在水下以任意方向运动,提高了水下监测的灵活高效性,很好的满足了操作人员的需要。
本发明的技术方案为:
和现有技术相比,本发明提供了一种水下机器人四螺旋桨推进器控制方法,包括如下步骤:
(1)水下机器人上位机检测三维摇杆的实时位置将其转化成相应的参数通过485通信发给下位机;
(2)下位机接收到上位机发来的控制信息后,判断三维摇杆的三维运动参数up_dow,fro_bac,lef_rig,当摇杆不操作时,处于中间位置,摇杆的三维运动实时参数均为0;
(3)根据三维摇杆的命令参数控制四个螺旋桨推进器的推力大小以及方向,利用左垂直推进器和右垂直推进器控制水下机器人的上升和下潜运动,利用左水平推进器和右水平推进器控制水下机器人直线前进、直线后退、左转弯、右转弯、左前方前进、右前方前进、左后方后退、右后方后退动作。基于上述方案,本发明还进行如下改进:
当摇杆从中间位置顺时针旋转到头的过程中,第一维摇杆实时参数up_dow的读数位从1到(N-1)均匀递增,当摇杆从中间位置逆时针旋转到头的过程中,读数位从N到(2N-1)均匀递增,下位机通过判断第一维运动参数up_dow,控制水下机器人的上升和下潜运动;如果第一维运动参数up_dow≤(N-1),此时左垂直推进器旋转方向为正,右垂直推进器旋转方向为反,实现下潜运功;如果第一维运动参数up_dow≥N,左垂直推进器旋转方向为反,右垂直推进器旋转方向为正,实现上升运功。
当摇杆从中间位置向前到头的过程中,第二维摇杆实时参数fro_bac的读数位从1到(N-1)均匀递增,当摇杆从中间位置向后到头的过程中,读数位从N到(2N-1)均匀递增,下位机判断第二维运动参数fro_bac,控制水下机器人的前进和后退运动;如果第二维运动参数fro_bac≤(N-1)成立,同时再判断第三维运动参数lef_rig=0,实现直线前进动作;如果第二维运动参数fro_bac≥N成立,同时再判断第三维运动参数lef_rig=0,实现直线后退动作。
当摇杆从中间位置向右到头的过程中,第三维摇杆实时参数lef_rig的读数位从1到(N-1)均匀递增,当摇杆从中间位置向左到头的过程中,读数位从N到(2N-1)均匀递增,下位机判断第三维运动参数lef_rig,控制水下机器人的左转弯和右转弯运动;如果第三维运动参数lef_rig≤(N-1)成立,同时再判断第二维运动参数fro_bac=0,实现右转弯运动;如果第三维运动参数lef_rig≥N成立,同时再判断第二维运动参数fro_bac=0,实现左转弯运动。
如果第二维运动参数fro_bac≤(N-1)成立,则fro=fro_bac,为前进命令;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器旋转方向为反,右水平推进器动力为[Max*(fro+lef)/N]r/min,当(fro+lef)≥N时,取(fro+lef)=N;左水平推进器动力为[Max*(|fro-lef|)/N]r/min,当(fro-lef)≥0时,左水平推进器旋转方向为正,当(fro-lef)<0时,左水平推进器旋转方向为反,实现左前方前进动作;如果第三维运动参数lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器旋转方向为正,左水平推进器动力为[Max*(fro+rig)/N]r/min,当(fro+rig)≥N时,取(fro+rig)=N;右水平推进器动力为[Max*(|fro-rig|)/N]r/min,当(fro-rig)≥0时右水平推进器旋转方向为反,当(fro-rig)<0时右水平推进器旋转方向为正,实现右前方前进动作。
如果第二维运动参数N<fro_bac<(N+40)成立,则bac=fro_bac-N,为左转弯过渡状态或转弯命令区;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器旋转方向为反,右水平推进器动力为[Max*(bac+lef)/N]r/min,当(bac+lef)≥N时,取(bac+lef)=N;左水平推进器动力为[Max*(|bac-lef|)/N]r/min,当(bac-lef)≥0时左水平推进器旋转方向为正,当(fro-lef)<0时左水平推进器旋转方向为反,实现左转弯过渡状态;如果lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器旋转方向为正,左水平推进器动力为[Max*(bac+rig)/N]r/min,当(bac+rig)≥N时,取(fro+rig)=N;右水平推进器动力为[Max*(|bac-rig|)/N]r/min,当(bac-rig)≥0时右水平推进器旋转方向为反,当(bac-rig)<0时右水平推进器旋转方向为正,实现右转弯过渡状态。
如果第二维运动参数fro_bac≥(N+40)成立,则bac=fro-bac-N,为后退命令;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器旋转方向为正,右水平推进器动力为[Max*(bac+lef)/N]r/min,当(bac+lef)≥N时,取(bac+lef)=N;左水平推进器动力为[Max*(|bac-lef|)/N]r/min,当(bac-lef)≥0时左水平推进器旋转方向为反,当(bac-lef)<0时左水平推进器旋转方向为正,实现左后方后退动作;如果第三维运动参数lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器旋转方向为反,左水平推进器动力为[Max*(bac+rig)/N]r/min,当(bac+rig)≥N时,取(bac+rig)=N;右水平推进器动力为[Max*(|bac-rig|)/N]r/min,当(bac-rig)≥0时右水平推进器旋转方向为正,当(bac-rig)<0时右水平推进器旋转方向为反,实现右后方后退动作。
本发明的技术效果为:
本发明通过上位机检测三维摇杆的实时位置将其转化成相应的参数通过485通信发给下位机,下位机接收到上位机发来的控制信息后,判断三维摇杆的三维运动参数up_dow,fro_bac,lef_rig,根据三维摇杆的命令参数控制四个螺旋桨推进器的推力大小以及方向,从而实现水下机器人在水中的运动控制;本发明不仅提高了水下工作效率以及水下机器人的控制精度和控制效率,而且提高了水下监测的灵活高效性,很好的满足了操作人员的需要。
附图说明
图1为本发明结构组成以及运动方向图。
图2为本发明上位机三维摇杆控制方向图。
图3为本发明一维运动参数控制示意图。
图4为本发明二维运动参数控制示意图。
图5为本发明三维运动参数控制示意图。
具体实施方式
下面结合附图说明本发明的具体实施方式:
由图1-5所示,本发明提供了一种水下机器人四螺旋桨推进器控制方法,水下机器人5包括左水平推进器3、右水平推进器4和左垂直推进器1、右垂直推进器2,每个推进器由一个电机和一个螺旋桨组成。四个推进器采用一种电机,但采用两对螺旋桨,水平推进器用一对,垂直推进器用一对,其中每对螺旋桨同向安装,但桨叶方向相反。上位机通过操作三维摇杆6来控制水下机器人5的运动方式。水平推进器提供水平推进动力,垂直推进器提供上升下潜动力,水下机器人5水平向前推进的时候为水平螺旋桨提供动力的两个电机分别反向旋转,故两个螺旋桨提供的动力都为向前;当两个电机同向旋转的时候,两个螺旋桨提供的动力一个向前一个向后,实现水下机器人5的转向,并且分别给予两个电机不同的动力,实现了转弯角度大小的控制。水下机器人5的上升下潜控制时左垂直推进器1和右垂直推进器2的两个电机不进行差速控制,而是同时给予相同的动力,通过控制动力大小控制水下机器人5的上升和下潜速度。下位机通过判断三维摇杆6的第一维运动参数实现控制水下机器人5的上升和下潜运动,通过判断第二和第三维运动参数,实现水下机器人5的直线前进、直线后退、左转弯、右转弯、左前方前进、右前方前进、左后方后退、右后方后退的运动控制。
本发明提供了一种水下机器人四螺旋桨推进器控制方法,包括如下步骤:
(1)水下机器人5上位机检测三维摇杆6的实时位置将其转化成相应的参数通过485通信发给下位机;
(2)下位机接收到上位机发来的控制信息后,判断三维摇杆6的三维运动参数up_dow,fro_bac,lef_rig,当摇杆6不操作时,处于中间位置,摇杆6的三维运动实时参数均为0;
(3)根据三维摇杆6的命令参数控制四个螺旋桨推进器的推力大小以及方向,利用左垂直推进器1和右垂直推进器2控制水下机器人5的上升和下潜运动,利用左水平推进器3和右水平推进器4控制水下机器人5直线前进、直线后退、左转弯、右转弯、左前方前进、右前方前进、左后方后退、右后方后退动作。
当摇杆6从中间位置顺时针旋转到头的过程中,第一维摇杆实时参数up_dow的读数位从1到(N-1)均匀递增,当摇杆6从中间位置逆时针旋转到头的过程中,读数位从N到(2N-1)均匀递增,下位机通过判断第一维运动参数up_dow,控制水下机器人5的上升和下潜运动;如果第一维运动参数up_dow≤(N-1),此时左垂直推进器1旋转方向为正,右垂直推进器2旋转方向为反,实现下潜运功;如果第一维运动参数up_dow≥N,左垂直推进器1旋转方向为反,右垂直推进器2旋转方向为正,实现上升运功。
当摇杆6从中间位置向前到头的过程中,第二维摇杆实时参数fro_bac的读数位从1到(N-1)均匀递增,当摇杆6从中间位置向后到头的过程中,读数位从N到(2N-1)均匀递增,下位机判断第二维运动参数fro_bac,控制水下机器人5的前进和后退运动;如果第二维运动参数fro_bac≤(N-1)成立,同时再判断第三维运动参数lef_rig=0,实现直线前进动作;如果第二维运动参数fro_bac≥N成立,同时再判断第三维运动参数lef_rig=0,实现直线后退动作。
当摇杆6从中间位置向右到头的过程中,第三维摇杆实时参数lef_rig的读数位从1到(N-1)均匀递增,当摇杆6从中间位置向左到头的过程中,读数位从N到(2N-1)均匀递增,下位机判断第三维运动参数lef_rig,控制水下机器人5的左转弯和右转弯运动;如果第三维运动参数lef_rig≤(N-1)成立,同时再判断第二维运动参数fro_bac=0,实现右转弯运动;如果第三维运动参数lef_rig≥N成立,同时再判断第二维运动参数fro_bac=0,实现左转弯运动。
如果第二维运动参数fro_bac≤(N-1)成立,则fro=fro_bac,为前进命令;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器4旋转方向为反,右水平推进器4动力为[Max*(fro+lef)/N]r/min,当(fro+lef)≥N时,取(fro+lef)=N;左水平推进器3动力为[Max*(|fro-lef|)/N]r/min,当(fro-lef)≥0时,左水平推进器3旋转方向为正,当(fro-lef)<0时,左水平推进器3旋转方向为反,实现左前方前进动作;如果第三维运动参数lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器3旋转方向为正,左水平推进器3动力为[Max*(fro+rig)/N]r/min,当(fro+rig)≥N时,取(fro+rig)=N;右水平推进器4动力为[Max*(|fro-rig|)/N]r/min,当(fro-rig)≥0时右水平推进器4旋转方向为反,当(fro-rig)<0时右水平推进器4旋转方向为正,实现右前方前进动作。
如果第二维运动参数N<fro_bac<(N+40)成立,则bac=fro_bac-N,为左转弯过渡状态或转弯命令区;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器4旋转方向为反,右水平推进器4动力为[Max*(bac+lef)/N]r/min,当(bac+lef)≥N时,取(bac+lef)=N;左水平推进器3动力为[Max*(|bac-lef|)/N]r/min,当(bac-lef)≥0时左水平推进器3旋转方向为正,当(fro-lef)<0时左水平推进器3旋转方向为反,实现左转弯过渡状态;如果lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器3旋转方向为正,左水平推进器3动力为[Max*(bac+rig)/N]r/min,当(bac+rig)≥N时,取(fro+rig)=N;右水平推进器4动力为[Max*(|bac-rig|)/N]r/min,当(bac-rig)≥0时右水平推进器4旋转方向为反,当(bac-rig)<0时右水平推进器4旋转方向为正,实现右转弯过渡状态。
如果第二维运动参数fro_bac≥(N+40)成立,则bac=fro-bac-N,为后退命令;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器4旋转方向为正,右水平推进器4动力为[Max*(bac+lef)/N]r/min,当(bac+lef)≥N时,取(bac+lef)=N;左水平推进器3动力为[Max*(|bac-lef|)/N]r/min,当(bac-lef)≥0时左水平推进器3旋转方向为反,当(bac-lef)<0时左水平推进器3旋转方向为正,实现左后方后退动作;如果第三维运动参数lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器3旋转方向为反,左水平推进器3动力为[Max*(bac+rig)/N]r/min,当(bac+rig)≥N时,取(bac+rig)=N;右水平推进器4动力为[Max*(|bac-rig|)/N]r/min,当(bac-rig)≥0时右水平推进器4旋转方向为正,当(bac-rig)<0时右水平推进器4旋转方向为反,实现右后方后退动作。

Claims (7)

1.一种水下机器人四螺旋桨推进器控制方法,其特征在于,包括如下步骤:
(1)水下机器人上位机检测三维摇杆的实时位置将其转化成相应的参数通过485通信发给下位机;
(2)下位机接收到上位机发来的控制信息后,判断三维摇杆的三维运动参数up_dow,fro_bac,lef_rig,当摇杆不操作时,处于中间位置,摇杆的三维运动实时参数均为0;
(3)根据三维摇杆的命令参数控制四个螺旋桨推进器的推力大小以及方向,利用左垂直推进器和右垂直推进器控制水下机器人的上升和下潜运动,利用左水平推进器和右水平推进器控制水下机器人直线前进、直线后退、左转弯、右转弯、左前方前进、右前方前进、左后方后退、右后方后退动作。
2.如权利要求1所述的水下机器人四螺旋桨推进器控制方法,其特征在于:当摇杆从中间位置顺时针旋转到头的过程中,第一维摇杆实时参数up_dow的读数位从1到(N-1)均匀递增,当摇杆从中间位置逆时针旋转到头的过程中,读数位从N到(2N-1)均匀递增,下位机通过判断第一维运动参数up_dow,控制水下机器人的上升和下潜运动;如果第一维运动参数up_dow≤(N-1),此时左垂直推进器旋转方向为正,右垂直推进器旋转方向为反,实现下潜运功;如果第一维运动参数up_dow≥N,左垂直推进器旋转方向为反,右垂直推进器旋转方向为正,实现上升运功。
3.如权利要求1所述的水下机器人四螺旋桨推进器控制方法,其特征在于:当摇杆从中间位置向前到头的过程中,第二维摇杆实时参数fro_bac的读数位从1到(N-1)均匀递增,当摇杆从中间位置向后到头的过程中,读数位从N到(2N-1)均匀递增,下位机判断第二维运动参数fro_bac,控制水下机器人的前进和后退运动;如果第二维运动参数fro_bac≤(N-1)成立,同时再判断第三维运动参数lef_rig=0,实现直线前进动作;如果第二维运动参数fro_bac≥N成立,同时再判断第三维运动参数lef_rig=0,实现直线后退动作。
4.如权利要求3所述的水下机器人四螺旋桨推进器控制方法,其特征在于:当摇杆从中间位置向右到头的过程中,第三维摇杆实时参数lef_rig的读数位从1到(N-1)均匀递增,当摇杆从中间位置向左到头的过程中,读数位从N到(2N-1)均匀递增,下位机判断第三维运动参数lef_rig,控制水下机器人的左转弯和右转弯运动;如果第三维运动参数lef_rig≤(N-1)成立,同时再判断第二维运动参数fro_bac=0,实现右转弯运动;如果第三维运动参数lef_rig≥N成立,同时再判断第二维运动参数fro_bac=0,实现左转弯运动。
5.如权利要求4所述的水下机器人四螺旋桨推进器控制方法,其特征在于:如果第二维运动参数fro_bac≤(N-1)成立,则fro=fro_bac,为前进命令;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器旋转方向为反,右水平推进器动力为[Max*(fro+lef)/N]r/min,当(fro+lef)≥N时,取(fro+lef)=N;左水平推进器动力为[Max*(|fro-lef|)/N]r/min,当(fro-lef)≥0时,左水平推进器旋转方向为正,当(fro-lef)<0时,左水平推进器旋转方向为反,实现左前方前进动作;如果第三维运动参数lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器旋转方向为正,左水平推进器动力为[Max*(fro+rig)/N]r/min,当(fro+rig)≥N时,取(fro+rig)=N;右水平推进器动力为[Max*(|fro-rig|)/N]r/min,当(fro-rig)≥0时右水平推进器旋转方向为反,当(fro-rig)<0时右水平推进器旋转方向为正,实现右前方前进动作。
6.如权利要求5所述的水下机器人四螺旋桨推进器控制方法,其特征在于:如果第二维运动参数N<fro_bac<(N+40)成立,则bac=fro_bac-N,为左转弯过渡状态或转弯命令区;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器旋转方向为反,右水平推进器动力为[Max*(bac+lef)/N]r/min,当(bac+lef)≥N时,取(bac+lef)=N;左水平推进器动力为[Max*(|bac-lef|)/N]r/min,当(bac-lef)≥0时左水平推进器旋转方向为正,当(fro-lef)<0时左水平推进器旋转方向为反,实现左转弯过渡状态;如果lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器旋转方向为正,左水平推进器动力为[Max*(bac+rig)/N]r/min,当(bac+rig)≥N时,取(fro+rig)=N;右水平推进器动力为[Max*(|bac-rig|)/N]r/min,当(bac-rig)≥0时右水平推进器旋转方向为反,当(bac-rig)<0时右水平推进器旋转方向为正,实现右转弯过渡状态。
7.如权利要求6所述的水下机器人四螺旋桨推进器控制方法,其特征在于:如果第二维运动参数fro_bac≥(N+40)成立,则bac=fro-bac-N,为后退命令;同时再判断第三维运动参数,如果第三维运动参数lef_rig≥N成立,则lef=lef_rig-N,右水平推进器旋转方向为正,右水平推进器动力为[Max*(bac+lef)/N]r/min,当(bac+lef)≥N时,取(bac+lef)=N;左水平推进器动力为[Max*(|bac-lef|)/N]r/min,当(bac-lef)≥0时左水平推进器旋转方向为反,当(bac-lef)<0时左水平推进器旋转方向为正,实现左后方后退动作;如果第三维运动参数lef_rig≤(N-1)成立,则rig=lef_rig,左水平推进器旋转方向为反,左水平推进器动力为[Max*(bac+rig)/N]r/min,当(bac+rig)≥N时,取(bac+rig)=N;右水平推进器动力为[Max*(|bac-rig|)/N]r/min,当(bac-rig)≥0时右水平推进器旋转方向为正,当(bac-rig)<0时右水平推进器旋转方向为反,实现右后方后退动作。
CN201410080503.4A 2014-03-06 2014-03-06 水下机器人四螺旋桨推进器控制方法 Active CN103885404B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410080503.4A CN103885404B (zh) 2014-03-06 2014-03-06 水下机器人四螺旋桨推进器控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410080503.4A CN103885404B (zh) 2014-03-06 2014-03-06 水下机器人四螺旋桨推进器控制方法

Publications (2)

Publication Number Publication Date
CN103885404A true CN103885404A (zh) 2014-06-25
CN103885404B CN103885404B (zh) 2016-08-17

Family

ID=50954352

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410080503.4A Active CN103885404B (zh) 2014-03-06 2014-03-06 水下机器人四螺旋桨推进器控制方法

Country Status (1)

Country Link
CN (1) CN103885404B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104199458A (zh) * 2014-08-15 2014-12-10 浙江大学 水下作业机器人
CN104802969A (zh) * 2015-05-06 2015-07-29 江苏科技大学 水下机器人动力推进系统及设计方法
CN104960652A (zh) * 2015-06-23 2015-10-07 山东科技大学 水下作业机器人及其工作方法
CN105425610A (zh) * 2015-11-09 2016-03-23 哈尔滨工程大学 一种作业型水下机器人液压推进器的推力控制仿真系统
CN105643626A (zh) * 2016-03-08 2016-06-08 哈尔滨工程大学 一种基于双重判据的水下机器人推力优化分配方法
CN106272469A (zh) * 2016-09-18 2017-01-04 河海大学常州校区 水下侦查定位机器人及工作方法、控制系统
CN109960276A (zh) * 2017-12-14 2019-07-02 世宗大学校产学协力团 无人航空器的远程控制装置、方法及计算机可读存储介质
CN117689730A (zh) * 2024-02-01 2024-03-12 广东控银实业有限公司 基于图像的摇杆开关位置检测方法及系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1114784A (ja) * 1997-06-20 1999-01-22 Hitachi Ltd 原子炉内検査装置
CN1778530A (zh) * 2004-11-17 2006-05-31 中国科学院沈阳自动化研究所 用于海参养殖观察的水下机器人
CN101234665A (zh) * 2008-03-03 2008-08-06 中国科学院光电技术研究所 一种小型水下观测机器人
US20090208292A1 (en) * 2005-08-23 2009-08-20 Hawkes Calvert T Remotely Operated Underwater Vehicle
CN202703877U (zh) * 2012-08-18 2013-01-30 郑州大学 一种基于图像处理的自我控制水下机器人
CN102951275A (zh) * 2012-11-08 2013-03-06 北京航空航天大学 一种核电站微小型作业水下机器人

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1114784A (ja) * 1997-06-20 1999-01-22 Hitachi Ltd 原子炉内検査装置
CN1778530A (zh) * 2004-11-17 2006-05-31 中国科学院沈阳自动化研究所 用于海参养殖观察的水下机器人
US20090208292A1 (en) * 2005-08-23 2009-08-20 Hawkes Calvert T Remotely Operated Underwater Vehicle
CN101234665A (zh) * 2008-03-03 2008-08-06 中国科学院光电技术研究所 一种小型水下观测机器人
CN202703877U (zh) * 2012-08-18 2013-01-30 郑州大学 一种基于图像处理的自我控制水下机器人
CN102951275A (zh) * 2012-11-08 2013-03-06 北京航空航天大学 一种核电站微小型作业水下机器人

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104199458A (zh) * 2014-08-15 2014-12-10 浙江大学 水下作业机器人
CN104802969B (zh) * 2015-05-06 2017-04-05 江苏科技大学 水下机器人动力推进系统的设计方法
CN104802969A (zh) * 2015-05-06 2015-07-29 江苏科技大学 水下机器人动力推进系统及设计方法
CN104960652A (zh) * 2015-06-23 2015-10-07 山东科技大学 水下作业机器人及其工作方法
CN104960652B (zh) * 2015-06-23 2017-04-12 山东科技大学 水下作业机器人及其工作方法
CN105425610A (zh) * 2015-11-09 2016-03-23 哈尔滨工程大学 一种作业型水下机器人液压推进器的推力控制仿真系统
CN105425610B (zh) * 2015-11-09 2018-07-24 哈尔滨工程大学 一种作业型水下机器人液压推进器的推力控制仿真系统
CN105643626A (zh) * 2016-03-08 2016-06-08 哈尔滨工程大学 一种基于双重判据的水下机器人推力优化分配方法
CN106272469A (zh) * 2016-09-18 2017-01-04 河海大学常州校区 水下侦查定位机器人及工作方法、控制系统
CN106272469B (zh) * 2016-09-18 2018-10-23 河海大学常州校区 水下侦查定位机器人及工作方法、控制系统
CN109960276A (zh) * 2017-12-14 2019-07-02 世宗大学校产学协力团 无人航空器的远程控制装置、方法及计算机可读存储介质
CN117689730A (zh) * 2024-02-01 2024-03-12 广东控银实业有限公司 基于图像的摇杆开关位置检测方法及系统
CN117689730B (zh) * 2024-02-01 2024-04-26 广东控银实业有限公司 基于图像的摇杆开关位置检测方法及系统

Also Published As

Publication number Publication date
CN103885404B (zh) 2016-08-17

Similar Documents

Publication Publication Date Title
CN103885404A (zh) 水下机器人四螺旋桨推进器控制方法
CN105366018B (zh) 电磁驱动仿水母探测机器人
CN108408007A (zh) 混合动力水下机器人
CN102079382B (zh) 一种水下机械式仿生扑翼推进器
CN204037873U (zh) 一种新型低阻力水下滑翔器
CN202935544U (zh) 波浪驱动的机动浮标
CN204956891U (zh) 一种仿生鱼尾双驱动柔性推进结构
CN103950525A (zh) 一种低能耗仿生机器鱼的磁动力推进机构
CN110435861A (zh) 一种实现海洋无人航行器多航态、低能耗航行的水翼装置
CN203902829U (zh) 一种低能耗仿生机器鱼的磁动力推进机构
CN103192951B (zh) 水翼前向推进效率实验装置
CN106585935B (zh) 一种仿生机构驱动的海上航行器
CN109866903A (zh) 一种仿生可折叠胸鳍的机器鱼
CN207670636U (zh) 一种新型仿生机械鱼
CN204096071U (zh) 螺旋桨助推器
KR20120076001A (ko) 물고기 로봇의 옆 지느러미 장치
CN108482669A (zh) 海空两栖航行器
CN202175189U (zh) 船用表面桨推进装置
CN109367746B (zh) 一种基于流致振动驱动的水下仿生蝌蚪
CN104989588A (zh) 一种波浪能转换装置
CN202175186U (zh) 一种仿水母式水下推进装置
CN206107522U (zh) 一种小型可潜浮仿生机器鱼
CN202879777U (zh) 一种折叠蹼式船用推进器
CN203638068U (zh) 一种多鳍组合运动的仿生推进器
CN207300300U (zh) 一种用于水下观测的机器人及水下观测系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
PE01 Entry into force of the registration of the contract for pledge of patent right
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: Method for controlling four-propeller thruster of underwater robot

Effective date of registration: 20191113

Granted publication date: 20160817

Pledgee: Qingdao financing guarantee Centre Limited

Pledgor: QINGDAO ROBOTFISH MARINE TECHNOLOGY CO., LTD.

Registration number: Y2019370010036

PC01 Cancellation of the registration of the contract for pledge of patent right
PC01 Cancellation of the registration of the contract for pledge of patent right

Date of cancellation: 20210202

Granted publication date: 20160817

Pledgee: Qingdao financing guarantee Centre Ltd.

Pledgor: QINGDAO ROBOTFISH MARINE TECHNOLOGY Co.,Ltd.

Registration number: Y2019370010036