Add unit tests using boost test

Added UnitTests for a few classes, as well as fixing some minor bugs and cleaning up a little bit in the process.
Yes loosing const is not really nice. You would need to register each thread with the DataStructure to setup the local RTrees. We could do that at the start of each ::HandleRequest
something like facade->initializeThreadData() or something.