Multi-threaded and SSE friendly NDT algorithm - View it on GitHub