+ MessageQueue, various new headers

Added MessageQueue, a waiting queue useful for asynchronous even loops,
as well as a couple of headers for planned stuff like the behavior
framework and some basic Math stuff to support IMUs. Also going to
implement UDP socket wrappers soon.