Add mutex

Use mutex when manipulating queues (messages have been lost when send frequency became too high).