Files
WoodDrone/utils/quat.h
Dana Markova 0de214c9a1 first commit
2025-07-28 13:21:36 +03:00

15 lines
406 B
C

#pragma once
struct Vec3 { float x, y, z; };
struct ORI
{
float sinX, sinY, cosZ; // Earth's plane tilt
float Pitch, Roll, Yaw; // Sovereign orientation (not Euler)
float IneX, IneY, IneZ; // Inertial accelerations
};
ORI WorkAccGyroMag(const Vec3 acc, const Vec3 gyr, const Vec3 mag, const float mag_shift, const float alpha);
Vec3 RotateToZ(const Vec3 vec, bool Rev=false);
void QuatGoToZero();