利用halcon解方程,和曲线拟合

Size:=500
X := [25:50:Size]
Y := 15 + 0.4 * X + 0.001 * X * X
Y := Y + 40 * rand(|Y|)

% 随机生成点集


gen_cross_contour_xld (Cross, Size - Y, X, 15, 0.785398)
% 将坐标点变成十字架图标。



% 现在将生成的点进行二次曲线拟合:f(x) = a*x^2 + b*x + c
 
转化为: Ax = B
        A=[X^2, X, 1],
        x = [a, b, c]
        B=f(x)
/

create_matrix (|X|, 3, 1.0, MatrixA)    
* 创建|x|行3列,值为1.0的矩阵

create_matrix (|X|, 1, X, MatrixACol1)
* 创建|x|行1列,值为x的矩阵,x== [25:50:Size]

create_matrix (|X|, 1, X * X, MatrixACol0)
* 创建|x|行1列,值为X * X的矩阵

set_sub_matrix (MatrixA, MatrixACol1, 0, 1)
*用矩阵MatrixACol1来替换矩阵MatrixA中的0行1列中的值

set_sub_matrix (MatrixA, MatrixACol0, 0, 0)
*用矩阵MatrixACol0来替换矩阵MatrixA中的0行0列中的值(这里MatrixA是经过上一步变换之后的矩阵)

create_matrix (|X|, 1, Y, MatrixB)


solve_matrix (MatrixA, 'general', 0, MatrixB, MatrixX)
* 解方程即可得到a,b,c的系数,记为矩阵MatrixX

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%


/曲线拟合//
Sequence := [0:1200]

*该函数是得到矩阵MatrixX中0行0列的值
get_value_matrix (MatrixX, 0, 0, A)
get_value_matrix (MatrixX, 1, 0, B)
get_value_matrix (MatrixX, 2, 0, C)

*得到多项式的值
Distances := A * Sequence * Sequence + B * Sequence + C

% 将坐标点变成十字架图标。
gen_contour_polygon_xld (Contour, Size - Distances, Sequence)
dev_set_color ('forest green')
dev_display (Contour)
Message := 'Approximated quadratic function'
Message[1] := 'f(x) = ' + A$'.2' + '*x^2 + ' + B$'.2' + '*x + ' + C$'.2' + ''
disp_message (WindowHandle, Message, 'window', 100, 25, 'forest green', 'false')
disp_end_of_program_message (WindowHandle, 'black', 'true')

 

  • 5
    点赞
  • 19
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
Hi~ 可私信我了解后再进行下载~ 1.基于halcon算法平台; 2.提供深度图源文件以及解压密码; 3.代码预览: */********************************* * @文档名称: 基于点云的平面拟合。 * @作者: hugo * @版本: 1.1 * @日期: 2021-6-16 * @描述: 该方法支持点云平面拟合以及深度图平面拟合。 **********************************/* read_image (imageReal, './replay_38893_2021-6-7.tif') xResolution:=0.06 yResolution:=0.06 zResolution:=0.001 ScaleFactor:=[xResolution,yResolution,zResolution] rateLowRemove:=0.1 rateHighRemove:=0.1 dev_get_window (WindowHandle) *采样区域1 create_drawing_object_rectangle2 (300, 120, rad(90), 30, 20, DrawID) set_drawing_object_params (DrawID, 'color', 'red') set_drawing_object_params (DrawID, 'line_width', 1) attach_drawing_object_to_window (WindowHandle, DrawID) ......... TransPose := [0,0,d,0,0,0,0] rigid_trans_object_model_3d (SampledObjectModel3D1, TransPose, _SampledObjectModel3D1) rigid_trans_object_model_3d (ObjectModelPlane1, TransPose, _ObjectModelPlane1) create_pose (0, 0, Mean/2, 180, 0, 0, 'Rp+T', 'gba', 'point', Pose1) *visualize_object_model_3d (WindowHandle, [_ObjectModelPlane1,_SampledObjectModel3D1,SampledObjectModel3D2], [], [Pose1], [], ['intensity','lut','lut'], ['&amplitude','sqrt','sqrt'], '', 'Edited by AmazingRobot+ ' , PoseOut) visParamName := ['intensity_1','color_0','color_2','alpha_0'] visParamValue := ['coord_z','red','yellow',0.5] visualize_object_model_3d (WindowHandle, [_SampledObjectModel3D1,SampledObjectModel3D2,_ObjectModelPlane1], [], [], visParamName, visParamValue, 'Edited by AmazingRobot+', [], '', PoseOut) stop () 谢谢您的信任~
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值