Modified apriltags.cpp to undistort images