Code that implements a convoj system for lego mindstorm robots