Accel/gyro works! Code is very ugly though, that's only intended for testing.