预览加载中,请您耐心等待几秒...
1/10
2/10
3/10
4/10
5/10
6/10
7/10
8/10
9/10
10/10

亲,该文档总共22页,到这已经超出免费预览范围,如果喜欢就直接下载吧~

如果您无法下载资料,请参考说明:

1、部分资料下载需要金币,请确保您的账户上有足够的金币

2、已购买过的文档,再次下载不重复扣费

3、资料包下载后请先用软件解压,在使用对应软件打开

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN114407008A(43)申请公布日2022.04.29(21)申请号202111637784.5(22)申请日2021.12.29(71)申请人广州极飞科技股份有限公司地址510000广东省广州市天河区高普路115号C座(72)发明人霍汉民(74)专利代理机构北京泽方誉航专利代理事务所(普通合伙)11884代理人徐濛(51)Int.Cl.B25J9/16(2006.01)B25J13/08(2006.01)G05B13/04(2006.01)权利要求书2页说明书13页附图6页(54)发明名称机器人运动控制方法、装置、设备及存储介质(57)摘要本申请公开了一种机器人运动控制方法、装置、设备及存储介质。本申请提供的技术方案包括:获取机器人所在平面的法向量,并根据法向量和机器人的偏航角,确定机器人的俯仰补偿角和滚转补偿角;根据俯仰补偿角和滚转补偿角,确定机器人的第一躯干姿态;获取机器人所在平面与水平面的夹角,根据夹角确定机器人的摩擦约束条件;根据第一躯干姿态和摩擦约束条件,基于质心模型确定机器人的腿部支撑力,以根据腿部支撑力控制机器人运动。通过上述技术手段,解决了现有技术中因地形变化较大导致足型机器人失控的问题,提高控制稳定性。CN114407008ACN114407008A权利要求书1/2页1.一种机器人运动控制方法,其特征在于,包括:获取机器人所在平面的法向量,并根据所述法向量和所述机器人的偏航角,确定所述机器人的俯仰补偿角和滚转补偿角;根据所述俯仰补偿角和所述滚转补偿角,确定所述机器人的第一躯干姿态;获取所述机器人所在平面与水平面的夹角,根据所述夹角确定所述机器人的摩擦约束条件;根据所述第一躯干姿态和所述摩擦约束条件,基于质心模型确定所述机器人的腿部支撑力,以根据所述腿部支撑力控制所述机器人运动。2.根据权利要求1所述的机器人运动控制方法,其特征在于,所述方法还包括:获取所述机器人下一次移动的第一足端移动轨迹,根据所述俯仰补偿角和所述滚转补偿角对所述第一足端移动轨迹进行补偿,得到所述机器人的第二足端移动轨迹,以根据所述第二足端移动轨迹控制所述机器人移动。3.根据权利要求1所述的机器人运动控制方法,其特征在于,所述获取机器人所在平面的法向量包括:当机器人的足端触地时,根据机器人腿部的连杆长度和关节角度,基于单腿运动学模型确定各个足端的第一位置坐标;根据所述第一位置坐标确定所述机器人所在平面的平面方程,并根据所述平面方程确定所述法向量。4.根据权利要求1所述的机器人运动控制方法,其特征在于,所述根据所述法向量和所述机器人的偏航角,确定所述机器人的俯仰补偿角和滚转补偿角包括:根据所述偏航角计算所述法向量对应的第一分解矩阵,根据所述第一分解矩阵和所述法向量计算所述法向量对应的第二分解矩阵;其中,所述第一分解矩阵和所述第二分解矩阵根据所述法向量对应的列矩阵分解得到;根据所述第二分解矩阵计算所述俯仰补偿角和所述滚转补偿角。5.根据权利要求4所述的机器人运动控制方法,其特征在于,所述第一分解矩阵的计算公式为:所述第二分解矩阵的计算公式为:所述俯仰补偿角的计算公式为:θy=arccos(p1/p3)所述滚转补偿角的计算公式为:θx=arcsin(p2)其中,q为所述第一分解矩阵,p为所述第二分解矩阵,ne为所述法向量的单位向量,θz为所述偏航角,θx为所述滚转补偿角,θy为所述俯仰补偿角。6.根据权利要求1所述的机器人运动控制方法,其特征在于,所述根据所述俯仰补偿角和所述滚转补偿角,确定所述机器人的第一躯干姿态包括:2CN114407008A权利要求书2/2页对所述俯仰补偿角和所述滚转补偿角进行滤波处理,将滤波处理后的俯仰补偿角和滚转补偿角与所述机器人的第二躯干姿态相加,得到所述第一躯干姿态。7.根据权利要求1所述的机器人运动控制方法,其特征在于,所述根据所述夹角确定所述机器人的摩擦约束条件包括:根据所述夹角确定所述机器人所受重力的第一分力,所述第一分力为所述重力相对所述机器人所在平面的水平分力;根据所述第一分力,确定所述机器人的摩擦约束条件。8.根据权利要求2所述的机器人运动控制方法,其特征在于,所述获取所述机器人下一次移动的第一足端移动轨迹包括:根据预设足端移动距离和第一位置坐标,确定对应足端下一次移动时的落点坐标;根据预设足端移动高度、所述第一位置坐标和所述落点坐标,确定对应足端下一次移动时的最高点坐标。9.根据权利要求8所述的机器人运动控制方法,其特征在于,所述根据所述俯仰补偿角和所述滚转补偿角对所述第一足端移动轨迹进行补偿,确定所述机器人的第二足端移动轨迹包括:根据所述俯仰补偿角和所述滚转补偿角确定齐次变换矩阵;通过所述齐次变换矩阵对转换至所述躯干坐标