示例#1
0
    public SOrientation Update(SOrientation or_acc_mag, Quaternion gyro_rotation_step, float filter)
    {
        Quaternion Rotation_AccMag = or_acc_mag.Rotation;

        m_FusedRotation = Quaternion.Lerp(Rotation_AccMag, m_FusedRotation * gyro_rotation_step, filter);
        return(SOrientation.FromRotation(m_FusedRotation));
    }
示例#2
0
 public void PrintText(Quaternion q, int numdigits = 3)
 {
     PrintText(SOrientation.FromRotation(q));
 }