Split undistort into initUndistortRectifyMap and remap

Splitting undistort and caching the remapping speeds up the method.

Since this results in faster playback, even whithout tracking or recognition, I might have to look into our fixed framerate feature, depending on how good it works.