MATLAB Scan-matching test harness