Added pitch and altitude controller