Presentation is loading. Please wait.

Presentation is loading. Please wait.

M. De Cecco - Robotics and Sensor Fusion RANSAC RANdom SAmple Consensus Prof. Mariolino De Cecco, Ing. Luca Baglivo, Ing. Nicolò Blasi, Ilya Afanasyev.

Similar presentations


Presentation on theme: "M. De Cecco - Robotics and Sensor Fusion RANSAC RANdom SAmple Consensus Prof. Mariolino De Cecco, Ing. Luca Baglivo, Ing. Nicolò Blasi, Ilya Afanasyev."— Presentation transcript:

1 M. De Cecco - Robotics and Sensor Fusion RANSAC RANdom SAmple Consensus Prof. Mariolino De Cecco, Ing. Luca Baglivo, Ing. Nicolò Blasi, Ilya Afanasyev Department of Structural Mechanical Engineering, University of Trento

2 M. De Cecco - Robotics and Sensor Fusion ANALISI DI REGRESSIONE Lanalisi di regressione consente di determinare i parametri di un modello in modo tale che al meglio interpreti i dati sperimentali mediante un legame algebrico ingresso-uscita. Regressione di un modello

3 M. De Cecco - Robotics and Sensor Fusion Scopo Determinare i parametri c i, i=1,...m, in base alla ripetizione delle misure delle grandezze x i, i=1,...N, e delle corrispondenti uscite y i ed alla scelta del tipo di modello, minimizzando un certo indice di prestazione. 3. regressione del modello

4 M. De Cecco - Robotics and Sensor Fusion Nel metodo dei minimi quadrati lindice di prestazione è costituito dalla somma dei quadrati degli scarti (anche detti residui): Essendo: 3. regressione del modello Linsieme dei parametri si determina:

5 M. De Cecco - Robotics and Sensor Fusion parametri (a,b) x y N Dati sperimentali 3. regressione del modello Caso lineare - Calcolo retta ai minimi quadrati: Si noti che i residui risultano essere lineari in funzione dei parametri da determinare Dunque anche il fitting con un polinomio qualsiasi risulta risolvibile in maniera analoga i

6 M. De Cecco - Robotics and Sensor Fusion Posizione del problema 3. regressione del modello (La soluzione ha un solo minimo)

7 M. De Cecco - Robotics and Sensor Fusion Soluzione 3. regressione del modello Dove:

8 M. De Cecco - Robotics and Sensor Fusion What happens if we have outliers ? outlier Fitted line Fitting with outliers

9 M. De Cecco - Robotics and Sensor Fusion Lets try to formalize a more general way of fitting data with outliers. The problem can be stated in the following way: given a set of 2D data points, find the line which minimizes the sum of squared perpendicular distances (orthogonal regression), subject to the condition that none of the valid points deviates from this line by more than a threshold t This is actually two problems: 1.classification of the data into inliers (valid points) and outliers. The threshold t is set according to the measurement noise (for example t = 3 ), 2.line fit to the data Fitting with outliers

10 M. De Cecco - Robotics and Sensor Fusion The key idea is very simple: repeat N times the following: select randomly two points compute the connecting line the support for this line is measured by the number of points that lie within the distance threshold t the line with most support is deemed the robust fit The points within the threshold distance are the inliers (and constitute the consensus set). Fitting with outliers

11 M. De Cecco - Robotics and Sensor Fusion The intuition is that if one of the points is an outlier then the line will not gain much support Fitting with outliers

12 M. De Cecco - Robotics and Sensor Fusion Scoring a line by its support has the additional advantage of favouring better fits. The line (a, b) has a support of 10, whereas the line (a, d), where the sample points are neighbours, has a support of only 4. Consequently, even though both samples contain no outliers, the line (a. b) will be selected Fitting with outliers

13 M. De Cecco - Robotics and Sensor Fusion As stated by Fischler and Bolles [Fischler, 1981]: "The RANSAC procedure is opposite to that of conventional smoothing techniques: Rather than using as much of the data as possible to obtain an initial solution and then attempting to eliminate the invalid data points (like for example using the Chauvenet criteria), RANSAC uses as small an initial data set as feasible and enlarges this set with consistent data when possible". Fitting with outliers

14 M. De Cecco - Robotics and Sensor Fusion Objective Robust fit of a model to a data set S which contains outliers. Algorithm Randomly select a sample of s data points from S and instantiate the model from this subset Determine the set of data points Si which are within a distance threshold t of the model. The set Si, is the consensus set of the sample and defines the inliers of S If the size of Si (the number of inliers) is greater than some threshold T, re- estimate the model using all the points in Si and terminate (iv) If the size of Si is less than T, select a new subset and repeat the above, (v) After N trials the largest consensus set Si is selected, and the model is re-estimated using all the points in the subset Si Algorithm

15 M. De Cecco - Robotics and Sensor Fusion Algorithm revised Select a sample of s data Use the s data to estimate the model Determine the consensus set Si and its cardinality ns ns >T Use Si to estimate the model yes no Determine the new consensus set Si and the cardinality ns new yes n new = n old no Stop Verify the sample data This to verify if the sample is able to provide a reliable fitting This to ensure a Maximum Likelikood solution { {

16 M. De Cecco - Robotics and Sensor Fusion It is often computationally infeasible and unnecessary to try every possible sample. Instead the number of samples N is chosen sufficiently high to ensure with a probability, p, that at least one of the random samples of s points is free from outliers. Usually p is chosen at 0.99 The number N of samples required to ensure, with a probability p = 0.99, that at least one sample has no outliers for a given size of sample S, and proportion of outliers Number of samples

17 M. De Cecco - Robotics and Sensor Fusion For a given and p the number of samples increases with the size of the minimal subset It might be thought that it would be advantageous to use more than the minimal subset, three or more points in the case of a line, because then a better estimate of the line would be obtained, and the measured support would more accurately reflect the true support. However, this possible advantage in measuring support is generally outweighed by the severe increase in computational cost incurred by the increase in the number of samples. How large is an acceptable consensus set? A rule of thumb is to terminate if the size of the consensus set is similar to the number of inliers believed to be in the data set, given the assumed proportion of outliers, i.e. for n data points T < (1 - ) n Number of samples - consensus set

18 M. De Cecco - Robotics and Sensor Fusion An advantage of RANSAC is its ability to achieve robust estimation of the model parameters, i.e., it can estimate the parameters with a high degree of accuracy even when significant amount of outliers are present in the data set. A disadvantage of RANSAC is that there is no upper bound on the time it takes to compute these parameters. When an upper time bound is used (a maximum number of iterations) the solution obtained may not be the optimal one, it may not even be one that fits the data in a good way. A reasonable model can be produced by RANSAC only with a certain probability, a probability that becomes larger the more iterations that are used Another disadvantage of RANSAC is that it requires the setting of problem-specific thresholds. RANSAC - conclusions

19 M. De Cecco - Robotics and Sensor Fusion Example - plane fitting Suppose we acquired the 3D cloud of points of a cube:

20 M. De Cecco - Robotics and Sensor Fusion close all clear all % CARICHIAMO E PLOTTIAMO IL SET DI DATI load('Points.mat'); all_point = Points(:, 1:3); all_point(:, 1) = -all_point(:, 1); % convenzione Kinect ? % Plot all points figure('Name','All points') hold on axis equal plot3(Points(:,1), Points(:,2), Points(:,3), '.' ) % FITTIAMO CON RANSAC IL PIANO % decimiamo i punti ss = length(all_point); ii = 1 : 10 : ss; all_pointDec = all_point(ii, :); % FIT RANSAC [B, P, inliers] = ransacfitplane(all_pointDec', 0.01, 1); % Plot risultato plotPlane3D( all_point', B ) Example - main function

21 M. De Cecco - Robotics and Sensor Fusion % RANSACFITPLANE - fits plane to 3D array of points using RANSAC % Usage [B, P, inliers] = ransacfitplane(XYZ, t, feedback) % This function uses the RANSAC algorithm to robustly fit a plane % to a set of 3D data points. % % Arguments: % XYZ - 3xNpts array of xyz coordinates to fit plane to. % t - The distance threshold between data point and the plane % used to decide whether a point is an inlier or not. % feedback - Optional flag 0 or 1 to turn on RANSAC feedback % information. % % Returns: % B - 4x1 array of plane coefficients in the form % b(1)*X + b(2)*Y +b(3)*Z + b(4) = 0 % The magnitude of B is 1. % This plane is obtained by a least squares fit to all the % points that were considered to be inliers, hence this % plane will be slightly different to that defined by P below. % P - The three points in the data set that were found to % define a plane having the most number of inliers. % The three columns of P defining the three points. % inliers - The indices of the points that were considered % inliers to the fitted plane. % Copyright (c) Peter Kovesi Example - RANSACFITPLANE

22 M. De Cecco - Robotics and Sensor Fusion s = 3; % Minimum No of points needed to fit a plane. fittingfn distfn degenfn [P, inliers] = ransac(XYZ, fittingfn, distfn, degenfn, s, t, feedback); % Perform least squares fit by means of the inlying points B = fitplane(XYZ(:,inliers)); % % Function to define a plane given 3 data points as required by % RANSAC. In our case we use the 3 points directly to define the plane. function P = defineplane(X); P = X; Example - RANSACFITPLANE

23 M. De Cecco - Robotics and Sensor Fusion % Function to calculate distances between a plane and a an array of points in the X matrix where % each column represents the x, y, z coordinates (X: 3 x Npts array of xyz coordinates) % The plane is defined by a 3x3 matrix, P. The three columns of P defining % three points that are within the plane. function [inliers, P] = planeptdist(P, X, t) n = cross(P(:,2)-P(:,1), P(:,3)-P(:,1)); % Plane normal. n = n/norm(n); % Make it a unit vector. npts = length(X); d = zeros(npts,1); % d will be an array of distance values. % The perpendicular distance from the plane to each point: % d = n * ( X - P(:,1) ) [1 x Npts] for i=1:3 d = d + ( X(i,:) - P(i,1) ) * n(i) ; end inliers = find(abs(d) < t); % Function to determine whether a set of 3 points are in a degenerate % configuration for fitting a plane as required by RANSAC. In this case % they are degenerate if they are colinear. function r = isdegenerate(X) % The three columns of X are the coords of the 3 points. r = iscolinear(X(:,1),X(:,2),X(:,3)); Example - RANSACFITPLANE

24 M. De Cecco - Robotics and Sensor Fusion At the end we obtain the following fitted floor plane Example - OUTCOME

25 M. De Cecco - Robotics and Sensor Fusion Ideas for homework 1.To use the camera view to assert consensus. Colour or curvature information could be used 2.To use the 3D and colour information to assert consensus 3.To modify the consensus criteria simulating the laser view of the fitted object Ideas for homework

26 M. De Cecco - Robotics and Sensor Fusion ….


Download ppt "M. De Cecco - Robotics and Sensor Fusion RANSAC RANdom SAmple Consensus Prof. Mariolino De Cecco, Ing. Luca Baglivo, Ing. Nicolò Blasi, Ilya Afanasyev."

Similar presentations


Ads by Google