Login| Sign Up| Help| Contact|

Patent Searching and Data


Title:
MECHANISM OF ONE-LEGGED ROBOT ENABLING JUMPING ON WALL SURFACE, AND CONTROL METHOD
Document Type and Number:
WIPO Patent Application WO/2020/173098
Kind Code:
A1
Abstract:
A mechanism of a one-legged robot enabling jumping on a wall surface and a control method. The mechanism comprises a robot leg. Multiple rotary blades are fixedly connected to a leg body (1) of the robot leg. The multiple rotary blades are positioned in a mirrored arrangement relative to the leg body (1), and working surfaces thereof are parallel to one another. Provision of a rotary blade mechanism enables active control of a path of the center of mass and an orientation of a robot in the air. Combination of the control method and the mechanism disclosed in the present invention enables a robot to continuously jump on a vertical wall surface, such that the robot is applicable to more scenarios and has improved movement capability.

Inventors:
ZHU QIUGUO (CN)
ZHAO YIDONG (CN)
WU JUN (CN)
XIONG RONG (CN)
Application Number:
PCT/CN2019/110519
Publication Date:
September 03, 2020
Filing Date:
October 11, 2019
Export Citation:
Click for automatic bibliography generation   Help
Assignee:
UNIV ZHEJIANG (CN)
International Classes:
B62D57/02
Foreign References:
CN109850025A2019-06-07
CN102815349A2012-12-12
CN106184453A2016-12-07
CN103264733A2013-08-28
CN201784421U2011-04-06
CN2312160Y1999-03-31
CN103879470A2014-06-25
ES2209617A12004-06-16
US8205694B22012-06-26
Attorney, Agent or Firm:
HANGZHOU QIUSHI PATENT OFFICE CO., LTD. (CN)
Download PDF:
Claims:
权 利 要 求 书

1.一种墙面跳跃的单腿机器人机构, 其特征在于, 包括机器人腿部等, 所述机器人腿部 的机身上固接有多个旋翼,多个旋翼相对于机身呈镜像分布,且多个旋翼的工作面相互平行。

2.根据权利要 1 所述的一种墙面跳跃的单腿机器人机构, 其特征在于, 所述机身内部安 装有控制器与陀螺仪, 陀螺仪和多个旋翼均与控制器相连。

3.根据权利要 1 所述的一种墙面跳跃的单腿机器人机构, 其特征在于, 多个旋翼的数量 为四个, 分别即为左上旋翼、 右上旋翼、 左下旋翼、 右下旋翼。

4.根据权利要 3所述的一种墙面跳跃的单腿机器人机构, 其特征在于, 所述机器人腿部 包括依次铰接的机身、 大腿、 小腿和足部, 所述机身与大腿的铰接处设有驱动大腿旋转的髋 关节, 所述大腿上设有驱动小腿转动的膝关节, 所述小腿上设有驱动足部转动的踝关节, 所 述髋关节、 膝关节和踝关节均与控制器相连。

5.根据权利要 4所述的一种墙面跳跃的单腿机器人机构, 其特征在于, 所述足部底部安 装有摩擦因数大于 0.5的材料。

6.根据权利要求 5所述的一种墙面跳跃的单腿机器人机构的控制方法, 其特征在于, 该 方法包括发力阶段、 滞空阶段、 收缩阶段三个过程;

在墙面跳跃过程中, 发力阶段是足部蹬踏墙面, 髋关节、 膝关节与踝关节主动工作的阶 段; 发力阶段中, 单腿机器人机构通过给墙面压力以及借助足部与墙面的摩擦力, 给单腿机 器人机构提供向上以及远离墙面的推力, 此阶段中通过上下旋翼不同的转速来提供对身体的 扭矩, 以平衡因足部蹬踏对身体产生的扰动扭矩, 维持身体的平衡; 发力阶段中, 安装在身 体中的陀螺仪监控机器人的姿态与速度信息, 进而通过调整足部蹬踏墙面以及旋翼的转速维 持身体平衡;

滞空阶段是机器人足部不接触墙面, 机器人整体滞空的阶段; 滞空阶段中, 根据陀螺仪 反馈身体姿态, 同时左上旋翼、 右上旋翼、 左下旋翼、 右下旋翼配合对单腿机器人机构施加 向墙面的推力, 使质心获得向墙面的加速度; 同时, 髋关节、 膝关节、 踝关节协同运动, 一 方面需要克服重力矩的影响, 另一方面需根据垂直速度选择合适的落脚点位置;

收缩阶段是足部再次接触墙面之后, 髋关节、 膝关节与踝关节触墙被动收缩, 单腿机器 人机构的质心在水平方向上减速的过程; 收缩阶段中, 当足部接触墙面之后, 根据陀螺仪的 数据反馈机器人的身体姿态, 同时左上旋翼、 右上旋翼、 左下旋翼、 右下旋翼调整转速, 以 平衡墙面对足部冲击带来的对单腿机器人机构质心造成的扭矩, 保持身体的平衡, 直到腿部 被压缩到设定的极限点, 进入发力阶段; 如此循环, 可实现单腿机器人机构在墙面的连续跳跃。

Description:
一种墙面跳跃的单腿机器人机构及控制方法

技术领域

本发明涉及机器人技术领域, 具体涉及一种墙面跳跃的单腿机器人机构及控 制方法。 背景技术

随着科技的进步, 机器人时代正在向我们走来。腿足机器人是目 前机器人领域的主要研 宄热点之一, 如何实现腿足机器人的快速跑跳等已经成为机 器人技术领域的研宄重点。 人体 腿部能够实现行走和跳跃等运动, 对腿足机器人提升其运动性能有重要的借鉴意 义。 目前, 世界上对腿足机器人的研究主要集中在平面上 的步行、 跑跳和爬行等功能, 尚未对腿足机器 人翻越垂直的墙面等障碍有深入的研究。 然后, 这种机器人在特殊的场合却有着重要的应用 价值。

单腿机器人是腿式机器人中结构最简单的机器 人, 具有动力学模型简单、 干扰较少、 研 宄成本低和周期短的优点。 通过设计单腿机器人机构, 可以更好地了解腿式机器人的结构特 点和运动特性。

如授权公告号为 CN106005079A 的专利文献公开的一种带主动脚踝关节与仿生 足部的 单腿机器人跳跃机构,解决了现有技术对机器 人跳跃中蓄能能力弱,不能实现髋膝协同工作 , 以及无法保护踝关节电机免受跳跃中冲击的问 题。 但该单腿机器人没有在空中调整质心轨迹 的功能, 因此保持运动的平衡性具备一定难度, 且难以实现复杂地面的越障功能。

如授权公告号为 CN103879470B 的专利文献公开的一种连杆传动的单腿机器人 跳跃机 构, 由于方向驱动装置能够驱动大腿旋转, 实现方向控制; 跳跃驱动装置和方向驱动装置靠 近机身, 这降低了大腿相对于机身的转动惯量, 能减少第一驱动电机的能耗, 提高机器人运 动的稳定性和敏捷性; 通过平衡飞轮, 增加了机器人的稳定性; 通过设置的弹性储能件和平 衡件, 既能储能又能缓冲。 但该机器人没有踝关节及足底, 不能利用踝关节运动提高机器人 的跳跃能力, 在高强度跳跃运动中对减缓地面对机器人膝关 节与髋关节冲击的能力也较为有 限。

论文“Fearing. Robotic vertical jumping agility via series-elastic power modulation”中公开的 种具备极强力量的跳跃机器人技术方案, 其腿部设计加入了铰链和八条杠杆, 当电机向其 中一条施加扭矩时,其他的杠杆也会跟着转动 ,这时腿部会产生很大能量并向下方发出推力 , 机器就能更好跳跃起来。 虽然该机器人从实现了从地面跳跃到墙上, 再从墙上跳开的连续跳 跃动作, 但本质上还是依靠地面发力的弹跳机器人技术 方案, 不具备在垂直墙面连续跳跃的 能力, 无法跳过较高的障碍物。

论文“Precision jumping limits from flight-phase control in Salto-lP”公开了一种带螺旋桨 控制的单腿机器人技术方案, 螺旋桨推进器能够控制该机器人在空中的航向 和横滚, 再加上 原本旋转惯性尾巴在垂直方向上的仰俯控制能 力, 使得该技术方案实现了在空中调整姿态的 功能。 但该机器人的螺旋桨动力较小, 在滞空状态下螺旋桨对机身质心施加的加速度 较小, 不能在空中有效控制弹跳过程中触地受到的较 大冲击力, 因此不能实现机器人在墙面的连续 跳跃。

发明内容

针对上述问题, 本发明提供了一种墙面跳跃的单腿机器人机构 及控制方法, 实现了单腿 机器人在复杂环境下的平衡运动功能, 且具备墙面跳跃运动的能力。

为了达到上述目的, 本发明采取的技术方案如下: 一种墙面跳跃的单腿机器人机构, 包 括机器人腿部,所述机器人腿部的机身上固接 有多个旋翼,多个旋翼相对于机身呈镜像分布 , 且多个旋翼的工作面相互平行。

进一步的, 所述机身内部安装有控制器与陀螺仪, 陀螺仪和多个旋翼均与控制器相连。 进一步的, 所述机身内部安装有用于检测机器人身体姿态 的陀螺仪, 与控制器相连。 进一步的, 多个旋翼的数量为四个, 分别即为左上旋翼、 右上旋翼、 左下旋翼、 右下旋 翼。

进一步的, 所述机器人腿部包括依次铰接的机身、 大腿、 小腿和足部, 所述机身与大腿 的铰接处设有驱动大腿旋转的髋关节, 所述大腿上设有驱动小腿转动的膝关节, 所述小腿上 设有驱动足部转动的踝关节, 所述髋关节、 膝关节和踝关节均与控制器相连。

进一步的, 所述足部底部安装有摩擦因数大于 0.5的材料。

本发明的另一目的是提供一种墙面跳跃的单腿 机器人机构的控制方法,该方法分为发力 阶段、 滞空阶段、 收缩阶段三个过程。

在墙面跳跃过程中, 发力阶段是机器人足部蹬踏墙面, 髋关节、 膝关节与踝关节主动工 作的阶段。 发力阶段中, 机器人通过给墙面压力以及借助足部与墙面的 摩擦力, 给机器人提 供向上以及远离墙面的推力, 此阶段中旋翼的工作目的是通过上下旋翼不同 的转速来提供对 身体的扭矩, 以平衡因足部蹬踏对身体产生的扰动扭矩, 维持身体的平衡。 发力阶段中, 安 装在机器人身体中的陀螺仪监控机器人的姿态 与速度信息, 进而通过调整足部蹬踏墙面以及 旋翼的转速维持身体平衡。 当足部离开墙面, 进入滞空阶段。

滞空阶段是机器人足部不接触墙面, 机器人整体滞空的阶段。 滞空阶段中, 根据陀螺仪 反馈机器人的身体姿态, 同时左上旋翼、 右上旋翼、 左下旋翼、 右下旋翼配合对机器人施加 向墙面的推力, 使质心获得向墙面的加速度。 如果机器人身体前倾则左下旋翼、 右下旋翼旋 转较快, 左上旋翼、 右上旋翼旋转较慢, 给机器人一个仰扭矩; 如果机器人身体后仰则左上 旋翼、 右上旋翼旋转较快, 左下旋翼、 右下旋翼旋转较慢, 给机器人一个俯扭矩, 以此保证 机器人在滞空阶段的姿态稳定。 同时, 机器人的髋关节、 膝关节、 踝关节协同运动, 一方面 需要克服重力矩的影响, 另一方面需根据垂直速度选择合适的落脚点位 置。 当足部接触墙面 开始, 进入收缩阶段。

收缩阶段是机器人足部再次接触墙面之后, 髋关节、 膝关节与踝关节触墙被动收缩, 机 器人质心在水平方向上减速的过程。 收缩阶段中, 当足部接触墙面之后, 根据陀螺仪的数据 反馈机器人的身体姿态, 同时左上旋翼、 右上旋翼、 左下旋翼、 右下旋翼调整转速, 以平衡 墙面对足部冲击带来的对机器人质心造成的扭 矩, 保持身体的平衡, 直到腿部被压缩到设定 的极限点, 进入发力阶段。 如此循环, 可实现机器人在墙面的连续跳跃功能。

本发明与背景技术相比, 具有的有益效果是: 本发明附带有旋翼机构, 能够主动控制机 器人在空中的质心轨迹与身体姿态; 结合本发明公开的控制方法, 能够实现在垂直墙面进行 连续跳跃的技术效果, 提升了机器人的应用场合与运动能力。

附图说明

图 1是本发明墙面跳跃单腿机器人机构的结构立 图;

图 2是本发明墙面跳跃单腿机器人机构侧视图;

图 3是本发明墙面跳跃单腿机器人机构的墙面跳 发力阶段的动力学模型示意图; 图 4是本发明墙面跳跃单腿机器人机构的墙面跳 滞空阶段的动力学模型示意图; 图 5是本发明墙面跳跃单腿机器人机构的墙面跳 收缩阶段的动力学模型示意图; 图 6是本发明墙面跳跃单腿机器人的算法控制框 。

图中, 1.机身、 2.髓关节、 3.大腿、 4.膝关节、 5.小腿、 6.踩关节、 7.足部、 8.左上旋翼、 9.右上旋翼、 10.左下旋翼、 11.右下旋翼。

具体实施方式

下面结合附图和实例对本发明作进一步的说明 。

如图 1-2所示, 一种墙面跳跃的单腿机器人机构, 包括机器人腿部, 所述机器人腿部的 机身 1上固接有多个旋翼,多个旋翼相对于机身呈 像分布,且多个旋翼的工作面相互平行。

所述机身 1内部安装有控制器与陀螺仪, 陀螺仪和多个旋翼均与控制器相连。

本实施例中多个旋翼的数量为四个, 分别即为左上旋翼 8、 右上旋翼 9、 左下旋翼 10、 右下旋翼 11 ; 所述旋翼可采用无人机的旋翼, 但不限于此。

进一步的, 所述机器人腿部包括依次铰接的机身 1、 大腿 3、 小腿 5和足部 7, 所述机身 1与大腿 3的铰接处设有驱动大腿旋转的髋关节 2,所述大腿 3上设有驱动小腿 5转动的膝关 节 4, 所述小腿 5上设有驱动足部 7转动的踝关节 6, 所述髋关节 2、 膝关节 4和踝关节 6均 与控制器相连。 本发明的机器人腿部的技术方案可以采用授权 公告号为 CN106005079A的专 利文献公开的技术内容, 但不限于此。

进一步的,所述足部底部安装有橡胶等大摩擦 因数的材料,这些材料摩擦因数要大于 0.5。 本发明的工作过程如图 3-6所示, 分为发力阶段、 滞空阶段、 收缩阶段三个过程。 说明 如下:

图 3所示为发力阶段的机器人姿态及其受力情况 发力阶段是单腿机器人机构足部 7蹬 踏墙面, 髋关节 2、 膝关节 4与踝关节 6主动工作的阶段。 发力阶段中, 单腿机器人机构通 过给墙面压力以及借助足部 7与墙面的摩擦力, 给机器人提供向上以及远离墙面的推力, 此 阶段中旋翼的主要工作是平衡因足部 7蹬踏带来的扭矩。

如图 3所示, 列出发力阶段的动力学方程, 水平方向:

N— N || — ms ||

竖直方向:

f + N mg = ma

扭矩:

T - r = I p

其中, N为腿部蹬踏墙面产生的机器人质心受到的水 力, %为旋翼工作对单腿机器人 机构质心产生的水平力, m为机器人的质量, a|l 为单腿机器人机构水平方向的加速度; f为腿 部蹬踏墙面产生的单腿机器人机构质心受到的 摩擦力, N ± 为旋翼工作对单腿机器人机构质心 产生的竖直力, g为重力加速度, 3 ± 为机器人竖直方向的加速度; T为单腿机器人机构因足部 蹬踏墙面产生的扭矩, T'为旋翼工作产生的扭矩, I为机器人的转动惯量, P为单腿机器人机 构的角加速度。

发力阶段中, 安装在身体 1中的陀螺仪需要实时读取机身俯仰角度以及 a lh a ± 的值, 进 而通过调整足部 7蹬踏墙面以及旋翼的转速调整 、 N ± 与T'的大小, 使单腿机器人机构的质 心获得较大的竖直向加速度3 ± 以及较小的水平向加速度 a|l , 并且保持单腿机器人机构的身体 的扭矩平衡。 当大腿 3、 小腿 5处于一直线时, 机身 1持续向上向外运动, 足部 7将离开墙 面, 足部 7中的传感器检测不到触墙信息, 此时进入滞空阶段。

图 4所示为滞空阶段的单腿机器人机构姿态及其 力情况。滞空阶段是足部 7不接触墙 面, 机器人整体滞空的阶段。 滞空阶段中, 根据陀螺仪反馈单腿机器人机构的身体姿态, 同 时左上旋翼 8、 右上旋翼 9、 左下旋翼 10、 右下旋翼 11配合对机器人施加向墙面的推力, 以 及平衡身体的姿态。 如果身体 1前倾则左下旋翼 10、 右下旋翼 11旋转较快, 左上旋翼 8、 右 上旋翼 9旋转较慢, 给单腿机器人机构一个仰扭矩; 如果身体 1后仰则左上旋翼 8、 右上旋 翼 9旋转较快, 左下旋翼 10、 右下旋翼 11旋转较慢, 给单腿机器人机构一个俯扭矩。

如图 4所示, 列出滞空阶段的动力学方程, 水平方向:

N ll = ma ll

竖直方向:

N丄— mg = ma丄

扭矩:

r = I P

滞空阶段中, 安装在身体 1中的陀螺仪需要实时读取机身俯仰角度以及 a|l 、 a ± 的值, 进 而通过调整旋翼的转速调整 T'的大小, 使单腿机器人机构的质心获得较大的向墙面的 水平向 加速度 an, 并且保持单腿机器人机构的身体的扭矩平衡。 在滞空阶段, 髋关节 2、 膝关节 4、 踝关节 6协同运动, 一方面需要克服重力矩的影响, 另一方面需根据垂直速度选择合适的落 脚点位置。 当左上旋翼 8、 右上旋翼 9、 左下旋翼 10、 右下旋翼 11配合施加的向墙推力使单 腿机器人机构向墙运动, 足部 7接触墙面开始, 进入收缩阶段。

图 5所示, 为收缩阶段的单腿机器人机构姿态及其受力情 况。 收缩阶段是足部 7再次接 触墙面之后, 髋关节 2、 膝关节 4与踝关节 6处于零力矩状态中收缩的过程。 收缩阶段中, 当足部 7接触墙面之后, 根据陀螺仪的数据反馈单腿机器人机构的身体 姿态, 同时左上旋翼 8、 右上旋翼 9、 左下旋翼 10、 右下旋翼 11调整转速, 以平衡墙面对足部 7冲击带来的对单 腿机器人机构质心造成的扭矩, 保持身体 1的平衡。

如图 5所示, 列出收缩阶段的动力学方程, 水平方向:

N— N || = may

竖直方向:

N丄— mg = ma丄

扭矩:

T - r = I (3

收缩阶段中, 机器人通过旋翼的工作以保持单腿机器人机构 身体的姿态平衡, 收缩阶段 与发力阶段的动力学方程类似, 主要的区别在于收缩阶段中髋关节 2、 膝关节 4与踝关节 6 是被动运动, 直到腿部被压缩到设定的极限点, 进入发力阶段, 如此循环, 实现在垂直墙面 跳跃的功能。