Fixed typo/bug
Moved velocity command logging to setTarget