Work on c_vision

- refactoring to support c_slam with the same code
- c_vision_slam image analysis started
- c_vision_detector still works