State machine interrupt driven I2C code tested, need to clean up organization of ams-enc a bit
I2C driver appears to be working for both blocking and non-blocking reads of the encoders. Tested with pid running to verify that ocount is being properly updated. NOTE: delay of unknown length is necessary before calling amsEncoderSetup, otherwise encoders will NACK write and hang the code.
Removed commented out line with old encoder high/low bytes