Make i2c work
Support for self-flashing and led test script