added control law to reduce jitteriness of robots