概述
本文將介紹實時獲取和處理加速度數(shù)據(jù)。程序的核心流程包括初始化硬件接口、配置加速度計的參數(shù),以及通過輪詢檢查中斷信號來不斷讀取加速度數(shù)據(jù)。
最近在弄ST和瑞薩RA的課程,需要樣片的可以加群申請:615061293 。
視頻教學(xué)
https://www.bilibili.com/video/BV1gC4y117z2/
樣品申請
https://www.wjx.top/vm/OhcKxJk.aspx#
源碼下載
https://download.csdn.net/download/qq_24312945/88592069
生成STM32CUBEMX
用STM32CUBEMX生成例程,這里使用MCU為STM32WB55RG。
配置時鐘樹,配置時鐘為32M。
串口配置
查看原理圖,PB6和PB7設(shè)置為開發(fā)板的串口。
配置串口。
IIC配置
配置IIC為快速模式,速度為400k。
CS和SA0設(shè)置
INT1設(shè)置
數(shù)據(jù)準備完畢可以通過INT1獲取中斷信號。
INT1接入PA9,需要配置PA9為輸入模式。
配置如下所示。
串口重定向
打開魔術(shù)棒,勾選MicroLIB
在main.c中,添加頭文件,若不添加會出現(xiàn) identifier "FILE" is undefined報錯。
/* USER CODE BEGIN Includes */
#include "stdio.h"
/* USER CODE END Includes */
函數(shù)聲明和串口重定向:
/* USER CODE BEGIN PFP */
int fputc(int ch, FILE *f){
HAL_UART_Transmit(&huart1 , (uint8_t *)&ch, 1, 0xFFFF);
return ch;
}
/* USER CODE END PFP */
參考程序
https://github.com/STMicroelectronics/lis2dw12-pid
初始換管腳
由于需要向LIS2DW12_I2C_ADD_H寫入以及為IIC模式。
所以使能CS為高電平,配置為IIC模式。
配置SA0為高電平。
stmdev_ctx_t dev_ctx;
lis2dw12_reg_t int_route;
dev_ctx.write_reg = platform_write;
dev_ctx.read_reg = platform_read;
dev_ctx.handle = &SENSOR_BUS;
HAL_GPIO_WritePin(GPIOC, CS_Pin, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOC, SA0_Pin, GPIO_PIN_SET);
獲取ID
我們可以向WHO_AM_I (0Fh)獲取固定值,判斷是否為0x44。
lis2dw12_device_id_get為獲取函數(shù)。
對應(yīng)的獲取ID驅(qū)動程序,如下所示。
/* Wait sensor boot time */
platform_delay(BOOT_TIME);
/* Check device ID */
lis2dw12_device_id_get(&dev_ctx, &whoamI);
printf("LIS2DW12_ID=0x%x,whoamI=0x%x",LIS2DW12_ID,whoamI);
if (whoamI != LIS2DW12_ID)
while (1) {
/* manage here device not found */
}
復(fù)位操作
可以向CTRL2 (21h)的SOFT_RESET寄存器寫入1進行復(fù)位。
lis2dw12_reset_set為重置函數(shù)。
對應(yīng)的驅(qū)動程序,如下所示。
/* Restore default configuration */
lis2dw12_reset_set(&dev_ctx, PROPERTY_ENABLE);
do {
lis2dw12_reset_get(&dev_ctx, &rst);
} while (rst);
BDU設(shè)置
在很多傳感器中,數(shù)據(jù)通常被存儲在輸出寄存器中,這些寄存器分為兩部分:MSB和LSB。這兩部分共同表示一個完整的數(shù)據(jù)值。例如,在一個加速度計中,MSB和LSB可能共同表示一個加速度的測量值。
連續(xù)更新模式(BDU = '0'):在默認模式下,輸出寄存器的值會持續(xù)不斷地被更新。這意味著在你讀取MSB和LSB的時候,寄存器中的數(shù)據(jù)可能會因為新的測量數(shù)據(jù)而更新。這可能導(dǎo)致一個問題:當你讀取MSB時,如果寄存器更新了,接下來讀取的LSB可能就是新的測量值的一部分,而不是與MSB相對應(yīng)的值。這樣,你得到的就是一個“拼湊”的數(shù)據(jù),它可能無法準確代表任何實際的測量時刻。
塊數(shù)據(jù)更新(BDU)模式(BDU = '1'):當激活BDU功能時,輸出寄存器中的內(nèi)容不會在讀取MSB和LSB之間更新。這就意味著一旦開始讀取數(shù)據(jù)(無論是先讀MSB還是LSB),寄存器中的那一組數(shù)據(jù)就被“鎖定”,直到兩部分都被讀取完畢。這樣可以確保你讀取的MSB和LSB是同一測量時刻的數(shù)據(jù),避免了讀取到代表不同采樣時刻的數(shù)據(jù)。
簡而言之,BDU位的作用是確保在讀取數(shù)據(jù)時,輸出寄存器的內(nèi)容保持穩(wěn)定,從而避免讀取到拼湊或錯誤的數(shù)據(jù)。這對于需要高精度和穩(wěn)定性的應(yīng)用尤為重要。
可以向CTRL2 (21h)的BDU寄存器寫入1進行開啟。
對應(yīng)的驅(qū)動程序,如下所示。
/* Enable Block Data Update */
lis2dw12_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);
開啟INT1中斷
設(shè)置中斷通知方式。LIS2DW12_INT_LATCHED 表明使用鎖存型中斷,意味著中斷信號會保持激活狀態(tài),直到被讀取或者清除。
lis2dw12_int_notification_set(&dev_ctx, LIS2DW12_INT_LATCHED);
設(shè)置中斷引腳的極性。LIS2DW12_ACTIVE_LOW 指示中斷引腳在激活時是低電平。
lis2dw12_pin_polarity_set(&dev_ctx, LIS2DW12_ACTIVE_LOW);
讀取 INT1 引腳的當前中斷路由配置到 ctrl4_int1_pad 結(jié)構(gòu)體中,(CTRL4_INT1_PAD_CTRL, 地址為 0x23h)這個寄存器用于配置加速度計的中斷1引腳(INT1)的行為。
INT1_6D: 當設(shè)置為1時,6D定位識別的中斷會被路由到INT1引腳。
INT1_SINGLE_TAP: 單擊識別中斷的啟用/禁用。
INT1_WU: 喚醒識別中斷的啟用/禁用。
INT1_FF: 自由落體識別中斷的啟用/禁用。
INT1_TAP: 雙擊識別中斷的啟用/禁用。
INT1_DIFF5: FIFO滿識別中斷的啟用/禁用。
INT1_FTH: FIFO閾值中斷的啟用/禁用。
INT1_DRDY: 數(shù)據(jù)就緒(Data-Ready)中斷的啟用/禁用。
需要將INT1_DRDY置為1。
然后再將數(shù)據(jù)寫入到(CTRL4_INT1_PAD_CTRL, 地址為 0x23h)這個寄存器鐘。
lis2dw12_pin_int1_route_get(&dev_ctx, &ctrl4_int1_pad);
ctrl4_int1_pad.int1_drdy = PROPERTY_ENABLE;
lis2dw12_pin_int1_route_set(&dev_ctx, &ctrl4_int1_pad);
設(shè)置傳感器的量程
FS[1:0] - 全量程選擇:這兩個位用于設(shè)置傳感器的量程。量程決定了傳感器可以測量的最大加速度值。例如,量程可以設(shè)置為±2g、±4g、±8g或±16g。這允許用戶根據(jù)應(yīng)用的特定需求調(diào)整傳感器的靈敏度。
對應(yīng)的驅(qū)動程序,如下所示。
/* Set full scale */
lis2dw12_full_scale_set(&dev_ctx, LIS2DW12_2g);
配置過濾器鏈
lis2dw12_filter_path_set(&dev_ctx, LIS2DW12_LPF_ON_OUT);:設(shè)置加速度計輸出的過濾器路徑。這里選擇了輸出上的低通濾波器(LPF),用于去除高頻噪聲。
lis2dw12_filter_bandwidth_set(&dev_ctx, LIS2DW12_ODR_DIV_10);設(shè)置過濾器的帶寬。LIS2DW12_ODR_DIV_10 表明帶寬設(shè)置為輸出數(shù)據(jù)率(ODR)的十分之一。
配置電源模式
lis2dw12_power_mode_set(&dev_ctx, LIS2DW12_CONT_LOW_PWR_12bit);配置電源模式。這里設(shè)置為連續(xù)低功耗模式,且以 12 位分辨率運行。
設(shè)置輸出數(shù)據(jù)速率
lis2dw12_data_rate_set(&dev_ctx, LIS2DW12_XL_SET_SW_TRIG);設(shè)置加速度計的數(shù)據(jù)輸出速率。LIS2DW12_XL_SET_SW_TRIG 可能表示使用軟件觸發(fā)來設(shè)置數(shù)據(jù)輸出速率。
/* Wait sensor boot time */
platform_delay(BOOT_TIME);
/* Check device ID */
lis2dw12_device_id_get(&dev_ctx, &whoamI);
if (whoamI != LIS2DW12_ID)
while (1) {
/* manage here device not found */
}
/* Restore default configuration */
lis2dw12_reset_set(&dev_ctx, PROPERTY_ENABLE);
do {
lis2dw12_reset_get(&dev_ctx, &rst);
} while (rst);
/* Enable Block Data Update */
lis2dw12_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);
lis2dw12_int_notification_set(&dev_ctx, LIS2DW12_INT_LATCHED);
lis2dw12_pin_polarity_set(&dev_ctx, LIS2DW12_ACTIVE_LOW);
lis2dw12_pin_int1_route_get(&dev_ctx, &ctrl4_int1_pad);
ctrl4_int1_pad.int1_drdy = PROPERTY_ENABLE;
lis2dw12_pin_int1_route_set(&dev_ctx, &ctrl4_int1_pad);
/* Set full scale */
lis2dw12_full_scale_set(&dev_ctx, LIS2DW12_2g);
/* Configure filtering chain accelerometer */
lis2dw12_filter_path_set(&dev_ctx, LIS2DW12_LPF_ON_OUT);
lis2dw12_filter_bandwidth_set(&dev_ctx, LIS2DW12_ODR_DIV_10);
/* Configure power mode and Output Data Rate */
lis2dw12_power_mode_set(&dev_ctx, LIS2DW12_CONT_LOW_PWR_12bit);
lis2dw12_data_rate_set(&dev_ctx, LIS2DW12_XL_SET_SW_TRIG);
中斷判斷加速度數(shù)據(jù)狀態(tài)
通過判斷INT1管腳來判斷數(shù)據(jù)是否準備完畢。
如果電平為低電平說明加速度數(shù)據(jù)已經(jīng)準備完畢。
數(shù)據(jù)在28h-2Dh中。
加速度數(shù)據(jù)首先以原始格式(通常是整數(shù))讀取,然后需要轉(zhuǎn)換為更有意義的單位,如毫重力(mg)。這里的轉(zhuǎn)換函數(shù) lis2dw12_from_fs2_to_mg() 根據(jù)加速度計的量程(這里假設(shè)為±2g)將原始數(shù)據(jù)轉(zhuǎn)換為毫重力單位。
acceleration_mg[0] = lis2dw12_from_fs2_to_mg(data_raw_acceleration[0]); 等三行代碼分別轉(zhuǎn)換 X、Y、Z 軸的加速度數(shù)據(jù)。
● LIS2DW12 加速度計通常會有一個固定的位分辨率,比如 16 位(即輸出值是一個 16 位的整數(shù))。這意味著加速度計可以輸出的不同值的總數(shù)是 2^16=65536。這些值均勻地分布在 -2g 到 +2g 的范圍內(nèi)。
● 因此,這個范圍(4g 或者 4000 mg)被分成了 65536 個步長。
● 每個步長的大小是 4000 mg/65536≈0.061 mg/LSB
所以,函數(shù)中的乘法 ((float_t)lsb) * 0.061f 是將原始的整數(shù)值轉(zhuǎn)換為以毫重力(mg)為單位的加速度值。這個轉(zhuǎn)換對于將加速度計的原始讀數(shù)轉(zhuǎn)換為實際的物理測量值是必需的。
/* Infinite loop */
/* USER CODE BEGIN WHILE */
while (1)
{
/* polling on DRDY signal */
if (GPIO_PIN_RESET == HAL_GPIO_ReadPin(INT1_GPIO_Port, INT1_Pin)) {
/* Read acceleration data */
memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));
lis2dw12_acceleration_raw_get(&dev_ctx, data_raw_acceleration);
acceleration_mg[0] = lis2dw12_from_fs2_lp1_to_mg(
data_raw_acceleration[0]);
acceleration_mg[1] = lis2dw12_from_fs2_lp1_to_mg(
data_raw_acceleration[1]);
acceleration_mg[2] = lis2dw12_from_fs2_lp1_to_mg(
data_raw_acceleration[2]);
lis2dw12_data_rate_set(&dev_ctx, LIS2DW12_XL_SET_SW_TRIG);
printf("Acceleration [mg]:X=%4.2ftY=%4.2ftZ=%4.2frn",acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);
}
/* USER CODE END WHILE */
/* USER CODE BEGIN 3 */
}
/* USER CODE END 3 */
演示
審核編輯:湯梓紅
-
mems
+關(guān)注
關(guān)注
129文章
3885瀏覽量
190217 -
三軸加速度計
+關(guān)注
關(guān)注
1文章
27瀏覽量
13327 -
三軸磁力計
+關(guān)注
關(guān)注
0文章
7瀏覽量
8367 -
stm32cubemx
+關(guān)注
關(guān)注
5文章
280瀏覽量
14713
發(fā)布評論請先 登錄
相關(guān)推薦
評論