Hallo,

gröbere Schnitzer sind mir jetzt nicht aufgefallen,
ausser das #define NONE zweimal vorkommt Bild  

Evtl. machst du mal das & 0xfe beim vergleich von USI_address weg,
in der Zeile nach case NONE: