通俗易懂理解RANSAC算法

RANSAC(Random Sample Consensus),翻译为随机抽样一致算法。

算法思路:从所有观测中随机找到几个尽可能少的点去拟合模型,拟合后依次计算模型和所有观测数据的残差,当残差小于给定的阈值时,就将其判断为内点,大于给定的阈值时,就判断为外点,并统计内点的数量,然后再次随机选取几个点拟合模型迭代。如果本次拟合内点数量大于先前的模型,就将旧模型迭代为新的模型。

做过AMCL算法的同学是不是秒懂了,感觉就是一个低配版的粒子滤波。

直接上代码,以我正在做的项目中的一环进行代码分享(三维平面的拟合)。

#include <Eigen/Dense>
#include <cmath>
#include <iostream>
#include <limits>
#include <random>
#include <vector>#include "opencv2/highgui.hpp"
#include "opencv2/imgproc.hpp"
using namespace std;
using namespace cv;
using namespace Eigen;struct Point3D {double x, y, z;
};double distance(const Point3D& p1, const Point3D& p2) {return std::sqrt(std::pow(p1.x - p2.x, 2) + std::pow(p1.y - p2.y, 2) +std::pow(p1.z - p2.z, 2));
}Point3D ransacPlaneFitting(const std::vector<Point3D>& points, int max_iterations,double distance_threshold) {int n = points.size();// 生成随机数std::random_device rd;  // 用于随机数引擎获得随机种子std::mt19937 gen(rd()); // 以rd()为种子的标准mersenne_twister_enginestd::uniform_int_distribution<> dis(0, n - 1); // 限制随机数范围Point3D best_plane{0, 0, 0};int best_inliers = 0;// 一直迭代for (int i = 0; i < max_iterations; ++i) {int idx1 = dis(gen);int idx2 = dis(gen);int idx3 = dis(gen);Point3D p1 = points[idx1];Point3D p2 = points[idx2];Point3D p3 = points[idx3];double a = (p2.y - p1.y) * (p3.z - p1.z) - (p2.z - p1.z) * (p3.y - p1.y);double b = (p2.z - p1.z) * (p3.x - p1.x) - (p2.x - p1.x) * (p3.z - p1.z);double c = (p2.x - p1.x) * (p3.y - p1.y) - (p2.y - p1.y) * (p3.x - p1.x);double d = -a * p1.x - b * p1.y - c * p1.z;int inliers = 0;double m_dist = std::sqrt(a * a + b * b + c * c);for (const auto& point : points) {double dist = std::abs(a * point.x + b * point.y + c * point.z + d) / m_dist;if (dist < distance_threshold) {++inliers;}}if (inliers > best_inliers) {best_inliers = inliers;best_plane = {a, b, c};}}return best_plane;
}int main() {int png_size = 4;// TODO: 需要输入一个三维点集std::vector<Point3D> points;int max_iterations = 1000;double distance_threshold = 0.05;Point3D plane = ransacPlaneFitting(points, max_iterations, distance_threshold);// 输出平面的 ABC值std::cout << "Best plane: (" << plane.x << ", " << plane.y << ", " << plane.z << ")"return 0;
}

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/news/846554.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

软件测试进阶

目录 一、自动化测试 1.概念 2.Selenium 2.1 概念 2.1.1 Selenium是什么&#xff1f; 2.1.2 Selenium特点 2.1.3 工作原理 2.2 SeleniumJava环境搭配 2.3 定位元素 2.3.1 CSS语法 2.3.2 XPath语法 2.4 应用 2.4.1 点击提交文本 2.4.2 模拟输入 2.4.3 清除文本 2…

统信UOS桌面操作系统1070上使用notepad--文本编辑器

原文链接&#xff1a;统信UOS桌面操作系统1070上使用notepad–文本编辑器 Hello&#xff0c;大家好啊&#xff01;今天我要向大家推荐一款在统信UOS桌面操作系统1070上非常好用的文本编辑器软件——“notepad–”。这款软件功能强大、操作简便&#xff0c;特别适合开发人员和日…

车载软件架构 - AUTOSAR 的信息安全框架

车载软件架构 - AUTOSAR 的信息安全架构 我是穿拖鞋的汉子&#xff0c;魔都中坚持长期主义的汽车电子工程师。 老规矩&#xff0c;分享一段喜欢的文字&#xff0c;避免自己成为高知识低文化的工程师&#xff1a; 屏蔽力是信息过载时代一个人的特殊竞争力&#xff0c;任何消耗…

Nginx企业级负载均衡:技术详解系列(17)—— 长连接优化策略与下载服务器高效搭建

你好&#xff0c;我是赵兴晨&#xff0c;97年文科程序员。 今天咱们来聊聊Nginx的两个知识点&#xff1a;Nginx的长连接优化、如何将Nginx配置成下载服务器。 长连接配置详解 在Nginx的配置中&#xff0c;长连接是一个重要的性能优化手段。它允许一个TCP连接上发送多个请求和…

STM32作业实现(一)串口通信

目录 STM32作业设计 STM32作业实现(一)串口通信 STM32作业实现(二)串口控制led STM32作业实现(三)串口控制有源蜂鸣器 STM32作业实现(四)光敏传感器 STM32作业实现(五)温湿度传感器dht11 STM32作业实现(六)闪存保存数据 STM32作业实现(七)OLED显示数据 STM32作业实现(八)触摸按…

C++指针和引用到内存泄漏,内存对齐——面试八股素材库

参考《CPrimer》2.3 复合结构&#xff1b; C内存管理&#xff0c;内存泄漏&#xff0c;内存对齐 目录 指针和引用 引用和指针差别 引用 指针 具体用法差异 常量指针和指向常量对象的指针 const int * ptr; 和 int const * ptr 和 int * const ptr; 区别 const int *ptr…

c++实现:小型公司的信息管理系统(关于多态)

前言&#xff1a; 介绍员工信息&#xff1a;一个小型公司的人员信息管理系统 某小型公司&#xff0c;主要有四类人员&#xff1a;经理、技术人员、销售经理和推销员。现在&#xff0c;需要存储这些人员的姓名、编号、级别、当前薪水。计算月薪总额并显示全部信息人员编号基数为…

Nginx企业级负载均衡:技术详解系列(16)—— Nginx的try_files指令,你知道这个指令是干什么的吗?

你好&#xff0c;我是赵兴晨&#xff0c;97年文科程序员。 今天咱们来聊一聊Nginx的try_files指令&#xff0c;你知道这个指令是干什么的吗&#xff1f; 如果你对Web服务器配置有所了解&#xff0c;那么你可能会对try_files指令感到好奇。这个指令实际上是Nginx配置中的一项强…

提高工作效率的招数

自己的工作效率为啥比别人低&#xff0c;因为不会使用工具&#xff0c;这就是一个大冤种。 1.血泪教训&#xff0c;写代码调用第三方接口的时候已经要打印调用日志&#xff0c;不然扯皮真的难搞。 2.pg 上测试或的时候由于schema 错误mybatis会给你报空指针一样&#xff0c;还…

服务失败后如何重试?

服务失败后如何重试&#xff1f; 在分布式系统和网络应用程序中&#xff0c;重试策略对于有效处理瞬时错误和网络不稳定性至关重要。 重试策略能让系统在发生故障时多次尝试操作&#xff0c;从而提高最终成功的可能性。 下图显示了 4 种常见的重试策略。 01 线性回退 线性回…

SMV 算法【python,机器学习,算法】

支持向量机&#xff08;Support Vector Machine, SVM&#xff09;是一类按监督学习&#xff08;supervised learning&#xff09;方式对数据进行二元分类的广义线性分类器&#xff08;generalized linear classifier&#xff09;&#xff0c; 其决策边界是对学习样本求解的最大…

SSMP整合案例第六步 在前端页面上利用axios和element-ui与后端交互实现增删改

新增操作 正常我们都是从新增功能书写 查看源码 显示的是这个 在vue里面开下来 这样就能显示 点击确定 就能把数据发送到后台进行保存 //弹出添加窗口handleCreate() {this.dialogFormVisible true;},//重置表单resetForm() {},//添加handleAdd() {//绑定的是确定按钮 发起请…

浅谈Qt:跨平台开发的现在与未来

在软件开发领域&#xff0c;跨平台框架一直是热门话题。Qt作为一个成熟且功能丰富的跨平台C开发库&#xff0c;自从1991年由挪威Trolltech公司开发以来&#xff0c;已经走过了30多年的历程。Qt主要用于开发图形用户界面&#xff08;GUI&#xff09;程序&#xff0c;同时也支持开…

Educational Codeforces Round 166 (Rated for Div. 2) (A~C)

A. Verify Password 思路:按照ASCLL值进行比较就行(因为字母的ASCLL本来就在数字后面),所以,只要找到前面比后面的数大就输出NO,反之YES 代码实现: #include<bits/stdc.h> using namespace std; #define N 100005 typedef long long ll; ll n, m, num, sum, t; ll a[N]…

[力扣题解] 257. 二叉树的所有路径

题目&#xff1a;257. 二叉树的所有路径 思路 前序遍历 代码 /*** Definition for a binary tree node.* struct TreeNode {* int val;* TreeNode *left;* TreeNode *right;* TreeNode() : val(0), left(nullptr), right(nullptr) {}* TreeNode(int x)…

电脑死机问题排查

情况描述&#xff1a;2024年6月2日下午16&#xff1a;04分电脑突然花屏死机&#xff0c;此情况之前遇到过三次&#xff0c;认为是腾讯会议录屏和系统自带录屏软件冲突导致。 报错信息&#xff1a;应用程序-特定 权限设置并未向在应用程序容器 不可用 SID (不可用)中运行的地址…

整理好了!2024年最常见 20 道 Kafka面试题(二)

上一篇地址&#xff1a;整理好了&#xff01;2024年最常见 20 道 Kafka面试题&#xff08;一&#xff09;-CSDN博客 三、请解释Kafka中的生产者&#xff08;Producer&#xff09;和消费者&#xff08;Consumer&#xff09;。 在Kafka中&#xff0c;生产者&#xff08;Produce…

微信小程序的优劣势

微信小程序的优劣势可以归纳如下&#xff1a; 优势&#xff1a; 快速部署与低成本&#xff1a; 微信小程序允许商家快速搭建线上店铺&#xff0c;大大缩短了上线时间和开发周期&#xff0c;降低了初期投入成本。商家可以根据自身需求选择合适的模板&#xff0c;并进行个性化设…

C++设计模式|结构型 代理模式

1.什么是代理模式&#xff1f; 代理模式Proxy Pattern是一种结构型设计模式&#xff0c;用于控制对其他对象的访问。 在代理模式中&#xff0c;允许一个对象&#xff08;代理&#xff09;充当另一个对象&#xff08;真实对象&#xff09;的接口&#xff0c;以控制对这个对象的…

牛客周赛 Round 45VP

这场应该是十分仁慈的一场了 1.签到&#xff1a;https://ac.nowcoder.com/acm/contest/84244/A AC代码&#xff1a; #include<bits/stdc.h> using namespace std; int a,b,c,d,e; int main() {cin>>a>>b>>c>>d>>e;int sabcde;if(s>1…