CN113636048B - 一种多关节机器鱼及其运动控制方法 - Google Patents
一种多关节机器鱼及其运动控制方法 Download PDFInfo
- Publication number
- CN113636048B CN113636048B CN202110954465.0A CN202110954465A CN113636048B CN 113636048 B CN113636048 B CN 113636048B CN 202110954465 A CN202110954465 A CN 202110954465A CN 113636048 B CN113636048 B CN 113636048B
- Authority
- CN
- China
- Prior art keywords
- fish
- joint
- pectoral fin
- tail
- robot fish
- 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63C—LAUNCHING, HAULING-OUT, OR DRY-DOCKING OF VESSELS; LIFE-SAVING IN WATER; EQUIPMENT FOR DWELLING OR WORKING UNDER WATER; MEANS FOR SALVAGING OR SEARCHING FOR UNDERWATER OBJECTS
- B63C11/00—Equipment for dwelling or working underwater; Means for searching for underwater objects
- B63C11/52—Tools specially adapted for working underwater, not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63H—MARINE PROPULSION OR STEERING
- B63H1/00—Propulsive elements directly acting on water
- B63H1/30—Propulsive elements directly acting on water of non-rotary type
- B63H1/36—Propulsive elements directly acting on water of non-rotary type swinging sideways, e.g. fishtail type
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N33/00—Investigating or analysing materials by specific methods not covered by groups G01N1/00 - G01N31/00
- G01N33/18—Water
-
- 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
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A40/00—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production
- Y02A40/80—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production in fisheries management
- Y02A40/81—Aquaculture, e.g. of fish
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Health & Medical Sciences (AREA)
- Mechanical Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Medicinal Chemistry (AREA)
- Automation & Control Theory (AREA)
- Food Science & Technology (AREA)
- Combustion & Propulsion (AREA)
- Analytical Chemistry (AREA)
- Biochemistry (AREA)
- General Health & Medical Sciences (AREA)
- Immunology (AREA)
- Pathology (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种多关节机器鱼及其运动控制方法,包括密闭设置的鱼体结构,其上设置有传感器组,鱼体结构两侧对称连接有驱动鱼体结构上下运动的右胸鳍和左胸鳍,鱼体结构内部设有分别与右胸鳍和左胸鳍连接并带动其运动的右胸鳍舵机关节和左胸鳍舵机关节,鱼体结构内部还设有控制器、定位模块和通信模块;鱼体结构尾端连接有驱动鱼体结构水平游动的尾部关节机构,尾部关节机构包括至少三组依次相连的尾部舵机关节,末尾的尾部舵机关节尾端还连接有尾鳍;传感器组至少包括红外传感器、水质检测传感器和惯性导航传感器。本发明能实现多关节机器鱼精确、高效、自然、协调的自动巡航及避障。
Description
技术领域
本发明属于机器人运动控制方法领域,具体涉及一种多关节机器鱼及其运动控制方法。
背景技术
随着我国科技和经济的快速发展,水产养殖行业迎来了发展的大好前景,但在水产养殖过程中仍依赖于专业人员主观判断及参与,存在耗时耗力和误判率大等问题,无法做到科学养殖。于是,为了提高水产养殖的经济效益及水产品的质量,用于水质检测的水下移动机器人越来越多。其中,仿生机器鱼的使用最为广泛,于是如何安全高效地控制仿生机器鱼完成自动巡航及避障,并使仿生机器鱼能够自主游动到预定的采集点准确采集水质参数变得尤为重要。
传统仿生机器鱼的控制方法有基于运动学和动力学模型的拟合鱼体波法和正弦振荡器法。在这些控制方法下,机器鱼有鲁棒性差、游动不灵活、姿态不协调等缺点,且对环境信息处理能力弱,导致难以实现自动巡航。
发明内容
本发明的目的在于,提供一种多关节机器鱼机器运动控制方法,实现多关节机器鱼精确、高效、自然、协调的自动巡航及避障。
为解决上述技术问题,本发明的技术方案为:一种多关节机器鱼,包括密闭设置的鱼体结构,其上设置有传感器组,鱼体结构两侧对称连接有驱动鱼体结构上下运动的右胸鳍和左胸鳍,鱼体结构内部设有分别与右胸鳍和左胸鳍连接并带动其运动的右胸鳍舵机关节和左胸鳍舵机关节,鱼体结构内部还设有控制器、定位模块和通信模块;鱼体结构尾端连接有驱动鱼体结构水平游动的尾部关节机构,尾部关节机构包括至少三组依次相连的尾部舵机关节,末尾的尾部舵机关节尾端还连接有尾鳍;传感器组至少包括红外传感器、水质检测传感器和惯性导航传感器。
尾部舵机关节数量为三组。
多关节机器鱼的水平游动包括直线游动和转向游动;在多关节机器鱼进行直线游动时,通过控制三个尾部舵机关节使多关节机器鱼的尾鳍绕鱼体结构中心轴周期性左右摆动产生向前的推力,从而使机器鱼做直线游动,此时右胸鳍和左胸鳍不提供动力;在多关节机器鱼进行转向游动时,控制第一尾部舵机关节和第二尾部舵机关节向一侧偏转产生偏转力,再控制第三尾部舵机关节使尾鳍绕第二尾部舵机关节中心轴周期性左右摆动产生向前的推力,从而使多关节机器鱼做转向游动。
多关节机器鱼通过改变右胸鳍和左胸鳍的倾斜程度来实现上下运动,在尾鳍绕鱼体结构中心轴周期性左右摆动提供推进力的前提下,当右胸鳍和左胸鳍与鱼体结构平行时,多关节机器鱼保持水平方向的运动;当右胸鳍和左胸鳍同时向上倾斜时,多关节机器鱼实现上浮运动;当右胸鳍和左胸鳍同时向下倾斜时,多关节机器鱼实现下潜运动。
对多关节机器鱼的控制采用分层闭环控制,分为三层,包括:
传感器反馈层,由红外传感器和惯性导航传感器构成,用于提供多关节机器鱼的外部环境信息和自身姿态信息,不断进行多关节机器鱼模态及姿态的调整,从而有效控制多关节机器鱼游动;
高级控制层,用于进行多关节机器鱼的避障及路径规划和模态的选择;
低级控制层,用于对多关节机器鱼的姿态进行调整,调整内容还至少包括多关节机器鱼的航向和速度。
采用CPG网络模型控制尾部关节机构、右胸鳍和左胸鳍的运动。
所述高级控制层通过模糊算法进行避障及路径规划和模态的选择。
一种用于上述的一种多关节机器鱼的运动控制方法,包括以下步骤:
步骤一:判断多关节机器鱼是否处于目标位置,若是,则结束;若否,则利用红外传感器获取多关节机器鱼与障碍物的距离值d;
步骤四:传感器反馈层将距离值d反馈给高级控制层,将航向角偏差θ反馈给低级控制层,从而实现对多关节机器鱼模态和姿态的调整;
步骤五:实时调整,通过判断红外传感器采集到距离值d是否大于阈值,来对运动控制进行简化处理,若所有距离值d都大于阈值,说明不需要进行避障,只需通过CPG网络进行姿态调整即可,而若存在距离值d小于阈值,则需要先通过模糊算法进行避障,再通过CPG网络进行姿态调整;
步骤六:判断多关节机器鱼是否处于目标位置,若是,则结束;若否,则返回步骤一。与现有技术相比,本发明的有益效果为:
(1)利用多个传感器组成传感器网络采集环境信息,提高了机器鱼与环境的交互能力,避免了单一传感器探测信息采集不足、信息可信度不足的缺陷,可获取更全面、更精确的环境信息,从而使移机器鱼更准确地避障和运动。
(2)采用分层控制的方法来控制机器鱼,且模糊算法也分为两层,减少了许多计算量,简化了控制***,使得机器鱼实时性、抗干扰性、鲁棒性大大提升。
(3)在对机器鱼的各关节进行协调控制时,加入了自身姿态信息的反馈,形成了闭环控制,机器鱼可实现在变化环境中的连续模态变化,速度和航向控制都可得到改善。
(4)采用CPG控制各个关节舵机,由于各个神经元之间的耦合关系,各个舵机之间的配合更加协调,可实现机器鱼各模态切换的平滑过渡。
(5)CPG网络采用基于极限环的CPG模型,各CPG神经元采用双向链式最近相邻耦合方式,其幅值、频率、相位都可单独调节,减少了许多CPG的参数,简化了***的复杂度。
附图说明
图1为本发明实施例的结构示意图;
图2为本发明实施例的立体图;
图3为本发明实施例中CPG网络模型拓扑图;
图4为本发明实施例中分层闭环控制的原理图;
图5为本发明实施例中红外传感器的分布图;
图6为本发明实施例的运动控制流程图;
图中1——红外传感器,2——右胸鳍舵机关节,3——右胸鳍,4——GPS模块,5——STM32模块,6——LORA模块,7——第一尾部舵机关节,8——第二尾部舵机关节,9——第三尾部舵机关节,10——尾鳍,11——水质检测传感器,12——惯性导航传感器,13——左胸鳍,14——左胸鳍舵机关节,15——右红外传感器,16——上方红外传感器,17——下方红外传感器,18——前方红外传感器,19——左方红外传感器。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面结合附图和具体实施方式对本申请作进一步的详细说明。显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
针对机器鱼协调运动控制的需求,基于多关节舵机驱动的机器鱼,本发明提出了一种多关节机器鱼机器分层闭环运动控制方法。
机械结构及运动模式
机器鱼的运动控制与其机械结构密切相关,机器鱼的运动分为水平游动和上浮下潜两个方面。本发明机器鱼的机械结构示意图如图1、图2所示,本发明的技术方案为:一种多关节机器鱼,包括密闭设置的鱼体结构,其上设置有传感器组,鱼体结构两侧对称连接有驱动鱼体结构上下运动的右胸鳍3和左胸鳍13,鱼体结构内部设有分别与右胸鳍3和左胸鳍13连接并带动其运动的右胸鳍舵机关节2和左胸鳍舵机关节14,鱼体结构内部还设有控制器、定位模块和通信模块;鱼体结构尾端连接有驱动鱼体结构水平游动的尾部关节机构,尾部关节机构包括三组依次相连的尾部舵机关节,末尾的尾部舵机关节尾端还连接有尾鳍10;传感器组至少包括红外传感器1、水质检测传感器11和惯性导航传感器12。采用胸鳍和尾鳍10协同推进模式,依靠三个尾部舵机控制尾鳍10的摆动实现水平游动,依靠两个胸鳍舵机来控制胸鳍的角度实现上浮下潜。
机器鱼的水平游动分为直线游动和转向游动。在机器鱼进行直线游动时,通过控制三个尾部舵机关节使机器鱼的尾鳍10绕鱼体中心轴周期性左右摆动、产生向前的推力,从而使机器鱼做直线游动,此时胸鳍不提供动力。在机器鱼进行转向游动时,控制第一和第二尾部舵机关节8向一侧偏转、产生偏转力,再控制第三尾部舵机关节9使尾鳍10绕第二尾部舵机关节8中心轴周期性左右摆动、产生向前的推力,从而使机器鱼做转向游动。
在机器鱼进行上浮下潜运动时,通过改变胸鳍的倾斜程度来实现,在尾鳍绕鱼体中心轴周期性左右摆动、提供推进力的前提下,当胸鳍与鱼身平行时,机器鱼保持水平方向的运动;当控制左右胸鳍同时向上倾斜时,机器鱼实现上浮运动;当控制左右胸鳍同时向下倾斜时,机器鱼实现下潜运动。
CPG网络模型
Hopf振荡器的微分方程为:
单个CPG神经元只能控制一个舵机关节,而本机器鱼有多个舵机关节,所以必需要构建CPG网络,使得多个CPG神经元进行耦合,实现对所有舵机的控制。本发明以Hopf振荡器为基础,采用基于极限环的CPG网络模型,各CPG神经元采用双向链式最近相邻耦合方式,对n+2个CPG神经元进行耦合,其幅值、频率、相位都可单独调节,且输出信号收敛于正弦波,其微分方程为:
式中,i=1,...,n,n+1,n+2,表示***中的CPG神经元;其中,1,...,n代表尾部关节的CPG神经单元,n+1和n+2分别代表左右胸鳍关节的CPG神经元;xi、yi为第i个神经元的状态变量,xi为膜电势、yi为调节电势;ωi、mi分别表示第i个神经元的频率和振幅,表示神经元间的相位差;l1、l2为耦合系数,表示神经元间的抑制关系,其中l1为上行耦合系数、l2为下行耦合系数,h1、h2为收敛速度调节因子,ci表示输出信号的放大系数,z为输出。
本发明中,多关节机器鱼的CPG模型网络拓扑图如图3所示。在本发明中,由于左右胸鳍是同步的,所以在耦合的时候,可以把CPG4和CPG5看作是同一CPG神经元,于是两个胸鳍CPG都只受到CPG1的状态影响,而CPG1会受到CPG2状态和胸鳍CPG状态的共同影响。
当CPG网络建立后,初始膜电势xi,初始调节电势yi,耦合系数l1、l2,收敛速度调节因子h1、h2,输出信号的放大系数ci就已确定,接下来只需根据环境信息的不同调节相位差频率ωi、振幅mi三个参数因子就可以改变CPG的输出z,实现对各舵机的协调控制,从而实现机器鱼的灵活协调游动。其中/>主要决定机器鱼的模态,ωi、mi主要决定机器鱼的速度。
本发明中,机器鱼模态分为直游、左转、右转、上浮、下潜五种,速度分为快、慢两种。
分层闭环控制方法
本发明中,对机器鱼的控制采用分层闭环控制,分为三层:传感器反馈层、高级控制层、低级控制层。其中闭环体现在传感器反馈层对高级控制层和低级控制层的反馈上。分层闭环运动控制原理图如图4所示。
(1)传感器反馈层
传感器反馈层由机器鱼头部搭载的5个红外传感器1和体内搭载的惯性导航传感器12构成的传感器网络组成,不断为高级控制层和低级控制层提供机器鱼的外部环境信息和自身姿态信息,不断进行机器鱼模态及姿态的调整,从而有效控制机器鱼游动。
在本发明中,将红外传感器1检测到的机器鱼与障碍物的距离分为两个集合。因为红外传感器检测范围为10-80cm,所以设置阈值为70cm。当检测到机器鱼与障碍物的距离高于阈值时,直接通过低级控制层对各个舵机关节进行控制;而当距离低于阈值时,先通过高级控制层给低级控制层发出命令,再通过低级控制层对各个舵机关节进行控制。
在没有检测到障碍物时(红外传感器检测到的距离高于阈值),通过搭载的惯性传感器对机器鱼进行速度和航向反馈,在不改变CPG神经元参数的条件下,直接通过耦合传感器反馈,实现对机器鱼的速度和航向控制;此过程不需要经过高级控制层的控制。
在检测到障碍物时(红外传感器1检测到的距离低于阈值),通过搭载的红外测距传感器对周围环境信息进行反馈,由避障算法分析处理后,按照避障策略,选择最合适的CPG参数,从而确定CPG网络模型,进而改变机器鱼的模态,达到控制机器鱼避障的目的。
(2)高级控制层
高级控制层由避障算法构成,主要进行机器鱼的避障及路径规划和运动模态的选择。
在本发明中,由于机器鱼在水下环境中工作,无法实现基于精确信息的避障及路径规划,且机器鱼搭载多个传感器,因此可通过模糊避障算法对多个传感器信息进行处理后,再根据模糊规则进行决策,并根据传感器反馈层输入值的不同,选取相对应的模态,输出不同的CPG参数。
机器鱼头部搭载的红外传感器分别为前方红外传感器18(FRS)、左方红外传感器19(LRS)、右方红外传感器15(RRS)、上方红外传感器16(TRS)以及下方红外传感器17(BRS)。机器鱼红外传感器的配置如图5所示。为了减少规则数目,将所搭载的红外传感器分为两组,模糊规则也对应分为水平避障规则和上浮下潜规则。其中前方红外传感器18(FRS)、左方红外传感器19(LRS)、右方红外传感器15(RRS)检测到的距离值d1对应水平避障规则的输入;上方红外传感器16(TRS)以及下方红外传感器17(BRS)检测到的距离值d2对应上浮下潜规则的输入。模糊避障输出为机器鱼的游动模态及对应CPG设置参数。
在水平避障控制中,因为红外传感器1检测范围为10-80cm,且当红外传感器1检测到距离少于70cm时才反馈给模糊避障算法,所以其论域为[10,70];又因为机器鱼运动速度最大为25cm/s,所以选定一个安全距离为50cm,大于50cm对应模糊子集为{远(F)},小于50cm对应模糊子集为{近(N)}。输出模糊集合有两个,分别为方向模糊集合{直游(D)、左转(L)、右转(R)},速度模糊集合{快(K)、慢(S)}。水平避障规则如表1所示:
表1水平避障规则
在本发明中,水平避障规则优先级高于上浮下潜规则,即机器鱼优先采取水平方向的避障行为。在水平避障规则中,当左右两侧都距离障碍物较远、而距离前方障碍物较近时,根据隶属度决定具体朝那边转弯。
在上浮下潜避障控制中,同样设置红外传感器检测范围论域为[10,70],由于上浮下潜速度相比较水平游动速度较慢,因此需要设置一个比较大的安全距离为60cm,大于60cm对应模糊子集为{远(F)},小于60cm对应模糊子集为{近(N)}。输出模糊集合为{上浮(T)、下潜(B)、小半径转弯(M)}。上浮下潜规则如表2所示:
表2上浮下潜规则
在上浮下潜规则中,当上下两侧都距离障碍物较近时,说明出现了前侧、左前侧、右前侧、上侧以及下侧都有障碍物的极端情况,就需要减小转弯半径,进行原地转弯;而当上下两侧都距离障碍物较远时,根据隶属度决定具体朝那边进行避障。
通过两层模糊避障算法的判断,就可以根据红外传感器的输入,输出对应模态,但要得到具体的CPG参数,还要对模糊输出进行解模糊。
在本模糊算法中,输入、输出隶属函数都采用梯形隶属函数,于是根据模糊规则中选取的规则和红外传感器输入距离的隶属度就可得出不同隶属度的幅值、频率和相位差,实现机器鱼模态的切换。
(3)低级控制层
低级控制层由CPG网络来控制,主要对机器鱼游动姿态进行调整,包含航向和速度调整。在红外传感器1没有检测到障碍物时,通过搭载的惯性传感器对机器鱼进行航向和速度反馈,在CPG模型中加入反馈项,调整CPG的输出,使其输出稳定的周期性节律运动信号,再根据此生成PWM信号,达到协调控制机器鱼各个关节舵机的目的,实现对机器鱼的航向和速度控制。此过程不需要经过避障算法的控制,只通过CPG网络控制即可。
具有反馈机制的CPG网络模型微分方程为:
式中bi表示传感器反馈信息、与机器鱼当前航向角有关,惯性传感器检测到的实际航向和理想航向会形成一个偏差θ,即为bi,被反馈给CPG模型,使得CPG模型输出z发生变化,进而影响到PWM波的生成。
优点和效果
(1)利用多个传感器组成传感器网络采集环境信息,提高了机器鱼与环境的交互能力,避免了单一传感器探测信息采集不足、信息可信度不足的缺陷,可获取更全面、更精确的环境信息,从而使移机器鱼更准确地避障和运动。
(2)采用分层控制的方法来控制机器鱼,且模糊算法也分为两层,减少了许多计算量,简化了控制***,使得机器鱼实时性、抗干扰性、鲁棒性大大提升。
(3)在对机器鱼的各关节进行协调控制时,加入了自身姿态信息的反馈,形成了闭环控制,机器鱼可实现在变化环境中的连续模态变化,速度和航向控制都可得到改善。
(4)采用CPG控制各个关节舵机,由于各个神经元之间的耦合关系,各个舵机之间的配合更加协调,可实现机器鱼各模态切换的平滑过渡。
(5)CPG网络以Hopf振荡器为基础,采用基于极限环的CPG模型,各CPG神经元采用双向链式最近相邻耦合方式,其幅值、频率、相位都可单独调节,减少了许多CPG的参数,简化了***的复杂度。
本文中应用了具体个例对本申请的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本申请的技术方案及其核心思想。应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以对本申请进行若干改进和修饰,这些改进和修饰也落入本申请权利要求的保护范围内。
Claims (8)
1.一种多关节机器鱼,其特征在于,包括密闭设置的鱼体结构,其上设置有传感器组,鱼体结构两侧对称连接有驱动鱼体结构上下运动的右胸鳍和左胸鳍,鱼体结构内部设有分别与右胸鳍和左胸鳍连接并带动其运动的右胸鳍舵机关节和左胸鳍舵机关节,鱼体结构内部还设有控制器、定位模块和通信模块;鱼体结构尾端连接有驱动鱼体结构水平游动的尾部关节机构,尾部关节机构包括至少三组依次相连的尾部舵机关节,末尾的尾部舵机关节尾端还连接有尾鳍;传感器组至少包括红外传感器、水质检测传感器和惯性导航传感器;
对多关节机器鱼的控制采用分层闭环控制,分为三层,包括:
传感器反馈层,由红外传感器和惯性导航传感器构成,用于提供多关节机器鱼的外部环境信息和自身姿态信息,不断进行多关节机器鱼模态及姿态的调整,从而有效控制多关节机器鱼游动;
高级控制层,用于进行多关节机器鱼的避障及路径规划和模态的选择;
低级控制层,用于对多关节机器鱼的姿态进行调整,调整内容还至少包括多关节机器鱼的航向和速度;
采用CPG网络模型控制尾部关节机构、右胸鳍和左胸鳍的运动;
Hopf振荡器的微分方程为:以Hopf振荡器为基础,采用基于极限环的CPG网络模型,各CPG神经元采用双向链式最近相邻耦合方式,对n+2个CPG神经元进行耦合,其幅值、频率、相位都可单独调节,且输出信号收敛于正弦波,其微分方程为:式中,i=1,...,n,n+1,n+2,表示***中的CPG神经元;其中,1,...,n代表尾部舵机关节的CPG神经元,n+1和n+2分别代表左右胸鳍舵机关节的CPG神经元;xi、yi为第i个神经元的状态变量,xi为膜电势、yi为调节电势;ωi、mi分别表示第i个神经元的频率和振幅,φi表示神经元间的相位差;l1、l2为耦合系数,表示神经元间的抑制关系,其中l1为上行耦合系数、l2为下行耦合系数,h1、h2为收敛速度调节因子,ci表示输出信号的放大系数,z为输出。
2.根据权利要求1所述的一种多关节机器鱼,其特征在于,尾部舵机关节数量为三组。
3.根据权利要求2所述的一种多关节机器鱼,其特征在于,多关节机器鱼的水平游动包括直线游动和转向游动;在多关节机器鱼进行直线游动时,通过控制三个尾部舵机关节使多关节机器鱼的尾鳍绕鱼体结构中心轴周期性左右摆动产生向前的推力,从而使机器鱼做直线游动,此时右胸鳍和左胸鳍不提供动力;在多关节机器鱼进行转向游动时,控制第一尾部舵机关节和第二尾部舵机关节向一侧偏转产生偏转力,再控制第三尾部舵机关节使尾鳍绕第二尾部舵机关节中心轴周期性左右摆动产生向前的推力,从而使多关节机器鱼做转向游动。
4.根据权利要求1所述的一种多关节机器鱼,其特征在于,多关节机器鱼通过改变右胸鳍和左胸鳍的倾斜程度来实现上下运动,在尾鳍绕鱼体结构中心轴周期性左右摆动提供推进力的前提下,当右胸鳍和左胸鳍与鱼体结构平行时,多关节机器鱼保持水平方向的运动;当右胸鳍和左胸鳍同时向上倾斜时,多关节机器鱼实现上浮运动;当右胸鳍和左胸鳍同时向下倾斜时,多关节机器鱼实现下潜运动。
5.根据权利要求1所述的一种多关节机器鱼,其特征在于,所述高级控制层通过模糊算法进行避障及路径规划和模态的选择。
6.一种用于控制如权利要求1所述的一种多关节机器鱼的运动控制方法,其特征在于,包括以下步骤:
步骤一:判断多关节机器鱼是否处于目标位置,若是,则结束;若否,则利用红外传感器获取多关节机器鱼与障碍物的距离值d;
步骤二:获取距离值d,根据高级控制层选择相应的模态,得到对应CPG参数ω、m;其中为相位差、ω为频率、m为振幅;
步骤三:低级控制层根据输入的ω、m,输出稳定的周期性节律信号z,并根据此信号生成PWM信号,控制尾部关节机构、右胸鳍和左胸鳍的摆动角度和转速;
步骤四:传感器反馈层将距离值d反馈给高级控制层,将航向角偏差θ反馈给低级控制层,从而实现对多关节机器鱼模态和姿态的调整;
步骤五:实时调整,通过判断红外传感器采集到距离值d是否大于阈值,来对运动控制进行简化处理,若所有距离值d都大于阈值,说明不需要进行避障,只需通过CPG网络进行姿态调整即可,而若存在距离值d小于阈值,则需要先通过模糊算法进行避障,再通过CPG网络进行姿态调整;
步骤六:判断多关节机器鱼是否处于目标位置,若是,则结束;若否,则返回步骤一。
7.根据权利要求6所述的运动控制方法,其特征在于,多关节机器鱼的水平游动包括直线游动和转向游动;在多关节机器鱼进行直线游动时,通过控制三个尾部舵机关节使多关节机器鱼的尾鳍绕鱼体结构中心轴周期性左右摆动产生向前的推力,从而使机器鱼做直线游动,此时右胸鳍和左胸鳍不提供动力;在多关节机器鱼进行转向游动时,控制第一尾部舵机关节和第二尾部舵机关节向一侧偏转产生偏转力,再控制第三尾部舵机关节使尾鳍绕第二尾部舵机关节中心轴周期性左右摆动产生向前的推力,从而使多关节机器鱼做转向游动。
8.根据权利要求6所述的运动控制方法,其特征在于,多关节机器鱼通过改变右胸鳍和左胸鳍的倾斜程度来实现上下运动,在尾鳍绕鱼体结构中心轴周期性左右摆动提供推进力的前提下,当右胸鳍和左胸鳍与鱼体结构平行时,多关节机器鱼保持水平方向的运动;当右胸鳍和左胸鳍同时向上倾斜时,多关节机器鱼实现上浮运动;当右胸鳍和左胸鳍同时向下倾斜时,多关节机器鱼实现下潜运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110954465.0A CN113636048B (zh) | 2021-08-19 | 2021-08-19 | 一种多关节机器鱼及其运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110954465.0A CN113636048B (zh) | 2021-08-19 | 2021-08-19 | 一种多关节机器鱼及其运动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113636048A CN113636048A (zh) | 2021-11-12 |
CN113636048B true CN113636048B (zh) | 2023-03-31 |
Family
ID=78422936
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110954465.0A Active CN113636048B (zh) | 2021-08-19 | 2021-08-19 | 一种多关节机器鱼及其运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113636048B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114371698A (zh) * | 2021-12-09 | 2022-04-19 | 沈阳航天新光集团有限公司 | 一种自主避障游动仿生机器鱼 |
CN114394219A (zh) * | 2022-01-14 | 2022-04-26 | 中国科学院深圳先进技术研究院 | 基于头部及多鱼鳍协同运动的智能仿生机器鱼 |
CN114455045A (zh) * | 2022-03-09 | 2022-05-10 | 哈尔滨工业大学 | 一种胸鳍同频异幅的仿生鳐鱼摆动机构 |
CN114545953B (zh) * | 2022-04-26 | 2022-07-12 | 中国科学院自动化研究所 | 仿生鱼路径控制方法、装置及仿生鱼 |
CN115009478B (zh) * | 2022-06-15 | 2023-10-27 | 江苏科技大学 | 一种智能水下捕捞机器人及其捕捞方法 |
CN116300473B (zh) * | 2023-04-14 | 2023-09-22 | 清华大学深圳国际研究生院 | 一种基于cpg模型的软体仿生机器鱼游动优化方法 |
CN116974189B (zh) * | 2023-05-11 | 2024-05-10 | 西北工业大学宁波研究院 | 一种仿蝠鲼水下航行器cpg梯形波控制方法 |
CN117492473A (zh) * | 2023-11-10 | 2024-02-02 | 清华大学深圳国际研究生院 | 基于cpg控制及q学习的软体机器人路径规划方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100442185C (zh) * | 2006-09-01 | 2008-12-10 | 北京大学 | 一种多模态仿生机器鱼 |
CN103879535B (zh) * | 2014-03-12 | 2016-04-06 | 浙江大学 | 具有独立链状尾部支撑的机器鱼及其浮潜方法 |
CN105711778B (zh) * | 2016-03-11 | 2018-01-12 | 北京大学 | 新型自主式仿生机器鱼 |
CN209956198U (zh) * | 2019-04-09 | 2020-01-17 | 合肥工业大学 | 一种同步升潜串联舵机仿生机器鱼 |
CN112162075A (zh) * | 2020-10-21 | 2021-01-01 | 武汉工程大学 | 一种用于水质监测的自主导航仿生机器鱼及其控制方法 |
CN112918646A (zh) * | 2021-03-15 | 2021-06-08 | 武汉理工大学 | 一种仿生机器鱼的胸鳍与尾鳍协同控制***及方法 |
-
2021
- 2021-08-19 CN CN202110954465.0A patent/CN113636048B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113636048A (zh) | 2021-11-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113636048B (zh) | 一种多关节机器鱼及其运动控制方法 | |
Yu et al. | Parameter optimization of simplified propulsive model for biomimetic robot fish | |
Yu et al. | A framework for biomimetic robot fish's design and its realization | |
Yu et al. | Three-dimensional swimming | |
Wu et al. | Kinematic comparison of forward and backward swimming and maneuvering in a self-propelled sub-carangiform robotic fish | |
Wang et al. | Design, modeling, control, and experiments for a fish-robot-based IoT platform to enable smart ocean | |
CN102745320B (zh) | 一种仿鲹科机器鱼倒游运动的控制方法 | |
CN102303700A (zh) | 具有嵌入式视觉的多控制面机器鱼 | |
Niu et al. | Development and depth control of a robotic fish mimicking cownose ray | |
CN109976233A (zh) | 一种三维运动机器鱼的运动控制方法及控制*** | |
Zhang et al. | Design and locomotion control of a dactylopteridae-inspired biomimetic underwater vehicle with hybrid propulsion | |
CN111176116A (zh) | 一种基于cpg模型的机器鱼闭环反馈控制方法 | |
CN111745658B (zh) | 一种检测大型油浸式变压器的机器人及智能控制方法 | |
CN112109085B (zh) | 一种仿河狸机器人的cpg网络拓扑结构控制方法 | |
Yan et al. | Bionic fish tail design and trajectory tracking control | |
CN113325858A (zh) | 一种基于扑翼幅值的仿蝠鲼航行器航向控制方法 | |
Shen et al. | Implementation of a multi-link robotic dolphin with two 3-DOF flippers | |
Shen et al. | Depth control for robotic dolphin based on fuzzy PID control | |
Zhu et al. | Path planning algorithm for AUV based on a Fuzzy-PSO in dynamic environments | |
Ji et al. | Design and realization of a novel hybrid-drive robotic fish for aquaculture water quality monitoring | |
Cao et al. | Applying central pattern generators to control the robofish with oscillating pectoral fins | |
Xie et al. | Kinematic study on a self-propelled bionic underwater robot with undulation and jet propulsion modes | |
Hu et al. | Development and target following of vision-based autonomous robotic fish | |
Zhang et al. | Coordinated transport by multiple biomimetic robotic fish in underwater environment | |
Gao et al. | Design, fabrication, and testing of a maneuverable underwater vehicle with a hybrid propulsor |
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 |