Simplify I2C initalisation

workspace/TS100/Core/Drivers/BMA223.hpp

@@ -0,0 +1,42 @@
+/*
+ * BMA223.hpp
+ *
+ *  Created on: 18 Sep. 2020
+ *      Author: Ralim
+ */
+
+#ifndef CORE_DRIVERS_BMA223_HPP_
+#define CORE_DRIVERS_BMA223_HPP_
+#include "I2C_Wrapper.hpp"
+#include "LIS2DH12_defines.hpp"
+#include "BSP.h"
+
+
+class BMA223 {
+public:
+	static bool detect();
+	static void initalize();
+	//1 = rh, 2,=lh, 8=flat
+	static Orientation getOrientation() {
+#ifdef ACCEL_ORI_FLIP
+		uint8_t val = (FRToSI2C::I2C_RegisterRead(LIS2DH_I2C_ADDRESS,
+		LIS_INT2_SRC) >> 2);
+		if (val == 8)
+			val = 3;
+		else if (val == 1)
+			val = 1;
+		else if (val == 2)
+			val = 0;
+		else
+			val = 3;
+		return static_cast<Orientation>(val);
+#else
+		return static_cast<Orientation>((FRToSI2C::I2C_RegisterRead(LIS2DH_I2C_ADDRESS,LIS_INT2_SRC) >> 2) - 1);
+#endif
+	}
+	static void getAxisReadings(int16_t& x, int16_t& y, int16_t& z);
+
+private:
+};
+
+#endif /* CORE_DRIVERS_BMA223_HPP_ */