Added class for thread safe queue
Include own files after std-headers to avoid compiler conflicts
Added doxygen comments to sharedqueue.h
Added isEmpty function to sharedqueue
Fix typos in semaphore.h
Changes behaviour of the messages.

Now commands and messages expect a SerialPort reference to send/receive
themselves and check the response.
Created basic program outline and got it compile, but not working