Added YCM config
Floated all the double
Floated all doubles in samples and tests
Fixed the double-float solvepnp/rodrigues issue