Here i put code which i manipulate and works with my Zumobot from Pololu