Added temporary implementation of orientation from imu