ICM20948 DMP代码详解(6)

news2024/12/27 11:02:12

接前一篇文章:ICM20948 DMP代码详解(5)

 

前一篇文章解析了EMP-App中的入口函数main()中重点关注的第1段代码,本回继续往下进行解析。为了便于理解和回顾,再次贴出main函数源码:

int main (void)
{
	int rc = 0;
 
	/* Hardware initialization */
	sysclk_init();
	board_init();
	sysclk_enable_peripheral_clock(ID_TC0);
 
	/* Configure Device - Host Interface */
	configure_console();
 
#ifdef INV_MSG_ENABLE
	/* Setup message logging */
	INV_MSG_SETUP(INV_MSG_ENABLE, msg_printer);
#endif
 
	INV_MSG(INV_MSG_LEVEL_INFO, "##########################");
	INV_MSG(INV_MSG_LEVEL_INFO, "     ICM20948 example     ");
	INV_MSG(INV_MSG_LEVEL_INFO, "     Ver: %s", EMD_RELEASE_VERSION_STRING);
	INV_MSG(INV_MSG_LEVEL_INFO, "##########################");
 
	/* Initialize External Sensor Interrupt */
	ext_int_initialize(&ext_interrupt_handler);
	interface_initialize();
 
	/* Configure sysTick Timer */
	SysTick_Config(sysclk_get_cpu_hz() / MILLISECONDS_PER_SECOND);
 
	/*
	* Initialize icm20948 serif structure
	*/
	struct inv_icm20948_serif icm20948_serif;
	icm20948_serif.context   = 0; /* no need */
	icm20948_serif.read_reg  = idd_io_hal_read_reg;
	icm20948_serif.write_reg = idd_io_hal_write_reg;
	icm20948_serif.max_read  = 1024*16; /* maximum number of bytes allowed per serial read */
	icm20948_serif.max_write = 1024*16; /* maximum number of bytes allowed per serial write */
 
	icm20948_serif.is_spi = interface_is_SPI();
 
	/*
	* Reset icm20948 driver states
	*/
	inv_icm20948_reset_states(&icm_device, &icm20948_serif);
 
	inv_icm20948_register_aux_compass(&icm_device, INV_ICM20948_COMPASS_ID_AK09916, AK0991x_DEFAULT_I2C_ADDR);
 
	/*
	* Setup the icm20948 device
	*/
	rc = icm20948_sensor_setup();
 
	/*
	* Now that Icm20948 device was initialized, we can proceed with DMP image loading
	* This step is mandatory as DMP image are not store in non volatile memory
	*/
	rc += load_dmp3();
	check_rc(rc, "Error sensor_setup/DMP loading.");
 
	/*
	* Initialize Dynamic protocol stuff
	*/
	DynProTransportUart_init(&transport, iddwrapper_transport_event_cb, 0);
	DynProtocol_init(&protocol, iddwrapper_protocol_event_cb, 0);
 
	InvScheduler_init(&scheduler);
	InvScheduler_initTask(&scheduler, &commandHandlerTask, "commandHandlerTask", CommandHandlerTaskMain, 0, INVSCHEDULER_TASK_PRIO_MIN, 1);
	InvScheduler_initTask(&scheduler, &blinkerLedTask, "blinkerLedTask", BlinkerLedTaskMain, 0, INVSCHEDULER_TASK_PRIO_MIN+1, 1000000/SCHEDULER_PERIOD);
	InvScheduler_startTask(&blinkerLedTask, 0);
	InvScheduler_startTask(&commandHandlerTask, 0);
 
	hw_timer_start(20);		// Start the timestamp timer at 20 Hz.
	while (1)
    {
		InvScheduler_dispatchTasks(&scheduler);
 
		if (irq_from_device == 1) {
			inv_icm20948_poll_sensor(&icm_device, (void *)0, build_sensor_event_data);
 
			__disable_irq();
			irq_from_device = 0;
			__enable_irq();
		}
	}
 
	return 0;
}

接下来是第2段代码片段:

	/*
	* Reset icm20948 driver states
	*/
	inv_icm20948_reset_states(&icm_device, &icm20948_serif);
 
	inv_icm20948_register_aux_compass(&icm_device, INV_ICM20948_COMPASS_ID_AK09916, AK0991x_DEFAULT_I2C_ADDR);

inv_icm20948_reset_states函数在EMD-Core\sources\Invn\Devices\Drivers\ICM20948\Icm20948.h中,属于内联函数,代码如下:

/** @brief Reset and initialize driver states
 *  @param[in] s             handle to driver states structure
 */
static inline void inv_icm20948_reset_states(struct inv_icm20948 * s,
		const struct inv_icm20948_serif * serif)
{
	assert(icm20948_instance == 0);

	memset(s, 0, sizeof(*s));
	s->serif = *serif;
	icm20948_instance = s;
}

函数的第2个参数const struct inv_icm20948_serif * serif对应的实参就是上一回分析的、在main函数中新建并初始化的icm20948_serif。

0bbcf8d796a44e2893f6cf1575264090.png

而第1个参数对应的实参为&icm_device。icm_device是一个全局变量,在EMD-App\src\ICM20948\sensor.c中定义,代码如下:

/*
* Just a handy variable to handle the icm20948 object
*/
inv_icm20948_t icm_device;

inv_icm20948_t的定义在EMD-Core\sources\Invn\Devices\Drivers\ICM20948\Icm20948.h中,代码如下:

typedef struct inv_icm20948 {
	struct inv_icm20948_serif serif;
	/** @brief struct for the base_driver : this contains the Mems information */
	struct base_driver_t
	{
		unsigned char wake_state;
		chip_lp_ln_mode_icm20948_t chip_lp_ln_mode;
		unsigned char pwr_mgmt_1;
		unsigned char pwr_mgmt_2;
		unsigned char user_ctrl;
		unsigned char gyro_div;
		unsigned short secondary_div;
		short accel_div;
		unsigned char gyro_averaging;
		unsigned char accel_averaging;
		uint8_t gyro_fullscale; 
		uint8_t accel_fullscale;
		uint8_t lp_en_support:1;
		uint8_t firmware_loaded:1;
		uint8_t serial_interface;
		uint8_t timebase_correction_pll;
	}base_state;
	/* secondary device support */
	struct inv_icm20948_secondary_states {
		struct inv_icm20948_secondary_reg {
			uint16_t addr;
			uint16_t reg;
			uint16_t ctrl;
			uint16_t d0;
		} slv_reg[4];
		unsigned char sSavedI2cOdr;
		/* compass support */
		uint8_t compass_sens[3];
		long final_matrix[9];
		const int16_t *st_upper;
		const int16_t *st_lower;
		int scale;
		uint8_t dmp_on;
		uint8_t secondary_resume_compass_state;
		uint8_t mode_reg_addr;
		int compass_chip_addr;
		int compass_slave_id;
		inv_icm20948_compass_state_t compass_state;
	} secondary_state;
	/* self test */
	uint8_t selftest_done;
	uint8_t offset_done;
	uint8_t gyro_st_data[3];
	uint8_t accel_st_data[3];
	/* mpu fifo control */
	struct fifo_info_t
	{
		int fifoError;
		unsigned char fifo_overflow;
	} fifo_info;
	/* interface mapping */
	unsigned long sStepCounterToBeSubtracted;
	unsigned long sOldSteps;
	/* data converter */
	long s_quat_chip_to_body[4];
	/* base driver */
	uint8_t sAllowLpEn;
	uint8_t s_compass_available;
	uint8_t s_proximity_available;
	/* base sensor ctrl*/
	unsigned short inv_dmp_odr_dividers[37];//INV_SENSOR_NUM_MAX /!\ if the size change 
	unsigned short inv_dmp_odr_delays[37];//INV_SENSOR_NUM_MAX /!\ if the size change
	unsigned short bac_on; // indicates if ANDROID_SENSOR_ACTIVITY_CLASSIFICATON is on
	unsigned short pickup;
	unsigned short bac_status;
	unsigned short b2s_status;
	unsigned short flip_pickup_status;
	unsigned short inv_sensor_control;
	unsigned short inv_sensor_control2;
	unsigned long inv_androidSensorsOn_mask[2] ;// Each bit corresponds to a sensor being on
	unsigned short inv_androidSensorsOdr_boundaries[51][2];//GENERAL_SENSORS_MAX /!\ if the size change 
	unsigned char sGmrvIsOn; // indicates if GMRV was requested to be ON by end-user. Once this variable is set, it is either GRV or GMRV which is enabled internally
	unsigned short lLastHwSmplrtDividerAcc;
	unsigned short lLastHwSmplrtDividerGyr;
	unsigned char sBatchMode;
	uint8_t header2_count;
	char mems_put_to_sleep;
	unsigned short smd_status;
	unsigned short ped_int_status;
	unsigned short bac_request;
	uint8_t go_back_lp_when_odr_low; // set to 1 when we forced a switch from LP to LN mode to be able to reach 1kHz ODR, so we will need to go back to LP mode ASAP
	unsigned short odr_acc_ms; // ODR in ms requested for ANDROID_SENSOR_ACCELEROMETER
	//unsigned short odr_acc_wom_ms; // ODR in ms requested for ANDROID_SENSOR_WOM when using ACC
	unsigned short odr_racc_ms; // ODR in ms requested for ANDROID_SENSOR_RAW_ACCELEROMETER
	unsigned short odr_gyr_ms; // ODR in ms requested for ANDROID_SENSOR_GYROSCOPE_UNCALIBRATED
	unsigned short odr_rgyr_ms; // ODR in ms requested for ANDROID_SENSOR_RAW_GYROSCOPE
	int bias[9];// dmp bias [0-2]:acc,[3-5]:gyr,[6-8]:mag
	/* Icm20948Fifo usage */
	signed char mounting_matrix[9];
	signed char mounting_matrix_secondary_compass[9];
	long soft_iron_matrix[9];
	uint8_t skip_sample[INV_ICM20948_SENSOR_MAX+1];
	uint64_t timestamp[INV_ICM20948_SENSOR_MAX+1];
	uint8_t sFirstBatch[INV_ICM20948_SENSOR_MAX+1];
	sensor_type_icm20948_t sensorlist[INV_ICM20948_SENSOR_MAX+1];
	unsigned short saved_count;
	/* Icm20948Transport*/
	unsigned char reg;
	unsigned char lastBank;
	unsigned char lLastBankSelected;
	/* augmented sensors*/
	unsigned short sGravityOdrMs;
	unsigned short sGrvOdrMs;
	unsigned short sLinAccOdrMs;
	unsigned short sGravityWuOdrMs;
	unsigned short sGrvWuOdrMs;
	unsigned short sLinAccWuOdrMs;
	unsigned short sRvOdrMs;
	unsigned short sOriOdrMs;
	unsigned short sRvWuOdrMs;
	unsigned short sOriWuOdrMs;
	/* Icm20649Setup */
	short set_accuracy;
	int new_accuracy;
} inv_icm20948_t;

这是一个较为庞大的结构体,其中囊括了各种功能。而此结构体的第一个成员正是struct inv_icm20948_serif serif。

回到inv_icm20948_reset_states函数中:

/** @brief Reset and initialize driver states
 *  @param[in] s             handle to driver states structure
 */
static inline void inv_icm20948_reset_states(struct inv_icm20948 * s,
		const struct inv_icm20948_serif * serif)
{
	assert(icm20948_instance == 0);

	memset(s, 0, sizeof(*s));
	s->serif = *serif;
	icm20948_instance = s;
}

inv_icm20948_reset_states函数的代码比较简单,先是将第1个参数的全部成员清零。这里,由于第1个参数对应的实参icm_device是全局变量,系统已经自动清零了,因此实际上这一句有没有都可以。如果有传入的实参为局部变量的情况,那么这一句就有用了。

接下来,就是将struct inv_icm20948对象的第一个成员struct inv_icm20948_serif serif赋值为main函数中新建的那个inv_icm20948_serif serif。注意这里是值传递,也就是两者并不指向同一段内存。

接下来将第1个参数赋给icm20948_instance。icm20948_instance也是一个全局变量,在EMD-Core\sources\Invn\Devices\Drivers\ICM20948\Icm20948Transport.c中,如下:

struct inv_icm20948 * icm20948_instance;

这里就和inv_icm20948_reset_states函数的第1行代码对应起来了。

	assert(icm20948_instance == 0);

调用inv_icm20948_reset_states函数的时候必须要求第1个参数对应的实参为空。由于struct inv_icm20948 * icm20948_instance为全局变量,因此系统会将其设置为0即空。

至此,main函数第2段代码片段的前一个函数inv_icm20948_reset_states就讲解完了。下一回讲解后一个函数inv_icm20948_register_aux_compass。

 

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/2114946.html

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!

相关文章

一次关于生产环境服务无故宕机的排查过程

故事的开始 这个故事是在一年之前,当时我们的系统运行在客户的k8s环境上。然后很神奇的是每个月底我们都会服务宕机,当然我们开启了多个实例。当时的容器线条就像心跳图一样(或许有些描述的不太准确,我没有找到当时那个像心电图一…

【Map】、集合总结

Map(*)——映射 比较之前的集合 List 为什么使用map <k,v>&#xff1a;key–value Api–>尽量用k去操作value put<k,v> package com.ffyc.map;import java.util.HashMap; import java.util.Map;/*** 映射*/ public class MapDemo {public static void main(St…

Linux下的Makefile与进度条程序

目录 Linux下的Makefile与进度条程序 Makefile与make Makefile与make介绍 创建第一个Makefile并使用make Makefile文件基本格式介绍 Makefile依赖方法执行过程 Makefile通用写法 进度条程序 实现效果 前置知识 回车(\r)与换行(\n) 输出缓冲区 实现进度条 Linux下的…

vue+ThreeJS:从0 到1 搭建开发环境

文章目录 一、下载安装&#xff08;懒人版&#xff09;二、顺序安装1&#xff0c;下载安装nodejs2&#xff0c;安装vue-cli3&#xff0c;创建vue-three 项目。4&#xff0c;安装threeJS5&#xff0c;安装element UI &#xff08;选装&#xff09;最终package.json文件如下&…

C语言深入理解指针3

1.字符指针变量 在指针类型中char*是字符指针 int main() {char ch w;char* pc &ch;//pc是字符指针变量//字符指针变量是用来存放地址的const char* p "abcsefghi";// 不是将abcdefghi\0存放到p中// 而是将首字符a的地址存放在p中// "abcsefghi"是…

逻辑代数的基本规则

目录 逻辑代数的基本规则 带入规则 反演规则 对偶规则 逻辑代数的基本规则 带入规则 将逻辑等式两边的某一变量均用同一个逻辑函数代替&#xff0c;等式仍然成立。 可以用A非代替A&#xff0c;也可以用C代替B。 也可使用BC这样一个整体代替B。 反演规则 可以把与换或&#x…

营养作用的对象是有区别的 第八篇

除了7大营养素 还需要补充其他营养素 食品营养学 临床营养学 大众营养学 食品营养学 你要早点就开始预防

怎么强制撤销excel工作表保护?

经常不是用的Excel文件设置了工作表保护&#xff0c;偶尔打开文件的时候想要编辑文件&#xff0c;但是发现忘记了密码&#xff0c;那么这种情况&#xff0c;我们怎么强制撤销excel工作表保护&#xff1f;今天分享两种解决方法。 方法一、 将excel文件转换为其他文件格式&…

C语言进阶【1】--字符函数和字符串函数【1】

本章概述 字符分类函数字符转换函数strlen的使用和模拟实现strcpy的使用和模拟实现strcat的使用和模拟实现strcmp的使用和模拟实现彩蛋时刻&#xff01;&#xff01;&#xff01; 字符分类函数 字符&#xff1a; 这个概念&#xff0c;我们在以前的文章中讲过了。我们键盘输入的…

通信工程学习:什么是MPC多媒体个人计算机、MCS多媒体计算机系统

一、MPC多媒体个人计算机&#xff08;Multimedia Personal Computer&#xff09; 1、MPC多媒体个人计算机定义 多媒体个人计算机&#xff08;MPC&#xff09;是指具备处理多媒体信息&#xff08;如音频、视频、图像、动画和文本等&#xff09;能力的个人计算机。它不仅具备传统…

html记账本改写:保存数据 localStorage。

<!DOCTYPE html> <html lang"zh-CN"> <head><meta charset"UTF-8"><title>记账本改写</title><style>table {user-select: none;/* width: 100%; */border-collapse: collapse;}table,th,td {border: 1px solid…

数据集 3DPW-开源户外三维人体建模-姿态估计-人体关键点-人体mesh建模 >> DataBall

3DPW 3DPW-开源户外三维人体建模数据集-姿态估计-人体关键点-人体mesh建模 开源户外三维人体数据集 inproceedings{vonMarcard2018, title {Recovering Accurate 3D Human Pose in The Wild Using IMUs and a Moving Camera}, author {von Marcard, Timo and Henschel, Robe…

从“游戏科学”到玄机科技:《黑神话:悟空》的视角打开动漫宇宙

近日&#xff0c;中国游戏界迎来了一场前所未有的盛事——由游戏科学公司开发的《黑神话&#xff1a;悟空》正式上线&#xff0c;并迅速成为全球玩家热议的焦点。在居高不下的讨论热度中&#xff0c;有人说他的成功在于对《西游记》为背景进行改编&#xff0c;对原著进行了分析…

读软件设计的要素04概念的关系

1. 概念的关系 1.1. 概念是独立的&#xff0c;彼此间无须相互依赖 1.1.1. 一个概念是应该独立地被理解、设计和实现的 1.1.2. 独立性是概念的简单性和可重用性的关键 1.2. 软件存在依赖性 1.2.1. 不是说一个概念需要依赖另一个概念才能正确运行 1.2.2. 只有当一个概念存在…

1 模拟——67. 二进制求和

1 模拟 67. 二进制求和 给你两个二进制字符串 a 和 b &#xff0c;以二进制字符串的形式返回它们的和。 示例 1&#xff1a; 输入:a "11", b "1" 输出&#xff1a;"100" 示例 2&#xff1a; 输入&#xff1a;a "1010", b "…

单GPU一分钟生成16K高清图像!新加坡国立发布LinFusion:无缝兼容Stable Diffusion插件

论文链接&#xff1a;https://arxiv.org/pdf/2409.02097 Git链接&#xff1a;https://lv-linfusion.github.io/ 亮点直击 本文研究了Mamba的非因果和归一化感知版本&#xff0c;并提出了一种新颖的线性注意力机制&#xff0c;解决了扩散模型在高分辨率视觉生成中的挑战。 本文…

Vue——day11之生命周期

目录 生命周期的八个阶段 生命周期执行的流程图 代码示例 总结 Vue的生命周期是指在Vue实例创建、挂载、更新和销毁过程中&#xff0c;会触发的一系列钩子函数。这些钩子函数可以用来在不同的生命周期阶段执行相应的逻辑操作。 生命周期的八个阶段 Vue的生命周期可以分为…

Github 2024-09-08 php开源项目日报 Top10

根据Github Trendings的统计,今日(2024-09-08统计)共有10个项目上榜。根据开发语言中项目的数量,汇总情况如下: 开发语言项目数量PHP项目10TypeScript项目1JavaScript项目1Laravel: 以优雅语法简化Web开发 创建周期:4028 天开发语言:PHP协议类型:MIT LicenseStar数量:30…

gazebo 已加载模型但无法显示

目录 写在前面的话问题一&#xff1a;robot_state_publisher 发布机器人信息失败报错一 Error: Error document empty.报错二 .xcaro 文件中有多行注释成功启动 问题二&#xff1a;通过 ros2 启动 gazebo 失败成功启动 问题三&#xff1a;gazebo 崩溃和无法显示模型问题四&…

使用LSTM(长短期记忆网络)模型预测股票价格的实例分析

一&#xff1a;LSTM与RNN的区别 LSTM&#xff08;Long Short-Term Memory&#xff09;是一种特殊的循环神经网络&#xff08;RNN&#xff09;架构。LSTM是为了解决传统RNN在处理长序列数据时遇到的梯度消失或梯度爆炸问题而设计的。 在传统的RNN中&#xff0c;信息通过隐藏状…