Camera Pinhole Model Matlab