Almost finished implementation of Contoller class. Worked on Matching functions.
Merge branch 'master' of https://github.com/jhallard/3DLocalization