In my experience the first place to look is whether the delays are long enough. I can't tell how long your delay loops take because they are in C, but you could try making them all much longer (e.g. 10 times longer).