Added I2C2 initialization in main.  Added a test write on I2C2 in main and some GPIO output for debugging.