Added altitude and increased max gimbal to 10.5 deg