Fixing xenomai timing bug?