Added a power switcher and an IMU, still need a compass