Hallo,

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

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