was meinst du genau? du kannst zweimal drei zeichen eingeben, und dann immer nur noch eines?

spontan denke ich ist dein quellcode ok, kann ihn leider gerade nicht testen...

du kannst höchstens mal versuchen, die variable data auch nur 3 zeichen lang zu machen, also

unsigned char data[] = "12"

(das letzte zeichen wird automatisch mit dem wert null gefüll, deine variable von oben ist also 5 zeichen lang!)
oder noch einfacher

unsigned char data[3];

evtl hilfts was...