estabilizar gimbal (con pan y tilt) hacia tierra

deseo obtener la manera de que mi camara se encuentre observandoi en cada momento la superficie terrestre, sin importar los movimientos de mi aeronave.

para obtener los angulos son poseeo IMU de 5dof