Arduino + Lego NXT

and how do you correct the drift ?

PS great work!