[发明专利]一种四足机器人本体质心标定方法

说明书

本发明公开了一种四足机器人本体质心标定方法，根据机器人本体上的基础传感器对机器人的质心位置进行精准的估计和标定；本发明公开的质心标定方法，可以方便、精准地测量四足机器人这种非规则结构的质心位置，不需要专业的质心测量装置。

技术领域

本发明涉及机器人的技术领域，更具体的说是涉及一种四足机器人本体质心标定方法。

背景技术

在四足机器人应用时，需要精准地测量四足机器人非规则结构的质心位置，从而指导四足机器人运动控制器进行更加精准的动力学控制，使机器人的运动稳定性更强，通常采用如下两种方案解决：

1、用专门的CAE软件，根据四足机器人的结构模型、材料属性等，软件仿真计算质心位置。

2、用专门的质心位置测量装置对机器人的质心位置进行测量标定。

上述两种方案中：

方案1需要事先得到四足机器人的3D结构模型、材料参数等，并且存在加工误差，CAE软件计算的质心位置与实际的机器人质心位置之间的误差不可控。

方案2需要专门的质心位置测量装置，成本较高，操作复杂。

发明内容

本发明为了解决上述技术问题提供一种四足机器人本体质心标定方法。

本发明通过下述技术方案实现：一种四足机器人本体质心标定方法，根据机器人本体上的基础传感器对机器人的质心位置进行精准的估计和标定。

具体的，四足机器人具有4条腿，每条腿具有3个关节，3个关节均由电机驱动，所述的基础传感器包括用于估计机身中心在世界坐标系下的位置及机身姿态的IMU、反馈关节位置的编码器和反馈关节扭矩的电流采样电阻；

考虑四足机器人的每条移动腿有三个自由度，已知每个自由度通过关节活动，每个关节均通过点机带动，在四足机器人静态平衡时，每个电机反馈其估计的输出扭矩，电流采样电阻可以估算电机输出扭矩，四足机器人的关节扭矩和足端力存在以下关系：

τ＝J^Tf

其中τ为每条腿上3个关节的三维扭矩向量，f为每条腿足端的三维地面反作用力，J为每条腿的雅可比矩阵；

因此可以根据电流采样电阻估算足端力，将四条腿的足端力加起来就可以估算机体质量。

本体质心测量具体如下：

在四足机器人静态站立状态下(机器人速度和加速度为零)，机器人的质心静力矩为零，即：

其中f_i表示第i条腿的足端力，p_COM,i表示第i条腿足端到机体质心距离矢量，p_i表示第i条腿足端位置，p_COM表示机体质心位置；

对四条腿的足端力和足端位置进行N次测量，建立N个上述(1)中的方程组成的方程组：

其中只有p_COM为未知的机体质心位置；

当N≥4时，上述(2)的方程组为超定方程，p_COM为该方程的最小二乘解，用奇异值分解法(SVD)求得，p_COM与状态估计得到的机器人形心位置做差，就可以得到机体质心在机器人结构上的相对位置。

本发明与现有技术相比，具有如下的优点和有益效果：

本发明公开的质心标定方法，可以方便、精准地测量四足机器人这种非规则结构的质心位置，不需要专业的质心测量装置。

附图说明