--- a/drivers/timers_xeno/timers_xeno.c	Fri Jun 16 14:44:23 2006 +0200
+++ b/drivers/timers_xeno/timers_xeno.c	Mon Jun 19 14:19:23 2006 +0200
@@ -52,8 +52,9 @@
 			EnterMutex();
 			TimeDispatch();
 			LeaveMutex();
-		}while ((ret =  rt_task_sleep_until(last_alarm_set)) == 0);
-	}while (ret == -EINTR && !stop_timer );
+			while ((ret = rt_task_sleep_until(last_alarm_set)) == -EINTR);
+		}while (ret == 0);
+	}while (!stop_timer);
 	printf("End of TimerLoop, code %d\n",ret);
 }
 
@@ -86,7 +87,8 @@
 		goto error;
 	}
 	
-
+	return;
+	
 error:
 	cleanup_all();
 }