Added some basic motor processing
Added some missing header incs to nxt_control
Added some breakout logic to main loop