Fixed a dynamic reconfiguration bug in the velocity controller.