Put check for vtol status to correct place
Publish att_sp and att_rates_sp only if vtol is in fw mode
Subscribe to vehicle_status topic and use it to only publish att_sp and att_rates_sp if vtol is in rotary wing mode
Fixed typo