Bug correction

This code is now working but not really usable.

TODO : Design for the LCD display. Informations are well displayed, but
in a very bad way.