Ciao, la vedo dura che qualcuno si scarichi il sorgente e lo testi per te.
TI consiglio di mettere delle printf ovunque in modo da controllare passo per passo, magari usando anche delle breakpoint e vedere in quel momento i valori delle variabili.