Mast_servo and tilt done. ecerything functional