基于小脑模型的仿生手臂控制系统及小脑模型建模方法
【专利摘要】本发明属于生物信息系统建模与仿生控制技术领域，一种基于小脑模型的仿生手臂控制系统及小脑模型建模方法，其中，所述一种基于小脑模型的仿生手臂控制系统，包括人机交互模块、储存器、命令产生模块和仿生手臂运动控制模块，所述人机交互模块、储存器、命令产生模块和仿生手臂运动控制模块依次相连，此外，所述命令产生模块还分别与储存器及仿生手臂运动控制模块相连，所述仿生手臂运动控制模块还分别与人机交互模块及储存器相连；本发明不仅具有良好的人机交互功能，而且，可以实现对手臂相对准确的控制。本发明将小脑建模控制与Phantom Omni力反馈器相结合，使被控手臂不再局限于仿真模型，为进一步建立真实小脑控制手臂运动的模型奠定基础。
【专利说明】
基于小脑模型的仿生手臂控制系统及小脑模型建模方法
技术领域
[0001] 本发明设及一种基于小脑模型的仿生手臂控制系统及小脑模型建模方法，属于生 物信息系统建模与仿生控制技术领域。
【背景技术】
[0002] 人的小脑位于大脑半球后方，覆盖在脑桥及延髓之上，横跨在中脑和延髓之间，具 有协调运动的功能。在感觉运动系统中，小脑不仅接收大脑皮层的运动命令传递给脊髓肌 肉系统，同时也会接收本体感受器的反馈信息，对部分运动命令进行调整。当由于自身基 因、蛋白质病变或某种外部因素使小脑受损后，患者无法有效利用来自大脑皮层和外周神 经的信息来协调运动，就会导致产生随意运动协调性素乱的症状，表现为测距不准、站立不 稳、步履瞒哪等现象，称为小脑共济失调(Cerebellar Ataxia)。在临床工作中小脑共济失 调的病历并不少见，患者的日常生活受到了严重的影响。目前医学研究虽然已经能在细胞 及分子水平上识别许多与小脑共济失调相关的基因和蛋白质，但运种功能障碍的神经环路 传播机理尚不完全明确，缺乏从仿生学和控制学角度通过建模方法对运动命令传播过程进 行形式化描述。因此在神经解剖学和神经生理学的基础上建立小脑模型是解决该问题的关 键，并在此基础上建立基于小脑模型的仿生手臂控制系统，通过采集患者数据并输入到系 统中进行分析，可W为小脑性共济失调患者提供一种新的辅助分析和诊断方法。
[0003] 小脑对运动的调整十分重要，关于小脑的运种功能是如何融合到现实的运动控制 和系统学习中是国际上认知领域的一个研究热点。围绕运个问题，多年来包括生物学家、神 经生理学家W及控制理论家在内的学者们进行了相关的探索，建立了多种小脑模型，如 A化US的小脑皮层非匀质结构模型W及在此理论基础上建立的小脑关联控制器;Fuji ta等 人指出苔薛纤维是将动态时变信号传递至小脑，提出自适应滤波器的小脑内部模型等。然 而，现有的小脑模型大多可黑箱结构"来比拟，突出小脑与感受器的相互作用，忽略、 简化了小脑内部的诸多结构，不能充分体现小脑本身的特性；同时，现有的基于小脑模型的 手臂运动控制系统中使用的是仅具有仿真意义的简单手臂模型，仅能够检验小脑模型的某 些特定的控制效果，难W满足应用的要求。因此，需要在神经解剖学和神经生理学的基础 上，从控制学的角度致力于模拟和复制小脑功能，建立新型小脑模型，并在此基础上搭建仿 生手臂控制系统，为小脑共济失调患者提供新的辅助分析和诊断技术。
【发明内容】
[0004] 为了克服现有技术存的问题，本发明目的是提供一种基于小脑模型的仿生手臂控 制系统及小脑模型建模方法。该系统由基于神经解剖学和神经生理学特征的小脑模型来控 审IJ，不仅具有良好的人机交互功能，而且，可W实现对手臂相对准确的控制。该系统所具有 学习记忆的能力，不仅可W对未知动作命令进行自我学习，储存其相关控制命令信息，更可 W实现对已学动作的控制命令的快速调用。由于在小脑建模时参考了大量的生理解剖学知 识，从而克服了现存的许多小脑建模方法着重追求控制效果而忽略其本身特性的弊端。本 发明首次将小脑建模控制与化antom Omni力反馈器相结合，使被控手臂不再局限于仿真模 型，可W更好地模拟手臂运动的真实情形，为进一步建立个性化小脑共济失调训练康复力 反馈系统奠定了基础。
[0005] 为了实现上述发明目的，解决现有技术中所存在的问题，本发明采取的技术方案 是:一种基于小脑模型的仿生手臂控制系统，包括人机交互模块、储存器、命令产生模块和 仿生手臂运动控制模块，所述人机交互模块、储存器、命令产生模块和仿生手臂运动控制模 块依次相连，此外，所述命令产生模块还分别与储存器及仿生手臂运动控制模块相连，所述 仿生手臂运动控制模块还分别与人机交互模块及储存器相连;所述命令产生模块，包括小 脑模块、命令转换模块和学习模块，除此之外，还包括命令产生模块与外部连接的第1、2输 入端、第1、2输出端四个接口，其中，命令产生模块与外部接口的第1输入端、小脑模块、命令 转换模块及命令产生模块与外部接口的第2输出端依次相连，所述命令转换模块还分别与 学习模块及命令产生模块与外部接口的第1输出端相连，所述学习模块还分别与小脑模块 及命令产生模块与外部接口的第2输入端相连;所述仿生手臂运动控制模块，包括仿生手臂 运动控制模块与外部连接的输入端、输出端二个接口、仿真手臂模块、数据采集模块、软件 控制平台及化antom Omni力反馈器，其中，仿生手臂运动控制模块与外部接口的输入端与 仿真手臂模块输入端相连，仿真手臂模块输出端分别与数据采集模块及仿生手臂运动控制 模块与外部接口的输出端相连，所述数据采集模块还与软件控制平台、Phantom Omni力反 馈器及仿生手臂运动控制模块与外部接口的输出端依次相连。
[0006] 所述一种基于小脑模型的仿生手臂控制系统中的小脑模型建模方法，包括W下步 骤：
[0007] 步骤A、建立小脑模型的基本结构，由于小脑皮层具有匀质结构特性，因此，可W使 用具有相同结构的基本单元的阵列对小脑进行建模，每个基本单元接收相同的用户指令信 息输入，随后进入步骤B;
[0008] 步骤B、计算各个基本单元中传递目标位置信息和传递本体感受信息的平行纤维 的状态，根据用户输入的手臂末端起始位置和期望终止位置的指令信息，计算各个基本单 元中传递目标位置信息和传递本体感受信息的平行纤维的状态，具体包括W下子步骤：
[0009] 子步骤B1、根据期望的手臂运动终点的位置坐标，利用小脑模型控制器，即CMAC二 维稀疏编码方法来确定第m个基本单元中传递目标位置信息的平行纤维的状态，即Xmi的取 值，其值具有二值性，用"0"表示抑制状态，"Γ表示激活状态，在当次指令执行过程中一旦 确定便不再改变;其中，m=l，2,--,16,1 = 1,2,…8;
[0010] 子步骤B2、根据学习模块接收的仿真手臂相关信息和命令转换关系，利用公式 (1)，计算在t时刻，第m个基本单元中传递本体感受信息的平行纤维的状态Pm(t)，运里t = 1，2,3，···为整数。
[0011]
(1)
[0012] 令
良示第m个基本单元对应的命令转换模块中的关节角度调整向 量，且为常向量;其中，Em表示上臂与竖直方向夹角的调整值，訂1表示下臂与水平方向夹角 的调整值
表示t时刻时仿真手臂的关节角度向量，a(t)分别表示上臂与竖直方 向夹角，e(t)表示下臂与水平方向的夹角，其初始值由用户指定，函数g(X)的定义为，
[0013]
(2)
[0014] 然后进入步骤C;
[0015] 步骤C、计算各个基本单元的输出，从而得到小脑模块输出命令，具体包括W下子 步骤：
[0016] 子步骤C1、计算第m个基本单元的网状结构输出，即此基本单元中各个浦肯野细胞 的状态ymj，j = 1，2，…12，y"j的值随时间改变，具体包括W下子步骤：
[0017] 子步骤C11、利用公式(3)计算第m个基本单元中第j个浦肯野细胞在t时刻的膜电 位值Smj (t ),
[001 引
口）
[0019]式中，Wmi康示第i条传递目标位置信息的平行纤维与第j个浦肯野细胞形成的突 触的记忆权值，由于该类突触为小脑学习记忆的载体，因此WmU设为可调，其初始值设为1， 小脑模块的输出通过调整其值大小来改变;Pm(t)为传递本体感受信息的平行纤维的状态； WPmj表示传递本体感受信息的平行纤维与第j个浦肯野细胞形成的突触的权值，Wbmj表示篮 细胞与第j个浦肯野细胞形成的突触的权值，由于篮细胞对浦肯野细胞产生抑制作用，因此 其值为负值，W上两权值均为固定值，分别设为0.2和-1，bm表示篮细胞的状态值，篮细胞在 执行过程中始终保持激发状态，因此其值恒定为1;
[0020] 子步骤C12、浦肯野细胞状态具有二值性，用"0"表示抑制状态，"Γ表示激活状态， 结合子步骤C11公式(3)计算得到的利用公式(4)、（5)、（6)计算在t时刻时第m个基本 单元中第j个浦肯野细胞的状态，
[0021] 对于起始时刻t = l，
[0022]
(4)
[002；3]当t〉l时，ymj (t)与上一时刻ymj (t-1)的值相关，对于ymj (t-1) =0的情况，赋值方法 为，
[0024]
(5)
[0025] 而对于ymj (t-1 ) = 1的情况，ymj (t)将依概率取值为0或1，
[0026]
[0027]其中，sm^t)表示在t时刻的浦肯野细胞的膜电位值，Φ、ri分别为浦肯野细胞膜电 位的去极化和复极化的阔值，为固定常数，且Φ〉η;函数pro(x)表示X发生的概率，具体说明 如下，当pro (ymj (t) = 0) = 0.2，则ymj (t似0.2的概率赋值为0，而W0.8的概率赋值为1; [00%]子步骤C2、根据反馈环路，即loop的状态，计算各个基本单元输出，loop具有两种 状态，即on与off状态，当小脑模块接收用户运动指令时，loop由off转变为on状态，当基本 单元中的浦肯野细胞处于激活状态的数量达到总数量的90%时，loop由on转变为off状态， 根据loop不同状态，利用公式(7)计算得到第m个基本单元的输出命令0m(t)，
[0029]
[0030] 式中，丫为命令调整系数，设为常数;ym^t)为在t时刻时第m个基本单元中第j个浦 肯野细胞的状态；则在t时刻小脑模块的输出命令为0 ( t ) = [ 01 ( t )，02 ( t )，…016 (t)]，若0 (t)为零向量，则执行步骤D，即完成一次小脑模块命令的输出，否则执行子步骤C3;
[0031] 子步骤C3、计算当前小脑模块记忆信息对应的控制命令输出，具体包括W下子步 骤：
[0032] 子步骤C31、根据权值调整公式(8)，调整第m个基本单元在t+1时刻的传递目标位 置信息的平行纤维和浦肯野细胞形成的突触权值WmU(t+l)的大小，
[00削
巧）
[0034] 式中，λ为调整系数，设为常数;ym^t)为在t时刻时第m个基本单元中第j个浦肯野 细胞的状态;Xmi表示传递目标位置信息的平行纤维的状态值；Δ WmU(t)为在t时刻时传递目 标位置信息的平行纤维和浦肯野细胞形成的突触权值的变化值;WmU(t)表示在t时刻时传 递目标位置信息的平行纤维和浦肯野细胞形成的突触权值的大小；
[0035] 子步骤C32、根据t时刻的小脑模块输出命令0(t)和命令转换模块中的关节角度调 整矩阵Δφ二[Δφι，Δ(ρ2,…Δφκ]，利用公式（9)计算t+1时刻仿真手臂的关节角度向量
[0036]
贷）
[0037] 式中
表示表示t时刻时仿真手臂的关节角度向量，a(t)分别表示上臂与竖 直方向夹角，β (t)表示下臂与水平方向的夹角
表示在t时刻时小脑输出命令控制 手臂关节调整的角度值，Aa(t)表示上臂与竖直方向的角度调整值，Δβ(〇表示下臂与水 平方向的角度调整值；
[0038] 子步骤C33、根据此时的仿真手臂关节角度信息，重复执行子步骤Β2;
[0039] 步骤D、执行小脑模块学习功能，根据用户指令调整小脑模块命令输出，具体包括 W下子步骤：
[0040] 子步骤D1、在完成步骤C之后，根据仿真手臂停止位置的关节角度信息
，利用 公式（10)计算化antom Omni仿真手臂在笛卡尔空间上的位置信息(x,y ,ζ)，
[0041]
(1的
[00创其中，L读示上臂长度，L康示其下臂长度，目谢目2分别为俯视化antom Omni时，上 臂与地平面之间的夹角和下臂与地垂线之间的夹角，03为与地面平行的旋转平面上的旋转 角度，在此，设定
θ3 = 0,然后计算仿真手臂位置信息与用户设 定的期望位置的偏差Αχ及其模值II Δχ| I，如果I I Δχ| I小于仿真手臂坐标空间的单位长 度的0.5倍，则建模完成，否则执行子步骤D2;
[0043] 子步骤D2、根据公式（10)表示的仿真手臂的关节角度与位置的关系，计算其雅克 比矩阵J，再利用公式(11)计算关节调整角度A Θ，
[0044] A0=J-i.Ax (11)
[0045] 其中，Δ X表示仿真手臂位置信息与用户设定的期望位置的偏差；
[0046] 子步骤D3、根据ΔΘ确定第m个基本单元中攀爬纤维的状态值cm(n)，n为学习次数， 初始值为1，具体包括W下子步骤：
[0047] 子步骤D31、根据公式(12)计算第m个基本单元对应的攀爬纤维的激发概率Pm，
[0048]
(1满
[0049] 式中，(?表示相应的命令转换模块中的关节角度调整向量Δφ^与关节调整角度Δ θ之间的夹角；
[0050] 子步骤D32、将小于0.5的Pm的值重置为0,调整之后攀爬纤维的激发概率设为Pm'， 根据公式（13)，确定cm(n)的取值，
[0化1] pro(cm(n) = l)=Pm' (13)
[0052] 其中，函数pro(x)表示X发生的概率；
[0053] 子步骤D4、根据公式（14)，对小脑模块第m个基本单元中的每个平行纤维和浦肯野 细胞的初始权值Wmij( 1 )进行调整，
[0054]
(M)
[0055] 式中，μ表示学习系数，为常数，cm(n)第m个基本单元中在η次学习后攀爬纤维的状 态值，Xmi表示传递目标位置信息的平行纤维的状态值，Δ WmU ( 1 )表示传递目标位置信息的 平行纤维和浦肯野细胞形成突触权值的初值变化值；
[0056] 子步骤D5、将仿真手臂恢复到初始位置，将t重置为1，学习次数为n+1，执行子步骤 B2。
[0057] 本发明有益效果是：一种基于小脑模型的仿生手臂控制系统及小脑模型建模方 法，其中，所述一种基于小脑模型的仿生手臂控制系统，包括人机交互模块、储存器、命令产 生模块和仿生手臂运动控制模块，所述人机交互模块、储存器、命令产生模块和仿生手臂运 动控制模块依次相连，此外，所述命令产生模块还分别与储存器及仿生手臂运动控制模块 相连，所述仿生手臂运动控制模块还分别与人机交互模块及储存器相连;所述一种基于小 脑模型的仿生手臂控制系统中的小脑模型建模方法，包括W下步骤：（1)建立小脑模型的基 本结构，（2)计算各个基本单元中传递目标位置信息和传递本体感受信息的平行纤维的状 态，（3)计算各个基本单元的输出，从而得到小脑模块输出命令，（4)执行小脑模块学习功 能，根据用户指令调整小脑模块命令输出。与已有技术相比，本发明不仅具有良好的人机交 互功能，而且，可W实现对手臂相对准确的控制。该系统所具有学习记忆的能力，不仅可W 对未知动作命令进行自我学习，储存其相关控制命令信息，更可W实现对已学动作的控制 命令的快速调用。由于在小脑建模时参考了大量的生理解剖学知识，因此能克服现存的许 多小脑建模方法着重追求控制效果而忽略其本身特性的弊端。本发明首次将小脑建模控制 与化antom Omni力反馈器相结合，使被控手臂不再局限于仿真模型，并且，Phantom Omni力 反馈器所具有的独特的力反馈功能可W更好地模拟手臂运动的真实情形，为进一步建立真 实小脑控制手臂运动的模型奠定基础。
【附图说明】
[005引图1是本发明一种基于小脑模型的仿生手臂控制系统总体框图。
[0059] 图2是本发明一种基于小脑模型的仿生手臂控制系统中的命令产生模块框图。
[0060] 图3是本发明一种基于小脑模型的仿生手臂控制系统中的仿生手臂运动控制模块 框图。
[0061] 图4是本发明一种基于小脑模型的仿生手臂控制系统中的命令产生模块中小脑模 块结构框图。
[0062] 图5是小脑模块中的基本单元框图。
[0063] 图6是仿真手臂示意图。
[0064] 图7是软件平台控制流程图。
[0065] 图8是本发明中小脑模型建模方法步骤流程图。
[0066] 图9和图10是本发明系统针对不同用户指令控制仿真手臂运动的末端轨迹图。图 中V'代表起始位置，代表期望目标位置。
【具体实施方式】
[0067] 下面结合附图对本发明作进一步说明。
[0068] 如图1所示，一种基于小脑模型的仿生手臂控制系统，包括人机交互模块、储存器、 命令产生模块和仿生手臂运动控制模块，所述人机交互模块、储存器、命令产生模块和仿生 手臂运动控制模块依次相连，此外，所述命令产生模块还分别与储存器及仿生手臂运动控 制模块相连，所述仿生手臂运动控制模块还分别与人机交互模块及储存器相连。
[0069] 如图2所示，命令产生模块，包括小脑模块、命令转换模块和学习模块，除此之外， 还包括命令产生模块与外部连接的第1、2输入端、第1、2输出端四个接口，其中，命令产生模 块与外部接口的第1输入端、小脑模块、命令转换模块及命令产生模块与外部接口的第2输 出端依次相连，所述命令转换模块还分别与学习模块及命令产生模块与外部接口的第1输 出端相连，所述学习模块还分别与小脑模块及命令产生模块与外部接口的第2输入端相连。
[0070] 如图3所示，仿生手臂运动控制模块，包括仿生手臂运动控制模块与外部连接的输 入端、输出端二个接口、仿真手臂模块、数据采集模块、软件控制平台及Phantom Omni力反 馈器，其中，仿生手臂运动控制模块与外部接口的输入端与仿真手臂模块输入端相连，仿真 手臂模块输出端分别与数据采集模块及仿生手臂运动控制模块与外部接口的输出端相连， 所述数据采集模块还与软件控制平台、Phantom Omni力反馈器及仿生手臂运动控制模块与 外部接口的输出端依次相连。
[0071] 化antom Omni运动控制系统具体工作原理为:仿真手臂模块接收小脑模块产生的 与用户指令相应的控制命令，控制仿真手臂运动;通过数据采集模块采集部分仿真手臂末 端运动轨迹信息，将信息传递给软件控制平台，并利用公式（15)完成对化antom Omni力反 馈器的运动控制：
[0072]
(1却
[0073] 其中，d表示位移，F表示Phantom Omni产生的力，V表示手臂速度，R代表设定的阻 尼，K表示设定的刚度。
[0074] -种基于小脑模型的仿生手臂控制系统中的小脑模型建模方法，包括W下步骤：
[0075] 步骤A、建立小脑模型的基本结构，由于小脑皮层具有匀质结构特性，因此，可W使 用具有相同结构的基本单元的阵列对小脑进行建模，每个基本单元接收相同的用户指令信 息输入，随后进入步骤B;
[0076] 步骤B、计算各个基本单元中传递目标位置信息和传递本体感受信息的平行纤维 的状态，根据用户输入的手臂末端起始位置和期望终止位置的指令信息，计算各个基本单 元中传递目标位置信息和传递本体感受信息的平行纤维的状态，具体包括W下子步骤：
[0077] 子步骤Bl、根据期望的手臂运动终点的位置坐标，利用小脑模型控制器，即CMAC二 维稀疏编码方法来确定第m个基本单元中传递目标位置信息的平行纤维的状态，即Xmi的取 值，其值具有二值性，用"0"表示抑制状态，"Γ表示激活状态，在当次指令执行过程中一旦 确定便不再改变;其中，m=l，2,--,16,1 = 1,2,…8;
[0078] 子步骤B2、根据学习模块接收的仿真手臂相关信息和命令转换关系，利用公式 (1)，计算在t时刻，第m个基本单元中传递本体感受信息的平行纤维的状态pm(t)，运里t = 1，2,3，···为整数。
[0079]
( 1 )
[0080] 令
表示第m个基本单元对应的命令转换模块中的关节角度调整向 量，且为常向量;其中，Em表示上臂与竖直方向夹角的调整值，表示下臂与水平方向夹角 的调整值
则表示t时刻时仿真手臂的关节角度向量，a(t)分别表示上臂与竖直方 向夹角，e(t)表示下臂与水平方向的夹角，其初始值由用户指定，函数g(X)的定义为，
[0081 ]
12)
[0082] 然后进入步骤C;
[0083] 步骤C、计算各个基本单元的输出，从而得到小脑模块输出命令，具体包括W下子 步骤：
[0084] 子步骤C1、计算第m个基本单元的网状结构输出，即此基本单元中各个浦肯野细胞 的状态ymj，j = 1，2，· · · 12，ymj的值随时间改变，具体包括W下子步骤：
[0085] 子步骤C11、利用公式(3)计算第m个基本单元中第j个浦肯野细胞在t时刻的膜电 位值 Sm.i(t)，
[0086]
1^3)
[0087] 式中，WmU表示第i条传递目标位置信息的平行纤维与第j个浦肯野细胞形成的突 触的记忆权值，由于该类突触为小脑学习记忆的载体，因此WmU设为可调，其初始值设为1， 小脑模块的输出通过调整其值大小来改变;Pm(t)为传递本体感受信息的平行纤维的状态； WPmj表示传递本体感受信息的平行纤维与第j个浦肯野细胞形成的突触的权值，Wbmj表示篮 细胞与第j个浦肯野细胞形成的突触的权值，由于篮细胞对浦肯野细胞产生抑制作用，因此 其值为负值，W上两权值均为固定值，分别设为0.2和-l，bm表示篮细胞的状态值，篮细胞在 执行过程中始终保持激发状态，因此其值恒定为1 ;
[0088] 子步骤C12、浦肯野细胞状态具有二值性，用"0"表示抑制状态，"Γ表示激活状态， 结合子步骤Cll公式(3)计算得到的Sm^t)，利用公式(4)、（5)、（6)计算在t时刻时第m个基本 单元中第j个浦肯野细胞的状态，
[0089] 对于起始时刻t = l，
[0090]
(4)
[0091 ]当t〉l时，ymj(t)与上一时刻ymj(t-l)的值相关，对于ymj(t-l) =0的情况，赋值方法 为，
[0092]
、5)
[0093] 而对于ymj (t-1) = 1的情况，ymj (t)将依概率取值为0或1，
[0094]
(6)
[0095] 其中，Sm^t)表示在t时刻的浦肯野细胞的膜电位值，Φ、!!分别为浦肯野细胞膜电 位的去极化和复极化的阔值，为固定常数，且Φ〉η;函数pro(x)表示X发生的概率，具体说明 如下，当pro (ymj (t) = 0) = 0.2，则ymj (t似0.2的概率赋值为0，而W0.8的概率赋值为1;
[0096] 子步骤C2、根据反馈环路，即loop的状态，计算各个基本单元输出，loop具有两种 状态，即on与off状态，当小脑模块接收用户运动指令时，loop由off转变为on状态，当基本 单元中的浦肯野细胞处于激活状态的数量达到总数量的90%时，loop由on转变为off状态， 根据loop不同状态，利用公式(7)计算得到第m个基本单元的输出命令0m(t)，
[0097]
巧)
[009引式中，丫为命令调整系数，设为常数;ym^t)为在t时刻时第m个基本单元中第j个浦 肯野细胞的状态；则在t时刻小脑模块的输出命令为0 ( t ) = [ 01 ( t )，02 ( t )，…016 (t)]，若0 (t)为零向量，则执行步骤D，即完成一次小脑模块命令的输出，否则执行子步骤C3;
[0099] 子步骤C3、计算当前小脑模块记忆信息对应的控制命令输出，具体包括W下子步 骤：
[0100] 子步骤C31、根据权值调整公式(8)，调整第m个基本单元在t+1时刻的传递目标位 置信息的平行纤维和浦肯野细胞形成的突触权值WmU(t+l)的大小，
[0101]
巧)：
[0102] 式中，λ为调整系数，设为常数;ym^t)为在t时刻时第m个基本单元中第j个浦肯野 细胞的状态;Xmi表示传递目标位置信息的平行纤维的状态值；Δ WmU(t)为在t时刻时传递目 标位置信息的平行纤维和浦肯野细胞形成的突触权值的变化值;WmU(t)表示在t时刻时传 递目标位置信息的平行纤维和浦肯野细胞形成的突触权值的大小；
[0103] 子步骤C32、根据t时刻的小脑模块输出命令0(t)和命令转换模块中的关节角度调 整矩阵么啤=|>巧|，么(})2，-，/_^#16]，利用公式（9)计算* + 1时刻仿真手臂的关节角度向量
[0104]
(9)
[0105] 式中
表示表示t时刻时仿真手臂的关节角度向量，a(t)分别表示上臂与竖 直方向夹角，e(t)表示下臂与水平方向的夹角
良示在t时刻时小脑输出命令控制 手臂关节调整的角度值，Aa(t)表示上臂与竖直方向的角度调整值，Δβ(〇表示下臂与水 平方向的角度调整值；
[0106] 子步骤C33、根据此时的仿真手臂关节角度信息，重复执行子步骤Β2;
[0107] 步骤D、执行小脑模块学习功能，根据用户指令调整小脑模块命令输出，具体包括 W下子步骤：
[0108] 子步骤D1、在完成步骤C之后，根据仿真手臂停止位置的关节角度信息
利用 公式（10)计算化antom Omni仿真手臂在笛卡尔空间上的位置信息(x,y ,ζ)，
[0109]
(IQ)
[0110] 其中，Li表示上臂长度，L2表示其下臂长度，目谢目2分别为俯视化antom Omni时，上 臂与地平面之间的夹角和下臂与地垂线之间的夹角，θ3为与地面平行的旋转平面上的旋转 角度，在此，设S
θ3 = 0,然后计算仿真手臂位置信息与用户设 定的期望位置的偏差Αχ及其模值II Δχ| I，如果I I Δχ| I小于仿真手臂坐标空间的单位长 度的0.5倍，则建模完成，否则执行子步骤D2;
[0111] 子步骤D2、根据公式（10)表示的仿真手臂的关节角度与位置的关系，计算其雅克 比矩阵J，再利用公式(11)计算关节调整角度A Θ，
[0112] A0=J-i.Ax (11)
[0113] 其中，Δ X表示仿真手臂位置信息与用户设定的期望位置的偏差；
[0114] 子步骤D3、根据ΔΘ确定第m个基本单元中攀爬纤维的状态值cm(n)，n为学习次数， 初始值为1，具体包括W下子步骤：
[0115] 子步骤D31、根据公式(12)计算第m个基本单元对应的攀爬纤维的激发概率Pm，
[0116]
(12)
[0117] 式中，表示相应的命令转换模块中的关节角度调整向量Δφ。,与关节调整角度Δ Θ之间的夹角；
[0118] 子步骤D32、将小于0.5的Pm的值重置为0,调整之后攀爬纤维的激发概率设为Pm'， 根据公式（13)，确定cm(n)的取值，
[0119] pro(cm(n) = 1) = Pm' (13)
[0120] 其中，函数pro(x)表示X发生的概率；
[0121] 子步骤D4、根据公式（14)，对小脑模块第m个基本单元中的每个平行纤维和浦肯野 细胞的初始权值Wmij (1)进行调整，
[0122]
(14)
[0123] 式中，μ表示学习系数，为常数，cm(n)第m个基本单元中在η次学习后攀爬纤维的状 态值，Xmi表示传递目标位置信息的平行纤维的状态值，Δ WmU ( 1 )表示传递目标位置信息的 平行纤维和浦肯野细胞形成突触权值的初值变化值；
[0124] 子步骤D5、将仿真手臂恢复到初始位置，将t重置为1，学习次数为n+1，执行子步骤 B2〇
[0125] 本发明基于小脑模型的仿生手臂控制系统执行过程，具体包括W下步骤：
[0126] 步骤1、启动系统，用户通过人机交互模块向系统中输入控制手臂的指令信息。
[0127] 步骤2、系统根据用户输入信息进行存储器检索，如果储存器中已存在当前用户指 令的小脑控制命令信息，则直接执行步骤4,否则，为当前指令申请新的存储空间，然后执行 步骤3。
[0128] 步骤3、将用户的指令输入到命令产生模块，并根据小脑模型建模方法完成对小脑 模块的建模。然后，将小脑模块的输出经过命令转换模块输出到储存器中新申请的存储空 间保存，同时将控制命令输出到仿生手臂运动控制模块。
[0129] 步骤4、仿生手臂运动控制模块根据系统的输入信息通过仿真手臂模块模拟 Phantom Omni设备运动，并通过数据采集模块采集仿真手臂运动信息，然后通过软件平台 完成对化antom Omni设备控制任务。
[0130] 步骤5、将仿真手臂轨迹图像和Phantom Omni设备的位置坐标输出到人机交互模 块进行显示，则系统的一次指令执行过程结束。
【主权项】
1. 一种基于小脑模型的仿生手臂控制系统，包括人机交互模块、储存器、命令产生模块 和仿生手臂运动控制模块，其特征在于:所述人机交互模块、储存器、命令产生模块和仿生 手臂运动控制模块依次相连，此外，所述命令产生模块还分别与储存器及仿生手臂运动控 制模块相连，所述仿生手臂运动控制模块还分别与人机交互模块及储存器相连;所述命令 产生模块，包括小脑模块、命令转换模块和学习模块，除此之外，还包括命令产生模块与外 部连接的第1、2输入端、第1、2输出端四个接口，其中，命令产生模块与外部接口的第1输入 端、小脑模块、命令转换模块及命令产生模块与外部接口的第2输出端依次相连，所述命令 转换模块还分别与学习模块及命令产生模块与外部接口的第1输出端相连，所述学习模块 还分别与小脑模块及命令产生模块与外部接口的第2输入端相连;所述仿生手臂运动控制 模块，包括仿生手臂运动控制模块与外部连接的输入端、输出端二个接口、仿真手臂模块、 数据采集模块、软件控制平台及Phantom Omni力反馈器，其中，仿生手臂运动控制模块与外 部接口的输入端与仿真手臂模块输入端相连，仿真手臂模块输出端分别与数据采集模块及 仿生手臂运动控制模块与外部接口的输出端相连，所述数据采集模块还与软件控制平台、 Phantom Omni力反馈器及仿生手臂运动控制模块与外部接口的输出端依次相连。2. 根据权利要求1所述一种基于小脑模型的仿生手臂控制系统中的小脑模型建模方 法，其特征在于包括以下步骤： 步骤A、建立小脑模型的基本结构，由于小脑皮层具有匀质结构特性，因此，可以使用具 有相同结构的基本单元的阵列对小脑进行建模，每个基本单元接收相同的用户指令信息输 入，随后进入步骤B; 步骤B、计算各个基本单元中传递目标位置信息和传递本体感受信息的平行纤维的状 态，根据用户输入的手臂末端起始位置和期望终止位置的指令信息，计算各个基本单元中 传递目标位置信息和传递本体感受信息的平行纤维的状态，具体包括以下子步骤： 子步骤B1、根据期望的手臂运动终点的位置坐标，利用小脑模型控制器，即CMAC二维稀 疏编码方法来确定第m个基本单元中传递目标位置信息的平行纤维的状态，即xmi的取值，其 值具有二值性，用"〇"表示抑制状态，"1"表示激活状态，在当次指令执行过程中一旦确定便 不再改变;其中，m=l，2, = 子步骤B2、根据学习模块接收的仿真手臂相关信息和命令转换关系，利用公式（1)，计 算在t时刻，第m个基本单元中传递本体感受信息的平行纤维的状态?》(〇,这里t = l，2， 3,…为整数。表示第m个基本单元对应的命令转换模块中的关节角度调整向量，且为 常向量;其中，^表示上臂与竖直方向夹角的调整值，心，表示下臂与水平方向夹角的调整则表示t时刻时仿真手臂的关节角度向量，a(t)分别表示上臂与竖直方向夹角， iKt)表示下臂与水平方向的夹角，其初始值由用户指定，函数g(x)的定义为，然后进入步骤C; 步骤C、计算各个基本单元的输出，从而得到小脑模块输出命令，具体包括以下子步骤： 子步骤C1、计算第m个基本单元的网状结构输出，即此基本单元中各个浦肯野细胞的状 态ymj，j = 1，2，…12，ymj的值随时间改变，具体包括以下子步骤： 子步骤C11、利用公式(3)计算第m个基本单元中第j个浦肯野细胞在t时刻的膜电位值 Smj (t )，式中，表示第i条传递目标位置信息的平行纤维与第j个浦肯野细胞形成的突触的 记忆权值，由于该类突触为小脑学习记忆的载体，因此设为可调，其初始值设为1，小脑 模块的输出通过调整其值大小来改变;p m(t)为传递本体感受信息的平行纤维的状态; 表示传递本体感受信息的平行纤维与第j个浦肯野细胞形成的突触的权值，wbw表示篮细胞 与第j个浦肯野细胞形成的突触的权值，由于篮细胞对浦肯野细胞产生抑制作用，因此其值 为负值，以上两权值均为固定值，分别设为0.2和-l，b m表示篮细胞的状态值，篮细胞在执行 过程中始终保持激发状态，因此其值恒定为1; 子步骤C12、浦肯野细胞状态具有二值性，用"0"表示抑制状态，"Γ表示激活状态，结合 子步骤C11公式(3)计算得到的Smj(t)，利用公式(4)、（5)、（6)计算在1:时刻时第1]1个基本单元 中第j个浦肯野细胞的状态， 对于起始时刻t = l，当t> 1时，ymj (t)与上一时刻ymj (t-1)的值相关，对于ymj (t-1 )= 0的情况，赋值方法为，而对于(t-1) = 1的情况，5? (t)将依概率取值为0或1，其中，Smj(t)表示在t时刻的浦肯野细胞的膜电位值，Φ、ri分别为浦肯野细胞膜电位的 去极化和复极化的阈值，为固定常数，且Φ>η;函数pro(X)表示X发生的概率，具体说明如 下，当坪〇(7以〇=0)=0.2，则5^办）以0.2的概率赋值为0，而以0.8的概率赋值为1; 子步骤C2、根据反馈环路，即loop的状态，计算各个基本单元输出，loop具有两种状态， 即on与off状态，当小脑模块接收用户运动指令时，loop由off转变为on状态，当基本单元中 的浦肯野细胞处于激活状态的数量达到总数量的90%时，loop由on转变为off状态，根据 loop不同状态，利用公式(7)计算得到第m个基本单元的输出命令0m(t)，式中，γ为命令调整系数，设为常数;ymj(t)为在t时刻时第m个基本单元中第j个浦肯野 细胞的状态；则在t时刻小脑模块的输出命令为0(t) = [(h (t)，02 (t)，…016(t)]，若0(t)为 零向量，则执行步骤D，即完成一次小脑模块命令的输出，否则执行子步骤C3; 子步骤C3、计算当前小脑模块记忆信息对应的控制命令输出，具体包括以下子步骤： 子步骤C31、根据权值调整公式(8)，调整第m个基本单元在t+Ι时刻的传递目标位置信 息的平行纤维和浦肯野细胞形成的突触权值《_(1+1)的大小，式中，λ为调整系数，设为常数;ymj(t)为在t时刻时第m个基本单元中第j个浦肯野细胞 的状态;xmi表示传递目标位置信息的平行纤维的状态值；A Wmij(t)为在t时刻时传递目标位 置信息的平行纤维和浦肯野细胞形成的突触权值的变化值;表示在t时刻时传递目 标位置信息的平行纤维和浦肯野细胞形成的突触权值的大小； 子步骤C32、根据t时刻的小脑模块输出命令0( t)和命令转换模块中的关节角度调整矩 阵厶(？ = 0<?|4(?2,-4<?|6]，利用公式（9)计算七+ 1时刻仿真手臂的关节角度向量表示表示t时刻时仿真手臂的关节角度向量，a(t)分别表示上臂与竖直方 向夹角，Kt)表示下臂与水平方向的夹角表示在t时刻时小脑输出命令控制手臂 关节调整的角度值，Aa(t)表示上臂与竖直方向的角度调整值，Δβ(〇表示下臂与水平方 向的角度调整值； 子步骤C33、根据此时的仿真手臂关节角度信息，重复执行子步骤B2;步骤D、执行小脑模块学习功能，根据用户指令调整小脑模块命令输出，具体包括以下 子步骤： 子步骤D1、在完成步骤C之后，根据仿真手臂停止位置的关节角度信息 ，利用公式 (10)计算Phantom Omni仿真手臂在笛卡尔空间上的位置信息(X，y，Z)， x = sin03 · (Li · cos02+L2 · sinBi) y = Li · sin02-L2 · cosBi (10) z = cos03 · (Li · cos02+L2 · sinBi) 其中，Li表示上臂长度，L2表示其下臂长度，θι和Θ2分别为俯视Phantom Omni时，上臂与 地平面之间的夹角和下臂与地垂线之间的夹角，θ3为与地面平行的旋转平面上的旋转角 度，在此，然后计算仿真手臂位置信息与用户设定 的期望位置的偏差Αχ及其模值| | ΔΧ| |，如果| | ΔΧ| |小于仿真手臂坐标空间的单位长度 的〇. 5倍，则建模完成，否则执行子步骤D2; 子步骤D2、根据公式（10)表示的仿真手臂的关节角度与位置的关系，计算其雅克比矩 阵J，再利用公式(11)计算关节调整角度Α Θ， Δ 0 = J-1 · Δχ (11) 其中，△ x表示仿真手臂位置信息与用户设定的期望位置的偏差； 子步骤D3、根据ΔΘ确定第m个基本单元中攀爬纤维的状态值Cm(n)， n为学习次数，初始 值为1，具体包括以下子步骤： 子步骤D31、根据公式(12)计算第m个基本单元对应的攀爬纤维的激发概率pm，式中，表示相应的命令转换模块中的关节角度调整向量4((^与关节调整角度△ Θ之 间的夹角； 子步骤D32、将小于〇.5的0"的值重置为0,调整之后攀爬纤维的激发概率设为pm'，根据 公式(13)，确定cm(n)的取值， pro(cm(n) = 1) =Pm， (13) 其中，函数pro(x)表示x发生的概率； 子步骤D4、根据公式（14)，对小脑模块第m个基本单元中的每个平行纤维和浦肯野细胞 的初始权值Wmi j ( 1 )进行调整，式中，μ表示学习系数，为常数，cm(n)第m个基本单元中在η次学习后攀爬纤维的状态值， xmi表示传递目标位置信息的平行纤维的状态值，△ (1)表示传递目标位置信息的平行 纤维和浦肯野细胞形成突触权值的初值变化值； 子步骤D5、将仿真手臂恢复到初始位置，将t重置为1，学习次数为n+1，执行子步骤B2。
【文档编号】G05B17/02GK105824250SQ201610319716
【公开日】2016年8月3日
【申请日】2016年5月14日
【发明人】刘蓉, 林相乾, 林悦琪
【申请人】大连理工大学