Final changes before leaving to FURC

Problems that still exist: Green border around images, random error
OpenCV Error: Bad argument (Unknown array type) in cvarrToMat