config lcdbus nutze ich nie..

Ich würde noch eine Hauptschleife einbringen. Ein paar Nops zwischen den I2C-Befehlen können nicht schaden.