如何通过Z轴参数控制NAO机器人完成半蹲动作（避免摔倒）

问题根源 #

直接移动Torso的Z轴位置时，未启用NAO的平衡控制机制，导致重心偏移超出支撑脚的稳定区域，机器人失去平衡摔倒。NAO的躯干移动必须结合平衡约束，让系统自动调整腿部关节来维持重心在支撑面内。

修正方案 #

启用平衡约束，仅控制Z轴方向的躯干移动，同时控制动作速度确保平衡系统有足够时间调整腿部。

修正后的代码 #

motionProxy = ALProxy("ALMotion", "127.0.0.1", 9559)
postureProxy = ALProxy("ALRobotPosture", "127.0.0.1", 9559)

# 回到稳定初始姿态
postureProxy.goToPosture("StandInit", 0.5)

# 启用平衡约束，允许躯干在维持平衡的前提下移动
motionProxy.wbEnableBalanceConstraint(True)

useSensor = False
# 获取当前躯干在世界坐标系下的位置
current_torso = motionProxy.getPosition("Torso", 2, useSensor)
# 设置Z轴目标位置：向下移动0.01米（半蹲幅度）
target_torso = [
    current_torso[0],  # 保持X轴位置不变
    current_torso[1],  # 保持Y轴位置不变
    current_torso[2] - 0.01,  # Z轴向下移动0.01米
    current_torso[3],  # 保持Roll角度不变
    current_torso[4],  # 保持Pitch角度不变
    current_torso[5]   # 保持Yaw角度不变
]

# 仅控制Z轴位置（二进制0b100对应十进制4）
axis_mask = 4
# 设置合理的动作速度，给平衡系统调整时间
fraction_max_speed = 0.1

# 执行躯干移动
motionProxy.setPositions("Torso", 2, target_torso, fraction_max_speed, axis_mask)

# 等待动作完成
motionProxy.waitUntilMoveIsFinished()
# 可选：关闭平衡约束
motionProxy.wbEnableBalanceConstraint(False)

关键调整说明 #

• wbEnableBalanceConstraint(True)：开启平衡约束后，NAO会自动调整腿部关节，确保重心始终落在支撑脚的稳定区域内，这是避免摔倒的核心设置。
• 仅控制Z轴：将axis_mask设为4（二进制0b100），只修改Z轴位置，避免误动X/Y轴导致重心横向偏移。
• 合理速度：fraction_max_speed=0.1（最大速度的10%），给平衡系统足够时间同步调整腿部动作，避免速度过快导致平衡跟不上。
• 世界坐标系：使用参数2（WORLD_FRAME）获取和设置躯干位置，确保Z轴移动是相对于地面的垂直方向，动作更可控。

之前代码的问题分析 #

• 未启用平衡约束：直接移动躯干时，机器人无法自动调整腿部维持平衡。
• 轴掩码设置不当：AXIS_MASK_ALL或7（控制X/Y/Z全位置）可能导致躯干意外平移，破坏重心稳定。
• 速度设置不合理：过慢的速度（如0.001）可能导致动作超时，过快则平衡系统来不及响应。

内容的提问来源于stack exchange，提问作者Sam