Fix isFinished() for various commands

[daniwhite]

Many commands that should stop eventually (e.g. TargetYaw()) return isFinished() as always false, even though sensor feedback could tell us when it's done. It should return true eventually.