#define LIS3DSHWHOAMIADDR 0x0F #define LIS3DSHCTRLREG4ADDR 0x20 #define…
- User
#define LIS3DSH_WHO_AM_I_ADDR 0x0F #define LIS3DSH_CTRL_REG4_ADDR 0x20 #define LIS3DSH_CTRL_REG5_ADDR 0x21 #define LIS3DSH_OUT_X_L_ADDR 0x28 #define LIS3DSH_OUT_Y_L_ADDR 0x2A #define LIS3DSH_OUT_Z_L_ADDR 0x2C
#define LIS3DSH_SENSITIVITY_2G 0.06 // Значение чувствительности в mg/LSB при диапазоне 2G
SPI_HandleTypeDef hspi1;
void LIS3DSH_Write(uint8_t reg, uint8_t data) { uint8_t txData[2] = {reg, data}; HAL_GPIO_WritePin(GPIOE, GPIO_PIN_3, GPIO_PIN_RESET); // CS Low HAL_SPI_Transmit(&hspi1, txData, 2, HAL_MAX_DELAY); HAL_GPIO_WritePin(GPIOE, GPIO_PIN_3, GPIO_PIN_SET); // CS High }
uint8_t LIS3DSH_Read(uint8_t reg) { uint8_t txData = reg | 0x80; // Установка бита чтения uint8_t rxData; HAL_GPIO_WritePin(GPIOE, GPIO_PIN_3, GPIO_PIN_RESET); // CS Low HAL_SPI_Transmit(&hspi1, &txData, 1, HAL_MAX_DELAY); HAL_SPI_Receive(&hspi1, &rxData, 1, HAL_MAX_DELAY); HAL_GPIO_WritePin(GPIOE, GPIO_PIN_3, GPIO_PIN_SET); // CS High return rxData; }
void LIS3DSH_Init(void) { // Включение акселерометра и установка диапазона чувствительности LIS3DSH_Write(LIS3DSH_CTRL_REG4_ADDR, 0x67); // Output Data Rate = 100 Hz, Enable X, Y, Z LIS3DSH_Write(LIS3DSH_CTRL_REG5_ADDR, 0x00); // Full scale = ±2g }
void Read_Accelerometer(int16_t *pData) { uint8_t rxData[2] = {0, 0};
// Чтение данных по X (младший и старший байты) rxData[0] = LIS3DSH_Read(LIS3DSH_OUT_X_L_ADDR); // OUT_X_L rxData[1] = LIS3DSH_Read(LIS3DSH_OUT_X_L_ADDR + 1); // OUT_X_H pData[0] = (int16_t)(rxData[1] << 8 | rxData[0]); // Объединение байтов в 16-битное значение // Чтение данных по Y (младший и старший байты) rxData[0] = LIS3DSH_Read(LIS3DSH_OUT_Y_L_ADDR); // OUT_Y_L rxData[1] = LIS3DSH_Read(LIS3DSH_OUT_Y_L_ADDR + 1); // OUT_Y_H pData[1] = (int16_t)(rxData[1] << 8 | rxData[0]); // Объединение байтов в 16-битное значение // Чтение данных по Z (младший и старший байты) rxData[0] = LIS3DSH_Read(LIS3DSH_OUT_Z_L_ADDR); // OUT_Z_L rxData[1] = LIS3DSH_Read(LIS3DSH_OUT_Z_L_ADDR + 1); // OUT_Z_H pData[2] = (int16_t)(rxData[1] << 8 | rxData[0]); // Объединение байтов в 16-битное значение}
void Control_LEDs(int16_t *accelData) { // Простое управление светодиодами в зависимости от значений осей X и Y if (accelData[0] > 500) HAL_GPIO_WritePin(GPIOD, GPIO_PIN_13, GPIO_PIN_SET); // LED4 ON else HAL_GPIO_WritePin(GPIOD, GPIO_PIN_13, GPIO_PIN_RESET); // LED4 OFF
if (accelData[0] < -500) HAL_GPIO_WritePin(GPIOD, GPIO_PIN_15, GPIO_PIN_SET); // LED5 ON else HAL_GPIO_WritePin(GPIOD, GPIO_PIN_15, GPIO_PIN_RESET); // LED5 OFF if (accelData[1] > 500) HAL_GPIO_WritePin(GPIOD, GPIO_PIN_12, GPIO_PIN_SET); // LED3 ON else HAL_GPIO_WritePin(GPIOD, GPIO_PIN_12, GPIO_PIN_RESET); // LED3 OFF if (accelData[1] < -500) HAL_GPIO_WritePin(GPIOD, GPIO_PIN_14, GPIO_PIN_SET); // LED6 ON else HAL_GPIO_WritePin(GPIOD, GPIO_PIN_14, GPIO_PIN_RESET); // LED6 OFF}
Добавь сюда функцию калибровки
- Assistant
void Calibrate_Accelerometer(int16_t *offsetData) { // Инициализация переменных для накопления данных int32_t sumData[3] = {0, 0, 0}; int16_t accelData[3]; int num_samples = 1000; // Количество измерений для усреднения // Сбор данных for (int i = 0; i < num_samples; i++) { Read_Accelerometer(accelData); sumData[0] += accelData[0]; sumData[1] += accelData[1]; sumData[2] += accelData[2]; HAL_Delay(1); // Задержка между измерениями } // Вычисление среднего значения смещения offsetData[0] = sumData[0] / num_samples; offsetData[1] = sumData[1] / num_samples; offsetData[2] = (sumData[2] / num_samples) - (int16_t)(1.0 / LIS3DSH_SENSITIVITY_2G); // Учет гравитации по оси Z }Эта функция выполняет калибровку акселерометра, вычисляя смещения по каждой оси. Она собирает определённое количество измерений, усредняет их и сохраняет полученные смещения в массив
offsetData. При последующем чтении данных акселерометра эти смещения можно вычитать из измеренных значений для получения откалиброванных данных.Пример использования откалиброванных данных в функции чтения акселерометра:
void Read_Accelerometer_Calibrated(int16_t *pData, int16_t *offsetData) { Read_Accelerometer(pData); // Вычитание смещений pData[0] -= offsetData[0]; pData[1] -= offsetData[1]; pData[2] -= offsetData[2]; }Применение функции калибровки в основном коде:
int16_t offsetData[3]; Calibrate_Accelerometer(offsetData); while (1) { int16_t accelData[3]; Read_Accelerometer_Calibrated(accelData, offsetData); Control_LEDs(accelData); HAL_Delay(100); }Теперь акселерометр будет выдавать откалиброванные данные, и управление светодиодами будет более точным.