Update for velocity control

Signed-off-by: ysuga <ysuga@ysuga.net>
Merge branch 'version2'