1. 并联踝关节运动学解算原理
在双足机器人控制系统中,踝关节的运动学解算是一个关键环节。仿真环境(如Isaac Lab和MuJoCo)通常将踝关节简化为两个独立的旋转关节(Pitch和Roll),可以直接发送角度/力矩指令。但在实际机器人中,为了降低末端惯量,普遍采用并联机构设计(如2-RSS-1U或2-RSU-1U构型)。这种设计带来了控制指令的映射问题:仿真侧直接控制关节角度,而真机侧需要将关节角度解算为电机角度。
1.1 机构构型与坐标系定义
以典型的2-RSS-1U并联踝关节为例,其机构组成如下:
- 2-RSS:两条相同的驱动链,每条包含主动旋转关节(R,由电机驱动)、球铰(S)和连接脚掌的球铰(S)
- 1-U:中央被动万向节(Universal Joint),定义脚掌的Roll/Pitch运动中心
在实际应用中,需要从机械图纸获取以下关键几何参数:
| 参数 | 符号 | 典型值(参考) | 获取方法 |
|---|---|---|---|
| 电机驱动臂长度 | l_bar | 85 mm | CAD测量 |
| 连杆长度 | l_rod | 135 mm | 实物测量 |
| 两驱动链间距 | l_spacing | 43 mm | 设计图纸 |
| A点坐标(电机轴位置) | A_i | 需实测 | 激光跟踪仪 |
| C点坐标(连杆与脚掌连接点) | C_i | 需实测 | 三坐标测量 |
这些参数的准确性直接影响后续运动学计算的精度,建议采用多次测量取平均值的方法来确保数据可靠。
1.2 逆运动学(IK)实现
逆运动学是将期望的脚掌姿态(q_roll, q_pitch)转换为两个电机角度(θ₁, θ₂)的过程。具体计算流程如下:
-
根据期望姿态计算脚掌平台的旋转矩阵R_platform:
matlab复制R_roll = [1 0 0; 0 cos(q_roll) -sin(q_roll); 0 sin(q_roll) cos(q_roll)]; R_pitch = [cos(q_pitch) 0 sin(q_pitch); 0 1 0; -sin(q_pitch) 0 cos(q_pitch)]; R_platform = R_roll * R_pitch; -
计算每条驱动链的C点新坐标:
cpp复制
Eigen::Vector3d C_i_prime = R_platform * C_i; -
建立几何约束方程:
code复制||C_i_prime - A_i||² = l_rod² (A_i - O) · (C_i_prime - A_i) = l_bar * cos(θ_i)其中O为电机旋转中心。
-
解析求解电机角度θ_i:
python复制def inverse_kinematics(q_pitch, q_roll): # 计算旋转后的C点位置 C_rotated = rotate_points(C, q_pitch, q_roll) # 求解电机角度 theta1 = solve_motor_angle(A1, C_rotated[0], l_bar, l_rod) theta2 = solve_motor_angle(A2, C_rotated[1], l_bar, l_rod) return theta1, theta2
在实际工程中,需要考虑以下特殊情况处理:
- 奇异位置判断:当机构接近奇异位置时,需要加入保护逻辑
- 多解处理:根据机构运动连续性选择合理的解
- 角度限幅:确保解算结果在电机物理限制范围内
1.3 正运动学(FK)实现
正运动学用于从电机编码器读数反算脚掌实际姿态。由于并联机构的复杂性,通常采用数值解法:
