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