Opencv

Merge first version communicating with robot into master