GrabBag/GrabBagConfig/Inc/IVrConfig.h

340 lines
9.7 KiB
C
Raw Normal View History

2025-06-08 12:48:04 +08:00
#ifndef IVRCONFIG_H
#define IVRCONFIG_H
#include <string>
#include <vector>
#include <utility>
#include <algorithm>
2025-06-08 12:48:04 +08:00
2025-07-23 01:35:14 +08:00
/**
* @brief
*/
enum class ProjectType
{
GrabBag = 0, // 抓包
DirectBag = 1, // 带方向的编织袋
};
/**
* @brief
*/
inline std::string ProjectTypeToString(ProjectType type)
{
switch (type) {
case ProjectType::GrabBag:
return "GrabBag";
case ProjectType::DirectBag:
return "DirectBag";
default:
return "Unknown";
}
}
/**
* @brief
*/
inline ProjectType StringToProjectType(const std::string& str)
{
if (str == "GrabBag" || str == "0") {
return ProjectType::GrabBag;
} else if (str == "DirectBag" || str == "1") {
return ProjectType::DirectBag;
} else {
return ProjectType::GrabBag; // 默认返回抓包
}
}
2025-06-08 12:48:04 +08:00
struct DeviceInfo
{
std::string name;
std::string ip;
};
/**
* @brief
*/
struct SerialConfig
{
#ifdef _WIN32
2025-07-23 01:35:14 +08:00
std::string portName = "COM6"; // 串口名称
#else
std::string portName = "/dev/ttyS3"; // 串口名称
#endif
int baudRate = 115200; // 波特率
int dataBits = 8; // 数据位
int stopBits = 1; // 停止位
int parity = 0; // 校验位 (0-无校验, 1-奇校验, 2-偶校验)
int flowControl = 0; // 流控制 (0-无, 1-硬件, 2-软件)
bool enabled = true; // 是否启用串口通信
};
/**
* @brief
*/
struct VrBagParam
{
double bagL = 650.0; // 长
double bagW = 450.0; // 宽
double bagH = 160.0; // 高
};
/**
* @brief
*/
struct VrPileParam
{
double pileL = 1300.0; // 垛长
double pileW = 900.0; // 垛宽
double pileH = 800.0; // 垛高
};
/**
* @brief
*/
struct VrOutlierFilterParam
{
double continuityTh = 20.0; // 连续性阈值
int outlierTh = 5; // 离群点判断阈值
};
/**
* @brief
*/
struct VrCornerParam
{
double minEndingGap = 20.0; // 最小结束间隙
2025-07-23 01:35:14 +08:00
double minEndingGap_z = 20.0; // z方向最小结束间隙
double scale = 15.0; // 计算方向角的窗口比例因子
double cornerTh = 30.0; // 角点阈值
double jumpCornerTh_1 = 60.0; // 判断角点是否为跳跃的第一阈值
double jumpCornerTh_2 = 15.0; // 判断角点是否为跳跃的第二阈值
};
/**
* @brief
*/
struct VrSlopeParam
{
double LSlopeZWin = 10.0; // 计算L型Slope特征高度计算的窗口长度
double validSlopeH = 10.0; // 有效斜率高度
double minLJumpH = 20.0; // 最小L跳跃高度
double minEndingGap = 20.0; // 最小结束间隙
};
/**
* @brief V特征参数
*/
struct VrVFeatureParam
{
double valleyMinH = 10.0; // 山谷最小高度
double valleyMaxW = 80.0; // 山谷最大宽度
};
/**
* @brief
*/
struct VrTreeGrowParam
{
double yDeviation_max = 20.0; // 生长时允许的最大Y偏差
double zDeviation_max = 80.0; // 生长时允许的最大Z偏差
int maxLineSkipNum = 5; // 生长时允许跳过的最大线条数
double maxSkipDistance = 20.0; // 最大跳跃距离
double minLTypeTreeLen = 50.0; // L型树的最小长度
double minVTypeTreeLen = 50.0; // V型树的最小长度
};
2025-07-23 01:35:14 +08:00
/**
* @brief HSV颜色比较参数
*/
struct VrHsvCmpParam
{
double hueTh = 15.0; // 色度阈值,小于门限为同一颜色
double saturateTh = 120.0; // 色饱和度阈值
double FBVldPtRatioTh = 0.075; // 正反两面有效颜色点的比例门限
bool frontVldPtGreater = true; // true有效颜色比例高的点的是正面false有效颜色比例高的点的是反面
bool front_upVldPtGreater = false; // true有效颜色比例高的点的是正面朝上false有效颜色比例高的点的是正面朝下
bool back_upVldPtGreater = true; // true有效颜色比例高的点的是反面朝上false有效颜色比例高的点的是反面朝下
};
/**
* @brief RGB颜色模式
*/
struct VrRgbColorPattern
{
int r = 36; // 红色分量
int g = 165; // 绿色分量
int b = 208; // 蓝色分量
};
/**
* @brief
*/
#define RGN_HIST_SIZE 16
struct VrColorTemplateParam
{
double frontColorTemplate[RGN_HIST_SIZE] = {0.0}; // 正面颜色模板
double backColorTemplate[RGN_HIST_SIZE] = {0.0}; // 反面颜色模板
};
/**
* @brief
*/
struct VrCameraPlaneCalibParam
{
int cameraIndex = 1; // 相机索引1-based
std::string cameraName = ""; // 相机名称
double planeCalib[9] = {1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0}; // 旋转矩阵,将数据调平(默认单位矩阵)
double planeHeight = -1.0; // 参考平面的高度,用于去除地面数据
double invRMatrix[9] = {1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0}; // 逆旋转矩阵,回到原坐标系(默认单位矩阵)
bool isCalibrated = false; // 是否已经校准
};
/**
* @brief
*/
struct VrPlaneCalibParam
{
std::vector<VrCameraPlaneCalibParam> cameraCalibParams; // 各个相机的校准参数
// 获取指定相机的校准参数
VrCameraPlaneCalibParam* GetCameraCalibParam(int cameraIndex) {
for (auto& param : cameraCalibParams) {
if (param.cameraIndex == cameraIndex) {
return &param;
}
}
return nullptr;
}
// 获取指定相机的校准参数const版本
const VrCameraPlaneCalibParam* GetCameraCalibParam(int cameraIndex) const {
for (const auto& param : cameraCalibParams) {
if (param.cameraIndex == cameraIndex) {
return &param;
}
}
return nullptr;
}
// 设置或更新指定相机的校准参数
void SetCameraCalibParam(const VrCameraPlaneCalibParam& param) {
for (auto& existingParam : cameraCalibParams) {
if (existingParam.cameraIndex == param.cameraIndex) {
existingParam = param;
return;
}
}
// 如果不存在,则添加新的
cameraCalibParams.push_back(param);
}
// 移除指定相机的校准参数
void RemoveCameraCalibParam(int cameraIndex) {
cameraCalibParams.erase(
std::remove_if(cameraCalibParams.begin(), cameraCalibParams.end(),
[cameraIndex](const VrCameraPlaneCalibParam& param) {
return param.cameraIndex == cameraIndex;
}),
cameraCalibParams.end());
}
};
/**
* @brief
*/
struct VrDebugParam
{
bool enableDebug = false; // 是否开启调试模式
bool savePointCloud = false; // 是否保存点云数据
bool saveDebugImage = false; // 是否保存调试图像
bool printDetailLog = false; // 是否打印详细日志
std::string debugOutputPath = ""; // 调试输出路径
};
/**
* @brief
*/
struct VrAlgorithmParams
{
VrBagParam bagParam; // 编织袋参数
VrPileParam pileParam; // 垛参数
VrOutlierFilterParam filterParam; // 滤波参数
VrCornerParam cornerParam; // 角点特征参数
VrSlopeParam slopeParam; // 斜率参数
VrVFeatureParam valleyParam; // 山谷参数
VrTreeGrowParam growParam; // 增长参数
VrPlaneCalibParam planeCalibParam; // 平面校准参数
2025-07-23 01:35:14 +08:00
VrHsvCmpParam hsvCmpParam; // HSV颜色比较参数
VrRgbColorPattern rgbColorPattern; // RGB颜色模式
VrColorTemplateParam colorTemplateParam; // 颜色模板参数
};
2025-06-08 12:48:04 +08:00
/**
* @brief
2025-06-08 12:48:04 +08:00
*/
struct ConfigResult
{
std::vector<DeviceInfo> cameraList;
std::vector<DeviceInfo> deviceList;
VrAlgorithmParams algorithmParams; // 算法参数
VrDebugParam debugParam; // 调试参数
SerialConfig serialConfig; // 串口配置
2025-07-23 01:35:14 +08:00
ProjectType projectType; // 项目类型
2025-06-08 12:48:04 +08:00
};
/**
* @brief
*/
class IVrConfigChangeNotify
{
public:
virtual ~IVrConfigChangeNotify() {}
/**
* @brief
* @param configResult
*/
virtual void OnConfigChanged(const ConfigResult& configResult) = 0;
};
2025-06-08 12:48:04 +08:00
/**
* @brief VrConfig接口类
2025-06-08 12:48:04 +08:00
*/
class IVrConfig
{
public:
/**
* @brief
2025-06-08 12:48:04 +08:00
*/
virtual ~IVrConfig() {}
/**
* @brief
* @return
2025-06-08 12:48:04 +08:00
*/
static bool CreateInstance(IVrConfig** ppVrConfig);
/**
* @brief
* @param filePath
* @return
2025-06-08 12:48:04 +08:00
*/
virtual ConfigResult LoadConfig(const std::string& filePath) = 0;
/**
* @brief
* @param filePath
* @param configResult
* @return
2025-06-08 12:48:04 +08:00
*/
virtual bool SaveConfig(const std::string& filePath, ConfigResult& configResult) = 0;
/**
* @brief
* @param notify
*/
virtual void SetConfigChangeNotify(IVrConfigChangeNotify* notify) = 0;
2025-06-08 12:48:04 +08:00
};
#endif // IVRCONFIG_H