Just checked the code an it works in a different way. It's looks for a finished response from the focuser:
if (!strcmp(res, "GTok!"))
I guess this is not happening. I guess I should switch on the logging if I want to have a better idea what is happening.
It's finally clear and I am imaging, I always find it difficult to experiment on clear nights!