CN101916071B - 仿生机器鱼运动的cpg反馈控制方法 - Google Patents
仿生机器鱼运动的cpg反馈控制方法 Download PDFInfo
- Publication number
- CN101916071B CN101916071B CN201010244952XA CN201010244952A CN101916071B CN 101916071 B CN101916071 B CN 101916071B CN 201010244952X A CN201010244952X A CN 201010244952XA CN 201010244952 A CN201010244952 A CN 201010244952A CN 101916071 B CN101916071 B CN 101916071B
- Authority
- CN
- China
- Prior art keywords
- cpg
- feedback
- machine fish
- bionic machine
- information
- 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
- 241000251468 Actinopterygii Species 0.000 title claims abstract description 115
- 230000033001 locomotion Effects 0.000 title claims abstract description 56
- 238000000034 method Methods 0.000 title claims abstract description 24
- 230000003592 biomimetic effect Effects 0.000 title claims abstract description 15
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 18
- 210000002161 motor neuron Anatomy 0.000 claims abstract description 16
- 230000001020 rhythmical effect Effects 0.000 claims abstract description 10
- 239000011664 nicotinic acid Substances 0.000 claims description 98
- 238000010168 coupling process Methods 0.000 claims description 16
- 238000005859 coupling reaction Methods 0.000 claims description 15
- 210000000006 pectoral fin Anatomy 0.000 claims description 14
- 230000008878 coupling Effects 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 10
- 230000009182 swimming Effects 0.000 claims description 6
- 230000036541 health Effects 0.000 claims description 5
- 238000013341 scale-up Methods 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 238000013461 design Methods 0.000 abstract description 2
- 238000000465 moulding Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 18
- 230000007613 environmental effect Effects 0.000 description 9
- 210000002569 neuron Anatomy 0.000 description 7
- 230000008859 change Effects 0.000 description 6
- 241001465754 Metazoa Species 0.000 description 5
- 230000009471 action Effects 0.000 description 5
- 230000010355 oscillation Effects 0.000 description 5
- 230000004888 barrier function Effects 0.000 description 4
- 210000004556 brain Anatomy 0.000 description 4
- 230000010365 information processing Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- ZVKAMDSUUSMZES-NZQWGLPYSA-N OS II Natural products CC(=O)N[C@H]1[C@H](OC[C@@H](O)[C@@H](O)[C@@H](O)CO)O[C@H](CO)[C@H](O[C@H]2O[C@H](CO)[C@@H](O)[C@H](O)[C@H]2O)[C@@H]1O[C@@H]3O[C@H](CO)[C@@H](O)[C@H](O)[C@H]3O ZVKAMDSUUSMZES-NZQWGLPYSA-N 0.000 description 3
- 210000003169 central nervous system Anatomy 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 3
- 210000004227 basal ganglia Anatomy 0.000 description 2
- 210000001638 cerebellum Anatomy 0.000 description 2
- 239000011551 heat transfer agent Substances 0.000 description 2
- 230000006698 induction Effects 0.000 description 2
- 230000005764 inhibitory process Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000005086 pumping Methods 0.000 description 2
- 210000002265 sensory receptor cell Anatomy 0.000 description 2
- 102000027509 sensory receptors Human genes 0.000 description 2
- 108091008691 sensory receptors Proteins 0.000 description 2
- 210000000278 spinal cord Anatomy 0.000 description 2
- NBIIXXVUZAFLBC-UHFFFAOYSA-N Phosphoric acid Chemical compound OP(O)(O)=O NBIIXXVUZAFLBC-UHFFFAOYSA-N 0.000 description 1
- 241000251539 Vertebrata <Metazoa> Species 0.000 description 1
- 230000003321 amplification Effects 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 210000000133 brain stem Anatomy 0.000 description 1
- 208000010877 cognitive disease Diseases 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000003344 environmental pollutant Substances 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 210000000337 motor cortex Anatomy 0.000 description 1
- 235000001968 nicotinic acid Nutrition 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 210000000056 organ Anatomy 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 231100000719 pollutant Toxicity 0.000 description 1
- 230000009993 protective function Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000027387 rhythmic behavior Effects 0.000 description 1
- 230000001953 sensory effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000002463 transducing effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
- 239000003643 water by type Substances 0.000 description 1
Images
Abstract
本发明为仿生机器鱼运动的CPG反馈控制方法,提出了由高层控制模块、CPG、运动神经元等不同部位接收反馈信号的CPG反馈控制模型;高层控制模块接收仿生机器鱼本体状态信息与水域环境信息,通过信息处理、决策,发出相应的命令,选择对应的运动模板,从而确定合适的CPG构型,控制仿生机器鱼的身体各部分进行节律运动或非节律运动。本发明将为仿生机器鱼运动的反馈控制理论设计提供参考,并实现机动、灵活、自主的游动控制。
Description
技术领域
本发明属于仿生学技术领域,涉及基于不同反馈信号接收部位的仿生机器鱼运动的CPG反馈控制方法。
背景技术
中枢模式发生器(Central Pattern Generator,CPG)是一类存在于在无脊椎动物和脊椎动物的中枢神经系统中的神经元电路。它能在没有节律性的控制或反馈输入情况下产生有节律的行为,例如行走、游泳、飞翔、呼吸和咀嚼等。仿生机器人要实现自主运动,必须引入环境信息及机器人本体状态,但是机器人CPG模型多数由非线性微分方程构成,这造成了反馈控制实现难的问题。虽然基于CPG的机器人运动反馈控制受到了越来越多的关注,但多数研究尚处于起步阶段,没有明确给出CPG反馈控制方法的具体实施方案。
发明内容
本发明的目的是针对仿生机器鱼的游动控制,给出一种基于不同反馈信号接收部位的易于实现的CPG反馈控制模型;结合动物运动分层控制概念,首先给出CPG反馈控制结构,然后针对高层控制模块、CPG、运动神经元等不同部位接收反馈信息建立了相应的反馈控制模型,提出一种基于不同反馈接收部位的仿生机器鱼运动的中枢模式发生器(Central Pattern Generator,CPG)反馈控制方法,以解决仿生机器鱼的自主游动控制问题。
为达到上述目的,本发明提出基于不同反馈接收部位的仿生机器鱼运动的CPG反馈控制方法的步骤如下,基于仿生机器鱼不同反馈接收部位,针对高层控制模块、中枢模式发生器、仿生机器鱼的运动神经元建立相应的中枢模式发生器反馈控制模型,高层控制模块接收仿生机器鱼本体状态信息和水域环境信息,对仿生机器鱼本体状态信息和水域环境信息进行处理和智能决策并发出相应的控制命令,选择仿生机器鱼的运动模板,进而确定中枢模式发生器构型,控制仿生机器鱼身体各部分进行节律运动或非节律运动,从而实现仿生机器鱼机动、灵活的自主游动。
其中,所述高层控制模块接收反馈信号时,对于单纯接收速度反馈信息的仿生机器鱼系统采用PID控制方法;针对接收仿生机器鱼的目标物距离信息采用模糊决策控制方法。
其中,所述中枢模式发生器接收反馈信号时,针对中枢模式发生器内部和中枢模式发生器输出的速度反馈信息分别采用中枢模式发生器反馈控制模型。
其中,所述运动神经元根据接收到的不同部位的反馈信号选择相应的反馈控制模型。
其中,所述高层控制模块接收水域环境信息、仿生机器鱼本体运动状态信息,对所述信息及运动状态进行处理,并作出智能决策,发出相应的控制命令,选择仿生机器鱼的运动模板,从而控制中枢模式发生器模型的构型和参数,实现仿生机器鱼的游动控制。
其中,所述CPG反馈控制方法,还包括运动模板与特征模块选择仿生机器鱼的基本状态,基本状态包含前进、后退、左转弯、右转弯、上浮、下潜、加速、减速、起动、停止、滑行状态。
其中,所述中枢模式发生器模块针对相应的运动状态匹配不同的中枢模式发生器构型,主要包含两种构型:胸鳍型弱耦合构型和滑块型弱耦合构型;在确定构型后选择不同的推进控制面为身体-尾鳍型推进、尾鳍型推进、胸鳍型推进、或者它们之间的任意组合。
其中,所述仿生机器鱼本体信息的传感器选择了摄像模块、红外传感器、惯性测量单元、触觉传感器、压力传感器、弯曲度传感器。
本发明的有益效果:
本发明所提出的基于不同反馈接收部位的仿生机器鱼运动的CPG反馈控制方法对具有多关节或多自由度的仿生机器鱼反馈控制有良好的适用性,本发明的方法结合动物运动控制机理,提出了在高层控制模块、CPG、运动神经元等不同部位接收反馈信息的CPG反馈控制方法。利用该CPG反馈控制模型,能够实现仿生机器鱼机动、灵活的自主游动控制。
附图说明
图1仿生机器鱼的CPG反馈控制结构示意图;
图2图1中仿生机器鱼的控制硬件框图;
图3图2中核心扩展板控制软件框图;
图4人或动物运动系统组构略图;
图5高层控制模块接收反馈信息控制框图;
图6高层控制模块接收反馈信息PID控制框图;
图7高层控制模块接收反馈信息模糊控制框图;
图8a-图8d不同CPG模块的构型;
图9a-图9f仿生机器鱼前行状态对应的CPG模块的构型;
图10CPG模块内部耦合传感器信号控制框图;
图11CPG模块输出耦合传感器信号控制框图;
图12CPG模块输出叠加传感器信号控制框图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,以下结合具体实施例,下面结合所附图和表对本发明基于不同反馈接收部位的仿生机器鱼运动的CPG反馈控制方法做出详细说明。
一、仿生机器鱼的CPG反馈控制系统
图1给出了本发明方法的仿生机器鱼的CPG控制系统示意图,包括:高层控制模块1、运动模板匹配与特征调整模块2、CPG模块3、仿生机器鱼4和水域环境测量模块5。高层控制模块1连接仿生机器鱼4和水域环境测量模块5,高层控制模块1接收并对水域环境测量模块5输出的水域环境信息数据进行处理、决策、及接收并对仿生机器鱼4中的各种传感器的传感信息进行处理、决策,然后发出相应的控制命令。运动模板匹配与特征调整模块2连接高层控制模块1、CPG模块3和仿生机器鱼4,运动模板匹配与特征调整模块2在接收高层控制模块1的控制命令后,再综合仿生机器鱼4的传感信息选择CPG模块3的构型和参数;CPG模块3接收CPG构型和参数生成需要的CPG模型并发送驱动信号。仿生机器鱼4与CPG模块3连接,仿生机器鱼4各关节的驱动控制器接收CPG模块3发送驱动信号,驱动仿生机器鱼4各关节的驱动控制器产生运动,同时依靠仿生机器鱼4上安装的各种传感器产生需要的状态反馈信息,输送给高层控制模块1和运动模板匹配与特征调整模块2,并接收外界的水域环境测量模块5的水环境信息。
二、仿生机器鱼的CPG反馈控制系统的硬件及软件实现
针对仿生机器鱼4的反馈控制需求,根据图1我们设计了如附图2所示的仿生机器鱼CPG反馈控制的硬件框图。它的特点在于采用高速处理器ARM9内核的控制器,并把ARM核心板和仿生机器鱼扩展板分开,这样便于以后的升级换代。在附图1和图2中示出仿生机器鱼4,包括:障碍物感应传感器41、惯性导航传感器42、深度传感器43、触觉或力矩传感器44、弯曲度传感器45、右胸鳍46、尾鳍47、摄像模块48、电池及电源模块49、左胸鳍50、无线收发模块51、仿生机器鱼控制板52、摆动关节53,其中电池及电源模块49负责整个控制系统的电源供应,它输出电能给各传感器41至45、摄像模块48、无线接收模块51、仿生机器鱼控制板52和摆动关节53。仿生机器鱼控制板52接收各传感器41至45的传感信号,负责计算、信息处理、决策、CPG构型选择、CPG模型生成、在线生成离散控制量并输出给仿生机器鱼控制扩展板522;传感器41与仿生机器鱼控制板52之间通过传感器接口523连接;摄像模块48与仿生机器鱼控制板52之间通过图像采集接口524连接,负责采集机器鱼周围环境信息;仿生机器鱼控制板52根据环境信息作出决策,将控制指令经过舵机驱动接口526发送到摆动关节53,实现各个关节的摆动控制;无线收发模块51与仿生机器鱼控制板52之间通过无线收发接口525连接,与上层控制器54进行信息交换,从而构成多级分层控制。
仿生机器鱼4要实现完全自主游动,必须添加多种类型的传感器,以便通过感知外界环境来及时调整自己的行为,从而实现既定目标和游动任务。根据功能需要,我们还可选择的传感器有:障碍物感应传感器41可选择红外传感器、超声传感器、激光传感器、摄像头其中的一种,用于检测障碍物;惯性导航传感器42可选择陀螺仪、加速度计、GPS其中的一种,或具有定位及导航类传感器;深度传感器43可选择压力传感器;触觉或力矩传感器44;弯曲度传感器45。
由于仿生机器鱼4体积较小,为尽量减小惯性测量单元受到舵机磁场的影响,加速度计、陀螺仪等惯性测量单元选择安装在仿生机器鱼4身体内腔前部。摄像模块48、红外光电传感器可以帮助仿生机器鱼4识别障碍物及周围环境。压力传感器可测量仿生机器鱼所处的水下深度;温度传感器可以感知水温。弯曲度传感器可测量鱼体实际弯曲角度,触觉传感器帮助仿生机器鱼识别外界触碰,做出应激行为。电压与电流传感器可以用来计算仿生机器鱼的功耗,并起到过电流和过载保护作用。
基于CPG模型的控制系统其关键点在于CPG的在线计算,由于本发明所采用的CPG模型,采用一类能产生稳定极限环的简单非线性微分方程组来表示其振荡神经元,且以单个振荡神经元构成单元CPG,这大大简化了CPG的参数量及计算量。此外,CPG模型的输出可以分别单参数改变其性能,比如输出波形的振幅和频率,这也给程序编写和计算带来方便。基于不同反馈接收部位的仿生机器鱼运动的反馈控制方法的步骤如下,提出了以一类振荡频率和幅值可分别单参数控制的非线性振荡器作为振荡神经元,见公式(1-1)所示。
式(1-1)中i=1,…,n,n表示振荡器神经元的个数,此处n=2;其中i=1表示左胸鳍,i=2表示右胸鳍;xi、yi表示两个振荡器的两个状态变量;ωi表示振荡器的固有频率,表示振荡器的固有幅值;aj、bk表示振荡器间的耦合系数,si为反馈信息。
所述的仿生机器鱼运动的CPG反馈控制方法,提出了一种仿生机器鱼的CPG反馈控制架构,如附图1所示。该CPG反馈系统控制架构主要包含四个部分:高层控制模块1、运动模板匹配与特征调整模块2、CPG模块3、仿生机器鱼4本体(包含其中的各种传感器)。其中,高层控制模块1用于模拟人的大脑、中央神经系统等,主要负责环境信息及仿生机器鱼4本体状态信息的处理、决策,然后发出相应的控制命令,选择对应的运动模板,从而控制CPG模块3的构型和参数,达到控制仿生机器鱼4的目的。通过高层控制模块1的控制,CPG模块3能选择最合适的模式,控制仿生机器鱼4的身体各部分进行节律运动或非节律运动。仿生机器鱼4本体上装有相应的传感器,比如深度传感器、弯曲度传感器、触觉传感器、红外传感器、摄像模块48等。这些传感器信息给高层控制模块1和下层CPG模块3提供了控制依据,从而能实现仿生机器鱼4在复杂水域环境中的自主游动。
所述的仿生机器鱼运动的CPG反馈控制方法,该方法对于CPG内部接收反馈信息采用式(1-2)的耦合方法;对于CPG输出部耦合反馈信息,采取式(1-2)所示方法:
式(1-2)中Δt为计算步长,si为反馈信号,λi为反馈信号si耦合到状态变量xi上的比例系数,xi(k)为状态变量xi在k·Δt时刻的值,Δxi(k)为状态变量xi的增量;t1和t2分别表示反馈信号的起始时刻和停止时刻。
对于运动神经元接收反馈信息,采用式(1-3)所示方法:
式(1-3)中xbi表示第i个CPG的偏移量,t1和t2分别表示接收到障碍物信息的起始时刻和停止时刻。一种比较简便的实现方法就是采用简单叠加法,方法如下:
将公式(1-1)离散化,得如下公式:
由上式计算可得xi(k+1)。该方法控制舵机,计算耗时短,内存小,控制响应及时,输出平滑。
为了便于软件维护和升级,我们将软件分成三个层次,即操作系统级5211、底层驱动级5212和高层用户级5213,设计了如附图3所示的核心扩展板521的控制软件框图;其中,操作系统级5211的程序包括μC/OS-II的配置文件、μC/OS-II的文件和μC/OS-II的移植文件等。底层驱动级5212的程序主要给外围设备提供驱动,例如USB驱动程序、Ethernet驱动程序等。这里将任务Task DI、Task DO、Task AI、Task AO和Task PI也被划分到底层驱动级,主要处理数字量的输入和输出信号、模拟量的输入和输出信号、脉冲信号输入等,包括信号检测、滤波、放大、变换等。高层用户级5213的程序主要是为了完成特定任务而编写的,比如CPG模型实现任务、图像处理与视觉控制任务等。
三、不同部位接收反馈信息的CPG反馈控制建模
生物的运动控制是等级性组织的,越复杂的运动任务由越高级的中枢来组织,如附图4所示人或动物运动系统组构略图,图4中有高级控制中心(对应图1的高层控制模块1)、中枢模式发生器、运动神经元、效应器官、运动、感觉感受器、感觉反馈。在最简单的水平上,感觉感受器在脊髓内与运动神经元形成突触,来介导简单的反射,而不需要高层控制模块1(如大脑、小脑、基底神经节等)的参与。其次,脊髓和脑干的中间神经元网络组成中枢模式发生器(Central Pattern Generator,CPG),来协调多个运动群的相互作用。在这之上,在运动皮层、小脑和基底神经节中存在着神经元,监控这些低层次上的活动,并产生新的运动模式。运动输出一般是连续更新的,并被分布于运动轴上各个层次的感觉信息调节,反馈的调制作用能及时反映在运动模式的变化上。
仿生机器人的生物控制方法是通过对动物节律运动控制器-中枢模式发生器、高层控制中枢、生物反射等一些生物模型或控制机理的工程模拟、简化和改进,形成一种新的,更加简捷、自然、直接、快速的运动控制方法和理论,实现仿生机器人的节律运动,提高仿生机器人在各种实际环境中的工作性能。
仿生机器鱼在复杂水域环境中执行任务时,需要根据环境信息,比如地形、目标物体距离、水域温度、污染物等,做出决策,以确定需要执行的下一步动作,例如加速、减速、转弯等动作。此时,环境信息及仿生机器鱼本身的状态信息将在高层控制中枢(比如大脑、中央神经系统等)进行融合,然后反馈到CPG模型上控制模型输出。
四、高层控制模块接收反馈信息的CPG反馈控制
水域环境测量模块5将测量得到的水域环境的变化、目标物体的距离等信息送入高层控制模块1(比如大脑)后,高层控制模块1会做出处理、决策,调整仿生机器鱼4的游动速度和航向。附图5给出了高层控制模块1接收反馈信息的CPG反馈控制框图。环境信息和仿生机器鱼4的本体信息进入高层控制模块1后,对环境信息进行计算、处理,CPG模块3完成CPG构型选择、在线生成等步骤后输出到舵机驱动器上,驱动仿生机器鱼4运动,并将仿生机器鱼4的本体状态的速度、位置、摆角等信息反馈到高层控制模块1,再将反馈速度、位置、摆角等信息及环境信息进行耦合处理,重新经过CPG模块3并重复驱动仿生机器鱼4运动。
仿生机器鱼的游动速度与每个关节的摆动频率、幅值以及相互间的相位差等因素有关。由于摆动频率和幅值直接与CPG模块3的振荡频率ω和振荡幅值有关,而相位差的控制相对较复杂,故从工程角度出发,通过高层控制信号改变CPG模型的输入激励d,从而确定振荡频率ω和振荡幅值从而达到改变游动速度的目的。
假设仿生机器鱼4的期望游动速度vset∈(0,vmax),其中vmax为仿生机器鱼4最大设计游动速度;定义仿生机器鱼实际速度为v、速度反馈量vfb则速度误差ev=vset-vfb;采用比例-积分-微分(PID)控制,则建立如附图6所示的控制系统结构,高层信息处理、决策与控制单元中的PID控制器的输入期望游动速度vset和仿生机器鱼4的速度反馈量vfb,生成并输出一个速度误差ev,PID控制器接收速度误差ev并生成速度激励信号d,CPG模块根据速度激励信号d生成CPG模型用于改变仿生机器鱼4的游动速度。
若高层控制模块1接收的是目标物的距离信息,那么速度的调节就需要根据高层控制模块1的决策来进行。因此,在高层控制模块1可采用模糊决策控制器,设计的系统控制框图如附图7所示。环境信息及仿生机器鱼4位置等信息进入高层控制模块1后通过图像处理,由视觉测量模块得出相关的距离、运动等信息,然后通过模糊决策控制器输出激励d控制CPG模块3输出。
五、CPG构型调整
CPG的构型(即拓扑结构)可以通过高层控制模块1来改变,高层控制模块1根据信息处理与决策的结果来改变CPG的构型。例如:附图8a所示CPG模型中的每个单元CPG是由两个相互抑制振荡神经元组成,每个单元CPG控制每个关节部分的伸肌和屈肌,各单元CPG之间又相互耦合;附图8b中单元CPG是由单个振荡神经元组成,多个单元CPG组成链式结构;附图8c和图8d中的CPG构型都是网状结构,但图8c中的CPG间是双向抑制关系,而图8d中仅存在单向抑制。
对于仿生机器鱼来说,每种游动模式都对应一种或几种CPG构型,例如向前游动,附图9a-图9f给出了六种前行状态中常用的构型。其中,加圈序号1-6表示CPG1-CPG6,分别对应仿生机器鱼的摆动部多个关节33即第一关节、第二关节、第三关节、尾鳍34、左胸鳍31、右胸鳍32(图1示出)。由于在前行过程中,仿生机器鱼可以依靠身体后部及尾鳍推进,即BCF方式,如附图9b所示;也可以单独依靠尾鳍推进,即CF方式,如附图9f所示;另外还可以单独靠胸鳍推进,即PF方式(见附图9c)。此外,推进方式还可以是它们的组合,比如BCF+PF(见附图9a),或者依靠少数的摆动关节参与推进(见附图9d-图9f)。仿生机器鱼还可以依靠少数身体关节和胸鳍组合推进,如BF+CF方式。
在仿生机器鱼控制中,由于不同的CPG构型间的变换对仿生机器鱼嵌入式处理器与存储器有较高的要求,变换起来比较繁杂,比如从附图8a变换到附图8b,势必加大程序量,增加运动控制器的内存需求及任务调度负担。因此,通常在控制中不轻易使用CPG构型变换的方法。
六、CPG内部耦合反馈信号建模
仿生机器鱼的转弯、减速、后退等动作在避障过程中起着重要作用。仿生机器鱼的转弯动作可以由障碍物探测信号触发,在此情况下,传感器信号可以耦合到CPG的内部,也可以耦合到CPG的输出部分。附图10给出了CPG模块内部耦合障碍物信号的控制系统框图,其中反馈通道没有集成障碍物信息,输入可以是速度、航向等控制量。针对仿生机器鱼的特点,建立CPG耦合反馈信号模型如式(1-1)所示。
七、CPG输出部耦合反馈信号建模
对于CPG模块3,也可以在它的输出部分耦合传感器信号,还是以障碍物信号为例,对输出部耦合反馈信号进行建模。附图11给出了CPG模块输出部分耦合障碍物信息的控制框图。图11中包括CPG模块3、耦合处理单元5215、仿生机器鱼4,其中障碍物信息经过耦合处理单元5215反馈到CPG模块3。针对CPG输出部耦合反馈信息建立如下控制模型:
式(1-5)中Δt为计算步长,si为反馈信号,λi为反馈信号si耦合到状态变量xi上的比例系数,xi(k)为状态变量xi在k·Δt时刻的值,Δxi(k)为状态变量xi的增量;t1和t2分别表示障碍物信号的起始时刻和停止时刻。
八、CPG输出部叠加反馈信息的CPG反馈控制建模
运动神经元位于CPG的下一层级,CPG的输出信号是运动神经元的输入信号,因此,建立如附图12所示的CPG控制框图。图12中包含CPG模块3、比例增益单元5214、仿生机器鱼4。障碍物信息经过比例增益单元5214放大,然后与CPG模块3的输出相叠加,输出到仿生机器鱼上。针对运动神经元接收反馈信息建立如下模型,其中输出到控制对象上的变量用x′i(t)表示,CPG模型输出用xi(t)表示。
式(1-6)中xbi表示第i个CPG下一层次的运动神经元接收到的反馈信息,t1和t2分别表示接收到障碍物信息的起始时刻和停止时刻。
尽管对本发明的原理结合实施例进行了展示和描述,但本领域技术人员将会理解在不偏离本发明的原理和实质的情况下,对这些实施例进行改变,如CPG模型、主控制器CPU型号等,其范围也落入本发明的权利要求及其等同物所限定的范围内。
Claims (7)
1.一种仿生机器鱼运动的CPG反馈控制方法,其特征在于,基于仿生机器鱼不同反馈接收部位,针对高层控制模块、中枢模式发生器、仿生机器鱼的运动神经元建立相应的中枢模式发生器反馈控制模型,高层控制模块接收仿生机器鱼本体状态信息和水域环境信息,对仿生机器鱼本体状态信息和水域环境信息进行处理和智能决策并发出相应的控制命令,选择仿生机器鱼的运动模板,进而确定的中枢模式发生器构型,控制仿生机器鱼身体各部分进行节律运动或非节律运动,从而实现仿生机器鱼机动、灵活的自主游动;所述中枢模式发生器接收反馈信号时,针对中枢模式发生器内部和中枢模式发生器输出的速度反馈信息分别采用中枢模式发生器反馈控制模型为:
式(1-1)中i=1,…,n,n表示振荡器神经元的个数,此处n=2;其中i=1表示左胸鳍,i=2表示右胸鳍;xi、yi表示两个振荡器的两个状态变量;ωi表示振荡器的固有频率,表示振荡器的固有幅值;aj、bk表示振荡器间的耦合系数,si为反馈信息;
对于CPG输出部耦合反馈信息,采取式(1-2)所示方法:
式(1-2)中Δt为计算步长,si为反馈信号,λi为反馈信号si耦合到状态变量xi上的比例系数,xi(k)为状态变量xi在k·Δt时刻的值,Δxi(k)为状态变量xi的增量;t1和t2分别表示反馈信号的起始时刻和停止时刻。
2.根据权利要求1所述的CPG反馈控制方法,其特征在于,所述高层控制模块接收反馈信号时,对于单纯接收速度反馈信息的仿生机器鱼系统采用PID控制方法;针对接收仿生机器鱼的目标物距离信息采用模糊决策控制方法。
3.根据权利要求1所述的CPG反馈控制方法,其特征在于,所述运动神经元根据接收到的不同部位的反馈信号选择相应的反馈控制模型针对运动神经元接收反馈信息建立如下模型,其中输出到控制对象上的变量用x′i(t)表示,CPG模型输出用xi(t)表示:
式(1-6)中xbi表示第i个CPG下一层专利的运动神经元接收到的反馈信息,t1和t2分别表示接收到障碍物信息的起始时刻和停止时刻。
4.根据权利要求1所述的CPG反馈控制方法,其特征在于,所述高层控制模块还接收仿生机器鱼本体运动状态信息,对所述信息及运动状态进行处理,从而控制中枢模式发生器模型的参数,实现仿生机器鱼的游动控制。
5.根据权利要求1所述的CPG反馈控制方法,其特征在于,还包括运动模板与特征模块选择仿生机器鱼的基本状态,基本状态包含前进、后退、左转弯、右转弯、上浮、下潜、加速、减速、起动、停止、滑行状态。
6.根据权利要求1所述的CPG反馈控制方法,其特征在于,所述中枢模式发生器针对相应的运动状态匹配不同的中枢模式发生器构型,主要包含两种构型:胸鳍型弱耦合构型和滑块型弱耦合构型;在确定构型后选择不同的推进控制面为身体一尾鳍型推进、尾鳍型推进、胸鳍型推进、或者它们之间的任意组合。
7.根据权利要求1所述的CPG反馈控制方法,其特征在于,所述仿生机器鱼本体状态信息的传感器选择了摄像模块、红外传感器、惯性测量单元、触觉传感器、压力传感器、弯曲度传感器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010244952XA CN101916071B (zh) | 2010-08-04 | 2010-08-04 | 仿生机器鱼运动的cpg反馈控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010244952XA CN101916071B (zh) | 2010-08-04 | 2010-08-04 | 仿生机器鱼运动的cpg反馈控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101916071A CN101916071A (zh) | 2010-12-15 |
CN101916071B true CN101916071B (zh) | 2012-05-02 |
Family
ID=43323598
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010244952XA Active CN101916071B (zh) | 2010-08-04 | 2010-08-04 | 仿生机器鱼运动的cpg反馈控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101916071B (zh) |
Families Citing this family (33)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102303700B (zh) * | 2011-05-26 | 2013-09-04 | 中国科学院自动化研究所 | 具有嵌入式视觉的多控制面机器鱼 |
CN102759923A (zh) * | 2012-04-13 | 2012-10-31 | 中国科学院合肥物质科学研究院 | 仿生双足水上行走机器人控制方法 |
CN103376742A (zh) * | 2012-04-24 | 2013-10-30 | 中国科学院合肥物质科学研究院 | 一种仿壁虎足部柔性结构爬壁机器人cpg控制系统 |
CN102637036A (zh) * | 2012-05-08 | 2012-08-15 | 北京理工大学 | 一种复合式仿生四足机器人控制器 |
CN102745320B (zh) * | 2012-07-26 | 2015-03-11 | 中国科学院自动化研究所 | 一种仿鲹科机器鱼倒游运动的控制方法 |
CN103885336B (zh) * | 2014-03-18 | 2016-07-20 | 武汉科技大学 | 基于鹤颈运动的移动视觉控制方法 |
CN105022269B (zh) * | 2015-07-13 | 2017-08-25 | 北京航空航天大学 | 仿生机器鱼关节的控制方法及装置 |
CN105015702B (zh) * | 2015-07-22 | 2017-04-12 | 成都信息工程大学 | 一种尾鳍推进式机器鱼能耗统计方法 |
CN105945925B (zh) * | 2016-04-28 | 2018-06-19 | 中国科学院合肥物质科学研究院 | 一种仿生蛇形机器人控制方法 |
CN106914901B (zh) * | 2017-05-09 | 2020-06-05 | 淮海工学院 | 仿生机器人控制网络的分层构建方法 |
CN107818210B (zh) * | 2017-10-26 | 2020-10-09 | 成都信息工程大学 | 一种鱼鳍推进式机器鱼运动能耗的确定方法及系统 |
CN107786852A (zh) * | 2017-11-17 | 2018-03-09 | 上海遨拓深水装备技术开发有限公司 | 一种潜水器用高速大容量数据传输与存储系统 |
CN108196451B (zh) * | 2017-12-29 | 2021-01-22 | 中国电子科技集团公司信息科学研究院 | 一种仿生鱼群避障行为控制方法 |
CN108582066B (zh) * | 2018-03-13 | 2021-09-03 | 同济大学 | 一种分层cpg及在仿人机器人行走控制中的应用 |
CN109839939A (zh) * | 2019-02-20 | 2019-06-04 | 博雅工道(北京)机器人科技有限公司 | 一种基于cpg模型的仿生水下机器鱼游动姿态规划方法 |
CN109866904B (zh) * | 2019-04-09 | 2020-06-02 | 哈尔滨工程大学 | 一种仿生水母类水下机器人的运动及速度控制方法 |
CN109976233A (zh) * | 2019-04-25 | 2019-07-05 | 西安交通大学 | 一种三维运动机器鱼的运动控制方法及控制系统 |
CN110286592B (zh) * | 2019-06-28 | 2022-11-01 | 山东建筑大学 | 一种基于bp神经网络的机器鱼多模态运动方法及系统 |
CN110758698B (zh) * | 2019-11-28 | 2020-10-02 | 中国科学院自动化研究所 | 仿生滑翔机器海豚的滑翔深度控制方法、系统、装置 |
US10935986B1 (en) | 2019-11-28 | 2021-03-02 | Institute Of Automation, Chinese Academy Of Sciences | Gliding depth control method, system and device for biomimetic gliding robotic dolphin |
CN110909859B (zh) * | 2019-11-29 | 2023-03-24 | 中国科学院自动化研究所 | 基于对抗结构化控制的仿生机器鱼运动控制方法、系统 |
CN110942048B (zh) * | 2019-12-11 | 2022-12-20 | 斯云昊 | 一种识别仿鸟无人机的方法及终端 |
CN110937092A (zh) * | 2019-12-12 | 2020-03-31 | 华南理工大学 | 一种多模态仿生拉线机器鱼的cpg控制方法及机器鱼 |
CN111037572B (zh) * | 2019-12-31 | 2022-05-17 | 江苏海洋大学 | 一种机器人的迈步优先顺序控制方法 |
CN111176116B (zh) * | 2020-01-02 | 2021-05-28 | 西安交通大学 | 一种基于cpg模型的机器鱼闭环反馈控制方法 |
CN111158385B (zh) * | 2020-01-10 | 2023-06-30 | 南京工程学院 | 仿生机器鱼的运动控制方法、装置、设备及可读存储介质 |
CN115390442A (zh) * | 2021-01-26 | 2022-11-25 | 西湖大学 | 深度强化学习的仿生机器鱼控制方法、装置及存储介质 |
CN113342013B (zh) * | 2021-06-08 | 2022-08-05 | 西北工业大学 | 一种联合横滚机构与扑翼非对称相位差的航向控制方法 |
CN113311714A (zh) * | 2021-07-28 | 2021-08-27 | 中国科学院自动化研究所 | 多关节仿生机器鱼传感器故障诊断与容错控制方法及系统 |
US11700839B2 (en) * | 2021-09-01 | 2023-07-18 | X. Development | Calibration target for ultrasonic removal of ectoparasites from fish |
CN113734393B (zh) * | 2021-09-28 | 2022-12-02 | 深圳先进技术研究院 | 基于攻角法的仿生机器鱼定深控制方法和装置 |
CN114019988B (zh) * | 2022-01-05 | 2022-04-01 | 季华实验室 | 基于cpg的agv控制方法、装置、电子设备及存储介质 |
CN117148728B (zh) * | 2023-10-31 | 2024-01-26 | 西北工业大学宁波研究院 | 一种具有滑扑切换功能的仿生机器人的控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1916800A (zh) * | 2006-09-01 | 2007-02-21 | 北京大学 | 一种多模态仿生机器鱼 |
CN101609306A (zh) * | 2008-06-18 | 2009-12-23 | 中国科学院自动化研究所 | 一种仿生长鳍波动推进器运动控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7127326B2 (en) * | 2002-11-15 | 2006-10-24 | Iguana Robotics, Inc. | Certain principles of biomorphic robots including foot placement selection using non-geometric visual properties |
JP4630553B2 (ja) * | 2004-01-15 | 2011-02-09 | ソニー株式会社 | 動的制御装置および動的制御装置を用いた2足歩行移動体 |
JP4644833B2 (ja) * | 2004-03-31 | 2011-03-09 | 株式会社国際電気通信基礎技術研究所 | 2足歩行移動装置 |
-
2010
- 2010-08-04 CN CN201010244952XA patent/CN101916071B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1916800A (zh) * | 2006-09-01 | 2007-02-21 | 北京大学 | 一种多模态仿生机器鱼 |
CN101609306A (zh) * | 2008-06-18 | 2009-12-23 | 中国科学院自动化研究所 | 一种仿生长鳍波动推进器运动控制方法 |
Non-Patent Citations (5)
Title |
---|
JP特开2005-199383A 2005.07.28 |
JP特开2005-288594A 2005.10.20 |
汪明等.胸鳍推进型机器鱼的CPG控制及实现.《机器人》.2010,第32卷(第2期),248-255. * |
王龙等.基于CPG模型的仿生机器鱼运动控制.《控制理论与引用》.2007,第24卷(第5期),749-755. * |
郑浩峻等.基于CPG原理的机器人运动控制方法.《高技术通讯》.2003,(第7期),64-68. * |
Also Published As
Publication number | Publication date |
---|---|
CN101916071A (zh) | 2010-12-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101916071B (zh) | 仿生机器鱼运动的cpg反馈控制方法 | |
CN100442185C (zh) | 一种多模态仿生机器鱼 | |
CN102745320B (zh) | 一种仿鲹科机器鱼倒游运动的控制方法 | |
CN105137969B (zh) | 基于支撑线运动分解的四足机器人trot步态本体位姿控制方法 | |
CN104808590B (zh) | 一种基于关键帧策略的移动机器人视觉伺服控制方法 | |
CN101776863B (zh) | 一种胸鳍推进型机器鱼的运动控制方法 | |
CN113478486B (zh) | 基于深度强化学习的机器人运动参数自适应控制方法和系统 | |
Wu et al. | Neurally controlled steering for collision-free behavior of a snake robot | |
CN111176116B (zh) | 一种基于cpg模型的机器鱼闭环反馈控制方法 | |
Wu et al. | Kinematic comparison of forward and backward swimming and maneuvering in a self-propelled sub-carangiform robotic fish | |
CN1258436C (zh) | 实现动物节律运动的足式仿生机器人控制方法及装置 | |
CN102147592B (zh) | 一种控制四足机器人运动的模糊控制器 | |
Inoue et al. | Neural oscillator network-based controller for meandering locomotion of snake-like robots | |
CN105094124A (zh) | 基于操作条件反射进行自主路径探索的方法及模型 | |
CN104898594B (zh) | 一种用于水下机器人群协同控制的通信装置与方法 | |
Yan et al. | Real-world learning control for autonomous exploration of a biomimetic robotic shark | |
CN104914867A (zh) | 一种模糊神经网络的六足机器人自主导航闭环控制器 | |
CN113421345A (zh) | 基于深度强化学习技术的仿生机器鱼群集导航模拟方法 | |
Wang et al. | A CPG-based sensory feedback control method for robotic fish locomotion | |
Gordleeva et al. | Control of movement of underwater swimmers: Animals, simulated animates and swimming robots | |
CN108107881A (zh) | 一种新型的果园作业机器人装置及方法 | |
CN201124413Y (zh) | 四足式仿生机器人控制装置 | |
CN101219708B (zh) | 仿生机器鱼无半径转弯的控制方法 | |
CN107485540A (zh) | 一种用于智能协步手杖的能量注入系统 | |
CN101554725A (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 |