algoLib/sourceCode/workpieceHolePositioning_Export.h
2026-01-26 22:36:13 +08:00

50 lines
1.3 KiB
C++

#pragma once
#include "SG_algo_Export.h"
#include <vector>
#define _OUTPUT_DEBUG_DATA 1
typedef struct
{
int workpieceType;
double holeDiameter; //孔直径
double holeDist_L; //孔间距_长
double holeDist_W; //孔间距_宽
}WD_workpieceHoleParam;
typedef struct
{
int workpieceType;
std::vector<SVzNL3DPoint> holes;
std::vector<SVzNL3DPoint> holesDir;
SVzNL3DPoint center;
SVzNL3DPoint z_dir;
SVzNL3DPoint y_dir;
}WD_workpieceInfo;
//读版本号
SG_APISHARED_EXPORT const char* wd_workpieceHolePositioningVersion(void);
//相机水平安装计算地面调平参数。。
//旋转矩阵为调平参数,即将平面法向调整为垂直向量的参数
SG_APISHARED_EXPORT SSG_planeCalibPara wd_getGroundCalibPara(
std::vector< std::vector<SVzNL3DPosition>>& scanLines);
//相机水平时姿态调平,并去除地面
SG_APISHARED_EXPORT void wd_lineDataR(
std::vector< SVzNL3DPosition>& a_line,
const double* camPoseR,
double groundH);
//工件孔定位
SG_APISHARED_EXPORT void wd_workpieceHolePositioning(
std::vector< std::vector<SVzNL3DPosition>>& scanLinesInput,
const WD_workpieceHoleParam workpiecePara,
const SSG_lineSegParam lineSegPara,
const SSG_outlierFilterParam filterParam,
const SSG_treeGrowParam growParam,
const SSG_planeCalibPara groundCalibPara,
std::vector< WD_workpieceInfo>& workpiecePositioning,
int* errCode);