0

0

C++如何使用Ceres或g2o进行非线性优化_C++ 非线性优化方法

裘德小鎮的故事

裘德小鎮的故事

发布时间:2025-10-09 08:55:01

|

321人浏览过

|

来源于php中文网

原创

Ceres Solver适用于通用非线性最小二乘问题,支持自动微分与灵活残差定义,适合曲线拟合等任务;g2o专注稀疏图优化,如SLAM与位姿估计,基于图模型高效处理大规模问题;选择取决于是否为标准图结构及性能需求。

c++如何使用ceres或g2o进行非线性优化_c++ 非线性优化方法

在C++中进行非线性优化,Ceres Solverg2o(General Graph Optimization) 是两个广泛使用的开源库,尤其在SLAM、Bundle Adjustment、机器人状态估计等领域表现优异。它们都基于图优化理论,但接口设计和适用场景略有不同。

1. Ceres Solver:通用非线性最小二乘优化

Ceres 由 Google 开发,适合解决一般的非线性最小二乘问题,使用自动微分,配置灵活,代码清晰。

基本使用步骤:

  • 定义残差函数:通过仿函数(functor)或lambda表达式实现成本项。
  • 构建问题:向 Problem 添加残差块和待优化参数。
  • 求解:调用 Solve 并传入配置选项。

示例:拟合曲线 y = exp(ax + b)

立即学习C++免费学习笔记(深入)”;

假设有一组数据点 (x, y),想拟合指数函数的参数 a 和 b。

#include <ceres/ceres.h>
#include <iostream>
<p>struct ExponentialResidual {
ExponentialResidual(double x, double y) : x<em>(x), y</em>(y) {}</p><p>template <typename T>
bool operator()(const T<em> const a, const T</em> const b, T<em> residual) const {
residual[0] = T(y_) - ceres::exp(a[0] </em> T(x_) + b[0]);
return true;
}</p><p>double x<em>, y</em>;
};</p><p>int main() {
double a = 1.0, b = 0.5; // 初始值
std::vector<double> xs = {0.0, 1.0, 2.0, 3.0};
std::vector<double> ys = {1.0, 2.7, 7.4, 20.1}; // 近似 exp(x)</p><p>ceres::Problem problem;
for (int i = 0; i < xs.size(); ++i) {
ceres::CostFunction* cost_function =
new ceres::AutoDiffCostFunction<ExponentialResidual, 1, 1, 1>(
new ExponentialResidual(xs[i], ys[i])
);
problem.AddResidualBlock(cost_function, nullptr, &a, &b);
}</p><p>ceres::Solver::Options options;
options.linear_solver_type = ceres::DENSE_QR;
options.minimizer_progress_to_stdout = true;</p><p>ceres::Solver::Summary summary;
ceres::Solve(options, &problem, &summary);</p><p>std::cout << summary.BriefReport() << "\n";
std::cout << "Estimated a: " << a << ", b: " << b << "\n";</p><p>return 0;
}</p>

Ceres 支持自动微分、解析导数、鲁棒核函数(如 Huber)、边界约束等,非常适合复杂但结构不固定的优化问题。

2. g2o:面向图优化的稀疏非线性优化

g2o 更专注于稀疏图结构的优化,比如位姿图(pose graph)或BA问题。它采用图模型,节点是待优化变量(如SE(3)位姿),边是观测残差。

FloatSearch
FloatSearch

FloatSearch是一个专业的AI搜索引擎,提供多样化的见解

下载

基本流程:

  • 定义图类型:选择合适的顶点和边类型(如SE3Quat, VertexSBAPointXYZ)。
  • 构建图结构:添加顶点和边。
  • 初始化求解器:设置线性求解器、迭代方法(如Gauss-Newton, Levenberg-Marquardt)。
  • 执行优化:调用 optimize()。

示例:简单2D位姿图优化

假设有三个2D位姿节点,带有一些相对位姿观测。

#include <g2o/core/g2o_core_api.h>
#include <g2o/core/base_vertex.h>
#include <g2o/core/base_binary_edge.h>
#include <g2o/core/block_solver.h>
#include <g2o/core/optimization_algorithm_levenberg.h>
#include <g2o/solvers/dense/linear_solver_dense.h>
#include <g2o/types/slam2d/types_slam2d.h>
#include <iostream>
<p>int main() {
g2o::SparseOptimizer optimizer;
auto linearSolver = std::make_unique<g2o::LinearSolverDense<
g2o::BlockSolverX::PoseMatrixType>>();
auto blockSolver = std::make_unique<g2o::BlockSolverX>(std::move(linearSolver));
g2o::OptimizationAlgorithmLevenberg* solver =
new g2o::OptimizationAlgorithmLevenberg(std::move(blockSolver));
optimizer.setAlgorithm(solver);</p><p>// 添加顶点
g2o::VertexSE2* v1 = new g2o::VertexSE2();
v1->setId(0);
v1->setEstimate(g2o::SE2(0, 0, 0));
optimizer.addVertex(v1);</p><p>g2o::VertexSE2* v2 = new g2o::VertexSE2();
v2->setId(1);
v2->setEstimate(g2o::SE2(2, 0, 0));
optimizer.addVertex(v2);</p><p>// 添加边(v1到v2的理想观测为 (2,0,0))
g2o::EdgeSE2* e12 = new g2o::EdgeSE2();
e12->setMeasurement(g2o::SE2(2, 0, 0)); // 观测值
e12->setInformation(Eigen::Matrix3d::Identity());
e12->setVertex(0, v1);
e12->setVertex(1, v2);
optimizer.addEdge(e12);</p><p>optimizer.initializeOptimization();
optimizer.optimize(20);</p><p>std::cout << "Optimized pose 2: " << v2->estimate().translation().x() << ", "
<< v2->estimate().translation().y() << "\n";</p><p>optimizer.deleteSurface();
return 0;
}</p>

g2o 的优势在于对大规模稀疏系统高效,支持多种李群类型(SE3、SO3等),常用于视觉SLAM前端后端

3. 如何选择 Ceres 还是 g2o?

根据项目需求决定:

  • 选 Ceres:问题不是标准图结构,需要灵活定义残差;希望快速上手,利用自动微分;做曲线拟合、参数估计等通用优化。
  • 选 g2o:处理位姿图、BA、SLAM 类问题;已有图结构模型;追求稀疏性优化性能。

两者都能高效求解非线性最小二乘问题,Ceres 更“通用”,g2o 更“专用”。

基本上就这些。

热门AI工具

更多
DeepSeek
DeepSeek

幻方量化公司旗下的开源大模型平台

豆包大模型
豆包大模型

字节跳动自主研发的一系列大型语言模型

WorkBuddy
WorkBuddy

腾讯云推出的AI原生桌面智能体工作台

腾讯元宝
腾讯元宝

腾讯混元平台推出的AI助手

文心一言
文心一言

文心一言是百度开发的AI聊天机器人,通过对话可以生成各种形式的内容。

讯飞写作
讯飞写作

基于讯飞星火大模型的AI写作工具,可以快速生成新闻稿件、品宣文案、工作总结、心得体会等各种文文稿

即梦AI
即梦AI

一站式AI创作平台,免费AI图片和视频生成。

ChatGPT
ChatGPT

最最强大的AI聊天机器人程序,ChatGPT不单是聊天机器人,还能进行撰写邮件、视频脚本、文案、翻译、代码等任务。

相关专题

更多
lambda表达式
lambda表达式

Lambda表达式是一种匿名函数的简洁表示方式,它可以在需要函数作为参数的地方使用,并提供了一种更简洁、更灵活的编码方式,其语法为“lambda 参数列表: 表达式”,参数列表是函数的参数,可以包含一个或多个参数,用逗号分隔,表达式是函数的执行体,用于定义函数的具体操作。本专题为大家提供lambda表达式相关的文章、下载、课程内容,供大家免费下载体验。

215

2023.09.15

python lambda函数
python lambda函数

本专题整合了python lambda函数用法详解,阅读专题下面的文章了解更多详细内容。

193

2025.11.08

Python lambda详解
Python lambda详解

本专题整合了Python lambda函数相关教程,阅读下面的文章了解更多详细内容。

61

2026.01.05

硬盘接口类型介绍
硬盘接口类型介绍

硬盘接口类型有IDE、SATA、SCSI、Fibre Channel、USB、eSATA、mSATA、PCIe等等。详细介绍:1、IDE接口是一种并行接口,主要用于连接硬盘和光驱等设备,它主要有两种类型:ATA和ATAPI,IDE接口已经逐渐被SATA接口;2、SATA接口是一种串行接口,相较于IDE接口,它具有更高的传输速度、更低的功耗和更小的体积;3、SCSI接口等等。

1974

2023.10.19

PHP接口编写教程
PHP接口编写教程

本专题整合了PHP接口编写教程,阅读专题下面的文章了解更多详细内容。

680

2025.10.17

php8.4实现接口限流的教程
php8.4实现接口限流的教程

PHP8.4本身不内置限流功能,需借助Redis(令牌桶)或Swoole(漏桶)实现;文件锁因I/O瓶颈、无跨机共享、秒级精度等缺陷不适用高并发场景。本专题为大家提供相关的文章、下载、课程内容,供大家免费下载体验。

2413

2025.12.29

java接口相关教程
java接口相关教程

本专题整合了java接口相关内容,阅读专题下面的文章了解更多详细内容。

49

2026.01.19

TypeScript类型系统进阶与大型前端项目实践
TypeScript类型系统进阶与大型前端项目实践

本专题围绕 TypeScript 在大型前端项目中的应用展开,深入讲解类型系统设计与工程化开发方法。内容包括泛型与高级类型、类型推断机制、声明文件编写、模块化结构设计以及代码规范管理。通过真实项目案例分析,帮助开发者构建类型安全、结构清晰、易维护的前端工程体系,提高团队协作效率与代码质量。

76

2026.03.13

Python异步编程与Asyncio高并发应用实践
Python异步编程与Asyncio高并发应用实践

本专题围绕 Python 异步编程模型展开,深入讲解 Asyncio 框架的核心原理与应用实践。内容包括事件循环机制、协程任务调度、异步 IO 处理以及并发任务管理策略。通过构建高并发网络请求与异步数据处理案例,帮助开发者掌握 Python 在高并发场景中的高效开发方法,并提升系统资源利用率与整体运行性能。

116

2026.03.12

热门下载

更多
网站特效
/
网站源码
/
网站素材
/
前端模板

精品课程

更多
相关推荐
/
热门推荐
/
最新课程
CSS3 教程
CSS3 教程

共18课时 | 7.3万人学习

Vue 教程
Vue 教程

共42课时 | 9.6万人学习

React 教程
React 教程

共58课时 | 6.1万人学习

关于我们 免责申明 举报中心 意见反馈 讲师合作 广告合作 最新更新
php中文网:公益在线php培训,帮助PHP学习者快速成长!
关注服务号 技术交流群
PHP中文网订阅号
每天精选资源文章推送

Copyright 2014-2026 https://www.php.cn/ All Rights Reserved | php.cn | 湘ICP备2023035733号