【学习记录】PointLIO代码 update_iterated_dyn_share_modified 中函数指针的用法

本文主要是介绍【学习记录】PointLIO代码 update_iterated_dyn_share_modified 中函数指针的用法,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

最近在看PointLio的代码,有一部分看了半天没看懂,学习整理如下。

1、PointLio在迭代卡尔曼部分的代码

esekfom.hpp中,有部分代码如下:

void init_dyn_share_modified(processModel f_in, processMatrix1 f_x_in, measurementModel_dyn_share_modified h_dyn_share_in)
{f = f_in;f_x = f_x_in;// f_w = f_w_in;h_dyn_share_modified_1 = h_dyn_share_in;maximum_iter = 1;x_.build_S2_state();x_.build_SO3_state();x_.build_vect_state();x_.build_SEN_state();
}

之后,在迭代更新时,部分代码如下:

bool update_iterated_dyn_share_modified() {dyn_share_modified<scalar_type> dyn_share;state x_propagated = x_;int dof_Measurement;double m_noise;for(int i=0; i<maximum_iter; i++){dyn_share.valid = true;// 调用了 h_dyn_share_modified_1 函数,这个函数的类型是 `measurementModel_dyn_share_modified`// measurementModel_dyn_share_modified 是 void (state &, dyn_share_modified<scalar_type> &) 这个类型函数的一个别名;// 具体的,这个函数的实现是: h_dyn_share_modified_1 指向的 `h_dyn_share_in`(在初始化init_dyn_share_modified(_2h)中)// 而 h_dyn_share_in 是 h_model_input,在 estimateor.cpp 中被定义了具体实现。h_dyn_share_modified_1(x_, dyn_share);if(! dyn_share.valid){return false;// continue;}// 省略后续代码...

比较费解的是,上述代码中,h_dyn_share_modified_1(x_, dyn_share);这一行到底是在做什么。
仔细去看定义,可以发现,具体定义如下:

typedef Eigen::Matrix<scalar_type, m, n> processMatrix1(state &, const input &);
typedef Eigen::Matrix<scalar_type, m, process_noise_dof> processMatrix2(state &, const input &);
typedef Eigen::Matrix<scalar_type, process_noise_dof, process_noise_dof> processnoisecovariance;
typedef void measurementModel_dyn_share_modified(state &, dyn_share_modified<scalar_type> &);

其实也看不懂,于是问了下GPT,知道了这是“函数指针”,但还是云里雾里;又翻开了《C++Primer》和查阅了一些网络资料。

2、函数指针

函数指针和指针函数,区别如下:
在这里插入图片描述
图片来自哔哩哔哩:指针函数与函数指针

概括来说,函数指针,是一个指针,指向一个函数。那么面临着一个问题,这个函数到底是什么类型?

2.1 函数的类型

之前一直没有关注过函数的“类型”,《C++ Primer》指出:
在这里插入图片描述
即函数应该是一个 bool (const string&, const string&) 类型,那么函数指针就是一个指向这种类型的函数的一个指针。函数名称可以是任何名字。

2.2 形参为指针的函数

由于函数指针,本质上是一个指针,那么这个指针,可以当作另一个函数的形参,如下:
在这里插入图片描述
此时,useBigger这个函数接收的第3个参数是一个指针,这个指针指向了一个函数而已。

但是这种写法比较复杂,因此引入typedef关键字:

2.3 typedef 关键字

这里需要提一下typedef关键字。typedef是类型定义的替换,有一个视频讲的很好:
https://www.bilibili.com/video/BV15h4y1M7p2

在这里插入图片描述
即“用变量名替换上面typedef后面的类型,然后去掉typedef,剩下的就是这一行的定义”。

所以,再结合上面形参是指针的函数,可以写作这样:
在这里插入图片描述
我们把Func换成上方绿色的typedef定义,就能看懂了。

3、回到代码

下面回到PointLio中的代码,我们捋一下思路:

init_dyn_share_modified函数:

在初始化时,将h_dyn_share_modified_1这个“函数指针”和传入的形参h_dyn_share_in共享,即指向的都是h_dyn_share_in这个形参所代表的函数。

init_dyn_share_modified这个函数的调用,是在laserMapping.cpp中:

kf_input.init_dyn_share_modified(get_f_input, df_dx_input, h_model_input);

即传入的参数是指向h_model_input的指针,而这个h_model_inputEstimator.cpp中定义,就是“IMU做输入量的观测模型”(这里不展开解释,IMU的“输入”/“输出”的区别)。

update_iterated_dyn_share_modified函数:

那么,再往下,初始化完成以后,h_dyn_share_modified_1就指向了h_model_input这个函数,
在接下来update_iterated_dyn_share_modified函数中,h_dyn_share_modified_1(x_, dyn_share)就是相当于调用了h_model_input这个函数。

可以再去看h_model_input这个函数,和h_dyn_share_modified_1函数,传入的形参形式是一致的。所以,我理解的应该是正确的吧。

至此,搞明白了这部分的调用。

小彩蛋

当在代码中自己添加注释,解释这部分函数指针时,我想说“写的真复杂”,结果github的copilot自动补全了我的注释,如下:
在这里插入图片描述看样子可能不止我一个人被这个函数指针的写法绕进去过吧。

这篇关于【学习记录】PointLIO代码 update_iterated_dyn_share_modified 中函数指针的用法的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/788625

相关文章

Python UV安装、升级、卸载详细步骤记录

《PythonUV安装、升级、卸载详细步骤记录》:本文主要介绍PythonUV安装、升级、卸载的详细步骤,uv是Astral推出的下一代Python包与项目管理器,主打单一可执行文件、极致性能... 目录安装检查升级设置自动补全卸载UV 命令总结 官方文档详见:https://docs.astral.sh/

mapstruct中的@Mapper注解的基本用法

《mapstruct中的@Mapper注解的基本用法》在MapStruct中,@Mapper注解是核心注解之一,用于标记一个接口或抽象类为MapStruct的映射器(Mapper),本文给大家介绍ma... 目录1. 基本用法2. 常用属性3. 高级用法4. 注意事项5. 总结6. 编译异常处理在MapSt

Python实例题之pygame开发打飞机游戏实例代码

《Python实例题之pygame开发打飞机游戏实例代码》对于python的学习者,能够写出一个飞机大战的程序代码,是不是感觉到非常的开心,:本文主要介绍Python实例题之pygame开发打飞机... 目录题目pygame-aircraft-game使用 Pygame 开发的打飞机游戏脚本代码解释初始化部

java中long的一些常见用法

《java中long的一些常见用法》在Java中,long是一种基本数据类型,用于表示长整型数值,接下来通过本文给大家介绍java中long的一些常见用法,感兴趣的朋友一起看看吧... 在Java中,long是一种基本数据类型,用于表示长整型数值。它的取值范围比int更大,从-922337203685477

Java中Map.Entry()含义及方法使用代码

《Java中Map.Entry()含义及方法使用代码》:本文主要介绍Java中Map.Entry()含义及方法使用的相关资料,Map.Entry是Java中Map的静态内部接口,用于表示键值对,其... 目录前言 Map.Entry作用核心方法常见使用场景1. 遍历 Map 的所有键值对2. 直接修改 Ma

MyBatis ResultMap 的基本用法示例详解

《MyBatisResultMap的基本用法示例详解》在MyBatis中,resultMap用于定义数据库查询结果到Java对象属性的映射关系,本文给大家介绍MyBatisResultMap的基本... 目录MyBATis 中的 resultMap1. resultMap 的基本语法2. 简单的 resul

MyBatis Plus 中 update_time 字段自动填充失效的原因分析及解决方案(最新整理)

《MyBatisPlus中update_time字段自动填充失效的原因分析及解决方案(最新整理)》在使用MyBatisPlus时,通常我们会在数据库表中设置create_time和update... 目录前言一、问题现象二、原因分析三、总结:常见原因与解决方法对照表四、推荐写法前言在使用 MyBATis

Python主动抛出异常的各种用法和场景分析

《Python主动抛出异常的各种用法和场景分析》在Python中,我们不仅可以捕获和处理异常,还可以主动抛出异常,也就是以类的方式自定义错误的类型和提示信息,这在编程中非常有用,下面我将详细解释主动抛... 目录一、为什么要主动抛出异常?二、基本语法:raise关键字基本示例三、raise的多种用法1. 抛

统一返回JsonResult踩坑的记录

《统一返回JsonResult踩坑的记录》:本文主要介绍统一返回JsonResult踩坑的记录,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录统一返回jsonResult踩坑定义了一个统一返回类在使用时,JsonResult没有get/set方法时响应总结统一返回

Go学习记录之runtime包深入解析

《Go学习记录之runtime包深入解析》Go语言runtime包管理运行时环境,涵盖goroutine调度、内存分配、垃圾回收、类型信息等核心功能,:本文主要介绍Go学习记录之runtime包的... 目录前言:一、runtime包内容学习1、作用:① Goroutine和并发控制:② 垃圾回收:③ 栈和