Hi,

als erstes würde ich mal noch eine Endlosschleife
Code:
...
  while(1);
  return 0;
}
am Ende der main Routine setzen.
Sonst macht der Controller irgendwelchen Müll.

Gruß m.a.r.v.i.n