The Bernstein polynomial fit diverges for orders greater than 2

[dlezcan1]

Currently the issue is, most likely, with either the 'undistort' or 'correctDistortion' function. As of right now, when using a Bernstein fitting order greater than 2, the errors grow exponentially and the fit becomes awful. This will need to be looked into. All other functions are using an order of 2 for fitting

[dlezcan1]

Error was with correctDistortion function. The generation of the Bernstein polynomial was not correct.