Undistort camera data - rewritten

*Constants for front-camera included
*Removed distort method (no formula to calculate)