Added simple USART test task and I2C test task. A lot of cleaning up still required.