add 6DOF move
Merge pull request #3 from coolvision/master

add a command for movement with rotation (move6DOF)