feat: 初始化 Go2 导航代码与配置

This commit is contained in:
2026-10-14 11:08:44 +08:00
parent 8e16ecceba
commit 9dab37e8c8
1258 changed files with 1936673 additions and 0 deletions

View File

@@ -0,0 +1,14 @@
#ifndef FITLINE_H
#define FITLINE_H
#include"type.h"
#include<cmath>
int FitLine2D( Point2D32f * points, int _count, float *weights, float *line );
double CalcDist2D( Point2D32f * points, int count, float *_line, float *dist );
int FitLine2D(Point2D32f * points, int count, float *line);
void WeightL1( float *d, int count, float *w );
void WeightL12( float *d, int count, float *w );
void WeightHuber( float *d, int count, float *w, float _c );
void WeightFair( float *d, int count, float *w, float _c );
void WeightWelsch( float *d, int count, float *w, float _c );
double max(double a, double b);
#endif