Added some functionality to cmd_target
Command 'target' now sets target for mavlink too