旋转矢量传感器值转方位角、横滚角、俯仰角问题排查

嘿，我来帮你搞定这两个旋转矢量转欧拉角的问题，这俩都是新手常踩的计算坑，咱们一步步来拆解～

问题1：xAng/yAng被限制在80-280区间的原因与修复 #

你遇到的这个范围限制，大概率是三角函数选择错误或者角度转换时的不必要偏移导致的：

• 先检查欧拉角的计算逻辑：如果用asin或acos计算横滚/俯仰角，本身会有范围限制（比如asin的输出是-π/2到π/2，对应-90°到90°），但你得到的80-280更像是把这个范围加了180°，可能是代码里误写了类似180 + pitch的偏移操作，这完全没必要，应该直接把弧度转成角度即可。
• 推荐用正确的四元数转欧拉角公式：
  • 横滚角（Roll，绕X轴）：atan2(2*q1*q2 + 2*q0*q3, 1 - 2*q1² - 2*q3²)，输出范围是-180°到180°
  • 俯仰角（Pitch，绕Y轴）：asin(2*q0*q1 - 2*q2*q3)，输出范围是-90°到90°
• 确认角度转换代码：确保是弧度值 * (180 / π)，不要额外加180或者其他偏移量。

问题2：方位角zAng与磁南偏差12度的问题 #

这个问题涉及坐标系方向和磁偏角校准两个点：

• 先修正方位角的方向逻辑：正常罗盘的方位角以磁北为0°，顺时针递增，如果你的zAng=0对应磁南，说明计算时方向反了。可以检查方位角的计算公式：
  正确的磁方位角公式应该是：atan2(2*q1*q3 + 2*q0*q2, 1 - 2*q1² - 2*q2²)，如果结果是反向的，要么调整公式里的分子符号（比如改成2*q0*q2 - 2*q1*q3），要么在得到角度后取360° - azimuth_deg来反转方向。
• 校准磁偏角：磁偏角是当地磁北与真北的夹角，如果你发现方向还有12°的固定偏差，大概率是没加磁偏角校准值。你可以查一下当地的磁偏角（比如东偏12°就给方位角加12°，西偏就减），把校准值加到计算后的方位角上。
• 额外检查：确保磁力计已经完成校准（比如做8字校准），周围没有强磁场干扰（比如手机、金属物体），否则也会导致方位角偏移。

示例代码参考 #

这里给你一个标准的四元数转欧拉角的代码片段（假设旋转矢量返回的5个值里包含四元数的w(q0)、x(q1)、y(q2)、z(q3)分量）：

import math

def rotate_vector_to_euler(q0, q1, q2, q3):
    # 计算横滚角（Roll）
    roll_rad = math.atan2(2 * q1 * q2 + 2 * q0 * q3, 1 - 2 * q1**2 - 2 * q3**2)
    roll_deg = math.degrees(roll_rad)
    
    # 计算俯仰角（Pitch）
    pitch_rad = math.asin(2 * q0 * q1 - 2 * q2 * q3)
    pitch_deg = math.degrees(pitch_rad)
    
    # 计算方位角（Azimuth，磁北为0°）
    azimuth_rad = math.atan2(2 * q1 * q3 + 2 * q0 * q2, 1 - 2 * q1**2 - 2 * q2**2)
    azimuth_deg = math.degrees(azimuth_rad)
    
    # 把方位角调整到0-360°范围
    if azimuth_deg < 0:
        azimuth_deg += 360
    
    # 加入磁偏角校准（示例：东偏12°）
    magnetic_declination = 12
    azimuth_deg += magnetic_declination
    if azimuth_deg > 360:
        azimuth_deg -= 360
    
    return roll_deg, pitch_deg, azimuth_deg

按照这个逻辑调整你的代码，应该就能解决这两个问题啦～

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