生物启发式二维肢体协同控制方法及系统技术方案

本发明专利技术涉及自动控制领域，提供一种生物启发式二维肢体协同控制方法及系统，包括：S1：构建二维画板，用户在所述二维画板上画“∞”型轨迹；S2：机器人获取用户的手部运动轨迹，通过差分法对所述手部运动轨迹进行估计，获得速度位置时间序列；S3：通过所述速度位置时间序列和所述手部运动轨迹对机器人的运动模型进行调节，使机器人跟随用户的手部运动轨迹进行运动；S4：通过机器人进行跟随运动的轨迹判断用户的交互能力情况。本发明专利技术通过用户和机器人在二维平面上的交互运动，能够更好的激发用户产生更丰富复杂的运动与交互形式，更有利于用户恢复正常的社交能力。恢复正常的社交能力。恢复正常的社交能力。

【技术实现步骤摘要】
生物启发式二维肢体协同控制方法及系统


[0001]本专利技术涉及自动控制领域，尤其涉及一种生物启发式二维肢体协同控制方法及系统。

技术介绍

[0002]社交能力是一个人是否具备善于与他人交往的能力，是衡量一个人能否适应现代社会需求的标准之一。社交能力包括人际感受能力、人事记忆力、人际理解力、人际相像力、风度和表达力以及合作能力与协调能力。缺乏社交能力的人通常很难与他人协调和沟通，这给他们的生活带来了很大的不便。儿童缺乏社交能力则会降低自信心，使他们变得自闭，不利于身心健康发展。现阶段，主要是通过心理辅导或药物辅助的方法来诱导社交能力，这种方法存在花费成本高，药物存在副作用的问题。
[0003]社会心理学中的相似理论表明，人们更喜欢与具有相似形态、逻辑和行为特征的人互动，并且他们倾向于无意识地协调自己的行为。研究表明，人际协调过程与心理联系密切相关，两人之间的运动协同作用有望促进社会联系。研究人员发现，人类在与虚拟伙伴以领导
‑
跟随模式进行移动合作实验后，会学习到合作行为：当虚拟伙伴不再引导他/她的移动时，参与者仍能很好地互动。因此，社交能力的提升可以通过两个人之间的合作和联合行动来实现，这为一种新的儿童社交能力训练方法提供了思路：通过运动协同促进儿童的社会互动。本质上，它旨在开发一种新的训练方法，设计一个虚拟伙伴与儿童互动，同时通过调整虚拟伙伴的运动相似性来保持与儿童的一定程度的协调，因此，后者可以无意识地被引导到一些所需的运动特征，以提高儿童的社交能力。该方法可以为受训练儿童生成定制的虚拟交互伙伴，方案更个性化，成本更低。
[0004]上述新型社交能力提升方法在现有实践中仍存在一些不足之处：虚拟人和儿童的交互是在水平两端点间的来回运动，这种一维的运动形式较为单一，不利于二者长期的交互，可能导致训练效果不明显；目前研究人员在设计控制器时，没有考虑生物启发(即人体中枢神经系统对运动的调控机制)，因此可能出现交互不自然的情况。
[0005]上述内容仅用于辅助理解本专利技术的技术方案，并不代表承认上述内容是现有技术。

技术实现思路

[0006]为解决上述技术问题，本专利技术提供一种生物启发式二维肢体协同控制方法，包括：
[0007]S1：构建二维画板，用户在所述二维画板上画“∞”型轨迹；
[0008]S2：机器人获取用户的手部运动轨迹，通过差分法对所述手部运动轨迹进行估计，获得速度位置时间序列；
[0009]S3：通过所述速度位置时间序列和所述手部运动轨迹对机器人的运动模型进行调节，使机器人跟随用户的手部运动轨迹进行运动；
[0010]S4：通过机器人进行跟随运动的轨迹判断用户的交互能力情况。
[0011]优选的，所述二维画板为二维平面坐标系，横坐标为x轴，纵坐标为y轴。
[0012]优选的，所述速度位置时间序列的计算公式为：
[0013][0014]其中，t为时刻，h为采样间隔时间；x
hp
(t)为t时刻x方向上用户的当前位置，为t时刻x方向上用户的当前速度，y
hp
(t)为t时刻y方向上用户的当前位置，为t时刻y方向上用户的当前速度；x
hp
(t+h)为t+h时刻x方向上用户的当前位置，y
hp
(t+h)为t+h时刻y方向上用户的当前位置。
[0015]优选的，步骤S3具体为：
[0016]S31：通过所述速度位置时间序列和所述手部运动轨迹，计算获得调节运动幅度和调节频率；
[0017]S32：设置误差阈值，计算获得用户与机器人之间的状态误差；
[0018]S33：若所述状态误差大于或等于所述误差阈值，则机器人的运动模型按照所述调节运动幅度和所述调节频率进行一次调节，否则运动模型不变化。
[0019]优选的，调节运动幅度和调节频率的计算公式为：
[0020][0021]其中，t为时刻，x
vp
(t)为t时刻x方向上机器人的当前位置，为t时刻x方向上机器人的当前速度；y
vp
(t)为t时刻y方向上机器人的当前位置，为t时刻y方向上机器人的当前速度；x
hp
(t)为t时刻x方向上用户的当前位置，为t时刻x方向上用户的当前速度；y
hp
(t)为t时刻y方向上用户的当前位置，为t时刻y方向上用户的当前速度；为t时刻的调节频率，为t时刻的调节运动幅度；K1和K2为反馈增益，均为正值。
[0022]优选的，所述状态误差大于或等于所述误差阈值的表达式为：
[0023][0024]其中，t
k
是控制触发时刻，t
k+1
是下一次控制触发时刻，t0是初始时刻；s
vp
(t
k
)＝x
vp
(t
k
)+y
vp
(t
k
)是第k次控制触发时刻机器人x和y方向上的当前位置之和，s
vp
(t)＝x
vp
(t)+y
vp
(t)是t时刻机器人x和y方向上的理想位置之和，t∈(t
k
,t
k+1
]；x
vp
为x方向上机器人的当前位置，y
vp
为y方向上机器人的当前位置；α和δ均为控制参数，α和δ的取值均为正数。
[0025]优选的，所述机器人的运动模型的表达式为：
[0026][0027]其中，t为时刻，x
vp
(t)为t时刻x方向上机器人的当前位置，y
vp
(t)为t时刻y方向上机器人的当前位置，A(t)为t时刻机器人的运动幅度，ω(t)为t时刻机器人的运动频率。
[0028]优选的，步骤S4具体为：
[0029][0030][0031]其中，i表示采样点的编号，n是采样点的总数；x
vp,i
是x方向上机器人第i个采样点的位置；y
vp,i
是y方向上机器人第i个采样点的位置；x
hp,i
是x方向上用户第i个采样点的位置；y
hp,i
是y方向上用户第i个采样点的位置；RMSE表示机器人与用户轨迹的时间对应性；ΔΦ
i
是用户和机器人的运动轨迹在第i个采样点的相位差；CV衡量了用户和机器人的轨迹的运动协调水平。
[0032]一种生物启发式二维肢体协同控制系统，包括：
[0033]画板构建模块，用于构建二维画板，用户在所述二维画板上画“∞”型轨迹；
[0034]速度位置时间序列获取模块，用于机器人获取用户的手部运动轨迹，通过差分法对所述手部运动轨迹进行估计，获得速度位置时间序列；
[0035]机器人运动模块，用于通过所述速度位置时间序列和所述手部运动轨迹对机器人的运动模型进行调节，使机器人跟随用户的手部运动轨迹进行运动。
[00本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种生物启发式二维肢体协同控制方法，其特征在于，包括：S1：构建二维画板，用户在所述二维画板上画“∞”型轨迹；S2：机器人获取用户的手部运动轨迹，通过差分法对所述手部运动轨迹进行估计，获得速度位置时间序列；S3：通过所述速度位置时间序列和所述手部运动轨迹对机器人的运动模型进行调节，使机器人跟随用户的手部运动轨迹进行运动；S4：通过机器人进行跟随运动的轨迹判断用户的交互能力情况。2.根据权利要求1所述的生物启发式二维肢体协同控制方法，其特征在于，所述二维画板为二维平面坐标系，横坐标为x轴，纵坐标为y轴。3.根据权利要求1所述的生物启发式二维肢体协同控制方法，其特征在于，所述速度位置时间序列的计算公式为：其中，t为时刻，h为采样间隔时间；x
hp
(t)为t时刻x方向上用户的当前位置，为t时刻x方向上用户的当前速度，y
hp
(t)为t时刻y方向上用户的当前位置，为t时刻y方向上用户的当前速度；x
hp
(t+h)为t+h时刻x方向上用户的当前位置，y
hp
(t+h)为t+h时刻y方向上用户的当前位置。4.根据权利要求1所述的生物启发式二维肢体协同控制方法，其特征在于，步骤S3具体为：S31：通过所述速度位置时间序列和所述手部运动轨迹，计算获得调节运动幅度和调节频率；S32：设置误差阈值，计算获得用户与机器人之间的状态误差；S33：若所述状态误差大于或等于所述误差阈值，则机器人的运动模型按照所述调节运动幅度和所述调节频率进行一次调节，否则运动模型不变化。5.根据权利要求4所述的生物启发式二维肢体协同控制方法，其特征在于，调节运动幅度和调节频率的计算公式为：其中，t为时刻，x
vp
(t)为t时刻x方向上机器人的当前位置，为t时刻x方向上机器人的当前速度；y
vp
(t)为t时刻y方向上机器人的当前位置，为t时刻y方向上机器人的当前速度；x
hp
(t)为t时刻x方向上用户的当前位置，为t时刻x方向上用户的当前速度；y
hp
(t)为t时刻y方向上用户的当前位置，为t时刻y方向上用户的当前速度；为t时
刻的调节频率，为t时刻的调节运动幅度；K1和K2为反馈增益，均为正值。6.根据权利要求4所述的生物启发式二维肢体协同控制方法，其特征在于，所述状态误差大于或等于所述误差阈值的表达式为：...

【专利技术属性】
技术研发人员：翟超，郭博文，
申请(专利权)人：中国地质大学武汉，
类型：发明
国别省市：