diff --git a/project/ble_peripheral/ble_app_bladder_patch/command/handlers/cmd_piezo.c b/project/ble_peripheral/ble_app_bladder_patch/command/handlers/cmd_piezo.c index cc19695..588cd17 100644 --- a/project/ble_peripheral/ble_app_bladder_patch/command/handlers/cmd_piezo.c +++ b/project/ble_peripheral/ble_app_bladder_patch/command/handlers/cmd_piezo.c @@ -340,6 +340,11 @@ int Cmd_mbb(const ParsedCmd *cmd) maa_async_set_pre_capture_all(true); + if (!dr_piezo_is_power_on()) + { + dr_piezo_power_on(); + } + err = maa_async_start( m_config.piezo_freq_option, m_config.piezo_delay_us, @@ -389,13 +394,13 @@ int Cmd_mtb(const ParsedCmd *cmd) (void)imu_fifo_capture_start(); + maa_async_set_pre_capture_all(true); + if (!dr_piezo_is_power_on()) { dr_piezo_power_on(); } - maa_async_set_pre_capture_all(true); - err = maa_async_start( m_config.piezo_freq_option, m_config.piezo_delay_us,