i2c: at91: cleanup and fix some bug
little fix