commander: disarm system when safety enabled
Merge pull request #674 from PX4/safety_disarm

commander: disarm system when safety enabled