Sensor check

include/openearable_common.h

@@ -115,6 +115,14 @@ struct sensor_config {
 	uint8_t storageOptions;
 } __attribute__((packed));
 
+struct seal_check_data {
+    uint8_t version;
+    uint8_t quality;
+	uint8_t mean_magnitude;
+	uint8_t num_peaks;
+	uint16_t frequencies[9]; // 12.4 fixed point
+	uint16_t magnitudes[9];
+} __attribute__((packed));
 
 struct battery_settings {
     float u_nominal;

prj.conf

@@ -100,6 +100,10 @@ CONFIG_SFLOAT=y
 
 CONFIG_FPU=y
 
+CONFIG_CMSIS_DSP=y
+CONFIG_CMSIS_DSP_TRANSFORM=y
+CONFIG_CMSIS_DSP_COMPLEXMATH=y
+
 CONFIG_NEWLIB_LIBC=y
 CONFIG_NEWLIB_LIBC_FLOAT_PRINTF=y
 CONFIG_NEWLIB_LIBC_FLOAT_SCANF=y
@@ -182,6 +186,11 @@ CONFIG_FS_FATFS_EXFAT=y      # Enable exFAT support
 
 CONFIG_FDSP=y
 
+# CMSIS-DSP Configuration
+CONFIG_CMSIS_DSP=y
+CONFIG_CMSIS_DSP_TRANSFORM=y
+CONFIG_CMSIS_DSP_COMPLEXMATH=y
+
 CONFIG_SYSTEM_WORKQUEUE_STACK_SIZE=4096
 
 #CONFIG_USB_MASS_STORAGE=y

prj_fota.conf

@@ -261,3 +261,7 @@ CONFIG_MCUMGR_GRP_OS_RESET_HOOK=y
 #CONFIG_MCUMGR_GRP_SETTINGS_ACCESS_HOOK=y
 
 CONFIG_SETUP_FUEL_GAUGE=y
+
+CONFIG_CMSIS_DSP=y
+CONFIG_CMSIS_DSP_TRANSFORM=y
+CONFIG_CMSIS_DSP_COMPLEXMATH=y

src/Battery/BQ25120a.cpp

@@ -243,10 +243,8 @@ uint8_t BQ25120a::write_LDO_voltage_control(float volt) {
 
         readReg(registers::LS_LDO_CTRL, &status, sizeof(status));
 
-        //status |= (((uint16_t)((volt - 0.8) * 10)) & 0x1F) << 2;
         status &= 1 << 7;
         status |= ((uint8_t)((volt - 0.8f) * 10 + EPS)) << 2;
-        //status |= 1 << 7;
 
         writeReg(registers::LS_LDO_CTRL, &status, sizeof(status));
 
@@ -292,8 +290,6 @@ chrg_state BQ25120a::read_termination_control() {
 
         struct chrg_state chrg;
 
-        // if (!ret) printk("failed to read\n");
-
         chrg.enabled = status & 0x2;
         //chrg.high_impedance = status & 0x1;
 
@@ -343,8 +339,6 @@ ilim_uvlo BQ25120a::read_uvlo_ilim() {
 
         bool ret = readReg(registers::ILIM_UVLO, (uint8_t *) &status, sizeof(status));
 
-        // if (!ret) printk("failed to read\n");
-
         param.uvlo_v = CLAMP(3.0f- 0.2f * ((status & 0x7) - 2), 2.2, 3.0);
         param.lim_mA = 50.f + 50.f * ((status >> 3) & 0x7);
 
@@ -410,8 +404,6 @@ button_state BQ25120a::read_button_state() {
         uint8_t status = 0;
         bool ret = readReg(registers::BTN_CTRL, (uint8_t *) &status, sizeof(status));
 
-        // if (!ret) printk("failed to read\n");
-
         btn.wake_1 = status & 0x2;
         btn.wake_2 = status & 0x1;
 

src/Battery/PowerManager.cpp

@@ -631,7 +631,7 @@ int PowerManager::power_down(bool fault) {
     ret = pm_device_action_run(ls_sd,  PM_DEVICE_ACTION_SUSPEND);
     ret = pm_device_action_run(ls_3_3, PM_DEVICE_ACTION_SUSPEND);
     ret = pm_device_action_run(ls_1_8, PM_DEVICE_ACTION_SUSPEND);
-    ret = pm_device_action_run(cons, PM_DEVICE_ACTION_SUSPEND);
+    ret = pm_device_action_run(cons,   PM_DEVICE_ACTION_SUSPEND);
 
     /*const struct device *const i2c = DEVICE_DT_GET(DT_NODELABEL(i2c1));
     ret = pm_device_action_run(i2c, PM_DEVICE_ACTION_SUSPEND);
@@ -666,27 +666,7 @@ void PowerManager::charge_task() {
         battery_controller.enable_charge();
     }
 
-    //if (last_charging_state != charging_state ||  ) {
-        k_work_submit(&fuel_gauge_work);
-        //state_inidicator.set_state()
-        /*switch (charging_state) {
-        case 0:
-            LOG_INF("charging state: ready");
-            break;
-        case 1:
-            LOG_INF("charging state: charging");
-            break;
-        case 2:
-            LOG_INF("charging state: done");
-            break;
-        case 3:
-            LOG_WRN("charging state: fault");
-
-            //battery_controller.setup(_battery_settings);
-
-            break;
-        }*/
-    //}
+    k_work_submit(&fuel_gauge_work);
 
     last_charging_state = charging_state;
 }

src/ParseInfo/DefaultSensors.h

@@ -144,8 +144,8 @@ SensorScheme defaultSensors[SENSOR_COUNT] = {
             .availableOptions = DATA_STORAGE | FREQUENCIES_DEFINED, // no streaming
             .frequencyOptions = {
                 .frequencyCount = sizeof(Microphone::sample_rates.reg_vals),
-                .defaultFrequencyIndex = 1,
-                .maxBleFrequencyIndex = 1,
+                .defaultFrequencyIndex = 0,
+                .maxBleFrequencyIndex = 0,
                 .frequencies = Microphone::sample_rates.sample_rates,
             },
         },
@@ -159,7 +159,7 @@ SensorScheme defaultSensors[SENSOR_COUNT] = {
             .availableOptions = DATA_STREAMING | DATA_STORAGE | FREQUENCIES_DEFINED,
             .frequencyOptions = {
                 .frequencyCount = sizeof(PPG::sample_rates.reg_vals),
-                .defaultFrequencyIndex = 2,
+                .defaultFrequencyIndex = 1,
                 .maxBleFrequencyIndex = 12,
                 .frequencies = PPG::sample_rates.sample_rates,
             },

src/ParseInfo/ParseType.h

@@ -15,7 +15,7 @@ enum ParseType {
     PARSE_TYPE_DOUBLE,
 };
 
-const int parseTypeSizes[] = {
+static const int parseTypeSizes[] = {
     1,  // PARSE_TYPE_INT8
     1,  // PARSE_TYPE_UINT8
 

src/SD_Card/SDLogger/SDLogger.h

@@ -23,11 +23,6 @@ static_assert(BUFFER_SIZE % SD_BLOCK_SIZE == 0, "BUFFER_SIZE must be a multiple
 
 // Singleton pattern
 class SDLogger {
-protected:
-        // Add static instance pointer for work handler
-        //static SDLogger* instance_ptr;
-        //friend void sd_work_handler(struct k_work* work);
-
 private:
 
         SDCardManager* sd_card = nullptr;
@@ -80,14 +75,23 @@ class SDLogger {
         */
         int write_sensor_data(const void* const* data_blocks, const size_t* lengths, size_t block_count);
 
+        /**
+         * @brief Write a single sensor_data message to the log file
+         * @param msg The sensor_data message to write
+         * @return 0 on success, negative error code on failure
+         */
         int write_sensor_data(const sensor_data& msg);
 
         /**
-        * @brief End logging and close the current file
-        * @return 0 on success, negative error code on failure
-        */
+         * @brief End logging and close the current file
+         * @return 0 on success, negative error code on failure
+         */
         int end();
 
+        /**
+         * @brief Check if the logger is currently recording
+         * @return true if active, false otherwise
+         */
         bool is_active();
 
         SDLogger(SDLogger const&) = delete;

src/SensorManager/IMU.cpp

@@ -74,7 +74,7 @@ bool IMU::init(struct k_msgq * queue) {
     }
 
 	imu.setAccelRange(eAccelRange_2G);
-
+	imu.setGyroRange(eGyroRange_500DPS); 
 	sensor_queue = queue;
 
 	k_work_init(&sensor.sensor_work, update_sensor);
@@ -89,7 +89,7 @@ void IMU::start(int sample_rate_idx) {
     k_timeout_t t = K_USEC(1e6 / sample_rates.true_sample_rates[sample_rate_idx]);
 
 	imu.setAccelODR(sample_rates.reg_vals[sample_rate_idx]);
-
+	imu.setGyroODR(sample_rates.reg_vals[sample_rate_idx]);
 	_running = true;
 
 	k_timer_start(&sensor.sensor_timer, K_NO_WAIT, t);

src/SensorManager/Microphone.cpp

@@ -26,19 +26,18 @@ extern void empty_fifo();
 #endif
 
 #include <zephyr/logging/log.h>
-//LOG_MODULE_DECLARE(BMX160);
 LOG_MODULE_REGISTER(microphone, CONFIG_LOG_DEFAULT_LEVEL);
 
 extern struct data_fifo fifo_rx;
 
 Microphone Microphone::sensor;
 
-const SampleRateSetting<1> Microphone::sample_rates = {
-    { 0 },
+const SampleRateSetting<9> Microphone::sample_rates = {
+    { 1, 2, 3, 4, 6, 8, 12, 16, 24 },
 
-	{ 48000 },
+	{ 48000, 24000, 16000, 12000, 8000, 6000, 4000, 3000, 2000 },
 
-	{ 48000.0 }
+	{ 48000.0, 24000.0, 16000.0, 12000.0, 8000.0, 6000.0, 4000.0, 3000.0, 2000.0 }
 };
 
 bool Microphone::init(struct k_msgq * queue) {
@@ -55,16 +54,20 @@ bool Microphone::init(struct k_msgq * queue) {
 }
 
 void Microphone::start(int sample_rate_idx) {
-	ARG_UNUSED(sample_rate_idx);
+	//ARG_UNUSED(sample_rate_idx);
 
 	int ret;
 
 	if (!_active) return;
 
-	record_to_sd(true);
+	LOG_INF("Starting Microphone at %d Hz", sample_rates.sample_rates[sample_rate_idx]);
 
 	audio_datapath_aquire(&fifo_rx);
 
+	audio_datapath_decimator_init(sample_rates.reg_vals[sample_rate_idx]);
+
+	record_to_sd(true);
+
 	_running = true;
 }
 
@@ -78,5 +81,7 @@ void Microphone::stop() {
 
 	audio_datapath_release();
 
+	//audio_datapath_decimator_cleanup();
+
 	_running = false;
 }

src/SensorManager/Microphone.h

@@ -13,7 +13,7 @@ class Microphone : public EdgeMlSensor {
     void start(int sample_rate_idx) override;
     void stop() override;
 
-    const static SampleRateSetting<1> sample_rates;
+    const static SampleRateSetting<9> sample_rates;
 private:
     bool _active = false;
 };