Add: Handling speed / direction

Values not tested
Change: Better GPIO handling, allowing a not-on-Pi debug mode