CN107065563A - 一种基于三维模糊ptp算法的单体机器鱼行为控制策略 - Google Patents

一种基于三维模糊ptp算法的单体机器鱼行为控制策略 Download PDF

Info

Publication number
CN107065563A
CN107065563A CN201710349193.5A CN201710349193A CN107065563A CN 107065563 A CN107065563 A CN 107065563A CN 201710349193 A CN201710349193 A CN 201710349193A CN 107065563 A CN107065563 A CN 107065563A
Authority
CN
China
Prior art keywords
machine fish
heading
speed
behavior
region
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
CN201710349193.5A
Other languages
English (en)
Other versions
CN107065563B (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.)
Chinese PLA General Hospital
Beijing Institute of Technology BIT
Original Assignee
Chinese PLA General Hospital
Beijing Institute of Technology BIT
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 Chinese PLA General Hospital, Beijing Institute of Technology BIT filed Critical Chinese PLA General Hospital
Publication of CN107065563A publication Critical patent/CN107065563A/zh
Application granted granted Critical
Publication of CN107065563B publication Critical patent/CN107065563B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

一种基于三维模糊PTP算法的单体机器鱼行为控制策略,属于智能控制技术领域。涉及机器鱼顶球运动,提出了面向不同区域顶球点的划分、改进的PTP算法,设计了不同区域对应的行为策略,给出了机器鱼顶球过程中的基本行为序列。采用面向不同“区域”的控制算法,实现机器鱼顶球到达目标点的简单任务;具体根据顶球点划分水池区域,设计了机器鱼在对应区域的顶球运动行为。本发明可适应于多种机器鱼在含有障碍、噪音等较复杂的水下环境,应用范围广;将速度、角度、采样时间采用三维模糊化处理,并转化为控制模式,便于机器鱼控制模式的直接调用,大大简化了算法流程,降低了算法复杂度,具有数据更新速度快、精确度高及实时性好的优势。

Description

一种基于三维模糊PTP算法的单体机器鱼行为控制策略
技术领域
本发明涉及一种基于三维模糊PTP算法的单体机器鱼行为控制策略,属于智能控制技术领域。
背景技术
机器人运动规划问题是任何机器人研究者都不会忽略的问题,运动规划对机器人高效运动有重要作用。然而,水下机器鱼运动规划同陆地机器人相比具有特殊的难点:
(1)机器鱼特殊的运动学模型带来的难点,即由于惯性作用,机器鱼在水中无法立刻停止,或者像陆地机器人一样自由的后退。再者,目前仍然未能为机器鱼的运动建立精确的动力学模型,因此发出控制命令后,只能大致地预测机器鱼的反应;
(2)同陆地环境相比,水下环境具有更多的不确定性及干扰。当机器鱼游动时带来的扰动水波,不仅将影响到机器鱼本身及其他机器鱼的运动,而且会影响到传感器的精确测量;
(3)另外,被运输的物体可能会由于水波的冲击发生漂移和转动,这将会给机器鱼的运输运动控制带来很大的困难。因此,大多数陆地机器人的协作算法不能直接应用到机器鱼上,需要提出更新的、抗干扰能力更强的控制算法。
在机器鱼顶球的任务中,要求机器鱼在水池环境中,将半径为r的水球从初始位置移动到目标位置,没有其他辅助装置,机器鱼只允许通过头部或尾鳍顶球。理论上来讲,是运动规划和行为选择问题,不仅涉及到底层的运动控制,而且涉及到上层的规划和控制。因为水中环境会因机器鱼的游动而产生水波,因此采集水中环境信息,即机器鱼、水球、目标点的位置和角度信息,进行图像识别、处理是很重要的。
本专利假设初始情况下水球和机器鱼的位置可以是任意的。现有针对单体机器鱼顶球运动规划问题虽然能够使得机器鱼很快找到水球位置,该行为是游向行为,该算法较为复杂,尤其针对机器鱼转弯策略设计中,较难实现。因此,在运动性能提升方面及算法复杂度方面均存在很大改进空间。
本专利致力于从运动学角度对单体机器鱼顶球运动规划问题进行了改进,采用面向不同“区域”的控制算法,实现机器鱼顶球到达目标点的简单任务。该算法的基本思想是:根据顶球点划分水池区域,设计了对应区域的具体行为。
发明内容
本发明的目的在于克服现有单体机器鱼顶球运动规划算法较为复杂且转弯策略难以实现的技术缺陷,提出了一种基于三维模糊PTP算法的单体机器鱼行为控制策略。
本发明的核心思想为:采用面向不同“区域”的控制算法,实现机器鱼顶球到达目标点的简单任务;具体根据顶球点划分水池区域,设计了机器鱼在对应区域的顶球运动行为。
一种基于三维模糊PTP算法的改进单体机器鱼行为控制策略,包括如下步骤:
步骤1初始化采样时间、划分水池区域以及顶球点位置为主的参数,具体为:
步骤1.1初始化采样时间ΔT;
步骤1.2将机器鱼进行水下运动所处的水池区域划分为区域1、区域2、区域3和区域4;
其中,区域1为进攻区PR(Pushing Region);
区域2为上边界区UBR(Upper Boundary of the Region);
区域3为下边界区LBR(Lower Boundary of the Region);
区域4为射门区GR(Goal Region);
步骤1.3设定不同区域对应的顶球点坐标;
其中,顶球点,记为Point点;对应于步骤1.2的不同水池区域设定的顶球点位置如下:
(1)向下顶球点:对应上边界区UBR,设定的向下顶球点坐标为(b_pt.x,b_pt.y-r);
(2)向右顶球点:对应进攻区PR,设定的向右顶球点坐标为(b_pt.x-r,b_pt.y);
(3)向上顶球点:对应下边界区LBR,设定的向上顶球点坐标为(b_pt.x,b_pt.y+r);
(4)射门顶球点:对应射门区GR,设定的射门顶球点坐标为:
(b_pt.x-rcos(b_to_g_dir),b_pt.y-rsin(b_to_g_dir));
步骤2更新机器鱼的位置、方向信息及环境信息,计算机器鱼同顶球点的距离差和方向差,并判断机器鱼是否到达目标点,决定是否结束本发明所提策略,具体为:
其中,距离差,记为l;方向差,记为θe
若(l<δl)∩(θe<δθe),表明机器鱼已经到达目标点,结束本发明所提策略;否则,转步骤3;
其中,δl为距离绝对误差,δθe为方向绝对误差;
步骤3根据步骤2机器鱼的方向差,提取转角,对机器鱼进行方向控制,即决定调用转弯模态还是速度策略,具体为:
步骤3.1获取机器鱼当前的方向差θe,并根据方向差与角度阈值的大小关系,进行如下操作:
其中,角度阈值,记为θf,其取值范围为85到95度,优选的θf为90度;
3.1A获取机器鱼当前的方向差θe,如果|θe|<θf,转步骤4调用设计的机器鱼速度策略;
3.1B若|θe|≥θf,则转步骤3.2;
步骤3.2调用转弯模态进行大幅度方向改变;
其中,转弯模态,记为Mode1,具体为:
3.2A若θe<-θf,机器鱼进行左急转弯,转角为负60度到负30度,转步骤4;
3.2B若θe>θf,机器鱼进行右急转弯,转角为30度到60度,转步骤4;
步骤4:根据步骤2中距离差进行速度控制,设计机器鱼的速度策略,具体为:
4.1若距离差满足l>Ld,则设置机器鱼的速度为speed=15,跳至步骤5;
4.2若距离差满足Ls<l≤Ld,则设置机器鱼的速度为speed=12,跳至步骤5;
4.3若距离差l≤Ls,则设置机器鱼的速度为speed=8,跳至步骤5;
其中,Ls为近距离阈值,Ld为远距离阈值,且Ls<Ld
步骤5:将机器鱼的转角、速度值和采样时间进行三维模糊化处理,转化为不同的控制模式,通过无线方式发送给机器鱼,转步骤2,具体为:
步骤5.1对机器鱼的转角、速度值和采样时间进行三维模糊化处理,具体为:
5.1A在不同的采样时间下,机器鱼的转角和速度值划分区间不同;
5.1B将转角、速度和采样时间转换为运动模式;
其中,运动模式用(θa,Va,Ta)表示,θa为角度档位,Va为速度档位,Ta为采样时间档位;
其中,三维模糊化处理遵循如下规则:在如下条件下对转角、速度、采样时间模糊化处理,转换为同一运动模式:⑴相同的区间,不同的采样时间,⑵相同的速度区间,不同的速度值,⑶相同的转角区间,不同的转角值;而不同的转角区间、速度区间或采样时间区间,对转角、速度或采样时间模糊化处理,转换为不同的运动模式;
步骤5.2规划机器鱼顶球行为,即:针对步骤5.1输出的机器鱼所处区域及其运动模式,确定机器鱼的顶球行为;
其中,顶球行为由一系列动作组成,如实施例4所示;
步骤5.3规划机器鱼的基本动作,即:针对步骤5.2中机器鱼的顶球行为确定机器鱼的机器鱼动作;
其中,机器鱼的机器鱼动作由电机控制;
步骤5.4确定机器鱼的控制参数:将步骤5.3规划的机器鱼的基本动作转换为电机控制参数;
步骤5.5将步骤5.4输出的电机控制参数经无线方式传给机器鱼,控制机器鱼的顶球行为,转步骤2;
至此,经过了步骤1到步骤5,完成了一种基于三维模糊PTP算法的单体机器鱼行为控制策略。
有益效果
一种基于三维模糊PTP算法的单体机器鱼行为控制策略,与现有的单体机器鱼行为控制方法相比,具有如下有益效果:
1.本发明针对不同区域划分设计相应的机器鱼行为控制策略,可适应于多种机器鱼在含有障碍、噪音等多种比较复杂的水下环境中,应用范围广;
2.本发明所提策略中将速度、角度、采样时间,采用三维模糊化处理,并转化为控制模式,便于机器鱼控制模式的直接调用,大大简化了算法流程,降低了算法的复杂度;
3.本发明所提策略中使用的基于三维模糊的PTP算法,该算法流程简单,因此响应速度快,机器鱼灵敏度高,机器鱼的运动性能得到进一步提高;
4.本发明所提策略简化了大量的运算过程,可以设定较高的采样频率,具有数据更新速度快、精确度高以及实时性好的优势。
附图说明
图1是本发明一种基于三维模糊PTP算法的单体机器鱼行为控制策略的步骤1及实施例1中不同水池区域划分及相应区域顶球点设定;
图2是本发明一种基于三维模糊PTP算法的单体机器鱼行为控制策略及实施例2中的总体流程图;
图3是本发明一种基于三维模糊PTP算法的单体机器鱼行为控制策略的实施例3中机器鱼不同区域顶球行为的示意图;
图3(a)BPR行为示意图(有效进攻情况),图3(b)BPR行为示意图(过冲情况),图3(c)BUBR行为示意图,图3(d)BLBR行为示意图,图3(e)BGR行为示意图;
图4是本发明一种基于三维模糊PTP算法的单体机器鱼行为控制策略实施例4中机器鱼顶球动作示意图;
图4(a)向下顶球动作示意图,图4(b)向下顶球动作示意图,图4(c)射门动作示意图
图5是本发明一种基于三维模糊PTP算法的单体机器鱼行为控制策略实施例4中机器鱼过程动作示意图;
图5(a)到达临时返回点后转弯动作示意图,图5(b)尾部波动推进水球动作示意图。
具体实施方式
下面结合附图和实施例对本发明做进一步说明和详细描述。
实施例1
本实施例叙述了在本发明在具体实施时针对不同水池区域划分及相应区域顶球点设定。图1是本发明一种基于三维模糊PTP算法的单体机器鱼行为控制策略的步骤1中不同水池区域划分及相应区域顶球点设定。图1中,Oxy为直角坐标系。
从图1中可以看出,水池区域被划分为区域1、区域2、区域3和区域4;每一个区域中都有一个球,球上有个黑点即是顶球点,不同区域中设定的顶球点坐标,区域1中包含向右顶球点,其坐标为(b_pt.x-r,b_pt.y);区域2中包含向下顶球点,其坐标为(b_pt.x,b_pt.y-r);区域3中包含向上顶球点,其坐标为(b_pt.x,b_pt.y+r);区域4中包含射门顶球点,其坐标为(b_pt.x-rcos(b_to_g_dir),b_pt.y-rsin(b_to_g_dir))。其中cos(b_to_g_dir)是球心坐标与目标点之间连线和x轴夹角的余弦值,(sin(b_to_g_dir)是球心坐标与目标点之间连线和x轴夹角的正弦值。
实施例2
本实施例详细阐述了一种基于三维模糊PTP算法的单体机器鱼行为控制策略的总体流程。
图2为本发明一种基于三维模糊PTP算法的单体机器鱼行为控制策略的三维模糊策略下的PTP算法设计流程图。
从图2可以看出,本发明具体实施时包括如下步骤:
步骤A.初始化;
将采样时间初始化为1s;如图1所示,水池区域划分为4个区域;小球坐标为(103cm,47cm),位于区域1,point点坐标为(101cm,47cm);
步骤B.信息更新计算;
其中,信息更新参数为l和θe
步骤C.判断是否|θe|<δθ,并根据判断结果进行相应操作,具体为:
C.1若|θe|<δθ,即对应图2中的Y1,则跳至步骤E;
C.2若|θe|≥δθ,即对应图2中的N1,则跳至步骤D;
步骤D.判断是否|θe|<θf,并根据判断结果进行相应操作,具体为:
D.1若|θe|<δθ,即对应图2中的Y2,则调用转向策略,再跳至步骤E;
D.2若|θe|≥δθ,即对应图2中的N2,则调用转弯策略,再跳至步骤E;
步骤E.判断是否|l|<δl,并根据判断结果进行相应操作,具体为:
D.1若|θe|<δθ,即对应图2中的Y3,则跳至步骤F;
D.2若|θe|≥δθ,即对应图2中的N3,则调用速度控制策略,再跳至步骤F;
步骤F.输出机器鱼的速度、转向,具体为;
根据步骤D、E中的转向、转弯、速度控制策略,输出机器鱼的速度和转向。
步骤G.计算模糊控制模式,具体为;
根据步骤F机器鱼输出的速度、转向以及步骤A中的采样时间,三维模糊化处理转换为模糊控制模式;
步骤H.若(l<δl)∩(θe<δθe)结束,否则转步骤B;
实施例3
本实施例详细阐述了在本发明在具体实施时针对不同区域设置相应的机器鱼顶球行为规划策略,具体对应着本发明所提策略的步骤5.1中的机器鱼顶球行为规划。
顶球行为规划的目标是为机器鱼规划适当的运动行为,以引导机器鱼顶球到达目标点位置。对应于各种区域情况,相应的行为设计使得机器鱼在不同区域内选择相应的行为向目标点运动,其具体过程如下:
1)BPR行为:对应为进攻区的行为。有效进攻情况:如图3(a)所示,当机器鱼中心坐标f_CenterPt横坐标小于水球坐标b_pt的横坐标时,机器鱼沿最短路径朝向右顶球点游去,到达向右顶球点后,实施向右顶球动作。过冲情况:如图3(b)所示,若机器鱼中心坐标点f_CenterPt横坐标在b_pt的横坐标与g_pt横坐标之间时,即机器鱼位于水球和目标点之间的区域,为过冲情况。在这种情况下,机器鱼调整位姿,游向有效进攻区。
2)BUBR行为:对应为上边界区的行为。当水球处于上边界区域时,如图3(c)所示,机器鱼游向向下顶球点,实施向下顶球动作。
3)BLBR行为:对应为下边界区的行为。同上边界区域行为相似,如图3(d)所示,当水球处于下边界区域时,机器鱼游向向上顶球点,实施向上顶球动作。
4)BGR行为:对应为射门区的行为。如图3(e)所示,当水球处于射门区域时,机器鱼游向射门顶球点。
实施例4
本实施例详细阐述了在本发明中,根据不同区域的行为设计,给出相应的动作规划。在机器鱼顶球到目标点过程中,均是由这一系列动作组成,具体对应着本发明所提策略的步骤5.2中的动作规划。
(1)顶球动作P_Action
P_Action1:向右顶球动作,当机器鱼处于进攻区时,机器鱼朝向右顶球点运动,实施向右顶球动作。
P_Action2:向下顶球动作,这个动作应用于BUBR行为中,如图4(a)所示,机器鱼游到向下顶球点,实施向下顶球动作。
P_Action3:向上顶球动作,应用于BLBR行为中,如图4(b)所示,机器鱼游到向上顶球点,实施向上顶球动作。
P_Acition4:射门动作,如图4(c)所示,当水球处于射门区时,采取了切入圆射门算法,使得机器鱼将球顶入球门内。
(2)过程动作Action
为了区分机器鱼所处的区域情况,本发明对游向目标行为进行了具体的动作划分:
Action1:游向向右顶球点。
Action2:游向临时返回点。
Action3:到达临时返回点后转弯动作,如图5(a)所示,当机器鱼到达临时返回点后,设计相应的转弯动作,使机器鱼沿着舒适圆路径,朝向右顶球点运动,继而实施向右顶球动作。
Action4:游向向上顶球点。
Action5:游向向下顶球点。
Action6:游向射门顶球点。
Action7:顶球后尾巴波动推动水球运动,如图5(b)所示,当机器鱼采取顶球动作后,水球会由于机器鱼顶球受力,而漂离机器鱼,此时机器鱼采取急转弯,并伴随尾部波动,然后调直以速度v向前游动,即使机器鱼尾部没有接触到水球,借助尾部波动搅起的水波,产生力F,也可推动水球向目标点运动。
以上所述为本发明的较佳实施例而已,本发明不应该局限于该实施例和附图所公开的内容。凡是不脱离本发明所公开的精神下完成的等效或修改,都落入本发明保护的范围。

Claims (8)

1.一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:包括如下步骤:
步骤1初始化采样时间、划分水池区域以及顶球点位置为主的参数;
步骤2更新机器鱼的位置、方向信息及环境信息,计算机器鱼同顶球点的距离差和方向差,并判断机器鱼是否到达目标点,决定是否结束本发明所提策略;
步骤3根据步骤2机器鱼的方向差,提取转角,对机器鱼进行方向控制,即决定调用转弯模态还是速度策略;
步骤4:根据步骤2中距离差进行速度控制,设计机器鱼的速度策略;
步骤5:将机器鱼的转角、速度值和采样时间进行三维模糊化处理,转化为不同的控制模式,通过无线方式发送给机器鱼,转步骤2;
至此,经过了步骤1到步骤5,完成了一种基于三维模糊PTP算法的单体机器鱼行为控制策略。
2.根据权利要求1所述的一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:步骤1,具体为:
步骤1.1初始化采样时间ΔT;
步骤1.2将机器鱼进行水下运动所处的水池区域划分为区域1、区域2、区域3和区域4;
其中,区域1为进攻区PR(Pushing Region);
区域2为上边界区UBR(Upper Boundary of the Region);
区域3为下边界区LBR(Lower Boundary of the Region);
区域4为射门区GR(Goal Region);
步骤1.3设定不同区域对应的顶球点坐标;
其中,顶球点,记为Point点;对应于步骤1.2的不同水池区域设定的顶球点位置如下:
(1)向下顶球点:对应上边界区UBR,设定的向下顶球点坐标为(b_pt.x,b_pt.y-r);
(2)向右顶球点:对应进攻区PR,设定的向右顶球点坐标为(b_pt.x-r,b_pt.y);
(3)向上顶球点:对应下边界区LBR,设定的向上顶球点坐标为(b_pt.x,b_pt.y+r);
(4)射门顶球点:对应射门区GR,设定的射门顶球点坐标为:
(b_pt.x-rcos(b_to_g_dir),b_pt.y-rsin(b_to_g_dir))。
3.根据权利要求1所述的一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:步骤2中,距离差,记为l;方向差,记为θe;步骤2,具体为:若(l<δl)∩(θe<δθe),表明机器鱼已经到达目标点,结束本发明所提策略;否则,转步骤3;
其中,δl为距离绝对误差,δθe为方向绝对误差。
4.根据权利要求1所述的一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:步骤3具体为:
步骤3.1获取机器鱼当前的方向差θe,并根据方向差与角度阈值的大小关系,进行如下操作:
其中,角度阈值,记为θf,其取值范围为85到95度,优选的θf为90度;
3.1A获取机器鱼当前的方向差θe,如果|θe|<θf,转步骤4调用设计的机器鱼速度策略;
3.1B若|θe|≥θf,则转步骤3.2;
步骤3.2调用转弯模态进行大幅度方向改变;
其中,转弯模态,记为Mode1,具体为:
3.2A若θe<-θf,机器鱼进行左急转弯,转角为负60度到负30度,转步骤4;
3.2B若θe>θf,机器鱼进行右急转弯,转角为30度到60度,转步骤4。
5.根据权利要求1所述的一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:步骤4具体为:
4.1若距离差满足l>Ld,则设置机器鱼的速度为speed=15,跳至步骤5;
4.2若距离差满足Ls<l≤Ld,则设置机器鱼的速度为speed=12,跳至步骤5;
4.3若距离差l≤Ls,则设置机器鱼的速度为speed=8,跳至步骤5;
其中,Ls为近距离阈值,Ld为远距离阈值,且Ls<Ld
6.根据权利要求1所述的一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:步骤5具体为:
步骤5.1对机器鱼的转角、速度值和采样时间进行三维模糊化处理;
步骤5.2规划机器鱼顶球行为,即:针对步骤5.1输出的机器鱼所处区域及其运动模式,确定机器鱼的顶球行为;
其中,顶球行为由一系列动作组成;
步骤5.3规划机器鱼的基本动作,即:针对步骤5.2中机器鱼的顶球行为确定机器鱼的机器鱼动作;
其中,机器鱼的机器鱼动作由电机控制;
步骤5.4确定机器鱼的控制参数:将步骤5.3规划的机器鱼的基本动作转换为电机控制参数;
步骤5.5将步骤5.4输出的电机控制参数经无线方式传给机器鱼,控制机器鱼的顶球行为,转步骤2。
7.根据权利要求6所述的一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:步骤5.1具体为:
5.1A在不同的采样时间下,机器鱼的转角和速度值划分区间不同;
5.1B将转角、速度和采样时间转换为运动模式;
其中,运动模式用(θa,Va,Ta)表示,θa为角度档位,Va为速度档位,Ta为采样时间档位。
8.根据权利要求6所述的一种基于三维模糊PTP算法的单体机器鱼行为控制策略,其特征在于:其中,三维模糊化处理遵循如下规则:在如下条件下对转角、速度、采样时间模糊化处理,转换为同一运动模式:⑴相同的区间,不同的采样时间,⑵相同的速度区间,不同的速度值,⑶相同的转角区间,不同的转角值;而不同的转角区间、速度区间或采样时间区间,对转角、速度或采样时间模糊化处理,转换为不同的运动模式。
CN201710349193.5A 2016-11-30 2017-05-17 一种基于三维模糊化处理的单体机器鱼行为控制方法 Active CN107065563B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN2016110893948 2016-11-30
CN201611089394 2016-11-30

Publications (2)

Publication Number Publication Date
CN107065563A true CN107065563A (zh) 2017-08-18
CN107065563B CN107065563B (zh) 2018-11-16

Family

ID=59610067

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710349193.5A Active CN107065563B (zh) 2016-11-30 2017-05-17 一种基于三维模糊化处理的单体机器鱼行为控制方法

Country Status (1)

Country Link
CN (1) CN107065563B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109291060A (zh) * 2018-09-28 2019-02-01 北京信息科技大学 基于区域划分与临时点辅助的机器鱼顶球控制方法
KR102049719B1 (ko) * 2018-11-01 2020-01-08 (주)아이로 로봇 물고기의 일정수심 유영제어장치 및 방법
CN113703464A (zh) * 2021-08-03 2021-11-26 中国人民解放军陆军工程大学 一种2d仿真鱼的顶球控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007307686A (ja) * 2006-05-22 2007-11-29 Ryukoku Univ ロボットアームおよびロボット
KR100802354B1 (ko) * 2006-11-23 2008-02-13 건국대학교 산학협력단 압전세라믹 작동기로 구동되는 물고기 로봇
KR20110039077A (ko) * 2009-10-09 2011-04-15 강원도립대학산학협력단 어류의 생태 적응 훈련용 수중 로봇
CN102411307A (zh) * 2011-11-30 2012-04-11 中国科学院自动化研究所 一种快速、精确的仿生机器鱼c形起动的运动控制方法
CN104881045A (zh) * 2015-06-17 2015-09-02 中国科学院自动化研究所 嵌入式视觉引导下仿生机器鱼三维追踪控制方法
CN104966072A (zh) * 2015-07-08 2015-10-07 河海大学常州校区 一种基于形状的无色标机器鱼位姿识别算法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007307686A (ja) * 2006-05-22 2007-11-29 Ryukoku Univ ロボットアームおよびロボット
KR100802354B1 (ko) * 2006-11-23 2008-02-13 건국대학교 산학협력단 압전세라믹 작동기로 구동되는 물고기 로봇
KR20110039077A (ko) * 2009-10-09 2011-04-15 강원도립대학산학협력단 어류의 생태 적응 훈련용 수중 로봇
CN102411307A (zh) * 2011-11-30 2012-04-11 中国科学院自动化研究所 一种快速、精确的仿生机器鱼c形起动的运动控制方法
CN104881045A (zh) * 2015-06-17 2015-09-02 中国科学院自动化研究所 嵌入式视觉引导下仿生机器鱼三维追踪控制方法
CN104966072A (zh) * 2015-07-08 2015-10-07 河海大学常州校区 一种基于形状的无色标机器鱼位姿识别算法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109291060A (zh) * 2018-09-28 2019-02-01 北京信息科技大学 基于区域划分与临时点辅助的机器鱼顶球控制方法
CN109291060B (zh) * 2018-09-28 2021-07-30 北京信息科技大学 基于区域划分与临时点辅助的机器鱼顶球控制方法
KR102049719B1 (ko) * 2018-11-01 2020-01-08 (주)아이로 로봇 물고기의 일정수심 유영제어장치 및 방법
CN113703464A (zh) * 2021-08-03 2021-11-26 中国人民解放军陆军工程大学 一种2d仿真鱼的顶球控制方法
CN113703464B (zh) * 2021-08-03 2023-11-10 中国人民解放军陆军工程大学 一种2d仿真鱼的顶球控制方法

Also Published As

Publication number Publication date
CN107065563B (zh) 2018-11-16

Similar Documents

Publication Publication Date Title
CN106444738B (zh) 基于动态运动基元学习模型的移动机器人路径规划方法
CN110610271B (zh) 一种基于长短记忆网络的多重车辆轨迹预测方法
US9792546B2 (en) Hierarchical robotic controller apparatus and methods
CN106200679B (zh) 基于多模态自然交互的单操作员多无人机混合主动控制方法
Farrell et al. Chemical plume tracing experimental results with a REMUS AUV
US7765029B2 (en) Hybrid control device
CN107065563B (zh) 一种基于三维模糊化处理的单体机器鱼行为控制方法
Svenstrup et al. Pose estimation and adaptive robot behaviour for human-robot interaction
CN109241552A (zh) 一种基于多约束目标的水下机器人运动规划方法
CN109108942A (zh) 基于视觉实时示教与自适应dmps的机械臂运动控制方法和***
Zhang et al. Grasp for stacking via deep reinforcement learning
CN106780484A (zh) 基于卷积神经网络特征描述子的机器人帧间位姿估计方法
CN109240091A (zh) 一种基于强化学习的水下机器人控制方法及其进行跟踪的控制方法
Rudiawan et al. The deep learning development for real-time ball and goal detection of barelang-FC
CN103869824A (zh) 基于生物触角模型的多机器人水下目标搜寻方法及装置
CN111506063A (zh) 一种基于分层强化学习框架的移动机器人无图导航方法
CN115373415A (zh) 一种基于深度强化学习的无人机智能导航方法
CN114564008A (zh) 基于改进A-Star算法的移动机器人路径规划方法
US11467592B2 (en) Route determination method
EP2898996A1 (en) Method of controlling a robotic system and a robotic system controller for implementing this method
CN111444838A (zh) 一种机器人地面环境感知方法
CN115016499A (zh) 一种基于sca-ql的路径规划方法
Meng et al. A method to recognize and track runway in the image sequences based on template matching
Wu et al. Uncalibrated image-based visual servoing based on joint space and image moment
CN113485353A (zh) 基于rrt算法与人工势场法相结合的微机器人避障方法

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