Uncommented read() and write() for motor (needs test)