发明名称 一种支持增强力触觉反馈的涡卷弹簧模型
摘要 本发明提出了一种支持增强力触觉反馈的涡卷弹簧模型,所述涡卷弹簧模型由多个涡卷弹簧依次串接组成,在交互过程中,输出回馈为采用涡卷弹簧模型计算出来的反应在压力作用下柔性体实时变形仿真的力触觉信息的信号,该涡卷弹簧模型中所有层上产生压缩变形量之和的叠加对外等效为柔性体表面的变形。本发明涡卷弹簧模型每层涡卷弹簧的压缩变形量计算方法相同,计算简单,加快了压缩变形计算的速度;通过调节涡卷弹簧第一层半径,涡卷弹簧的节距和涡卷弹簧丝的直径等,就可模拟不同类型的柔性体,适用性广;可应用于虚拟外科手术仿真、遥控操作机器人控制、远程医疗等领域。
申请公布号 CN104063540A 申请公布日期 2014.09.24
申请号 CN201410256000.8 申请日期 2014.06.10
申请人 南京信息工程大学 发明人 张小瑞;黄昆;孙伟;宋爱国;牛建伟;张小娜;金炎
分类号 G06F17/50(2006.01)I 主分类号 G06F17/50(2006.01)I
代理机构 南京经纬专利商标代理有限公司 32200 代理人 朱小兵
主权项 一种支持增强力触觉反馈的涡卷弹簧模型,其特征在于,包括如下步骤:步骤1,对虚拟场景进行初始化;步骤2,在检测到虚拟代理碰撞到虚拟柔性体之前,即在靠近虚拟柔性体的过程中,反馈输出有色状态噪声信号η(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为时间;步骤3,当检测到虚拟代理碰撞到虚拟柔性体表面上任何一点时,在给定虚拟外力F作用下,虚拟代理与虚拟柔性体交互的局部区域内部,填充支持力触觉反馈的涡卷弹簧模型;在交互过程中,虚拟柔性体产生实时变形力触觉信息,该力触觉信息与有色状态噪声信号相加,作为反馈输出信号;所述涡卷弹簧模型的建模建模步骤如下:步骤3‑1,建立空间直角坐标系,确定柔性体表面上任意点处安放的涡卷弹簧模型,其过程如下:步骤3‑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空间坐标系;步骤3‑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="FDA0000518333050000021.GIF" wi="770" he="156" /></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="FDA0000518333050000022.GIF" wi="642" he="156" /></maths>其中,ρ是等差数列的公差,为实数;涡卷弹簧每层的截面惯性矩均为<img file="FDA0000518333050000023.GIF" wi="199" he="135" />涡卷弹簧各层的挠度值相同,挠度值为X′,弹性模量E取决于柔性体的材质,且柔性体的材质均相同;步骤3‑2,确定涡卷弹簧任一层所消耗的外力,假定给定虚拟外力F的作用线与涡卷弹簧中心线一致,且在给定虚拟外力F作用下,如果涡卷弹簧共有前C层产生变形,则第C层称为变形截止层;被拉伸或压缩时,变形截止层产生的变形量不大于挠度值X′,涡卷弹簧前C‑1层中,任意一层的变形量均等于挠度值X′;步骤3‑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="FDA0000518333050000024.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><msup><msub><mrow><mn>8</mn><mi>R</mi></mrow><mi>i</mi></msub><mn>3</mn></msup></mfrac><mrow><mo>(</mo><mi>d</mi><mo>-</mo><mi>h</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000518333050000031.GIF" wi="342" he="148" /></maths>其中,G表示该涡卷弹簧的切变模量,2≤i≤C‑1;步骤3‑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="FDA0000518333050000032.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="FDA0000518333050000033.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="FDA0000518333050000034.GIF" wi="267" he="141" /></maths>步骤3‑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="FDA0000518333050000035.GIF" wi="330" he="213" /></maths>步骤3‑4,将涡卷弹簧变形量相加,所得变形量之和X等效为虚拟柔性体表面的变形:<img file="FDA0000518333050000036.GIF" wi="1091" he="299" />
地址 210044 江苏省南京市浦口区宁六路219号