fixed target_set bug
Merge branch 'Reorg' of https://github.com/madcowswe/Mavrx-firmware into Reorg