Add velocity hw

[forno]

速度制御Joint追加版です。

[forno]

動いていることはわかりますが、思っている位置まで移動しません。 多分velにそのままcmdを流し込んでるせいだとは思いますが、どうしましょう。

[forno]

直りました。 完全に動作します。