单目测距matlab程序

以下是一个简单的单目测距 Matlab 程序示例：

% 读取图像
img = imread('test.jpg');

% 定义相机参数
focalLength = 50; % 焦距
sensorWidth = 36; % 传感器宽度
imageWidth = size(img, 2); % 图像宽度

% 检测图像中的特征点
points = detectSURFFeatures(rgb2gray(img));

% 提取特征描述子
features = extractFeatures(rgb2gray(img), points);

% 选择匹配特征
indexPairs = matchFeatures(features1, features2);

% 从匹配特征计算基础矩阵
fMatrix = estimateFundamentalMatrix(points1(indexPairs(:,1)), points2(indexPairs(:,2)));

% 计算本质矩阵
eMatrix = cameraParams2. IntrinsicMatrix.' * fMatrix * cameraParams1.IntrinsicMatrix;

% 计算相机位置和方向
[orient, loc] = relativeCameraPose(eMatrix, cameraParams1, cameraParams2, points1(indexPairs(:,1)), points2(indexPairs(:,2)));

% 计算物体到相机的距离
distance = focalLength * sensorWidth / (2 * imageWidth * abs(loc(1)));

这个程序使用 SURF 特征检测和匹配算法来计算图像中的特征点，并使用相机参数和基础矩阵计算物体到相机的距离。请注意，这只是一个简单的示例，实际应用中可能需要更复杂的算法和更精确的相机参数。