Внесены некоторые изменения в файл IRS.h
This commit is contained in:
@@ -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
|
||||||
Reference in New Issue
Block a user