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

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

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


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

技术介绍

[0002]社交能力是一个人是否具备善于与他人交往的能力，是衡量一个人能否适应现代社会需求的标准之一。社交能力包括人际感受能力、人事记忆力、人际理解力、人际相像力、风度和表达力以及合作能力与协调能力。缺乏社交能力的人通常很难与他人协调和沟通，这给他们的生活带来了很大的不便。儿童缺乏社交能力则会降低自信心，使他们变得自闭，不利于身心健康发展。现阶段，主要是通过心理辅导或药物辅助的方法来诱导社交能力，这种方法存在花费成本高，药物存在副作用的问题。
[0003]社会心理学中的相似理论表明，人们更喜欢与具有相似形态、逻辑和行为特征的人互动，并且他们倾向于无意识地协调自己的行为。研究表明，人际协调过程与心理联系密切相关，两人之间的运动协同作用有望促进社会联系。研究人员发现，人类在与虚拟伙伴以领导
‑
跟随模式进行移动合作实验后，会学习到合作行为：当虚拟伙伴不再引导他/她的移动时，参与者仍能很好本文档来自技高网...

【技术保护点】

【技术特征摘要】
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所述的生物启发式二维肢体协同控制方法，其特征在于，所述状态误差大于或等于所述误差阈值的表达式为：...

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