Halcon之最小二乘拟合直线

 

参考:https://www.cnblogs.com/xiaomaLV2/p/6697167.html

首先随机生成一组数据

Mx:=[100:10:500]

tuple_length(Mx,len)

tuple_gen_const(len,5,r)

Ma:=2

Mb:=40

tuple_rand(len , noise)

My:= Ma *Mx + Mb*noise

gen_circle(ContCircle, My, Mx, r)

Halcon之最小二乘拟合直线_第1张图片

 

1

2

3

4

5

6

7

接下来用矩阵进行最小二乘求解

* y = ax + b

* y1 = ax1 + b

* y2 = ax2 + b

* ... .......

* yn = ax + b

Halcon之最小二乘拟合直线_第2张图片

1

 

1

2

3

4

5

6

7

8

9

10

11

12

13

14

15

16

17

18

19

20

21

create_matrix(len,1,My,y)

create_matrix(len,2,1,x)

set_value_matrix(x, [0:len-1], gen_tuple_const(len, 0),Mx)

  

* XT 代表X的转置 inv(*)代表*的逆

* x beta = y

* xT x beta = xT y

* beta = inv( xT x) xT y

  

mult_matrix(x,x,'ATB',xtx)

mult_matrix(x,y,'ATB',xty)

  

invert_matrix(xtx,'general', 0, invxtx)

  

mult_matrix(invxtx,xty,'AB', beta)

  

get_full_matrix(beta, Values)

  

Newy:=Values[0] * [10,800] + Values[1]

  

gen_contour_polygon_xld(Contour, Newy, [10,800])

Halcon之最小二乘拟合直线_第3张图片

你可能感兴趣的:(Halcon)