Although it was working Ok, it is safe to use volatile in shared global
variables.
However, replacing the global variables with xQueue might be better in
the long run.