Fixed Radon Transform

The polyfit now functions correctly. Instead of using max() to find the
maximum variance I am now using findpeaks() and selecting the peak that
is closest to the peaks from calculations on previous frames.