Updated Stepper functions and test progs to work interrupt driven
Also made stuff in Main look more library like