Tested Library

Working Library.
Added stepper motor support.