Внесены некоторые изменения в файл IRS.h

This commit is contained in:
2026-03-12 13:26:06 +03:00
parent a09f026195
commit c1fab9fcb3

View File

@@ -6,33 +6,35 @@
#include "quaternion.h" #include "quaternion.h"
#include "vector.h" #include "vector.h"
Quaternion orientationQuat;
Vector3 tilts; // local oriented sinX sinY cosZ
typedef struct typedef struct
{ {
Vector3 Gyro, Accel; Quaternion orientationQ; // главный кватерион ориентации
} IMU; // последние значения датчиков // Vector3 tilts; // локально ориентированные наклоны sinX sinY cosZ
typedef struct Vector3 gyro, accel; // последние значения датчиков
{
Vector3 Accel, Spd, Pos; float roll, pitch, yaw;
} Inertial; // инерциальные значения движения
// Vector3 accel, spd, pos; // инерциальные значения движения
} IRS;
void updateIRS(IRS* irs, const Vector3* gyro, const Vector3* accel, float dt);
void IRSgetEuler(const IRS* irs);
void updateGyro(Vector3* gyro, const Vector3* newGyro); void updateGyro(Vector3* gyro, const Vector3* newGyro);
void updateAccel(Vector3* accel, const Vector3* newAccel); void updateAccel(Vector3* accel, const Vector3* newAccel);
void setShiftAlpha(const Vector3* pos, const Vector3* spd, const float* qua); // коэффициент восстановления позиции и скорости в секунду // void setShiftAlpha(const Vector3* pos, const Vector3* spd, const float* qua); // коэффициент восстановления позиции и скорости в секунду
void updatePosSpeed(); // void updatePosSpeed();
void updateQuat(); void updateQuat();
void restoreAllShift(); // void restoreAllShift();
void setAccelShift(); // void setAccelShift();
void getSinXYCosZ(); // void getSinXYCosZ();
void getRollPitchYaw(); // void getRollPitchYaw();
void getInertial(); // void getInertial();
#endif #endif