Added distortion correction to the camera model and fixed some gcc warnings