18 changed files with 16117 additions and 262 deletions
-
3.vscode/settings.json
-
5README.md
-
186app/app.uvoptx
-
20app/app.uvprojx
-
17app/src/algo/baseline_filtering.c
-
1app/src/algo/baseline_filtering.h
-
5app/src/algo/fix_delay_fifo.h
-
224app/src/algo/iflytop_simple_filter.c
-
96app/src/algo/iflytop_simple_filter.h
-
57app/src/algo/iflytop_simple_filter_ext.c
-
31app/src/algo/iflytop_simple_filter_ext.h
-
109app/src/basic/filters.c
-
53app/src/basic/filters.h
-
2app/src/basic/version.h
-
2app/src/board/board.h
-
10app/src/heart_wave_sample_service.c
-
15558release/V30/three_lead_ecg.hex
-
BINrelease/V30/three_lead_ecg.zip
@ -0,0 +1,224 @@ |
|||||
|
|
||||
|
#include "iflytop_simple_filter.h" |
||||
|
|
||||
|
#include <math.h> |
||||
|
#include <stdint.h> |
||||
|
#include <stdio.h> |
||||
|
#include <stdlib.h> |
||||
|
#include <string.h> |
||||
|
|
||||
|
#define PI 3.141592653 |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* LOW PASS FILTER |
||||
|
********************************************************************************************************/ |
||||
|
|
||||
|
void LPFilter_Init(LPFilter_t *filter, float cutoffFreqHz, float sampleTimeS, bool enable) { |
||||
|
float RC = 0.0; |
||||
|
RC = 1.0 / (2 * PI * cutoffFreqHz); |
||||
|
filter->coef[0] = sampleTimeS / (sampleTimeS + RC); |
||||
|
filter->coef[1] = RC / (sampleTimeS + RC); |
||||
|
|
||||
|
filter->v_out[0] = 0.0; |
||||
|
filter->v_out[1] = 0.0; |
||||
|
|
||||
|
filter->enable = enable; |
||||
|
} |
||||
|
|
||||
|
float LPFilter_Update(LPFilter_t *filter, float v_in) { |
||||
|
if (filter->enable == false) return v_in; |
||||
|
|
||||
|
filter->v_out[1] = filter->v_out[0]; |
||||
|
filter->v_out[0] = (filter->coef[0] * v_in) + (filter->coef[1] * filter->v_out[1]); |
||||
|
|
||||
|
return (filter->v_out[0]); |
||||
|
} |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* HIGH PASS FILTER |
||||
|
********************************************************************************************************/ |
||||
|
void HPFilter_Init(HPFilter_t *filter, float cutoffFreqHz, float sampleTimeS, bool enable) { |
||||
|
float RC = 0.0; |
||||
|
RC = 1.0 / (2 * PI * cutoffFreqHz); |
||||
|
|
||||
|
filter->coef = RC / (sampleTimeS + RC); |
||||
|
|
||||
|
filter->v_in[0] = 0.0; |
||||
|
filter->v_in[1] = 0.0; |
||||
|
|
||||
|
filter->v_out[0] = 0.0; |
||||
|
filter->v_out[1] = 0.0; |
||||
|
|
||||
|
filter->enable = enable; |
||||
|
} |
||||
|
|
||||
|
float HPFilter_Update(HPFilter_t *filter, float v_in) { |
||||
|
if (filter->enable == false) return v_in; |
||||
|
|
||||
|
filter->v_in[1] = filter->v_in[0]; |
||||
|
filter->v_in[0] = v_in; |
||||
|
|
||||
|
filter->v_out[1] = filter->v_out[0]; |
||||
|
|
||||
|
filter->v_out[0] = filter->coef * (filter->v_in[0] - filter->v_in[1] + filter->v_out[1]); |
||||
|
|
||||
|
return (filter->v_out[0]); |
||||
|
} |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* BAND PASS FILTER |
||||
|
********************************************************************************************************/ |
||||
|
|
||||
|
void PBFilter_Init(PBFilter_t *filter, float HPF_cutoffFreqHz, float LPF_cutoffFreqHz, float sampleTimeS, bool enable) { |
||||
|
LPFilter_Init(&filter->lpf, LPF_cutoffFreqHz, sampleTimeS, enable); |
||||
|
HPFilter_Init(&filter->hpf, HPF_cutoffFreqHz, sampleTimeS, enable); |
||||
|
filter->out_in = 0.0; |
||||
|
filter->enable = enable; |
||||
|
} |
||||
|
|
||||
|
float PBFilter_Update(PBFilter_t *filter, float v_in) { |
||||
|
if (filter->enable == false) return v_in; |
||||
|
|
||||
|
filter->out_in = HPFilter_Update(&filter->hpf, v_in); |
||||
|
|
||||
|
filter->out_in = LPFilter_Update(&filter->lpf, filter->out_in); |
||||
|
|
||||
|
return (filter->out_in); |
||||
|
} |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* NOTCH FILTER |
||||
|
********************************************************************************************************/ |
||||
|
|
||||
|
void NOTCHFilter_Init(NOTCHFilter_t *filter, float centerFreqHz, float notchWidthHz, float sampleTimeS, bool enable) { |
||||
|
// filter frequency to angular (rad/s) |
||||
|
float w0_rps = 2.0 * PI * centerFreqHz; |
||||
|
float ww_rps = 2.0 * PI * notchWidthHz; |
||||
|
|
||||
|
// pre warp center frequency |
||||
|
float w0_pw_rps = (2.0f / sampleTimeS) * tanf(0.5f * w0_rps * sampleTimeS); |
||||
|
|
||||
|
// computing filter coefficients |
||||
|
|
||||
|
filter->alpha = 4.0f + w0_rps * w0_pw_rps * sampleTimeS * sampleTimeS; |
||||
|
filter->beta = 2.0f * ww_rps * sampleTimeS; |
||||
|
|
||||
|
// clearing input and output buffers |
||||
|
|
||||
|
for (uint8_t n = 0; n < 3; n++) { |
||||
|
filter->vin[n] = 0; |
||||
|
filter->vout[n] = 0; |
||||
|
} |
||||
|
filter->enable = enable; |
||||
|
} |
||||
|
|
||||
|
float NOTCHFilter_Update(NOTCHFilter_t *filter, float vin) { |
||||
|
if (filter->enable == false) return vin; |
||||
|
|
||||
|
// shifting samples |
||||
|
filter->vin[2] = filter->vin[1]; |
||||
|
filter->vin[1] = filter->vin[0]; |
||||
|
|
||||
|
filter->vout[2] = filter->vout[1]; |
||||
|
filter->vout[1] = filter->vout[0]; |
||||
|
|
||||
|
filter->vin[0] = vin; |
||||
|
|
||||
|
// compute new output |
||||
|
filter->vout[0] = (filter->alpha * filter->vin[0] + 2.0f * (filter->alpha - 8.0f) * filter->vin[1] + filter->alpha * filter->vin[2] - |
||||
|
(2.0f * (filter->alpha - 8.0f) * filter->vout[1] + (filter->alpha - filter->beta) * filter->vout[2])) / |
||||
|
(filter->alpha + filter->beta); |
||||
|
|
||||
|
return (filter->vout[0]); |
||||
|
} |
||||
|
#if 0 |
||||
|
typedef struct { |
||||
|
float val[MEDIAN_FILTER_MAX_SIZE]; |
||||
|
int valStartPos; |
||||
|
int valEndPos; |
||||
|
int medianSize; |
||||
|
} median_filter_t; |
||||
|
#endif |
||||
|
|
||||
|
void median_filter_init(median_filter_t *filter, int medianSize) { |
||||
|
filter->medianSize = medianSize; |
||||
|
filter->numVal = 0; |
||||
|
for (int i = 0; i < MEDIAN_FILTER_MAX_SIZE; i++) { |
||||
|
filter->val[i] = 0; |
||||
|
} |
||||
|
} |
||||
|
float median_filter_update(median_filter_t *filter, float val) { |
||||
|
if (filter->numVal >= filter->medianSize) { |
||||
|
memmove(filter->val, filter->val + 1, (filter->medianSize - 1) * sizeof(float)); |
||||
|
filter->numVal--; |
||||
|
} |
||||
|
|
||||
|
filter->val[filter->numVal] = val; |
||||
|
filter->numVal++; |
||||
|
|
||||
|
for (int i = 0; i < filter->numVal; i++) { |
||||
|
filter->temp[i] = filter->val[i]; |
||||
|
} |
||||
|
|
||||
|
for (int i = 0; i < filter->numVal; i++) { |
||||
|
for (int j = i + 1; j < filter->numVal; j++) { |
||||
|
if (filter->temp[i] > filter->temp[j]) { |
||||
|
float temp = filter->temp[i]; |
||||
|
filter->temp[i] = filter->temp[j]; |
||||
|
filter->temp[j] = temp; |
||||
|
} |
||||
|
} |
||||
|
} |
||||
|
|
||||
|
if (filter->numVal % 2 == 0) { |
||||
|
return (filter->temp[filter->numVal / 2 - 1] + filter->temp[filter->numVal / 2]) / 2; |
||||
|
} else { |
||||
|
return filter->temp[filter->numVal / 2]; |
||||
|
} |
||||
|
} |
||||
|
|
||||
|
|
||||
|
|
||||
|
void BaselineDriftRemoval_Init(BaselineDriftRemoval_t *filter, int windows_size, bool enable) { |
||||
|
if (windows_size > MEDIAN_FILTER_SIZE) { |
||||
|
windows_size = MEDIAN_FILTER_SIZE; |
||||
|
} |
||||
|
|
||||
|
filter->windows_size = windows_size; |
||||
|
filter->datanum = 0; |
||||
|
filter->enable = enable; |
||||
|
for (int i = 0; i < windows_size; i++) { |
||||
|
filter->fifo[i] = 0; |
||||
|
} |
||||
|
} |
||||
|
float BaselineDriftRemoval_Update(BaselineDriftRemoval_t *filter, float vin) { |
||||
|
if (!filter->enable) return vin; |
||||
|
|
||||
|
// memmove(filter->fifo, filter->fifo + 1, (filter->windows_size - 1) * sizeof(float)); |
||||
|
filter->fifo[filter->windows_size - 1] = vin; |
||||
|
filter->datanum++; |
||||
|
if (filter->datanum > filter->windows_size) { |
||||
|
filter->datanum = filter->windows_size; |
||||
|
} |
||||
|
if (filter->datanum < filter->windows_size) { |
||||
|
return 0; |
||||
|
} |
||||
|
|
||||
|
// ÇóÖÐÖµ |
||||
|
// memcpy(filter->processcache, filter->fifo, filter->windows_size * sizeof(float)); |
||||
|
for (int i = 0; i < filter->windows_size; i++) { |
||||
|
for (int j = i + 1; j < filter->windows_size; j++) { |
||||
|
if (filter->processcache[i] > filter->processcache[j]) { |
||||
|
float temp = filter->processcache[i]; |
||||
|
filter->processcache[i] = filter->processcache[j]; |
||||
|
filter->processcache[j] = temp; |
||||
|
} |
||||
|
} |
||||
|
} |
||||
|
|
||||
|
float mid = filter->processcache[filter->windows_size / 2]; |
||||
|
float min_data_in_fifo = filter->fifo[filter->windows_size / 2]; |
||||
|
|
||||
|
return min_data_in_fifo - mid; |
||||
|
} |
||||
|
|
||||
@ -0,0 +1,96 @@ |
|||||
|
#pragma once |
||||
|
#include <stdbool.h> |
||||
|
|
||||
|
// #ifdef __cplusplus |
||||
|
// extern "C" { |
||||
|
// #endif |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* LOW PASS FILTER |
||||
|
********************************************************************************************************/ |
||||
|
typedef struct { |
||||
|
float coef[2]; |
||||
|
float v_out[2]; |
||||
|
bool enable; |
||||
|
} LPFilter_t; |
||||
|
|
||||
|
void LPFilter_Init(LPFilter_t *filter, float cutoffFreqHz, float sampleTimeS, bool enable); |
||||
|
float LPFilter_Update(LPFilter_t *filter, float v_in); |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* HIGH PASS FILTER |
||||
|
********************************************************************************************************/ |
||||
|
typedef struct { |
||||
|
float coef; |
||||
|
float v_out[2]; |
||||
|
float v_in[2]; |
||||
|
bool enable; |
||||
|
|
||||
|
} HPFilter_t; |
||||
|
|
||||
|
void HPFilter_Init(HPFilter_t *filter, float cutoffFreqHz, float sampleTimeS, bool enable); |
||||
|
float HPFilter_Update(HPFilter_t *filter, float v_in); |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* BAND PASS FILTER |
||||
|
********************************************************************************************************/ |
||||
|
|
||||
|
typedef struct { |
||||
|
LPFilter_t lpf; |
||||
|
HPFilter_t hpf; |
||||
|
float out_in; |
||||
|
bool enable; |
||||
|
|
||||
|
} PBFilter_t; |
||||
|
|
||||
|
void PBFilter_Init(PBFilter_t *filter, float HPF_cutoffFreqHz, float LPF_cutoffFreqHz, float sampleTimeS, bool enable); |
||||
|
float PBFilter_Update(PBFilter_t *filter, float v_in); |
||||
|
|
||||
|
/******************************************************************************************************** |
||||
|
* NOTCH FILTER |
||||
|
********************************************************************************************************/ |
||||
|
|
||||
|
typedef struct { |
||||
|
float alpha; |
||||
|
float beta; |
||||
|
|
||||
|
float vin[3]; |
||||
|
float vout[3]; |
||||
|
bool enable; |
||||
|
|
||||
|
} NOTCHFilter_t; |
||||
|
|
||||
|
void NOTCHFilter_Init(NOTCHFilter_t *filter, float centerFreqHz, float notchWidthHz, float sampleTimeS, bool enable); |
||||
|
float NOTCHFilter_Update(NOTCHFilter_t *filter, float vin); |
||||
|
|
||||
|
// #ifdef __cplusplus |
||||
|
// } |
||||
|
// #endif |
||||
|
#define MEDIAN_FILTER_MAX_SIZE 200 |
||||
|
|
||||
|
typedef struct { |
||||
|
float val[MEDIAN_FILTER_MAX_SIZE]; |
||||
|
float temp[MEDIAN_FILTER_MAX_SIZE]; |
||||
|
|
||||
|
int medianSize; |
||||
|
int numVal; |
||||
|
} median_filter_t; |
||||
|
|
||||
|
void median_filter_init(median_filter_t *filter, int medianSize); |
||||
|
float median_filter_update(median_filter_t *filter, float val); |
||||
|
|
||||
|
|
||||
|
#define MEDIAN_FILTER_SIZE 300 |
||||
|
typedef struct { |
||||
|
float fifo[MEDIAN_FILTER_SIZE]; |
||||
|
float processcache[MEDIAN_FILTER_SIZE]; |
||||
|
bool enable; |
||||
|
|
||||
|
int windows_size; |
||||
|
int datanum; |
||||
|
} BaselineDriftRemoval_t; |
||||
|
|
||||
|
void BaselineDriftRemoval_Init(BaselineDriftRemoval_t *filter, int windows_size, bool enable); |
||||
|
float BaselineDriftRemoval_Update(BaselineDriftRemoval_t *filter, float vin); |
||||
|
|
||||
|
|
||||
@ -0,0 +1,57 @@ |
|||||
|
#include "iflytop_simple_filter_ext.h" |
||||
|
|
||||
|
void LPFilterExt_init(LPFilterExt_t *filter, float cutoffFreqHz, float sampleTimeS, int order, bool enable) { |
||||
|
if (order > FILTER_MAX_ORDER) { |
||||
|
order = FILTER_MAX_ORDER; |
||||
|
} |
||||
|
|
||||
|
filter->order = order; |
||||
|
for (int i = 0; i < order; i++) { |
||||
|
LPFilter_Init(&filter->lp_filter[i], cutoffFreqHz, sampleTimeS, enable); |
||||
|
} |
||||
|
} |
||||
|
float LPFilterExt_update(LPFilterExt_t *filter, float v_in) { |
||||
|
float v_out = v_in; |
||||
|
for (int i = 0; i < filter->order; i++) { |
||||
|
v_out = LPFilter_Update(&filter->lp_filter[i], v_out); |
||||
|
} |
||||
|
return v_out; |
||||
|
} |
||||
|
|
||||
|
void HPFilterExt_init(HPFilterExt_t *filter, float cutoffFreqHz, float sampleTimeS, int order, bool enable) { |
||||
|
if (order > FILTER_MAX_ORDER) { |
||||
|
order = FILTER_MAX_ORDER; |
||||
|
} |
||||
|
|
||||
|
filter->order = order; |
||||
|
|
||||
|
for (int i = 0; i < order; i++) { |
||||
|
HPFilter_Init(&filter->hp_filter[i], cutoffFreqHz, sampleTimeS, enable); |
||||
|
} |
||||
|
} |
||||
|
float HPFilterExt_update(HPFilterExt_t *filter, float v_in) { |
||||
|
float v_out = v_in; |
||||
|
for (int i = 0; i < filter->order; i++) { |
||||
|
v_out = HPFilter_Update(&filter->hp_filter[i], v_out); |
||||
|
} |
||||
|
return v_out; |
||||
|
} |
||||
|
|
||||
|
void NOTCHFilterExt_init(NOTCHFilterExt_t *filter, float centerFreqHz, float notchWidthHz, float sampleTimeS, int order, bool enable) { |
||||
|
if (order > FILTER_MAX_ORDER) { |
||||
|
order = FILTER_MAX_ORDER; |
||||
|
} |
||||
|
|
||||
|
filter->order = order; |
||||
|
|
||||
|
for (int i = 0; i < order; i++) { |
||||
|
NOTCHFilter_Init(&filter->notch_filter[i], centerFreqHz, notchWidthHz, sampleTimeS, enable); |
||||
|
} |
||||
|
} |
||||
|
float NOTCHFilterExt_update(NOTCHFilterExt_t *filter, float v_in) { |
||||
|
float v_out = v_in; |
||||
|
for (int i = 0; i < filter->order; i++) { |
||||
|
v_out = NOTCHFilter_Update(&filter->notch_filter[i], v_out); |
||||
|
} |
||||
|
return v_out; |
||||
|
} |
||||
@ -0,0 +1,31 @@ |
|||||
|
#pragma once |
||||
|
#include "iflytop_simple_filter.h" |
||||
|
|
||||
|
#define FILTER_MAX_ORDER 20 |
||||
|
typedef struct { |
||||
|
LPFilter_t lp_filter[FILTER_MAX_ORDER]; |
||||
|
int order; |
||||
|
} LPFilterExt_t; |
||||
|
|
||||
|
void LPFilterExt_init(LPFilterExt_t *filter, float cutoffFreqHz, float sampleTimeS, int order, bool enable); |
||||
|
float LPFilterExt_update(LPFilterExt_t *filter, float v_in); |
||||
|
|
||||
|
typedef struct { |
||||
|
HPFilter_t hp_filter[FILTER_MAX_ORDER]; |
||||
|
int order; |
||||
|
} HPFilterExt_t; |
||||
|
|
||||
|
void HPFilterExt_init(HPFilterExt_t *filter, float cutoffFreqHz, float sampleTimeS, int order, bool enable); |
||||
|
float HPFilterExt_update(HPFilterExt_t *filter, float v_in); |
||||
|
|
||||
|
|
||||
|
typedef struct { |
||||
|
NOTCHFilter_t notch_filter[FILTER_MAX_ORDER]; |
||||
|
int order; |
||||
|
} NOTCHFilterExt_t; |
||||
|
|
||||
|
void NOTCHFilterExt_init(NOTCHFilterExt_t *filter, float centerFreqHz, float notchWidthHz, float sampleTimeS, int order, bool enable); |
||||
|
float NOTCHFilterExt_update(NOTCHFilterExt_t *filter, float v_in); |
||||
|
|
||||
|
|
||||
|
|
||||
@ -1,56 +1,3 @@ |
|||||
#pragma once |
#pragma once |
||||
#include <stdint.h> |
#include <stdint.h> |
||||
|
|
||||
/******************************************************************************************************** |
|
||||
* LOW PASS FILTER |
|
||||
********************************************************************************************************/ |
|
||||
typedef struct { |
|
||||
float coef[2]; |
|
||||
float v_out[2]; |
|
||||
} LPFilter; |
|
||||
|
|
||||
void LPFilter_Init(LPFilter *filter, float cutoffFreqHz, float sampleTimeS); |
|
||||
float LPFilter_Update(LPFilter *filter, float v_in); |
|
||||
|
|
||||
/******************************************************************************************************** |
|
||||
* HIGH PASS FILTER |
|
||||
********************************************************************************************************/ |
|
||||
typedef struct { |
|
||||
float coef; |
|
||||
float v_out[2]; |
|
||||
float v_in[2]; |
|
||||
|
|
||||
} HPFilter; |
|
||||
|
|
||||
void HPFilter_Init(HPFilter *filter, float cutoffFreqHz, float sampleTimeS); |
|
||||
float HPFilter_Update(HPFilter *filter, float v_in); |
|
||||
|
|
||||
/******************************************************************************************************** |
|
||||
* BAND PASS FILTER |
|
||||
********************************************************************************************************/ |
|
||||
|
|
||||
typedef struct { |
|
||||
LPFilter lpf; |
|
||||
HPFilter hpf; |
|
||||
float out_in; |
|
||||
} PBFilter; |
|
||||
|
|
||||
void PBFilter_Init(PBFilter *filter, float HPF_cutoffFreqHz, float LPF_cutoffFreqHz, float sampleTimeS); |
|
||||
float PBFilter_Update(PBFilter *filter, float v_in); |
|
||||
|
|
||||
/******************************************************************************************************** |
|
||||
* NOTCH FILTER |
|
||||
********************************************************************************************************/ |
|
||||
|
|
||||
typedef struct { |
|
||||
float alpha; |
|
||||
float beta; |
|
||||
|
|
||||
float vin[3]; |
|
||||
float vout[3]; |
|
||||
|
|
||||
} NOTCHFilter; |
|
||||
|
|
||||
void NOTCHFilter_Init(NOTCHFilter *filter, float centerFreqHz, float notchWidthHz, float sampleTimeS); |
|
||||
float NOTCHFilter_Update(NOTCHFilter *filter, float vin); |
|
||||
|
|
||||
15558
release/V30/three_lead_ecg.hex
File diff suppressed because it is too large
View File
File diff suppressed because it is too large
View File
Write
Preview
Loading…
Cancel
Save
Reference in new issue