隧道中线提取的优化方法

目录

一、算法原理

1、优化方法


2、参考文献

105

二、代码实现

cpp 复制代码
#include <iostream>
#include <vector>
#include <algorithm>
#include <pcl/point_types.h>
#include <pcl/point_cloud.h>
#include <Eigen/Dense>
#include <Eigen/Geometry>



struct QuadraticCoeffs 
{
    double a, b, c;  // 二次多项式系数: 对于XOY: x = a*y^2 + b*y + c; 对于YOZ: z = a*y^2 + b*y + c

    QuadraticCoeffs() : a(0), b(0), c(0) {}
    QuadraticCoeffs(double a_, double b_, double c_) : a(a_), b(b_), c(c_) {}

    double evaluate(double y) const 
    {
        return a * y * y + b * y + c;
    }

    double derivative(double y) const 
    {
        return 2.0 * a * y + b;
    }
};


/**
 * @brief计算法线与目标曲线的交点
 */
std::pair<bool, Eigen::Vector2d> findIntersectionWithNormal(
    double y0, double val0,  // 当前点在曲线1上的坐标
    const QuadraticCoeffs& curve1_coeffs,  // 当前点所在曲线
    const QuadraticCoeffs& curve2_coeffs)  // 目标曲线
{
    // 计算曲线1在当前点的导数
    double f_prime_y0 = curve1_coeffs.derivative(y0);
    // 法线斜率 = -1/f'(y0)
    double slope_normal = -1.0 / f_prime_y0;

    }
}
相关推荐
个 人 练 习 生10 小时前
C++:从零基础到深入了解vector的使用
开发语言·c++·经验分享·学习·程序人生·stl
ShineWinsu11 小时前
对于Qt窗口:QMainWindow、QMenuBar、Qmenu、QAction的解析
c++·qt·菜单·qmainwindow·qaction·qmenu·qmenubar
forest_0911 小时前
《AI 编程 Harness 实战手册》04|审批这道门:点了一百次“允许”,还剩多少作用?
人工智能·算法·prompt·agi
H.莓飛11 小时前
【C++】【STL】stack_OJ题
服务器·c语言·开发语言·数据结构·c++·算法·visual studio
Rabitebla12 小时前
【Linux操作系统】 文件篇(一):文件描述符与 Linux 文件管理机制
linux·网络·c++·笔记·学习
不会武功不懂江湖13 小时前
RISC-V链接器与链接脚本
汇编·算法·risc-v
Zwawa14 小时前
卡尔曼到底在算什么:从一维到它的变式以及工程版卡尔曼滤波算法C语言实现
c语言·算法·嵌入式
旖旎夜光14 小时前
【C++ 基础入门】智能指针:RAII、unique_ptr 与 shared_ptr 循环引用
c++·笔记·学习·智能指针
电科_银尘14 小时前
【大模型算法与工程 14】Tokenizer与Embedding:文本如何变成模型输入
算法·embedding