public ImuMessage(HeaderMessage header, QuaternionMessage orientation, double[] orientation_covariance, Vector3Message angular_velocity, double[] angular_velocity_covariance, Vector3Message linear_acceleration, double[] linear_acceleration_covariance)
{
this.header = header;
this.orientation = orientation;
this.orientation_covariance = orientation_covariance;
this.angular_velocity = angular_velocity;
this.angular_velocity_covariance = angular_velocity_covariance;
this.linear_acceleration = linear_acceleration;
this.linear_acceleration_covariance = linear_acceleration_covariance;
}
public static Quaternion ToQuaternion(this QuaternionMessage msg)
{
return(new Quaternion(msg.X, msg.Y, msg.Z, msg.W));
}