Working on motor output, nothing functional yet, some preliminary code.