CN106005317B - 用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法 - Google Patents

用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法 Download PDF

Info

Publication number
CN106005317B
CN106005317B CN201610323734.2A CN201610323734A CN106005317B CN 106005317 B CN106005317 B CN 106005317B CN 201610323734 A CN201610323734 A CN 201610323734A CN 106005317 B CN106005317 B CN 106005317B
Authority
CN
China
Prior art keywords
fish
steering wheel
shoal
draining
machine
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.)
Expired - Fee Related
Application number
CN201610323734.2A
Other languages
English (en)
Other versions
CN106005317A (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 University ZJU
Original Assignee
Zhejiang University ZJU
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 University ZJU filed Critical Zhejiang University ZJU
Priority to CN201610323734.2A priority Critical patent/CN106005317B/zh
Publication of CN106005317A publication Critical patent/CN106005317A/zh
Application granted granted Critical
Publication of CN106005317B publication Critical patent/CN106005317B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63CLAUNCHING, 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/00Equipment for dwelling or working underwater; Means for searching for underwater objects
    • B63C11/52Tools specially adapted for working underwater, not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63GOFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
    • B63G8/00Underwater vessels, e.g. submarines; Equipment specially adapted therefor
    • B63G8/14Control of attitude or depth

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Ocean & Marine Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

本发明公开了一种用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法。鱼头内部设有相连的排水针管、排水舵机、曲柄滑块和摄像头;排水舵机通过曲柄滑块与排水针管的活塞相连;排水针管对称设置于鱼头内部。所述的鱼头通过连接支架与鱼身相连,鱼身内设有若干个驱动舵机,驱动舵机之间通过级连固定件相连,最靠近鱼尾的驱动舵机通过级连固定件与鱼尾相连;级连固定件上固定有用于支撑蒙皮的蒙皮框架;靠近鱼尾的驱动舵机在靠近鱼头的驱动舵机的驱动下在水平方向转动;所述的摄像头、排水舵机和驱动舵机分别与控制器相连。本款机器鱼通过对于机械结构的改善和合理的运动规划增加游动速度,提高输出效率。

Description

用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法
技术领域
本发明属于机器人领域,具体涉及一种用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法。
背景技术
机器鱼,故名思议,从材料制作的外形像鱼的机器,机器鱼已在水质监测领域有十分广泛的应用,这一类型的机器鱼通常装有化学传感器,用于分析水中污染物成分等。本款机器鱼拟用于水产养殖业,用于定期驱赶鱼群,使鱼群定期游动,肉质得到改善,提高市场效益。
当前机器鱼的驱动方式常常基于仿生学,主要分为以下三种:
a.Anguilliform:(鳗状的)通过整体身躯肌肉的波动来游动,像鳗鱼一样
b.Carangiform:通过尾鳍和与尾部相连的身躯摆动来游动,像鲑鱼,金枪鱼,旗鱼
c.Ostraciifrom:只通过尾鳍的摆动而不利用身体摆动而进行泳动
然而当前机器鱼技术存在以下的弊端和改进:
1、现有机器鱼多用于水质监测等领域,依靠精密的化学传感器等,造价高。
2、由于其应用限制,当前机器鱼对于其外形和游动速度不加要求,然而用于驱赶鱼群的机器鱼对于其游动速度具有较高的要求。
3、现有机器鱼技术的防水流程复杂,且防水效果较差,成本较高。
发明内容
本发明的目的在于解决现有技术中存在的问题,并提供一种用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法。
本发明所采用的技术方案如下:
用于鱼群养殖业的自主追赶鱼群机器鱼,包括顺次相连且外表面包裹蒙皮的鱼头、鱼身和鱼尾;所述的鱼头内部设有相连的排水针管、排水舵机、曲柄滑块和摄像头;所述的排水舵机通过曲柄滑块与排水针管的活塞相连,用于驱动活塞运动以改变管内液体质量;所述的排水针管数量为双数,两两对称设置于鱼头内部,且针头的出水口位于鱼头外部;
所述的鱼头通过连接支架与鱼身相连,鱼身内设有若干个驱动舵机,驱动舵机之间通过级连固定件相连,最靠近鱼尾的驱动舵机通过级连固定件与鱼尾相连;级连固定件上固定有用于支撑蒙皮的蒙皮框架;靠近鱼尾的驱动舵机在靠近鱼头的驱动舵机的驱动下在水平方向转动;
所述的摄像头、排水舵机和驱动舵机分别与控制器相连。
作为优选,所述的控制器为树莓派。
作为优选,所述的蒙皮采用3M VHB胶带进行防水密封。
作为优选,所述的控制器、排水舵机和驱动舵机由电源设备进行供电,电源设备包括航模电池、电压降压模块和辅助电路
作为优选,所述的级连固定件整体呈Z形,上臂末端呈十字形,通过螺钉与上一级舵机的舵盘相连,上臂始端留有两个螺纹孔,用于与下一级舵机相连,进而完成级连的功能,并且传递扭矩;上臂始端设有肋板以提升结构强度。
作为优选,所述的控制器通过无线传输模块与用户进行数据交互。
一种利用所述用于鱼群养殖业的自主追赶鱼群机器鱼的控制方法,包括上下运动控制和左右运动控制;
所述的上下运动控制步骤如下:
S101:通过摄像头采集鱼群图像,并由控制器通过无线传输模块发送至服务器,在服务器端对图像中的目标鱼群进行位置识别,并将位置信息转换成控制指令传输回控制器中;
S102:控制器接收控制指令后,解析出该指令所对应的俯仰角度
S103:控制器控制排水舵机在t时间内匀速旋转角度θ1,θ1>0时排水针管水的体积增加,且θ1的计算公式如下:
式中:
y-目标点与鱼重心的轴向距离;z-目标点与鱼重心的竖直方向距离;ρ-液体密度;g-重力加速度;A-排水针管的横截面积;L1-针管中心与鱼重心距离;R-舵机曲柄滑块长度;J1-机器鱼竖直方向转动惯量;
上述公式的推导原理如下:
机器鱼的上下运动需要改变机器鱼在径向的俯仰角。为了便于控制,我们采用了固定时间调节的方式。
首先当鱼接收到旋转命令后,能够解析出指令俯仰角度通过俯仰角度经过以下的计算能够得到在指定时间t内,排水舵机所需要转过的角度θ1
通过改变排水舵机的旋转角度θ1来改变排水针管中的水的体积ΔV,其对应关系如下:
d=Rsinθ1
ΔV=dA=RAsinθ1
体积的变化造成机器鱼前部重力ΔF的变化,进而来改变机器鱼的前后扭矩ΔT的大小:
ΔF=ΔVρg=ρgARsinθ1
ΔT=2ΔFL1=2ρgAL1Rsinθ1
扭矩ΔT会造成机器鱼在径向的旋转,计算可得:
ΔT=J1β1
若我们要求运动在时间t内完成则可以得到下面的等式:
求解得即若使鱼在时间t内偏转角度,需要要求旋转舵机旋转
d-排水针管活塞位移;ΔV-排水针管排水体积;ΔF-因ΔV而增加的重力;ΔT-因ΔV而增加的转矩;β1-机器鱼竖直方向旋转角加速度;
y-目标点与鱼重心的轴向距离;z-目标点与鱼重心的竖直方向距离;ρ-液体密度;g-重力加速度;A-排水针管的横截面积;L1-针管中心与鱼重心距离;R-舵机曲柄滑块长度;J1-机器鱼竖直方向转动惯量;
S104:完成步骤S102后,由控制器控制排水舵机恢复至未旋转前的角度;
S105:不断重复S101~S104,实现垂直方向对目标鱼群的追赶;
所述的左右运动控制步骤如下:
S201:通过摄像头采集鱼群图像,并由控制器通过无线传输模块发送至服务器,在服务器端对图像中的目标鱼群进行位置识别,通过鱼群偏离图像中心的位置预测得到机器鱼需要偏离的角度θ2,并将位置信息转换成控制指令传输回控制器中;根据驱动舵机的运动幅度限制,设置鱼尾摆动次数N,来回摆动记为1次,单次摆动使机器鱼偏离的角度为θ',θ'=θ2/N;
S202:控制器接收控制指令后,解析出该指令所对应的双侧不对称旋转角度α和γ;其中α和γ为所有驱动舵机转动的角度之和,α>0时,鱼尾以鱼头为原点逆时针转动;γ>0时,鱼尾以鱼头为原点顺时针转动;α和γ满足以下约束条件:
τ1=FDL2cos(γ-γ1)
τ2=FDL2cos(α-α1)
式中:双侧鱼尾受力作用点和鱼重心之间所称角度为角度α1和γ1;FD为尾部所受的总作用力;L2-鱼尾中心与鱼重心间的距离;J2为机器鱼水平方向的转动惯量;τ1-鱼身以鱼头为原点顺时针方向所受力矩;τ2-鱼身鱼头为原点逆时针方向所受力矩;t-为单次摆动过程的总时间;
以上公式的推导原理如下:
水平方向控制按照左右两个摆动周期作为一次控制周期,进行粗略控制,每次转动的角度θ'。控制的流程为:
接收到旋转命令,解析出旋转方向。然后对尾部舵机进行旋转角方向的不对称控制。最后完成后鱼身恢复到初始状态。
其中机器鱼每次旋转的角度θ'与双侧不对称旋转角度α和γ之间的关系如下:
机器鱼鱼尾打水所收到的合外力可由以下公式计算得:
其中v=ωL2
如果左右之间的角度为双侧不对称旋转角度α和γ,双侧鱼尾受力作用点和鱼重心之间所称角度为角度α1和γ1,则两侧极端位置所收到的力矩为:
τ1=FD sinγL2sinγ1+FD cosγL2cosγ1=FDL2cos(γ-γ1)
τ2=FD sinαL2sinα1+FD cosαL2cosα1=FDL2cos(α-α1)
由于机器鱼摆动的速度较快,我们可以将受力进行近似,并且认为是恒力矩,则单次摆动所转过的角度为:
以总共摆动两次为例,所以每次执行旋转命令所转过的角度为:
上述公式中涉及参数的定义如下:
为尾部所受的总作用力;Cd-阻力系数;v-鱼尾摆动线速度;S-鱼尾面积;L2-鱼尾中心与鱼重心距离;J2为水平方向的转动惯量;τ1-鱼身顺时针方向所受力矩;τ2-鱼身逆时针方向所受力矩;t-为单次摆动的总时间;γ-鱼尾顺时针转动角度;γ1-鱼尾相对重心转过的顺时针角度;α-鱼尾逆时针转动角度;α1-鱼尾相对重心转过的逆时针角度。
S203:控制器控制驱动舵机转动,向两侧依次摆动α和γ,并重复N次;
S204:不断重复S201~203,实现水平方向对目标鱼群的追赶。
作为优选,所述的上下运动控制和左右运动控制同时或分别或依次进行。
本发明相对于现有技术而言,具有以下技术效果:
(1)机器鱼的机械效率和游动速度问题
现有技术多用于水下摄影、水质勘测等,重点放在其探测器的精密程度上,不对机器鱼平台的游动速度具有较高要求,然而本款机器鱼通过对于机械结构的改善和合理的运动规划增加游动速度,提高输出效率。
(2)机器鱼的运动规划问题
传统机器鱼常用于固定深度的水下,然而这款机器鱼的应用场所环境复杂,需要多种运动方向(直行、转弯、上浮、下沉等),此款机器鱼通过一个固定于鱼头处的排水装置,改变鱼的重量,进而改变其密度,从而实现机器鱼在水中的上浮及下沉。
(3)机器鱼的防水问题
传统技术未开发一套成本较低的防水结构,此款机器鱼利用了一种高弹性的材料VHB进行鱼身的防水和密封,既保护了电路和机械结构,又不干扰机器鱼本身的运动。
附图说明
图1为一种用于鱼群养殖业的自主追赶鱼群机器鱼的俯视内部结构图;
图2为级连固定件的示意图;其中a)为主视图;b)左视图;c)俯视图;
图3为本发明的机器鱼侧视图;
图4为机器鱼左右运动的控制示意图;
图5为本发明的排水舵机曲柄滑块装置运动示意图;
图6为机器鱼上下运动的控制示意图。
图中:排水针管1、排水舵机2、曲柄滑块3、级连固定件4、蒙皮框架5、鱼尾6、连接支架7、控制器8和摄像头9;
具体实施方式
下面结合附图和具体实施方式对本发明做进一步阐述和说明。本发明中各个实施方式的技术特征在没有相互冲突的前提下,均可进行相应组合。
如图1和3所示,一种用于鱼群养殖业的自主追赶鱼群机器鱼。该机器鱼主体部分分为顺次相连且外表面包裹蒙皮的鱼头、鱼身和鱼尾6。蒙皮采用3M VHB胶带进行防水密封,每次下水前都需要重新包裹,以保证机器鱼内部的防水性能。
所述的鱼头内部设有相连的排水针管1、排水舵机2、曲柄滑块3和摄像头9;所述的排水舵机2通过曲柄滑块3与排水针管1的活塞相连,用于驱动活塞运动以改变管内液体质量;所述的排水针管1数量为双数,两两对称设置于鱼头内部,且针头的出水口位于鱼头外部。本实施例中,排水针管1、排水舵机2及曲柄滑块3作为质心调整模块,共有2套,对称放置于鱼头下部。舵机带动曲柄滑块旋转,曲柄滑块机构与排水针管内活塞相连,从而将舵机的旋转运动转换为活塞的往复运动。
所述的鱼头通过连接支架7与鱼身相连。本实施例中,鱼身内设有3个驱动舵机,驱动舵机之间通过级连固定件4相连,最靠近鱼尾6的驱动舵机通过级连固定件4与鱼尾6相连。鱼尾部分前半部分采用与舵机级联固定件上臂部分相同的结构,后半部分固连一个鱼尾形状的排水板,通过打水的方式推动鱼在水中前进。
级连固定件4上固定有用于支撑蒙皮的蒙皮框架5。本实施例中,蒙皮框架5分为大小三个,呈椭圆形,分别通过胶连的方式固定在级联固定件上,面积大小比例分别为13:11:7,每级框架由两个由左右两个堆成的部分组成,上下分别由大小不同的1/4椭圆组成,相互之间平滑连接。靠近鱼尾6的驱动舵机在靠近鱼头的驱动舵机的驱动下在水平方向转动。尾部首级舵机通过螺钉固定在连接支架7上。如图2所示,级连固定件4整体呈Z形,上臂末端呈十字形,通过螺钉与上一级舵机的舵盘相连,上臂始端留有两个螺纹孔,用于与下一级舵机相连,进而完成级连的功能,并且传递扭矩;上臂始端设有肋板以提升结构强度。
所述的摄像头9、排水舵机2和驱动舵机分别与控制器8相连。本具体实施方式中控制器8为便于开发的树莓派。树莓派通过螺钉安装在机器鱼内部,实现机器鱼的基本控制。摄像头采用树莓派配套的专用摄像头,通过CSI接口与树莓派对应接口连接,摄像头模块通过支架固定在鱼的前部。
机器鱼中控制器8、排水舵机和驱动舵机由电源设备进行供电,电源设备包括航模电池、电压降压模块和辅助电路。
为了实现与远程服务器的交互,控制器8通过无线传输模块与用户进行数据交互。
本发明对机器鱼的基本控制原理为:
水平方向控制:接收到服务器端的指令后,树莓派会采取一系列的动作,以完成机器鱼水平方向的位置控制:
左:向左移动,α>β;中:向前直线移动,α=β;右:向右移动,α<β
竖直方向控制:接收到服务器端的指令后,树莓派会采取一系列的动作,以完成机器鱼竖直方向的位置控制。
上:排水舵机旋转,从而带动曲柄连杆装置,使活塞前移,这样机器鱼的整体重心后移并且重力减小,双方面原因造成鱼身上浮。
下:排水舵机旋转,从而带动曲柄连杆装置,使活塞后移,这样机器鱼的整体重心前移并且重力增加,双方面原因造成鱼身下沉。
树莓派中还设有辅助程序,辅助程序主要是用来执行一些辅助的功能,其中包括:
自平衡控制:通过单独改变左右排水舵机的旋转角度,使鱼身总体质心位置发生改变,相对于机器鱼的几何重心产生一定的扭矩,以保证机器鱼自身的扭矩平衡。
低电压保护:当机器鱼检测到工作电池电压低于一定阈值时,会启动低电保护,排光质心调整模块中针筒中的所有的水并使鱼尾对称运动,迫使机器鱼浮出水面。
进一步的,基于上述机器鱼,还可以提供一种所述用于鱼群养殖业的自主追赶鱼群机器鱼的控制方法,包括上下运动控制和左右运动控制。上下运动控制和左右运动控制可以根据实际需要同时、分别或依次进行。
如图5~6所示,所述的上下运动控制步骤如下:
S101:通过摄像头9采集鱼群图像,并由控制器8通过无线传输模块发送至服务器,在服务器端对图像中的目标鱼群进行位置识别,并将位置信息转换成控制指令传输回控制器8中;
S102:控制器8接收控制指令后,解析出该指令所对应的俯仰角度
S103:控制器8控制排水舵机2在t1时间内匀速旋转角度θ1,θ1>0时排水针管1水的体积增加,且θ1的计算公式如下:
式中:
y-目标点与鱼重心的轴向距离;z-目标点与鱼重心的竖直方向距离;ρ-液体密度;g-重力加速度;A-排水针管的横截面积;L1-针管中心与鱼重心距离;R-舵机曲柄滑块长度;J1-机器鱼竖直方向转动惯量;
S104:完成步骤S102后,由控制器8控制排水舵机2恢复至未旋转前的角度;
S105:不断重复S101~S104,实现垂直方向对目标鱼群的追赶;
如图4所示,所述的左右运动控制步骤如下:
S201:通过摄像头9采集鱼群图像,并由控制器8通过无线传输模块发送至服务器,在服务器端对图像中的目标鱼群进行位置识别,通过鱼群偏离图像中心的位置预测得到机器鱼需要匀速偏离的角度θ2,并将位置信息转换成控制指令传输回控制器8中;根据驱动舵机的运动幅度限制,设置鱼尾摆动次数N,来回摆动记为1次,单次摆动使机器鱼偏离的角度为θ',θ'=θ2/N;
S202:控制器8接收控制指令后,解析出该指令所对应的双侧不对称旋转角度α和γ;其中α和γ为所有驱动舵机转动的角度之和,α>0时,鱼尾以鱼头为原点逆时针转动;γ>0时,鱼尾以鱼头为原点顺时针转动;α和γ满足以下约束条件:
τ1=FDL2cos(γ-γ1)
τ2=FDL2cos(α-α1)
式中:双侧鱼尾受力作用点和鱼重心之间所称角度为角度α1和γ1;FD为尾部所受的总作用力;L2-鱼尾中心与鱼重心间的距离;J2为机器鱼水平方向的转动惯量;τ1-鱼身以鱼头为原点顺时针方向所受力矩;τ2-鱼身鱼头为原点逆时针方向所受力矩;t2-为单次摆动过程的总时间;
S203:控制器8控制驱动舵机转动,向两侧依次摆动α和γ,并重复N次;
S204:不断重复S201~203,实现水平方向对目标鱼群的追赶。
以上所述的实施例只是本发明的一种较佳的方案,然其并非用以限制本发明。有关技术领域的普通技术人员,在不脱离本发明的精神和范围的情况下,还可以做出各种变化和变型。因此凡采取等同替换或等效变换的方式所获得的技术方案,均落在本发明的保护范围内。

Claims (7)

1.一种用于鱼群养殖业的自主追赶鱼群机器鱼,其特征在于,包括顺次相连且外表面包裹蒙皮的鱼头、鱼身和鱼尾(6);所述的鱼头内部设有相连的排水针管(1)、排水舵机(2)、曲柄滑块(3)和摄像头(9);所述的排水舵机(2)通过曲柄滑块(3)与排水针管(1)的活塞相连,用于驱动活塞运动以改变管内液体质量;所述的排水针管(1)数量为双数,两两对称设置于鱼头内部,且针头的出水口位于鱼头外部;
所述的鱼头通过连接支架(7)与鱼身相连,鱼身内设有若干个驱动舵机,驱动舵机之间通过级连固定件(4)相连,最靠近鱼尾(6)的驱动舵机通过级连固定件(4)与鱼尾(6)相连;级连固定件(4)上固定有用于支撑蒙皮的蒙皮框架(5);靠近鱼尾(6)的驱动舵机在靠近鱼头的驱动舵机的驱动下在水平方向转动;
所述的摄像头(9)、排水舵机(2)和驱动舵机分别与控制器(8)相连;
机器鱼的控制方法包括上下运动控制和左右运动控制;
所述的上下运动控制步骤如下:
S101:通过摄像头(9)采集鱼群图像,并由控制器(8)通过无线传输模块发送至服务器,在服务器端对图像中的目标鱼群进行位置识别,并将位置信息转换成控制指令传输回控制器(8)中;
S102:控制器(8)接收控制指令后,解析出该指令所对应的俯仰角度
S103:控制器(8)控制排水舵机(2)在t1时间内匀速旋转角度θ1,θ1>0时排水针管(1)水的体积增加,且θ1的计算公式如下:
<mrow> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> <mo>=</mo> <mi>arctan</mi> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> <mi>arctan</mi> <mfrac> <mi>z</mi> <mi>y</mi> </mfrac> </mrow> <mrow> <msup> <msub> <mi>t</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <msub> <mi>&amp;rho;gAL</mi> <mn>1</mn> </msub> <mi>R</mi> </mrow> </mfrac> <mo>)</mo> </mrow> </mrow>
式中:
y-目标点与鱼重心的轴向距离;z-目标点与鱼重心的竖直方向距离;ρ-液体密度;g-重力加速度;A-排水针管的横截面积;L1-针管中心与鱼重心距离;R-舵机曲柄滑块长度;J1-机器鱼竖直方向转动惯量;
S104:完成步骤S102后,由控制器(8)控制排水舵机(2)恢复至未旋转前的角度;
S105:不断重复S101~S104,实现垂直方向对目标鱼群的追赶;
所述的左右运动控制步骤如下:
S201:通过摄像头(9)采集鱼群图像,并由控制器(8)通过无线传输模块发送至服务器,在服务器端对图像中的目标鱼群进行位置识别,通过鱼群偏离图像中心的位置预测得到机器鱼需要匀速偏离的角度θ2,并将位置信息转换成控制指令传输回控制器(8)中;根据驱动舵机的运动幅度限制,设置鱼尾摆动次数N,来回摆动记为1次,单次摆动使机器鱼偏离的角度为θ',θ'=θ2/N;
S202:控制器(8)接收控制指令后,解析出该指令所对应的双侧不对称旋转角度α和γ;其中α和γ为所有驱动舵机转动的角度之和,α>0时,鱼尾以鱼头为原点逆时针转动;γ>0时,鱼尾以鱼头为原点顺时针转动;α和γ满足以下约束条件:
τ1=FDL2cos(γ-γ1)
τ2=FDL2cos(α-α1)
<mrow> <msup> <mi>&amp;theta;</mi> <mo>&amp;prime;</mo> </msup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>&amp;tau;</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>&amp;tau;</mi> <mn>2</mn> </msub> </mrow> <mrow> <mn>4</mn> <msub> <mi>J</mi> <mn>2</mn> </msub> </mrow> </mfrac> <msup> <msub> <mi>t</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> </mrow>
式中:双侧鱼尾受力作用点和鱼重心之间所成角度为角度α1和γ1;FD为尾部所受的总作用力;L2-鱼尾中心与鱼重心间的距离;J2为机器鱼水平方向的转动惯量;τ1-鱼身以鱼头为原点顺时针方向所受力矩;τ2-鱼身以鱼头为原点逆时针方向所受力矩;t2-为单次摆动过程的总时间;
S203:控制器(8)控制驱动舵机转动,向两侧依次摆动α和γ,并重复N次;
S204:不断重复S201~203,实现水平方向对目标鱼群的追赶。
2.如权利要求1所述的用于鱼群养殖业的自主追赶鱼群机器鱼,其特征在于,所述的控制器(8)为树莓派。
3.如权利要求1所述的用于鱼群养殖业的自主追赶鱼群机器鱼,其特征在于,所述的蒙皮采用3M VHB胶带进行防水密封。
4.如权利要求1所述的用于鱼群养殖业的自主追赶鱼群机器鱼,其特征在于,所述的控制器(8)、排水舵机和驱动舵机由电源设备进行供电,电源设备包括航模电池、电压降压模块和辅助电路。
5.如权利要求1所述的用于鱼群养殖业的自主追赶鱼群机器鱼,其特征在于,所述的级连固定件(4)整体呈Z形,上臂末端呈十字形,通过螺钉与上一级舵机的舵盘相连,上臂始端留有两个螺纹孔,用于与下一级舵机相连,进而完成级连的功能,并且传递扭矩;上臂始端设有肋板以提升结构强度。
6.如权利要求1所述的用于鱼群养殖业的自主追赶鱼群机器鱼,其特征在于,所述的控制器(8)通过无线传输模块与用户进行数据交互。
7.如权利要求1所述的用于鱼群养殖业的自主追赶鱼群机器鱼,其特征在于,所述的上下运动控制和左右运动控制同时或分别或依次进行。
CN201610323734.2A 2016-05-16 2016-05-16 用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法 Expired - Fee Related CN106005317B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610323734.2A CN106005317B (zh) 2016-05-16 2016-05-16 用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610323734.2A CN106005317B (zh) 2016-05-16 2016-05-16 用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法

Publications (2)

Publication Number Publication Date
CN106005317A CN106005317A (zh) 2016-10-12
CN106005317B true CN106005317B (zh) 2017-11-17

Family

ID=57097537

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610323734.2A Expired - Fee Related CN106005317B (zh) 2016-05-16 2016-05-16 用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法

Country Status (1)

Country Link
CN (1) CN106005317B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106741762B (zh) * 2016-12-13 2019-03-05 辽宁石化职业技术学院 一种机器鱼及其水下目标跟踪方法
CN108408009A (zh) * 2018-05-13 2018-08-17 上海海洋大学 一种基于树莓派Raspberry Pi控制器的智能水下航行器
CN110228575B (zh) * 2019-05-20 2020-11-10 西安交通大学 一种水下仿生引导机器鱼及引导鱼类运动方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2476316Y (zh) * 2001-04-12 2002-02-13 梁建宏 新型遥控多关节仿生机器鱼
CN2628239Y (zh) * 2003-07-09 2004-07-28 中国科学技术大学 仿生机器鱼
JP2008044545A (ja) * 2006-08-18 2008-02-28 Mhi Solution Technologies Co Ltd 魚様ロボット
CN102303700A (zh) * 2011-05-26 2012-01-04 中国科学院自动化研究所 具有嵌入式视觉的多控制面机器鱼
CN203780783U (zh) * 2014-03-12 2014-08-20 浙江大学 一种具有独立链状尾部支撑的机器鱼
CN205770079U (zh) * 2016-05-16 2016-12-07 浙江大学 一种用于鱼群养殖业的自主追赶鱼群机器鱼

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2476316Y (zh) * 2001-04-12 2002-02-13 梁建宏 新型遥控多关节仿生机器鱼
CN2628239Y (zh) * 2003-07-09 2004-07-28 中国科学技术大学 仿生机器鱼
JP2008044545A (ja) * 2006-08-18 2008-02-28 Mhi Solution Technologies Co Ltd 魚様ロボット
CN102303700A (zh) * 2011-05-26 2012-01-04 中国科学院自动化研究所 具有嵌入式视觉的多控制面机器鱼
CN203780783U (zh) * 2014-03-12 2014-08-20 浙江大学 一种具有独立链状尾部支撑的机器鱼
CN205770079U (zh) * 2016-05-16 2016-12-07 浙江大学 一种用于鱼群养殖业的自主追赶鱼群机器鱼

Also Published As

Publication number Publication date
CN106005317A (zh) 2016-10-12

Similar Documents

Publication Publication Date Title
CN106005317B (zh) 用于鱼群养殖业的自主追赶鱼群机器鱼及其控制方法
CN105775082B (zh) 一种面向水质监测的仿生机器海豚
CN102962843B (zh) 一种跃水机器海豚
CN104503231B (zh) 两栖蛙板机器人的摆臂驱动式运动控制方法
WO2021012914A1 (zh) 基于海洋牧场水下环境探测的仿生柔性线驱动蝠鲼
CN207309951U (zh) 一种智能捡球机器人
CN104656664B (zh) 车载多旋翼无人直升机着陆导引控制系统及导引控制方法
CN206633010U (zh) 一种带计算机视觉功能的机器蛇
CN110304223A (zh) 仿生机器蝠鲼
CN105799876B (zh) 一种仿生智能机器鱼
CN103950527A (zh) 仿生鳐鱼胸鳍的压电耦合推进机构
CN104648685B (zh) 基于智能手机的四旋翼飞行器指定路径航拍系统和方法
CN207607626U (zh) 一种仿箱鲀科自主机器鱼
CN104375504B (zh) 一种陪跑机器人及其跟踪控制策略与运动控制方法
CN104015828A (zh) 一种仿生扑翼与弹跳多模式运动机器人
CN106774350A (zh) 双红外精确校准机器人与充电平台对接角度的机器人
CN104175315B (zh) 移动机器人载运的节点自动投放装置
CN102490885B (zh) 一种多关节机器海豚的翻滚运动控制方法
CN106774391A (zh) 一种水下空化清洗机器人的控制系统
CN2628239Y (zh) 仿生机器鱼
CN111438691B (zh) 仿生六足机器蟹控制系统
CN205770079U (zh) 一种用于鱼群养殖业的自主追赶鱼群机器鱼
CN106393108A (zh) 一种独立态单球体自平衡运动装置
CN103921949A (zh) 基于瑞萨芯片r5f100lea的四旋翼自主飞行器
CN108758301A (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
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20171117

Termination date: 20190516