Use commanded velocity - first implementation.