Added code for testing sensors, stepper

Wrote some come explicitly for testing sensors. Also attempted to use
Arduino stepper library for controlling stepper; was worse than my other
code. I think the library doesn't write to it properly.