Separated AHRS and telemetry code.

1 files changed, 25 insertions, 0 deletions

diff --git a/ahrs.h b/ahrs.h
new file mode 100644
index 0000000..e78ae8d
--- /dev/null
+++ b/ahrs.h
@@ -0,0 +1,25 @@
+#ifndef AHRS_H
+#define AHRS_H
+
+#include "itg3200.h"
+#include "bma150.h"
+
+class AHRS {
+	public:
+		ITG3200 gyro;
+		BMA150 accel;
+		
+		AHRS(I2C& i2c) : gyro(i2c), accel(i2c) {}
+		
+		void init() {
+			gyro.init();
+			accel.init();
+		}
+		
+		void update() {
+			gyro.update();
+			accel.update();
+		}
+};
+
+#endif