Nexus Robot nearly finished

only the modulate function must be modified. It has to modulate the
speed depending on the encoder values.