Внесены некоторые изменения в файл 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 "vector.h"
Quaternion orientationQuat;
Vector3 tilts; // local oriented sinX sinY cosZ
typedef struct
{
Vector3 Gyro, Accel;
} IMU; // последние значения датчиков
Quaternion orientationQ; // главный кватерион ориентации
// Vector3 tilts; // локально ориентированные наклоны sinX sinY cosZ
typedef struct
{
Vector3 Accel, Spd, Pos;
} Inertial; // инерциальные значения движения
Vector3 gyro, accel; // последние значения датчиков
float roll, pitch, yaw;
// 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 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 restoreAllShift();
// void restoreAllShift();
void setAccelShift();
// void setAccelShift();
void getSinXYCosZ();
void getRollPitchYaw();
void getInertial();
// void getSinXYCosZ();
// void getRollPitchYaw();
// void getInertial();
#endif