Basic guidance code for rotorcraft with PID control

@stabilization,guidance_rotorcraft guidance,attitude_command