《基于磁传感器的手指运动检测识别系统及方法.pdf》由会员分享,可在线阅读,更多相关《基于磁传感器的手指运动检测识别系统及方法.pdf(16页珍藏版)》请在专利查询网上搜索。
1、(19)中华人民共和国国家知识产权局 (12)发明专利申请 (10)申请公布号 (43)申请公布日 (21)申请号 201610374306.2 (22)申请日 2016.05.31 (71)申请人 南京医科大学 地址 210029 江苏省南京市鼓楼区汉中路 140号生物医学工程系 (72)发明人 吴小玲 张可 汤福南 李修寒 段磊 王伟 朱松盛 刘宾 (74)专利代理机构 南京知识律师事务所 32207 代理人 高娇阳 (51)Int.Cl. A61B 5/11(2006.01) A61B 5/00(2006.01) (54)发明名称 基于磁传感器的手指运动检测识别系统及 方法 (57)摘要。
2、 本发明及一种基于磁传感器的手指运动检 测识别系统及方法, 其信号采集模块包括小磁体 贴片、 磁传感器阵列、 置位/复位电路; 磁体贴片 用于贴在手指上, 磁传感器阵列由N(N10)个磁 传感器组成, 磁传感器在信号采集器上等间距排 列一周; 置位/复位电路用于产生置位/复位脉 冲。 信号处理模块包括模拟开关切换电路、 一级 放大电路和二级放大滤波电路、 模/数转换电路; 模拟开关切换电路将由多个磁传感器输入的多 路差分电压信号逐路输出到后续电路, 多路信号 共用一组模拟信号调理电路; 一级放大电路、 二 级放大滤波电路将模拟开关切换电路传送来的 微弱信号进行放大和高频滤波; 模/数转换电路 。
3、对经过放大滤波的模拟信号进行模/数转换。 权利要求书3页 说明书7页 附图5页 CN 105919599 A 2016.09.07 CN 105919599 A 1.一种基于磁传感器的手指运动检测识别系统, 其特征在于: 包括信号采集模块、 信号 处理模块、 单片机控制模块、 无线传输模块、 上位机; 所述信号采集模块包括磁源、 信号采集器; 所述磁源为小磁体贴片, 用于贴在手指上; 所述信号采集器包括磁传感器阵列、 置位/复位电路; 所述磁传感器阵列由N个磁传感器组 成, 其中N10; 磁传感器在信号采集器上等间距排列一周; 所述的置位/复位电路用于产生 置位/复位脉冲, 使传感器磁畴方向统。
4、一; 所述的信号处理模块包括模拟信号处理电路、 模/数转换电路; 所述的模拟信号处理电 路包括模拟开关切换电路、 一级放大电路和二级放大滤波电路; 所述的模拟开关切换电路 将由多个磁传感器输入的多路差分电压信号逐路输出到后续电路, 多路信号共用一组模拟 信号调理电路; 一级放大电路、 二级放大滤波电路将模拟开关切换电路传送来的微弱信号 进行放大和高频滤波; 所述模/数转换电路对经过放大滤波的模拟信号进行模/数转换; 所述单片机控制模块包括置位/复位信号控制电路、 一级放大电路增益控制电路、 模/ 数转换芯片信号控制电路、 无线传输信号控制电路; 所述无线传输模块将下位机处理后的 数字信号发送给。
5、上位机, 由上位机进行后续处理及显示; 所述上位机包括计算机和数据库 模块; 所述计算机用于处理数据信号和进行显示; 所述数据库模块用以存储数据。 2.根据权利要求1所述的基于磁传感器的手指运动检测识别系统, 其特征在于: 所述的 一级放大电路具体为可编程仪表放大电路, 将磁传感器阵列输出的微弱信号电压幅值放大 至mV级; 所述的二级放大滤波电路放大增益为32dB; 输出电压幅值范围为: 0.8-5V。 3.根据权利要求1所述的基于磁传感器的手指运动检测识别系统, 其特征在于: 所述的 上位机指安装LABVIEW虚拟仪器开发软件的PC机, 利用LABVIEW虚拟开发软件进行编程接收 无线传输模。
6、块发送来的数据, 并对手部动作进行实时显示, 存储。 4.根据权利要求1所述的基于磁传感器的手指运动检测识别系统, 其特征在于: 所述的 信号采集器为戒指式信号采集器(6)。 5.根据权利要求1所述的基于磁传感器的手指运动检测识别系统, 其特征在于: 所述的 小磁体贴片(1)为5个。 6.一种基于磁传感器的手部运动检测识别方法, 其特征在于: 包括以下步骤: 步骤一: 将小磁体贴片分别粘贴在指甲的表面, 将信号采集器佩戴于中指底部, 打开供 电开关与虚拟开关, 单片机控制模块控制产生置位/复位脉冲, 使磁传感器磁畴方向统一; 步骤二: 磁传感器阵列将采集到的多路信号经过模拟开关切换电路切换输出。
7、至一级放 大电路和二级放大滤波电路进行放大滤波处理, 再经过模/数转换电路传输给单片机控制 模块做预处理; 步骤三: 单片机控制模块对接受的信号建立初始方程, 并建立误差函数, 并将数据通过 无线传输模块发送给上位机; 步骤四: 上位机利用优化算法定位小磁体贴片的位置, 建立手指运动几何模型, 得到手 指姿态方程组, 最后再利用优化算法求解获得整个手指的运动状态, 最终完成手指运动的 检测识别, 在计算机显示器上实时显示。 7.根据权利要求6所述的基于磁传感器的手部运动检测识别方法, 其特征在于: 以定位一个小磁体贴片的位置描述步骤三中所述的初始方程: 权 利 要 求 书 1/3 页 2 CN。
8、 105919599 A 2 式中, l1, 2;0为真空导率, 为4 10-7H/m;(a, b, c)为一个小磁体贴片在某一时刻的位置, (Mn, Mp, Mq)为此小磁体在这一位置的磁矩, (xl, yl, zl)为这一时刻磁传感器的位置作为已知量; 该方程组为多元高次非线性方程组, 要求解 的变量为小磁体贴片的位置坐标(a, b, c)和其磁矩(Mn, Mp, Mq), 其中五个自由变量, 属于超 静定方程组, 采用非线性拟合算法求解。 8.根据权利要求6所述的基于磁传感器的手部运动检测识别方法, 其特征在于: 以定位一个小磁体贴片的位置描述步骤三中所述的误差函数: 式中,0为真空导率。
9、, 为4 10-7H/m;(a, b, c)为一个 小磁体贴片在某一时刻的位置, (Mn, Mp, Mq)为此小磁体在这一位置的磁矩, (xl, yl, zl)为这 一时刻磁传感器的位置作为已知量。 定义目标函数fEx+Ev+Ez, 求解目标函数最小值即可 解得这一个小磁体贴片的位置坐标(a, b, c)和其磁矩(Mn, Mp, Mq)。 9.根据权利要求6所述的基于磁传感器的手部运动检测识别方法, 其特征在于: 步骤四中所述的优化算法具体为PSO算法和L-M算法相结合的算法: 调用一次PSO算法 获得初始值之后利用L-M算法进行连续的定位; 所述PSO算法的数学描述为: 在D维搜索空间中, 。
10、其中D1; 有m个粒子构成一群体, 其中 20m40; 第i个粒子在D维空间中当前位置表示为xi(xi1, xi2, ., xid, ., xiD), 其中1 im, 1dD; 飞行速度为Vi(Vi1, Vi2, ., Vid, ., ViD), 其中1dD; 第i个粒子目前 的最优位置为Pi(Pi1, Pi2, ., Pid, ., PiD), 其中1dD; 群体目前的最优位置为pg (Pg1, Pg2, ., Pgd, ., PgD), 其中1gi, 1dD; 粒子按照以下公式更新位置和飞行速 度; xid(t+1)xid(t)+Vid(t+1); Vid(t+1)Vid(t)+c1r1(。
11、Pid(t)-xid(t)+c2r2(Pgd(t)-xid(t); 权 利 要 求 书 2/3 页 3 CN 105919599 A 3 式中, 1dD, 1im; r1, r2为0, 1之间的随机数; c1, c2为学习因子, 其取值决定了 粒子向自身与向群体学习的能力, 取c1c22; t为粒子更新迭代的次数; 所述L-M算法, 对于一个非线件方程组: 简记为F(x)0; x按下式更新: x(k+1)x(k)+h, 其中k为迭代次数; h为迭代步长, 由下式决定: (JTJ与 I)h-JTf; 式中, ff(x), JJ(x)是f的Jacobian式, JT为J的转置; 比例系数 0为常数。
12、。 10.根据权利要求6所述的基于磁传感器的手部运动检测识别方法, 其特征在于: 步骤四所述的手指姿态方程, 如下: 此方程组中, (a, b, c)为小磁体贴片的位置坐标, (Mn, Mp, Mq)为小磁体的磁矩; 为掌指 关节的内收/外展角度作为已知量; l为掌指关节在Y轴上的坐标作为已知量;分 别为掌指关节、 第二指间关节、 第一指尖关节的屈曲/伸展角度, 是需要求解的量; h1, h2, h3 分别为各指关节之间的距离, 是需要求解的量。 权 利 要 求 书 3/3 页 4 CN 105919599 A 4 基于磁传感器的手指运动检测识别系统及方法 技术领域 0001 本发明涉及一种手。
13、指运动检测识别系统及方法, 尤其涉及一种基于磁传感器的手 指运动检测识别系统及方法。 背景技术 0002 随着计算机在各个领域的不断发展, 传统的二维平面内的如鼠标键盘的人机交互 方式已经不能满足人们的日常需求。 近年来兴起的虚拟现实技术和增强现实技术不断推动 人机交互技术向前发展, 促使我们研究一种更加自然的、 以人为本的人机交互方式。 0003 手是人体最灵活的器官之一, 可以做出大量的动作。 而手势作为一种直观的自然 语言, 具有较强的表达力。 因而将手指动作的检测与识别引入人机交互可以给用户带来更 加逼真的感受, 使用户完全沉浸在虚拟而又真实的环境中, 大大增强互动性与娱乐性。 000。
14、4 当前手指动作检测和识别技术主要有以下方式: 数据手套和计算机视觉。 数据手 套一般采用IMU传感器来直接测量手指关节的角度位置, 可以得到可靠的数据, 具有无遮挡 的优点。 不过其在使用前都需要进行校准动作, 随着使用时长的增加, 会产生较大的误差, 且数据手套较为昂贵, 用户需要佩戴整套传感设备, 使用并不方便。 计算机视觉技术则利用 一个或多个摄像机拍摄手部运动的图像, 而后交由计算机进行图像处理识别, 具有无需穿 戴, 精度高的优点。 不过, 由于手部运动必须限制在摄像机拍摄范围内, 不能进行较大的动 作, 且存在遮挡的问题。 发明内容 0005 为了解决以上问题本发明提供了一种基于。
15、磁传感器的, 能够检测与识别手指运动 的系统及方法, 该系统具有成本低廉、 精确可靠、 实时显示的优点。 0006 为实现上述目的, 本发明提供如下技术方案: 一种基于磁传感器的手指运动检测 识别系统, 其特征在于: 包括信号采集模块、 信号处理模块、 单片机控制模块、 无线传输模 块、 上位机。 0007 所述信号采集模块包括磁源、 信号采集器; 所述磁源为小磁体贴片, 用于贴在手指 上; 所述信号采集器包括磁传感器阵列、 置位/复位电路; 所述磁传感器阵列由N(N10)个 磁传感器组成, 磁传感器在信号采集器上等间距排列一周; 所述的置位/复位电路用于产生 置位/复位脉冲, 使磁传感器磁畴。
16、方向统一, 恢复磁传感器灵敏度。 0008 所述的信号处理模块包括模拟信号处理电路、 模/数转换电路; 所述的模拟信号处 理电路包括模拟开关切换电路、 一级放大电路和二级放大滤波电路; 所述的模拟开关切换 电路将由多个磁传感器输入的多路差分电压信号逐路输出到后续电路, 多路信号共用一组 模拟信号调理电路; 一级放大电路、 二级放大滤波电路将模拟开关切换电路传送来的微弱 信号进行放大和高频滤波; 所述模/数转换电路对经过放大滤波的模拟信号进行模/数转 换。 0009 所述单片机控制模块包括置位/复位信号控制电路、 一级放大电路增益控制电路、 说 明 书 1/7 页 5 CN 105919599 。
17、A 5 模/数转换芯片信号控制电路、 无线传输信号控制电路。 0010 所述无线传输模块将下位机处理后的数字信号发送给上位机, 由上位机进行后续 处理及显示; 所述上位机包括计算机和数据库模块; 所述计算机用于处理数据信号和进行 显示; 所述数据库模块用以存储数据, 所述的数据为检测到的数据和预先存储手势的分类 数据, 以便完成手势识别。 0011 所述的一级放大电路具体为可编程仪表放大电路, 将磁传感器阵列输出的微弱信 号电压幅值放大至mV级; 所述的二级放大滤波电路放大增益为32dB; 输出电压幅值范围为: 0.8-5V。 0012 所述的上位机指安装LABVIEW虚拟仪器开发软件的PC机。
18、, 利用LABVIEW虚拟开发软 件进行编程接收无线传输模块发送来的数据, 并对手部动作进行实时显示, 存储。 0013 所述的信号采集器为戒指式信号采集器。 0014 在戒指式信号采集器的侧面设有供电开关, 控制整个系统的元器件是否工作, 在 上位机的人机交互界面上设有虚拟开关, 控制何时开始建立通信并进行数据采集与处理。 0015 所述的磁体贴片为5个。 0016 一种基于磁传感器的手部运动检测识别方法, 其特征在于: 包括以下步骤: 0017 步骤一: 将小磁体贴片分别粘贴在指甲的表面, 将信号采集器佩戴于中指底部, 打 开供电开关与虚拟开关, 单片机控制模块控制产生置位/复位脉冲, 使。
19、磁传感器磁畴方向统 一, 保证其检测灵敏度。 0018 步骤二: 磁传感器阵列将采集到的多路信号经过模拟开关切换电路切换输出至一 级放大电路和二级放大滤波电路进行放大滤波处理, 再经过模/数转换电路传输给单片机 控制模块做预处理。 0019 步骤三: 单片机控制模块对接受的信号建立初始方程, 并建立误差函数, 并将数据 通过无线传输模块发送给上位机。 0020 步骤四: 上位机利用优化算法定位小磁体贴片的位置, 建立手指运动几何模型, 得 到手指姿态方程组, 最后再利用优化算法求解获得整个手指的运动状态, 最终完成手指运 动的检测识别, 在计算机显示器上实时显示。 0021 以定位一个小磁体贴。
20、片的位置为例, 步骤三中所述的初始方程如下: 0022 0023 0024 0025式中, l1, 2;0为真空导率, 为4 10-7H/m; (a, b, c)为一个小磁体贴片在某一时刻的位置, (Mn, Mp, Mq)为此小磁体在这一位置的磁矩, (xl, yl, zl)为这一时刻磁传感器的位置作为已知量; 该方程组为多元高次非线性方程组, 要 求解的变量为小磁体贴片的位置坐标(a, b, c)和其磁矩(Mn, Mp, Mq), 其中五个自由变量, 属 说 明 书 2/7 页 6 CN 105919599 A 6 于超静定方程组, 采用非线性拟合算法求解。 0026 以定位一个小磁体贴片的。
21、位置为例, 步骤三中所述的误差函数如下: 0027 0028 0029 0030式中,0为真空导率, 为4 10-7H/m;(a, b, c)为 一个小磁体贴片在某一时刻的位置, (Mn, Mp, Mq)为此小磁体在这一位置的磁矩, (xl, yl, zl) 为这一时刻磁传感器的位置作为已知量。 定义目标函数fEx+Ey+Ez, 求解目标函数最小值 即可解得这一个小磁体贴片的位置坐标(a, b, c)和其磁矩(Mn, Mp, Mq); 0031 步骤四中所述的优化算法具体为PSO算法和L-M算法相结合的算法, PSO算法可以 在没有初始值的情况下, 通过智能寻优获得一个较为可靠的初始值, 但该。
22、算法耗时较长。 而 L-M 算法运行较快, 能够满足系统的实时性要求。 所以调用一次PSO算法获得初始值之后利 用L-M算法进行连续的定位。 0032 所述PSO算法的数学描述为: 在D(D1)维搜索空间中, 有m(20m40)个粒子构 成一群体, 第i(1im)个粒子在D维空间中当前位置表示为xi(xi1, xi2, ., xid, ., xiD), (1dD); 飞行速度为Vi(Vi1, Vi2, ., Vid, ., ViD), (1dD); 第i个粒子目前的 最优位置为Pi(Pi1, Pi2, ., Pid, ., PiD), (1dD); 群体目前的最优位置为pg(Pg1, Pg2,。
23、 ., Pgd, ., PgD), (1gi, 1dD)。 粒子按照以下公式更新位置和飞行速度。 0033 xid(t+1)xid(t)+Vid(t+1); 0034 Vid(t+1)Vid(t)+c1r1(Pid(t)-xid(t)+c2r2(Pgd(t)-xid(t); 0035 式中, 1dD, 1im; r1, r2为0, 1之间的随机数; c1, c2为学习因子, 其取值决 定了粒子向自身与向群体学习的能力, 一般取c1c22; t为粒子更新迭代的次数, 一般根 据实际问题人为设定, 这里可取100, 1000。 0036 所述L-M算法, 对于一个非线性方程组: 0037 0038。
24、 简记为F(x)0。 x按下式更新: 0039 x(k+1)x(k)+h, 其中k为迭代次数, 一般人为设定其值, 这里可取100, 1000; h为迭 代步长, 由下式决定: 0040 (JTJ+ I)h-JTf; 0041 式中, ff(x), JJ(x)是f的Jacobian式, JT为J的转置; 比例系数 0为常数。 0042 步骤四中所述的手指运动几何模型可以有不同的类型, 以一种较为简单的手指几 说 明 书 3/7 页 7 CN 105919599 A 7 何模型为例。 如图8, 将掌指关节的内收/外展自由度视为固定值的情况下, 建立此手指运动 几何模型。 根据此前求得的小磁体贴片。
25、的位置坐标(a, b, c)其磁矩(Mn, Mp, Mq)列出手指姿态 方程, 如下: 0043 0044 0045 0046 0047 0048 0049 此方程组中, (a, b, c)为小磁体贴片的位置坐标, (Mn, Mp, Mq)为小磁体的磁矩; 为 掌指关节的内收/外展角度作为已知量;分别为掌指关节、 第二指间关节、 第一 指间关节的屈曲/伸展角度, 是需要求解的量; h1, h2, h3分别为各指关节之间的距离, 是需要 求解的量。 0050 本发明系统及方法通过戒指式信号采集器将采集到的数据进行一系列处理, 最终 由上位机利用优化算法即可逆向求解出手部的运动状态, 无需其他辅助。
26、传感器。 具有检测、 识别、 实时显示手部姿态等功能。 结构简单, 成本低廉, 使用方便, 可应用于手势识别、 机械 外骨骼的控制、 虚拟现实等领域。 附图说明 0051 图1为本发明系统的结构框图; 0052 图2为本发明系统的具体结构原理图; 0053 图3为本发明磁源及戒指式信号采集器佩戴示意图; 0054 图4为本发明中戒指式信号采集器结构示意图; 0055 图5为本发明中上位机所用优化算法流程图。 0056 图6为本发明中所用PS0算法流程图。 0057 图7为本发明中所用L-M算法流程图。 0058 图8为本发明中所建立的手指几何模型示意图。 具体实施方式 0059 下面结合附图对。
27、本发明做进一步详细的说明。 0060 如图1至4所示, 本发明提供了一种基于磁传感器的手指运动检测识别系统, 包括 信号采集模块、 信号处理模块、 单片机控制模块、 无线传输模块、 上位机(计算机和数据库模 块); 0061 所述信号采集模块包括磁源、 信号采集器; 所述磁源为5个小磁体贴片1, 分别粘贴 于五个手指指甲中部表面; 所述戒指式信号采集器6包括磁传感器阵列、 置位/复位电路; 戒 指式信号采集器6佩戴于中指底部, 所述磁传感器阵列由N(N10)个磁传感器组成, 磁传感 器在信号采集器上等间距排列一周。 如图4, a为单个磁传感器; b为N个磁传感器在信号采集 说 明 书 4/7 。
28、页 8 CN 105919599 A 8 器上等间距排列一周所组成的磁传感器阵列; c为供电开关; 所述的置位/复位电路用于产 生置位/复位脉冲, 使磁传感器磁畴方向统一, 恢复磁传感器灵敏度。 0062 所述的信号处理模块包括模拟信号处理电路、 模/数转换电路; 所述的模拟信号处 理电路包括模拟开关切换电路、 一级放大电路和二级放大滤波电路; 所述的模拟开关切换 电路将由多个磁传感器输入的多路差分电压信号逐路输出到后续电路, 多路信号共用一组 模拟信号调理电路; 一级放大电路、 二级放大滤波电路将模拟开关切换电路传送来的微弱 信号进行放大和高频滤波; 所述模/数转换电路对经过放大滤波的模拟信。
29、号进行模/数转 换。 0063 所述单片机控制模块包括置位/复位信号控制电路、 一级放大电路增益控制电路、 模/数转换芯片信号控制电路、 无线传输信号控制电路。 0064 所述无线传输模块将下位机处理后的数字信号发送给上位机, 由上位机进行后续 处理及显示; 0065 所述计算机用于处理数据信号和进行显示; 所述数据库模块用以存储数据, 所述 的数据为检测到的数据和预先存储手势的分类数据, 以便完成手势识别。 0066 所述的一级放大电路具体为可编程仪表放大电路, 将磁传感器阵列输出的微弱信 号电压幅值放大至mV级; 所述的二级放大滤波电路放大增益为32dB; 输出电压幅值范围为: 0.8-5。
30、V。 0067 所述的上位机指安装LABVIEW虚拟仪器开发软件的PC机, 利用LABVIEW虚拟开发软 件进行编程接收无线传输模块发送来的数据, 并对手部动作进行实时显示, 存储。 0068 在戒指式信号采集器6的侧面设有供电开关7, 控制整个系统的元器件是否工作, 在上位机的人机交互界面上设有虚拟开关, 控制何时开始建立通信并进行数据采集与处 理。 0069 一种基于磁传感器的手部运动检测识别方法, 包括以下步骤: 0070 步骤一: 将小磁体贴片分别粘贴在指甲的表面, 将信号采集器佩戴于中指底部, 打 开供电开关与虚拟开关, 单片机控制模块控制产生置位/复位脉冲, 使磁传感器磁畴方向统 。
31、一, 保证其检测灵敏度。 0071 步骤二: 磁传感器阵列将采集到的多路信号经过模拟开关切换电路切换输出至一 级放大电路和二级放大滤波电路进行放大滤波处理, 再经过模/数转换电路传输给单片机 控制模块做 预处理。 0072 步骤三: 单片机控制模块对接受的信号建立初始方程, 并建立误差函数, 并将数据 通过无线传输模块发送给上位机。 0073 步骤四: 上位机利用优化算法定位小磁体贴片的位置, 建立手指运动几何模型, 得 到手指姿态方程组, 最后再利用优化算法求解获得整个手指的运动状态, 最终完成手指运 动的检测识别, 在计算机显示器上实时显示。 0074 以定位一个小磁体贴片的位置为例, 步。
32、骤三中所述的初始方程如下: 0075 说 明 书 5/7 页 9 CN 105919599 A 9 0076 0077 0078式中, l1, 2;0为真空导率, 为4 10-7H/m; (a, b, c)为一个小磁体贴片在某一时刻的位置, (Mn, Mp, Mq)为此小磁体在这一位置的磁矩, (xl, yl, zl)为这一时刻磁传感器的位置作为已知量; 该方程组为多元高次非线性方程组, 要 求解的变量为小磁体贴片的位置坐标(a, b, c)和其磁矩(Mn, Mp, Mq), 其中五个自由变量, 属 于超静定方程组, 采用非线性拟合算法求解。 0079 以定位一个小磁体贴片的位置为例, 步骤三。
33、中所述的误差函数如下: 0080 0081 0082 0083式中,0为真空导率, 为4 10-7H/m;(a, b, c)为 一个小磁体贴片在某一时刻的位置, (Mn, Mp, Mq)为此小磁体在这一位置的磁矩, (xl, yl, zl) 为这一时刻磁传感器的位置作为已知量。 定义目标函数fEx+Ey+Ez, 求解目标函数最小 值 即可解得这一个小磁体贴片的位置坐标(a, b, c)和其磁矩(Mn, Mp, Mq); 0084 步骤四中所述的优化算法具体为PSO算法和L-M算法相结合的算法, 流程图如图5 所示。 PSO算法可以在没有初始值的情况下, 通过智能寻优获得一个较为可靠的初始值, 。
34、但 该算法耗时较长。 而L-M算法运行较快, 能够满足系统的实时性要求。 所以调用一次PSO算法 获得初始值之后利用L-M算法进行连续的定位。 0085 所述PSO算法的数学描述为: 在D(D1)维搜索空间中, 有m(20m40)个粒子构 成一群体, 第i(1im)个粒子在D维空间中当前位置表示为xi(xi1, xi2, ., xid, ., xiD), (1dD); 飞行速度为Vi(Vi1, Vi2, ., Vid, ., ViD), (1dD); 第i个粒子目前的 最优位置为Pi(Pi1, Pi2, ., Pid, ., PiD), (1dD); 群体目前的最优位置为pg(Pg1, Pg2。
35、, ., Pgd, ., PgD), (1gi, 1dD)。 粒子按照以下公式更新位置和飞行速度。 0086 xid(t+1)xid(t)+Vid(t+1); 0087 Vid(t+1)Vid(t)+c1r1(Pid(t)-xid(t)+c2r2(Pgd(t)-xid(t); 0088 式中, 1dD, 1im; r1, r2为0, 1之间的随机数; c1, c2为学习因子, 其取值决 定了粒子向自身与向群体学习的能力, 一般取c1c22; t为粒子更新迭代的次数, 一般根 据实际问题人为设定, 这里可取100, 1000。 0089 PSO算法流程图如图6所示。 说 明 书 6/7 页 10。
36、 CN 105919599 A 10 0090 所述L-M算法, 对于一个非线性方程组: 0091 0092 简记为F(x)0。 x按下式更新: 0093 x(k+1)x(k)+h, 其中k为迭代次数, 一般人为设定其值, 这里可取100, 1000; h为迭 代步长, 由下式决定: 0094 (JTJ+ I)h-JTf; 0095 式中, ff(x), JJ(x)是f的Jacobian式, JT为J的转置; 比例系数 0为常数。 。 0096 L-M算法流程图如图7所示。 0097 步骤四中所述的手指运动几何模型可以有不同的类型, 以一种较为简单的手指几 何模型为例。 如图8, 将掌指关节的。
37、内收/外展自由度视为固定值的情况下, 建立此手指运动 几何模型。 根据此前求得的小磁体贴片的位置坐标(a, b, c)其磁矩(Mn, Mp, Mq)列出手指姿态 方程, 如下: 0098 0099 0100 0101 0102 0103 0104 此方程组中, (a, b, c)为小磁体贴片的位置坐标, (Mn, Mp, Mq)为小磁体的磁矩; 为 掌指关节的内收/外展角度作为已知量;分别为掌指关节、 第二指间关节、 第一 指间关节的屈曲/伸展角度, 是需要求解的量; h1, h2, h3分别为各指关节之间的距离, 是需要 求解的量。 0105 以上所述仅为本发明的优选实施例而已, 并不限制于。
38、本发明, 对于本领域的技术 人员来说, 本发明可以有各种更改和变化。 凡在本发明的精神和原则之内, 所作的任何修 改、 等同替换、 改进等, 均应包含在本发明的权利要求范围之内。 说 明 书 7/7 页 11 CN 105919599 A 11 图1 图2 说 明 书 附 图 1/5 页 12 CN 105919599 A 12 图3 图4 图5 说 明 书 附 图 2/5 页 13 CN 105919599 A 13 图6 说 明 书 附 图 3/5 页 14 CN 105919599 A 14 图7 说 明 书 附 图 4/5 页 15 CN 105919599 A 15 图8 说 明 书 附 图 5/5 页 16 CN 105919599 A 16 。