概述
本文將介紹如何驅動和利用LIS2DW12傳感器,實現精確的運動感應功能。
IS2DW12是一款高性能、超低功耗的三軸線性加速度計,屬于“femto”系列,利用了成熟的微機械加速度計制造工藝。這個傳感器提供可選擇的全量程±2g/±4g/±8g/±16g,能夠以1.6 Hz至1600 Hz的數據輸出率測量加速度。它包含了一個32級的先進先出(FIFO)緩沖區,用于存儲數據,以減少主處理器的干預需求。
此外,LIS2DW12具備自測功能,可在最終應用中驗證傳感器功能,并集成了一個處理運動和加速度檢測的內部引擎。這包括自由落體、喚醒、敲擊識別、活動/靜止監測、靜止/運動檢測、縱向/橫向檢測以及6D/4D定向等功能。
最近在弄ST和瑞薩RA的課程,需要樣片的可以加群申請:615061293 。
視頻教學
https://www.bilibili.com/video/BV1vM411R7We/
樣品申請
https://www.wjx.top/vm/OhcKxJk.aspx#
源碼下載
https://download.csdn.net/download/qq_24312945/88590588
通信模式
對于LIS2DW12,可以使用SPI或者IIC進行通訊。
最小系統圖如下所示。
在CS管腳為1的時候,為IIC模式。
本文使用的板子原理圖如下所示。
管腳定義
IIC通信模式
在使用IIC通訊模式的時候,SA0是用來控制IIC的地址位的。
對于IIC的地址,可以通過SDO/SA0引腳修改。SDO/SA0引腳可以用來修改設備地址的最低有效位。如果SDO/SA0引腳連接到電源電壓,LSb(最低有效位)為'1'(地址0011001b);否則,如果SDO/SA0引腳連接到地線,LSb的值為'0'(地址0011000b)。
對應的IIC接口如下所示。
主要使用的管腳為CS、SCL、SDA、SA0。
速率
該模塊支持的速度為普通模式(100k)和快速模式(400k)。
生成STM32CUBEMX
用STM32CUBEMX生成例程,這里使用MCU為STM32WB55RG。
配置時鐘樹,配置時鐘為32M。
串口配置
查看原理圖,PB6和PB7設置為開發板的串口。
配置串口。
IIC配置
配置IIC為快速模式,速度為400k。
CS和SA0設置
串口重定向
打開魔術棒,勾選MicroLIB
在main.c中,添加頭文件,若不添加會出現 identifier "FILE" is undefined報錯。
/* USER CODE BEGIN Includes */
#include "stdio.h"
/* USER CODE END Includes */
函數聲明和串口重定向:
/* 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為高電平。
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為獲取函數。
對應的獲取ID驅動程序,如下所示。
/* 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 */
}
復位操作
可以向CTRL2 (21h)的SOFT_RESET寄存器寫入1進行復位。
lis2dw12_reset_set為重置函數。
對應的驅動程序,如下所示。
/* Restore default configuration */
lis2dw12_reset_set(&dev_ctx, PROPERTY_ENABLE);
do {
lis2dw12_reset_get(&dev_ctx, &rst);
} while (rst);
BDU設置
在很多傳感器中,數據通常被存儲在輸出寄存器中,這些寄存器分為兩部分:MSB和LSB。這兩部分共同表示一個完整的數據值。例如,在一個加速度計中,MSB和LSB可能共同表示一個加速度的測量值。
連續更新模式(BDU = '0'):在默認模式下,輸出寄存器的值會持續不斷地被更新。這意味著在你讀取MSB和LSB的時候,寄存器中的數據可能會因為新的測量數據而更新。這可能導致一個問題:當你讀取MSB時,如果寄存器更新了,接下來讀取的LSB可能就是新的測量值的一部分,而不是與MSB相對應的值。這樣,你得到的就是一個“拼湊”的數據,它可能無法準確代表任何實際的測量時刻。
塊數據更新(BDU)模式(BDU = '1'):當激活BDU功能時,輸出寄存器中的內容不會在讀取MSB和LSB之間更新。這就意味著一旦開始讀取數據(無論是先讀MSB還是LSB),寄存器中的那一組數據就被“鎖定”,直到兩部分都被讀取完畢。這樣可以確保你讀取的MSB和LSB是同一測量時刻的數據,避免了讀取到代表不同采樣時刻的數據。
簡而言之,BDU位的作用是確保在讀取數據時,輸出寄存器的內容保持穩定,從而避免讀取到拼湊或錯誤的數據。這對于需要高精度和穩定性的應用尤為重要。
可以向CTRL2 (21h)的BDU寄存器寫入1進行開啟。
對應的驅動程序,如下所示。
/* Enable Block Data Update */
lis2dw12_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);
設置傳感器的量程
FS[1:0] - 全量程選擇:這兩個位用于設置傳感器的量程。量程決定了傳感器可以測量的最大加速度值。例如,量程可以設置為±2g、±4g、±8g或±16g。這允許用戶根據應用的特定需求調整傳感器的靈敏度。
對應的驅動程序,如下所示。
/* Set full scale */
lis2dw12_full_scale_set(&dev_ctx, LIS2DW12_2g);
配置過濾器鏈
lis2dw12_filter_path_set(&dev_ctx, LIS2DW12_LPF_ON_OUT);:設置加速度計輸出的過濾器路徑。這里選擇了輸出上的低通濾波器(LPF),用于去除高頻噪聲。
lis2dw12_filter_bandwidth_set(&dev_ctx, LIS2DW12_ODR_DIV_4);:設置過濾器的帶寬。這里的設置是將輸出數據率(ODR)除以4,進一步決定了濾波器的截止頻率。
配置電源模式
lis2dw12_power_mode_set(&dev_ctx, LIS2DW12_HIGH_PERFORMANCE);:這個調用設置加速度計的電源模式為高性能模式。這通常意味著更高的功耗,但提供更精確的測量。
設置輸出數據速率
lis2dw12_data_rate_set(&dev_ctx, LIS2DW12_XL_ODR_25Hz);:設置加速度計的輸出數據速率為每秒25次。輸出數據速率決定了傳感器多久采集一次數據,并影響數據的實時性和功耗。
/* Enable Block Data Update */
lis2dw12_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);
/* Set full scale */
lis2dw12_full_scale_set(&dev_ctx, LIS2DW12_2g);
/* Configure filtering chain
* Accelerometer - filter path / bandwidth
*/
lis2dw12_filter_path_set(&dev_ctx, LIS2DW12_LPF_ON_OUT);
lis2dw12_filter_bandwidth_set(&dev_ctx, LIS2DW12_ODR_DIV_4);
/* Configure power mode */
lis2dw12_power_mode_set(&dev_ctx, LIS2DW12_HIGH_PERFORMANCE);
/* Set Output Data Rate */
lis2dw12_data_rate_set(&dev_ctx, LIS2DW12_XL_ODR_25Hz);
輪詢獲取加速度
檢查新數據是否可用:
lis2dw12_flag_data_ready_get(&dev_ctx, ®);:這個函數調用檢查加速度計是否有新的數據可讀。如果有新數據,reg 變量將被設置為非零值。
主要為讀取STATUS (27h)的DRDY位。
如果 reg 是非零的,說明有新的加速度數據可讀。
lis2dw12_acceleration_raw_get(&dev_ctx, data_raw_acceleration);:這個函數調用實際讀取加速度計的原始數據,并存儲在 data_raw_acceleration 數組中。
數據在28h-2Dh中。
加速度數據首先以原始格式(通常是整數)讀取,然后需要轉換為更有意義的單位,如毫重力(mg)。這里的轉換函數 lis2dw12_from_fs2_to_mg() 根據加速度計的量程(這里假設為±2g)將原始數據轉換為毫重力單位。
acceleration_mg[0] = lis2dw12_from_fs2_to_mg(data_raw_acceleration[0]); 等三行代碼分別轉換 X、Y、Z 軸的加速度數據。
● LIS2DW12 加速度計通常會有一個固定的位分辨率,比如 16 位(即輸出值是一個 16 位的整數)。這意味著加速度計可以輸出的不同值的總數是 2^16=65536。這些值均勻地分布在 -2g 到 +2g 的范圍內。
● 因此,這個范圍(4g 或者 4000 mg)被分成了 65536 個步長。
● 每個步長的大小是 4000 mg/65536≈0.061 mg/LSB
所以,函數中的乘法 ((float_t)lsb) * 0.061f 是將原始的整數值轉換為以毫重力(mg)為單位的加速度值。這個轉換對于將加速度計的原始讀數轉換為實際的物理測量值是必需的。
/* Infinite loop */
/* USER CODE BEGIN WHILE */
while (1)
{
uint8_t reg;
/* Read output only if new value is available */
lis2dw12_flag_data_ready_get(&dev_ctx, ®);
if (reg) {
/* 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_fs8_lp1_to_mg(data_raw_acceleration[0]);
//acceleration_mg[1] = lis2dw12_from_fs8_lp1_to_mg(data_raw_acceleration[1]);
//acceleration_mg[2] = lis2dw12_from_fs8_lp1_to_mg(data_raw_acceleration[2]);
acceleration_mg[0] = lis2dw12_from_fs2_to_mg(
data_raw_acceleration[0]);
acceleration_mg[1] = lis2dw12_from_fs2_to_mg(
data_raw_acceleration[1]);
acceleration_mg[2] = lis2dw12_from_fs2_to_mg(
data_raw_acceleration[2]);
printf("Acceleration [mg]:X=%4.2ftY=%4.2ftZ=%4.2frn",acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);
}
HAL_Delay(100);
/* USER CODE END WHILE */
/* USER CODE BEGIN 3 */
}
/* USER CODE END 3 */
演示
審核編輯:湯梓紅
-
傳感器
+關注
關注
2541文章
49582瀏覽量
745962 -
mems
+關注
關注
128文章
3854瀏覽量
189703 -
三軸加速度計
+關注
關注
1文章
27瀏覽量
13307 -
stm32cubemx
+關注
關注
5文章
278瀏覽量
14585
發布評論請先 登錄
相關推薦
評論