Switched to JFedor's NXT control demo code, motor control works
Merge remote-tracking branch 'origin/master'