Sonar I2C protocol tested and optimized.
Bug fixes.
Code optimization.