Initial commit

Source/Control/Inc/attitude.h

@@ -0,0 +1,35 @@
+#ifndef ATTITUDE_H
+#define ATTITUDE_H
+
+#include "imu_processing.h"
+#include "radio_receiver.h"
+#include "pid.h"
+
+#define CF_ALPHA        0.99f
+
+typedef struct
+{
+  float roll;   // deg
+  float pitch;  // deg
+  float yaw_rate;    // deg/s
+} attitude_t;
+
+void complementary_filter_update(attitude_t* att, const imu_scaled_t* imu);
+void attitude_update(attitude_t* attitude, imu_scaled_t* imu);
+void yaw_rate_update(attitude_t* attitude, imu_scaled_t* imu);
+void attitude_pid_update(control_channels_t* control, 
+                         const rc_channels* rx, 
+                         const attitude_t* att, 
+                         const imu_scaled_t* imu);
+void TIM6_DAC_IRQHandler();
+
+float accel_roll_deg(const imu_scaled_t* imu);
+float accel_pitch_deg(const imu_scaled_t* imu);
+
+void integrate_gyro_roll_deg(float* roll, const imu_scaled_t* imu);
+void integrate_gyro_pitch_deg(float* pitch, const imu_scaled_t* imu);
+void integrate_gyro_yaw_deg(float* yaw, const imu_scaled_t* imu);
+
+
+
+#endif