Woohoo it works! The main function right now is just a proof of concept of the classes FeatureFinder and ImageHelper, this needs much debugging though! We need to sort out how to handle the ROS and CV loops independently, it appearently works now though.