发明名称 一种支持增强力触觉反馈的涡卷弹簧仿真系统
摘要 本发明公开了一种支持增强力触觉反馈的涡卷弹簧仿真系统,其特征是采用一种支持增强力触觉反馈的涡卷弹簧模型,在交互过程中,虚拟柔性体产生实时变形力触觉信息,该力触觉信息与有色状态噪声信号相加,作为反馈输出信号。本发明系统采用的涡卷弹簧每层的拉伸或压缩变形量计算方法相同,计算简单,加快了变形计算速度,能够保证变形仿真具有较高精度,通过调节涡卷弹簧第一层半径,任意两层弹簧之间的间距和弹簧丝的直径等,就可模拟不同类型的柔性体;加入的有色状态噪声信号能提高人的力触觉感知能力;为开发基于力触交互的虚拟手术平台提供了解决思路。
申请公布号 CN104063057A 申请公布日期 2014.09.24
申请号 CN201410255686.9 申请日期 2014.06.10
申请人 南京信息工程大学 发明人 张小瑞;曹燚;孙伟;宋爱国;牛建伟;张小娜
分类号 G06F3/01(2006.01)I;G06F19/00(2011.01)I;A61B19/00(2006.01)I 主分类号 G06F3/01(2006.01)I
代理机构 南京经纬专利商标代理有限公司 32200 代理人 朱小兵
主权项 一种支持增强力触觉反馈的涡卷弹簧仿真系统,其特征在于,包括:计算机主机(2)和力触觉交互设备(3),在计算机主机(2)上连接有显示器(1),所述计算机主机(2)至少包括硬盘(24)和1394卡(23),其特征在于,所述硬盘(24)至少包括:用于检测虚拟代理位置的位置检测模块(241)、用于检测虚拟代理与虚拟柔性体碰撞的碰撞检测模块(242)、力触觉计算变形模块(243)、根据力触觉计算变形模块(243)输出的最新力触觉变形信息进行图形显示的图形刷新模块(244)及力触觉信息反馈模块(245),所述硬盘(24)通过1394卡(23)及1394连接线与力触觉交互设备(3)连接,用于将力触觉计算变形模块(243)产生的柔性体表面的变形信息传输至力触觉交互设备(3),所述力触觉计算变形模块(243)用于在检测到虚拟代理碰撞到虚拟柔性体表面上任何一点时,在给定虚拟外力F作用作用下,虚拟代理与虚拟柔性体交互的局部区域内部,填充支持力触觉反馈的涡卷弹簧模型;在交互过程中,虚拟柔性体产生实时变形力触觉信息,该力触觉信息与有色状态噪声信号η(t)相加,作为反馈输出信号;所述涡卷弹簧模型的建模步骤如下:步骤1,建立空间直角坐标系,确定柔性体表面上任意点处安放的涡卷弹簧模型,其过程如下:步骤1‑1,建立空间直角坐标系,在给定虚拟外力F作用下,在柔性体表面任意点O<sub>1</sub>处安放一涡卷弹簧,在距离任意点O<sub>1</sub>为r处,取涡卷弹簧第一层的一个外侧点P<sub>0</sub>,即r为涡卷弹簧第一层的半径,以任意点O<sub>1</sub>为原点,射线O<sub>1</sub>P<sub>0</sub>所在方向为X轴正方向,建立XYZ空间坐标系;步骤1‑2,按层设置涡卷弹簧,涡卷弹簧任意两层的间距均为d,涡卷弹簧每层弹簧丝的直径均为h;所述涡卷弹簧的总层数包含两种,分别是奇数和偶数,令n=1,2,3……S,S为自然数;则所述涡卷弹簧具体描述如下:A.当该涡卷弹簧总层数为奇数时,设层数为2n+1,在Z轴上等间距取2n+1个点,分别为O<sub>1</sub>,O<sub>2</sub>,…,O<sub>i</sub>,…,O<sub>2n</sub>,O<sub>2n+1</sub>,间距为d;以O<sub>i</sub>为圆心,设置涡卷弹簧第i层,且该涡卷弹簧第i层的半径为R<sub>i</sub>,其表达式如下:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>R</mi><mi>i</mi></msub><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mi>r</mi><mo>+</mo><mrow><mo>(</mo><mi>i</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mi>&rho;</mi></mtd><mtd><mi>i</mi><mo>&le;</mo><mi>n</mi><mo>+</mo><mn>1</mn></mtd></mtr><mtr><mtd><mi>r</mi><mo>+</mo><mrow><mo>(</mo><mn>2</mn><mi>n</mi><mo>-</mo><mi>i</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>&rho;</mi></mtd><mtd><mi>i</mi><mo>></mo><mi>n</mi><mo>+</mo><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000518332840000021.GIF" wi="770" he="152" /></maths>B.当该涡卷弹簧总层数为偶数时,设层数为2n,则在Z轴上等间距取2n个点,分别为O<sub>1</sub>,O<sub>2</sub>,…,O<sub>i</sub>,…,O<sub>2n‑1</sub>,O<sub>2n</sub>,间距为d;以O<sub>i</sub>为圆心,设置涡卷弹簧第i层,且该涡卷弹簧第i层的半径为R<sub>i</sub>,其表达式如下:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>R</mi><mi>i</mi></msub><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mi>r</mi><mo>+</mo><mrow><mo>(</mo><mi>i</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mi>&rho;</mi></mtd><mtd><mi>i</mi><mo>&le;</mo><mi>n</mi></mtd></mtr><mtr><mtd><mi>r</mi><mo>+</mo><mrow><mo>(</mo><mn>2</mn><mi>n</mi><mo>-</mo><mi>i</mi><mo>)</mo></mrow><mi>&rho;</mi></mtd><mtd><mi>i</mi><mo>></mo><mi>n</mi></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000518332840000022.GIF" wi="642" he="155" /></maths>其中,ρ是等差数列的公差,为实数;涡卷弹簧每层的截面惯性矩均为<img file="FDA0000518332840000023.GIF" wi="196" he="135" />涡卷弹簧各层的挠度值相同,挠度值为X′,弹性模量E取决于柔性体的材质,且柔性体的材质均相同;步骤2,确定涡卷弹簧任一层所消耗的外力,假定给定虚拟外力F的作用线与涡卷弹簧中心线一致,且在给定虚拟外力F作用下,如果涡卷弹簧共有前C层产生变形,则第C层称为变形截止层;被拉伸或压缩时,变形截止层产生的变形量不大于挠度值X′,涡卷弹簧前C‑1层中,任意一层的变形量均等于挠度值X′;步骤2‑1,确定涡卷弹簧前C‑1层消耗的外力,涡卷弹簧第一层消耗的外力F<sub>1</sub>为:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>F</mi><mn>1</mn></msub><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><msup><mi>X</mi><mo>&prime;</mo></msup><mo>&CenterDot;</mo><msub><mi>K</mi><mn>1</mn></msub></mtd><mtd><mi>C</mi><mo>></mo><mn>1</mn></mtd></mtr><mtr><mtd><mi>F</mi></mtd><mtd><mi>C</mi><mo>=</mo><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000518332840000024.GIF" wi="474" he="157" /></maths>其中,K<sub>1</sub>表示涡卷弹簧第一层的刚度系数;除第一层和变形截止层第C层外,涡卷弹簧第i层消耗的外力F<sub>i</sub>为:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mi>F</mi><mi>i</mi></msub><mo>=</mo><mfrac><msup><mi>Gh</mi><mn>4</mn></msup><mrow><mn>8</mn><msup><msub><mi>R</mi><mi>i</mi></msub><mn>3</mn></msup></mrow></mfrac><mrow><mo>(</mo><mi>d</mi><mo>-</mo><mi>h</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000518332840000025.GIF" wi="342" he="148" /></maths>其中,G表示该涡卷弹簧的切变模量,2≤i≤C‑1;步骤2‑2,确定涡卷弹簧第一层和变形截止层第C层的刚度系数,分别表示为K<sub>1</sub>和K<sub>C</sub>;其表达式分别如下:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>K</mi><mn>1</mn></msub><mo>=</mo><mfrac><mi>EI</mi><msub><mi>l</mi><mn>1</mn></msub></mfrac></mrow>]]></math><img file="FDA0000518332840000031.GIF" wi="186" he="139" /></maths><maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>K</mi><mi>C</mi></msub><mo>=</mo><mfrac><mi>EI</mi><msub><mi>l</mi><mi>C</mi></msub></mfrac></mrow>]]></math><img file="FDA0000518332840000032.GIF" wi="198" he="139" /></maths>其中,l<sub>1</sub>、l<sub>C</sub>分别为该涡卷弹簧第一层和变形截止层的工作长度,其计算式分别如下:l<sub>1</sub>=2πR<sub>1</sub><maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>l</mi><mi>C</mi></msub><mo>=</mo><mn>2</mn><mi>&pi;</mi><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>C</mi></munderover><msub><mi>R</mi><mi>i</mi></msub></mrow>]]></math><img file="FDA0000518332840000033.GIF" wi="267" he="141" /></maths>步骤3,涡卷弹簧变形截止层产生拉伸或压缩的变形量为X<sub>C</sub>,其计算公式为:<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><msub><mi>X</mi><mi>C</mi></msub><mo>=</mo><mfrac><mrow><mi>F</mi><mo>-</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mrow><mi>C</mi><mo>-</mo><mn>1</mn></mrow></munderover><msub><mi>F</mi><mi>i</mi></msub></mrow><msub><mi>K</mi><mi>C</mi></msub></mfrac></mrow>]]></math><img file="FDA0000518332840000034.GIF" wi="330" he="212" /></maths>步骤4,将涡卷弹簧变形量相加,所得变形量之和X等效为虚拟柔性体表面的变形:<img file="FDA0000518332840000035.GIF" wi="1086" he="298" />步骤5,所述有色状态噪声信号η(t),其表达式为:η(t)=D(q<sup>‑1</sup>)/C(q<sup>‑1</sup>)ξ(t)式中,D(q<sup>‑1</sup>)、C(q<sup>‑1</sup>)分别表示单位滞后算子q<sup>‑1</sup>的多项式,其表达式分别为:D(q<sup>‑1</sup>)=1+D<sub>1</sub>q<sup>‑1</sup>+D<sub>2</sub>q<sup>‑2</sup>+D<sub>3</sub>q<sup>‑3</sup>C(q<sup>‑1</sup>)=1+C<sub>1</sub>q<sup>‑1</sup>+C<sub>2</sub>q<sup>‑2</sup>其中,D<sub>1</sub>、D<sub>2</sub>、D<sub>3</sub>、C<sub>1</sub>、C<sub>2</sub>皆是常数;ξ(t)是零均值白噪声,t为时间。
地址 210044 江苏省南京市浦口区宁六路219号