Fix torso rotation and imu coords