Started writing some real c++ code, added some new matlab functions in order to get rid of for loops
A first draft of using Gentle Boost OpenCV implementation. C++ code, it compiles (no testing yet)