写一段图像畸变校正的MATLAB代码

图像畸变校正是图像处理中的一个重要问题，下面是一段MATLAB代码用于图像畸变校正：

% 读入图像
img = imread('distorted_image.jpg');

% 设置相机内参和畸变参数
K = [fx, 0, cx;
     0, fy, cy;
     0, 0, 1];
D = [k1, k2, p1, p2, k3];

% 计算畸变校正映射矩阵
[width, height] = size(img);
[X, Y] = meshgrid(1:height, 1:width);
X = X - cx;
Y = Y - cy;
r = sqrt(X.^2 + Y.^2);
Xn = X.*(1 + D(1)*r.^2 + D(2)*r.^4 + D(5)*r.^6) + 2*D(3)*X.*Y + D(4)*(r.^2 + 2*X.^2);
Yn = Y.*(1 + D(1)*r.^2 + D(2)*r.^4 + D(5)*r.^6) + D(3)*(r.^2 + 2*Y.^2) + 2*D(4)*X.*Y;
Xn = Xn + cx;
Yn = Yn + cy;

% 利用畸变校正映射矩阵对图像进行畸变校正
undistorted_img = interp2(X, Y, double(img), Xn, Yn, 'cubic');

% 显示畸变校正结果
imshow(uint8(undistorted_img));

其中，`distorted_image.jpg`是待校正的图像文件，`fx`、`fy`、`cx`、`cy`、`k1`、`k2`、`p1`、`p2`和`k3`分别是相机的内参和畸变参数，根据具体相机的参数进行设置。代码中，首先计算出畸变校正映射矩阵，然后利用该映射矩阵对图像进行畸变校正，最后将校正后的图像显示出来。