Initialize joint command and tune speed