정렬모드 중에는 IMU FIFO OFF 하지 않도록 수정
- IMU 샘플 15개 보장
This commit is contained in:
@@ -53,7 +53,7 @@
|
|||||||
* : Unify both IMU direct-read and FIFO outputs as raw data in datasheet axis convention.
|
* : Unify both IMU direct-read and FIFO outputs as raw data in datasheet axis convention.
|
||||||
* - VBTFW0120 260615 jhChun : Add EMC mitigation logic for BLE link stability: extended supervision timeout and dynamic TX power control based on RSSI, RSSI silence, HVN latency, and TX queue congestion.
|
* - VBTFW0120 260615 jhChun : Add EMC mitigation logic for BLE link stability: extended supervision timeout and dynamic TX power control based on RSSI, RSSI silence, HVN latency, and TX queue congestion.
|
||||||
------------------------------------------------------------------------- */
|
------------------------------------------------------------------------- */
|
||||||
#define FIRMWARE_VERSION "VBTFW0120"
|
#define FIRMWARE_VERSION "VBTFW0129"
|
||||||
|
|
||||||
/*==============================================================================
|
/*==============================================================================
|
||||||
* Data Length Constants
|
* Data Length Constants
|
||||||
|
|||||||
@@ -684,6 +684,14 @@ static void imu_fifo_power_off(void)
|
|||||||
s_fifo_capture_active = false;
|
s_fifo_capture_active = false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void imu_fifo_capture_disable(void)
|
||||||
|
{
|
||||||
|
if (s_fifo_capture_active)
|
||||||
|
{
|
||||||
|
imu_fifo_power_off();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
int imu_fifo_capture_start(void)
|
int imu_fifo_capture_start(void)
|
||||||
{
|
{
|
||||||
int rc;
|
int rc;
|
||||||
@@ -719,7 +727,6 @@ int imu_fifo_capture_start(void)
|
|||||||
rc |= inv_imu_enable_accel_low_noise_mode(&icm_driver); // FIFO Accel Low Noise Mode
|
rc |= inv_imu_enable_accel_low_noise_mode(&icm_driver); // FIFO Accel Low Noise Mode
|
||||||
//rc |= inv_imu_enable_accel_low_power_mode(&icm_driver); // FIFO Accel Low Power Mode TEST
|
//rc |= inv_imu_enable_accel_low_power_mode(&icm_driver); // FIFO Accel Low Power Mode TEST
|
||||||
rc |= inv_imu_enable_gyro_low_noise_mode(&icm_driver); // FIFO Gyro Low Noise Mode
|
rc |= inv_imu_enable_gyro_low_noise_mode(&icm_driver); // FIFO Gyro Low Noise Mode
|
||||||
imu_fifo_log_power_mode();
|
|
||||||
dr_sd_delay_ms(IMU_FIFO_ENABLE_SETTLE_MS);
|
dr_sd_delay_ms(IMU_FIFO_ENABLE_SETTLE_MS);
|
||||||
rc |= inv_imu_reset_fifo(&icm_driver);
|
rc |= inv_imu_reset_fifo(&icm_driver);
|
||||||
|
|
||||||
@@ -977,6 +984,5 @@ int imu_fifo_capture_stop_and_send_rim(void)
|
|||||||
}
|
}
|
||||||
|
|
||||||
imu_fifo_send_rim_packets(packet_count);
|
imu_fifo_send_rim_packets(packet_count);
|
||||||
imu_fifo_power_off();
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -21,6 +21,7 @@
|
|||||||
|
|
||||||
#ifndef _APP_RAW_H_
|
#ifndef _APP_RAW_H_
|
||||||
#define _APP_RAW_H_
|
#define _APP_RAW_H_
|
||||||
|
#include <stdbool.h>
|
||||||
#include "sdk_config.h"
|
#include "sdk_config.h"
|
||||||
|
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
|
|||||||
Reference in New Issue
Block a user