Add compute_act_vel() and compute_wheel_speed()