Undistort
k1
k2
k3
p1
p2