Protect map and queue variable access with mutex, add test (#88)

Protect map and queue variable access with mutex, add test (#88) #220