Fixes and metric rectification

- metric rectification library
- SLAM compiles again and uses BaseLogic
- HighLevelDetector now works better and is more restrictive