完成一些速度相关功能。

Change-Id: I4c4a028b386227cfe8b7cc649154f62663d78168
将速度改为位置控制

Change-Id: I51cb966052d9e96be2df0d2a76f7421d0cb43ec7