The code is too big to post here but I have it on pastebin...The stepper motors are not using the interrupts.