三维人脸拟合圆柱

function [bestline bestr bestpoint pretotal new_grids] = consensus_cylinder（selected_grids selected_normal_vector grids）
dcxmin=0.050;
dcxmax=0.100;
dcymax=0.050;
dmax=0.020;
angel_max=pi/4;
dkeep=0.075;
C_cy1=0;
%d1=cross（linegrids（1:）-point）/sqtr（line.*line）-r

%clc;clear all;close all;

%%%二维直线拟合
%%%生成随机数据
%内点
%mu=[0 0];  %均值
%S=[1 2.5;2.5 8];  %协方差
%data1=mvnrnd（muS200）;   %产生200个高斯分布数据
%外点
%mu=[2 2];
%S=[8 0;0 8];
%data2=mvnrnd（muS100）;     %产生100个噪声数据
%合并数据
%data=[data1‘data2‘];
%iter = 100; 

 %%% 绘制数据点
 %figure;plot（data（1:）data（2:）‘o‘）;hold on; % 显示数据点
 %number = size（data2）; % 总点数
 %bestParameter1=0; bestParameter2=0; % 最佳匹配的参数
% sigma = 1;
 bestline=[000];          %找到最好的拟合直线
         
        bestpoint=[000];
    bestr=0;