camera calibrate点集排序算法

工具具体使用和说明请参考博客 https://blog.csdn.net/cuixing001/article/details/81194145

function main_sort（）
% 功能：相机标定点顺序提取，对无序点集按照“从上到下，从左到右”的原则排序。
% author:cuixingxing
% email: cuixingxing150@gmail.com
% 2018.7.23
%
%% Step1 人工制造6*10个投影变换点，并打乱排列顺序
rng（0）;
mode = [610];% 标定点模式，m*n个点
[XY] = meshgrid（1:mode（2）1:mode（1））;
T = [2.73790.29290;
    0.74260.750.1;
    0.531.00];% 手工设定的透视变换矩阵
coordates = [X（:）Y（:）ones（length（X（:））1）];
new_coords = coordates*T;
new_coords = new_coords./new_coords（:3）;

% 制造打乱顺序的点集，数字表示坐标唯一编号
n = length（X（:））;
index = randperm（nn）;
unorder_pts = new_coords（index[12]）;
figure;
hold on;
for i = 1:n
    plot（unorder_pts（i1）unorder_pts（i2）‘r.‘‘MarkerSize‘20）;
    text（unorder_pts（i1）+0.2unorder_pts（i2）num2str（i））
end
grid on
title（‘unordered points‘）

%% Step2算法排序
order_mat_index = CalibSort（unorder_ptsmode）;

%% Step3 结果显示，排序好的索引应用到原无序点集坐标，并逐个按顺序绘制
figure;
hold on;
n = 1;
for i = 1:mode（1）
    for j = 1:mode（2）
        index = order_mat_index（ij）;
        plot（unorder_pts（index1）unorder_pts（index2）‘r.‘‘MarkerSize‘20）;
        text（unorder_pts（index1）+0.1unorder_pts（index2）num2str（n））;
        n = n+1;
    end
end
grid
title（‘ordered points‘）
end

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2018-07-25 00:38  相机标定点集排序算法\
     文件         236  2018-07-25 00:18  相机标定点集排序算法\CalcPoint.p
     文件        1360  2018-07-25 00:18  相机标定点集排序算法\CalibSort.p
     文件         199  2018-07-25 00:18  相机标定点集排序算法\FindNearestPt.p
     文件         360  2018-07-25 00:18  相机标定点集排序算法\GetDiagPts.p
     文件         295  2018-07-25 00:18  相机标定点集排序算法\IsSameLine.p
     文件         285  2018-07-25 00:18  相机标定点集排序算法\JudgePtUpLine.p
     文件         273  2018-07-25 00:18  相机标定点集排序算法\JudgeSameSide.p
     文件        1319  2018-07-25 00:34  相机标定点集排序算法\main_sort.m
     文件          97  2018-07-25 00:39  相机标定点集排序算法\readme.txt