little bit of refactoring
some refactoring and commenting
removed debug printing
added comments and a myWait()
added a myWait(10) to the top of the loop, makes things go much more smoothly
Final Code, works really well