Simple movement routine.

Programmed a small routine that does 10000 steps on each direction. NEEDS TESTING
Commented the UART processing to avoid trouble.