Halcon 点云拟合平面并获取单位法向量及位姿

确实因为halcon的文档写的太好了，所以网上关于halcon的博客就很少，点云拟合平面的文档上介绍的比较详细，但是如何从平面模型中读取法向量可确实是难到了，找了三个小时人傻了，然后发现还是一行函数。

首先来说三维点云拟合平面，首先gen_object_model_3d_from_points,把点云转化为3d模型，输入：X，Y，Z坐标，输出ObjectModel3D

gen_object_model_3d_from_points( : : X, Y, Z : ObjectModel3D)

再选择拟合成想要的平面，使用fit_primitives_object_model_3d 把该上模型转化到Plane

fit_primitives_object_model_3d( : : ObjectModel3D, ParamName, ParamValue : ObjectModel3DOut)

ObjectModel3D:输入模型

ParamName：选择'primitive_type':拟合的类型，'fitting_algorithm':拟合方法等等

ParamValue:对应'primitive_type'------'cylinder', 'sphere', 'plane',就是"圆柱体","球体","平面"。对应'primitive_type'------'least_squares', 'least_squares_huber', 'least_squares_tukey'几种最小二乘法,这里选择plane和least_squares

ObjectModel3DOut：输出的平面

得到平面之后，ObjectModel3DOut相当于一个平面的模型，他里边包含各种平面的参数：pose，nomals等等，需要使用一个函数get_object_model_3d_params

get_object_model_3d_params( : : ObjectModel3D, ParamName : ParamValue)

F1文档查看，有所有想要的信息~

然后选择ParamName是'primitive_parameter',取出法向量

选择ParamName是'primitive_pose',取出位姿

代码如下:

X:=[-0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04, -0.04, -0.03, -0.02, -0.01, 0.0, 0.01, 0.02, 0.03, 0.04]
Y:=[-0.04, -0.04, -0.04, -0.04, -0.04, -0.04, -0.04, -0.04, -0.04, -0.03, -0.03, -0.03, -0.03, -0.03, -0.03, -0.03, -0.03, -0.03, -0.02, -0.02, -0.02, -0.02, -0.02, -0.02, -0.02, -0.02, -0.02, -0.01, -0.01, -0.01, -0.01, -0.01, -0.01, -0.01, -0.01, -0.01, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.01, 0.01, 0.01, 0.01, 0.01, 0.01, 0.01, 0.01, 0.01, 0.02, 0.02, 0.02, 0.02, 0.02, 0.02, 0.02, 0.02, 0.02, 0.03, 0.03, 0.03, 0.03, 0.03, 0.03, 0.03, 0.03, 0.03, 0.04, 0.04, 0.04, 0.04, 0.04, 0.04, 0.04, 0.04, 0.04]
Z:=[-0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0, -0.0]
*生成3D模型
gen_object_model_3d_from_points(X, Y, Z, ObjectModel3D)
dev_open_window(0, 0, 512, 512, 'black', WindowHandle)
*展示一下这个平面
fit_primitives_object_model_3d (ObjectModel3D, ['primitive_type','fitting_algorithm'], ['plane','least_squares_tukey'], ObjectModel3DOut)
visualize_object_model_3d (WindowHandle,[ObjectModel3D,ObjectModel3DOut], [],[], \['color_0','color_1','alpha_1','disp_pose'], ['green','gray',0.5,'true'],'RectBOX', [], [], Pose)
*获取法向量,Normal的前三个数值就是单位法向量
get_object_model_3d_params (ObjectModel3DOut, 'primitive_parameter', Normals)

平面图如下：

单位法向量：

刚好是Z轴正方向的那个法向量。

Halcon 点云拟合平面并获取单位法向量及位姿相关推荐

最小二乘求解点云平面方程及其对应法向量
csdn对latex语法支持不完整啊,太不友好了,那我只好上图片了.我把文档已经上传到csdn了,免积分,链接. 本文采用线性最小二乘直接解法(即对矩阵求逆),当矩阵维度大时,可能耗时比较多,可以采用 ...
Halcon 用点来拟合平面
一.简介项目要求用多个点来拟合一个平面,然后再用其他平面上的点来计算这个点到平面的距离,halcon 有现成的拟合函数. MatLab 版本:Matlab 最小二乘法拟合平面_Σίσυφος190 ...
RANSAC点云多平面拟合分割
RANSAC点云多平面拟合分割三维平面拟合(最小二乘法) 假设 P P P 为一个点集, p i p_i pi 是点集中的任意一点, p i ∈ P p_i\in P pi∈P, p c p_c ...
3D点云处理：拟合平面_优化后的最小二乘法
文章目录 0. 拟合效果 1. 论文:一种稳健的点云数据平面拟合方法 1.1 优化过程 2. 参考关联内容: 3D点云处理:拟合平面_最小二乘法_1 0. 拟合效果左(拉格朗日乘子法求解)中(SV ...
点云最小二乘法拟合平面
文章目录一.简介二.算法实现三.实现效果参考文献一.简介点云平面拟合的实质其实就是用一个拟合平面取代近似位于同一平面的点云,使点云中的所有点到拟合平面的距离平方和最小, 达到点云与拟合平面 ...
11 Halcon 点云平面交线计算
/******************************************************************************* @文档名称: 基于点云的平面交线计算. ...
RANSAC算法（2）：（拟合平面）本文以地面为基础以及源码分布解读
本章代码是本人根据一个未曾谋面的好人学习的(要怀抱希望,世界上好人真的是很多的,我要做一个去给别人带去正能量积极态度的人,加油喽),如需转载学习请注明.谢谢 ---------------基于rans ...
RANSAC 算法拟合平面
RANSAC 算法拟合平面视觉库为VisionPro 1.输入参数 Distance Threshold:对于拟合算法的每次迭代,测量候选平面与每个3D输入点之间的距离.比这个阈值更远的点被认为是离 ...
PCL：拟合平面直线和曲线以及空间曲线的原理到算法实现
使用两种思路进行直线拟合: 1.利用逆矩阵思想 --------------进行下列公式的推导需要理解逆矩阵(求A矩阵的逆矩阵,则A矩阵必须是方阵)的知识: (1)为什么要引入逆矩阵呢? 逆矩阵可以类 ...

Halcon 点云拟合平面并获取单位法向量及位姿

Halcon 点云拟合平面并获取单位法向量及位姿相关推荐

最新文章

热门文章