modified:   wheeled_robin_formation_drive/src/vel_control.cpp