机器人姿态控制方法、装置、可读存储介质及机器人制造方法及图纸

本申请属于机器人技术领域，尤其涉及一种机器人姿态控制方法、装置、计算机可读存储介质及机器人。所述方法应用于双轮足机器人，包括：建立所述双轮足机器人的单质点模型；对所述单质点模型进行动力学分析，确定所述双轮足机器人的动力学模型表达式；根据所述动力学模型表达式对所述双轮足机器人进行模型预测控制，得到所述双轮足机器人在当前时刻的控制量；根据所述当前时刻的控制量对所述双轮足机器人进行姿态控制。通过上述方法，可以对动力学模型表达式进行模型预测控制，获得当前时刻的控制量，并根据当前时刻的控制量对双轮足机器人进行姿态控制，实现了较好的姿态维持效果，提升了姿态控制方法的鲁棒性。提升了姿态控制方法的鲁棒性。提升了姿态控制方法的鲁棒性。

【技术实现步骤摘要】
机器人姿态控制方法、装置、可读存储介质及机器人


[0001]本申请属于机器人
，尤其涉及一种机器人姿态控制方法、装置、计算机可读存储介质及机器人。

技术介绍

[0002]现有技术中常采用虚拟模型控制(Virtual Model Control，VMC)方法对双轮足机器人进行姿态控制。然而，在面对建模误差时，VMC方法的鲁棒性较差，对双轮足机器人的姿态维持效果欠佳。

技术实现思路

[0003]有鉴于此，本申请实施例提供了一种机器人姿态控制方法、装置、计算机可读存储介质及机器人，以解决现有技术中对双轮足机器人的姿态控制方法鲁棒性较差，对双轮足机器人的姿态维持效果欠佳的问题。
[0004]本申请实施例的第一方面提供了一种机器人姿态控制方法，应用于双轮足机器人，可以包括：
[0005]对所述双轮足机器人的躯干进行模型简化，建立所述双轮足机器人的单质点模型；
[0006]对所述单质点模型进行动力学分析，确定所述双轮足机器人的动力学模型表达式；
[0007]根据所述动力学模型表达式对所述双轮足机器人进行本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机器人姿态控制方法，其特征在于，应用于双轮足机器人，所述方法包括：对所述双轮足机器人的躯干进行模型简化，建立所述双轮足机器人的单质点模型；对所述单质点模型进行动力学分析，确定所述双轮足机器人的动力学模型表达式；根据所述动力学模型表达式对所述双轮足机器人进行模型预测控制，得到所述双轮足机器人在当前时刻的控制量；根据所述当前时刻的控制量对所述双轮足机器人进行姿态控制。2.根据权利要求1所述的机器人姿态控制方法，其特征在于，所述根据所述当前时刻的控制量对所述双轮足机器人进行姿态控制，包括：根据所述当前时刻的控制量，计算所述双轮足机器人在当前时刻的关节力矩；根据所述当前时刻的关节力矩，对所述双轮足机器人进行姿态控制。3.根据权利要求2所述的机器人姿态控制方法，其特征在于，所述根据所述当前时刻的控制量，计算所述双轮足机器人在当前时刻的关节力矩，包括：获取所述双轮足机器人的腿部关节到腿部末端的雅克比矩阵；根据所述当前时刻的控制量和所述雅克比矩阵，计算得到所述当前时刻的关节力矩。4.根据权利要求1所述的机器人姿态控制方法，其特征在于，所述对所述双轮足机器人的躯干进行模型简化，建立所述双轮足机器人的单质点模型，包括：将所述双轮足机器人的躯干等效为一个有质量的刚体，将所述刚体的几何中心作为所述刚体的质心，建立所述单质点模型。5.根据权利要求4所述的机器人姿态控制方法，其特征在于，所述动力学模型表达式为：其中，m
b
是所述刚体的质量，z
b
为所述刚体的z向受力，为所述刚体的z向速度，为所述刚体的z向加速度，分别为所述刚体受到所述双轮足机器人的左轮足和右轮足的z向足底力，分别为所述刚体受到的所述左轮足和所述右轮足的y向足底力，分别为对应的力臂，为所述刚体相对于竖直平面的旋转角度，为所述刚体相对于竖直平面的旋转速度，为所述刚体相对于竖直平面的旋转加速度，g为重力加速度。6.根据权利要求1至5中任一项所述的机器人姿态控制方法，其特征在于，所述根据所述动力学模型表达式对...

【专利技术属性】
技术研发人员：周江琛，闫萌，陈春玉，
申请(专利权)人：深圳市优必选科技股份有限公司，
类型：发明
国别省市：