Cleanup
Organize camera class. Preparation to change distortion/undistortion
function