Fixed normal calculation
Merged tests
Fixed initialisation order
Fixed up vector of camera.
Updated defaults
Fixed color representation

OpenCV uses BGR for displaying images.