#include "main.h" #include "math.h" #include "drv_SGM58031.h" /* * opm.c * * Created on: 2021年6月24日 * Author: Eric.wang */ float cal_1310 = 0.0f; float dbm_value_1310 = -50.0f; float Calculate_1310_dbm_array[50] = {0}; float ADC_1310 = 0.0f; char Heart_rate = 0; // 心率 char respiratory_value = 0; // 呼吸值 char body_movement_value = 0; // 体动值 0_正常 3_轻微体动 4_中度体动 5_大幅体动 -100_无效值（一分钟的体动值分布，0x00-oxFF 数值越大,体动越明显） char equipment_status_value = OffBed_Status; // 设备状态值 3_离床 4_在床 5_光纤故障 6_离线 9_传感器负荷 10_信号弱 float test_adc = 0.0f; float test_value = 0.0f; double standard = 0; // 求标准差 uint16_t ads1115_buffer[4]; int channel_1310 = 1; int health_flg = 1; int opticalFibre_flg = 0; int sensorLoad_flg = 0; int lightSignal_flg = 0; float ON_BED_Threshold = -30.0f; float OFF_BED_Threshold = -20.0f; char body_flg = 0; // todo: 增加人体检测标志位 char bodyCheckSignal = BODY_CHECK_ENABLE; // 人体检测标志位 double sum = 0; // 求和 double avgValue = 0; // 求平均数 double last_average = 0; // 求平均数 double var = 0; // 求方差 #define ORGANISMS_EXIST_ENABLE 0 // 非生命体征识别使能 #define ORGANISMS_EXIST_THRESHOLD 0.008f #define ORGANISMS_EXIST_HI_THRESHOLD 0.1f #define ORGANISMS_EXIST_ONCE_COUNT 6 #define ORGANISMS_EXIST_OneSec_COUNT 500 #define ORGANISMS_EXIST_CALCULATION_COUNT 13 char Organisms_OnceFlag = 0; double Organisms_Difference = 0.0f; double Organisms_Difference_CountBuffer[ORGANISMS_EXIST_CALCULATION_COUNT] = {0.0f}; /** * @brief get_optical_power * @param 总体optical判断 * @retval None. */ int StableCount = 0; float maxOpticalPower = -30.0f; extern float SGM58031_ADC_Value; void value_get(float value) { if (value != 0.0f) ADC_1310 = value; else ADC_1310 = SGM58031_ADC_Value; //(SGM58031_ADC_Value + Adjust_ADC(AIN_1310)) / 2; // 两个数据进行融合 可能会更加准一点 if (ADC_1310 < 0.00001f) ADC_1310 = 0.00001f; dbm_value_1310 = 10 * log10(ADC_1310 / pow(10, channel_1310)) + cal_1310; if (channel_1310 == 0x01) { dbm_value_1310 = dbm_value_1310 - 0.7f; } StableCount++; if (dbm_value_1310 > maxOpticalPower && StableCount >= 0x0FFF) { StableCount = 0; maxOpticalPower = dbm_value_1310; } } void get_optical_power(void) { float avgVolt = 0.0f; avgVolt = get_optical_1310_power(); value_get(avgVolt); } void get_ADS1115(void) { } /** * @brief get_optical_1310_power * @param OLT-1490 ADC1-3 * @retval None. */ float volt = 0.0f; float get_optical_1310_power(void) { // char Channel_Flag = 0; uint8_t i = 0, j = 0; float avgValue = 0, tem = 0; float dataBuffer[25] = {0.0}; release_volt(); volt = SGM58031_ReadADCValue(); if ((volt > MAX_VOLT) && (channel_1310 > ADG704_L)) // 电压太高 { // 切换放大倍数更小的通道 channel_1310--; } else if ((volt < MIN_VOLT) && (channel_1310 < ADG704_H)) // 电压太低 { // 切换放大倍数更大的通道 channel_1310++; } set_1310_channel(channel_1310); // 切换通道 release_volt(); // 切换通道，so 保持电容放电 for (i = 0; i < 25; i++) /*sample for 25 */ { dataBuffer[i] = SGM58031_ReadADCValue(); // 获取电压值 delay_ms(2); } for (j = 0; j < 25 - 1; j++) /*array with data big up */ { for (i = 1; i < 25 - j; i++) { if (dataBuffer[i] < dataBuffer[i - 1]) { tem = dataBuffer[i]; dataBuffer[i] = dataBuffer[i - 1]; dataBuffer[i - 1] = tem; } } } for (i = 5; i < 20; i++) { avgValue = avgValue + dataBuffer[i]; } volt = avgValue / 15.00f; return volt; } void set_1310_channel(uint8_t ch) { switch (ch) { case 0: { OP1_B = 0; OP1_A = 0; } break; case 1: { OP1_B = 0; OP1_A = 1; } break; case 2: { OP1_B = 1; OP1_A = 0; } break; case 3: { OP1_B = 1; OP1_A = 1; } break; default: break; } } /** * @brief release_volt * @param 保持电容放电 * @retval None. */ void release_volt(void) { // Dis_1310 = 1; // delay_ms(5); Dis_1310 = 0; // delay_ms(5); } char Organisms_CountDoneFlag = 0; extern uint8_t g_mon, g_day, g_hour, g_min, g_sec; void get_check_result(void) { // "health": 1, // 1:健康; -1:不健康 // "status": // 1:正常; 0:离线; -1:故障 // { // "opticalFibre": 0, // 光纤 // "sensorLoad": 0, // 传感器负荷 // "lightSignal": 0 // 光信号 // } #if ORGANISMS_EXIST_ENABLE // 白天进行非生命识别 static char Dif_Count = 0; static char Count_Flag = 0; static char InBed_Count = 0; static char OffBed_Count = 0; double Organisms_Difference_Old = 0.0f; double Organisms_Difference_Dif = 0.0f; static double CheckBed_sum = 0; // 求和 static double CheckBed_standard = 0; // 求差 static double CheckBed_average = 0; // 求平均数 static double CheckBed_last_average = 0; // 求平均数 if (bodyCheckSignal == BODY_CHECK_ENABLE) { CheckBed_sum = 0; for (int i = 0; i <= model_num; i++) { CheckBed_sum += ppg_data_500_buf[i]; // 求和 } CheckBed_average = CheckBed_sum / model_num; // 求平均值 CheckBed_standard = fabs(fabs(CheckBed_average) - fabs(CheckBed_last_average)) * 100; CheckBed_last_average = CheckBed_average; if (Organisms_Difference != Organisms_Difference_Old && Organisms_OnceFlag && !Organisms_CountDoneFlag) { Organisms_OnceFlag = 0; Organisms_Difference_Dif = Organisms_Difference_Old - Organisms_Difference; Organisms_Difference_Old = Organisms_Difference; Organisms_Difference_CountBuffer[Dif_Count] = Organisms_Difference_Dif; Dif_Count++; if (Dif_Count >= ORGANISMS_EXIST_CALCULATION_COUNT && !Count_Flag) { Dif_Count = 0; Count_Flag = 1; InBed_Count = 0; OffBed_Count = 0; for (char i = 0; i < ORGANISMS_EXIST_CALCULATION_COUNT; i++) { if (fabs(Organisms_Difference_CountBuffer[i]) >= ORGANISMS_EXIST_THRESHOLD) { InBed_Count++; } else { OffBed_Count++; } } Organisms_CountDoneFlag = 1; } else if (Count_Flag) { if (Dif_Count >= ORGANISMS_EXIST_CALCULATION_COUNT) { Dif_Count = 0; } InBed_Count = 0; OffBed_Count = 0; for (char i = 0; i < ORGANISMS_EXIST_CALCULATION_COUNT; i++) { if (fabs(Organisms_Difference_CountBuffer[i]) >= ORGANISMS_EXIST_HI_THRESHOLD) { InBed_Count = 0; OffBed_Count = 0; break; } if (fabs(Organisms_Difference_CountBuffer[i]) >= ORGANISMS_EXIST_THRESHOLD) { InBed_Count++; } else if (fabs(Organisms_Difference_CountBuffer[i]) < ORGANISMS_EXIST_THRESHOLD) { OffBed_Count++; } } } } } else { InBed_Count = 0; OffBed_Count = 0; } #endif if (dbm_value_1310 < FAULT_OPM) // 光纤故障 { equipment_status_value = Fiber_Error_Status; opticalFibre_flg = -1; // 光纤 sensorLoad_flg = 1; // 传感器 lightSignal_flg = 1; // 光信号 health_flg = -1; // 1:健康; -1:不健康 } else if (dbm_value_1310 <= WEAK_OPM) // 信号弱 { equipment_status_value = WeakSignal_Status; opticalFibre_flg = 1; // 光纤 sensorLoad_flg = 1; // 传感器 lightSignal_flg = -1; // 光信号 health_flg = -1; // 1:健康; -1:不健康 } else if (dbm_value_1310 >= 0) // 传感器负荷 { equipment_status_value = Sensor_Load_Status; opticalFibre_flg = 1; // 光纤 sensorLoad_flg = -1; // 传感器 lightSignal_flg = 1; // 光信号 health_flg = -1; // 1:健康; -1:不健康 } #if 0 else if (dbm_value_1310 >= OFF_BED_Threshold) // 离床-18.5 { equipment_status_value = OffBed_Status; opticalFibre_flg = 0; // 光纤 sensorLoad_flg = 0; // 传感器 lightSignal_flg = 0; // 光信号 health_flg = 1; // 1:健康; -1:不健康 #if NOT_PRE_STAGE OffBed_Flag = 0; // 离床 #endif #if ORGANISMS_EXIST_ENABLE if (bodyCheckSignal == BODY_CHECK_ENABLE) { Dif_Count = 0; Count_Flag = 0; InBed_Count = 0; OffBed_Count = 0; Organisms_CountDoneFlag = 0; } #endif } #if ORGANISMS_EXIST_ENABLE else if ((dbm_value_1310 > ON_BED_Threshold) && (dbm_value_1310 < OFF_BED_Threshold) && (InBed_Count >= OffBed_Count)) // 有重物，是人体 #else else if ((dbm_value_1310 > ON_BED_Threshold) && (dbm_value_1310 < OFF_BED_Threshold)) // 有重物 #endif { equipment_status_value = InBed_Status; OffBed_Flag = 4; // 在床 opticalFibre_flg = 1; // 光纤 sensorLoad_flg = 1; // 传感器 lightSignal_flg = 1; // 光信号 health_flg = 1; // 1:健康; -1:不健康 sum = 0; for (int i = 0; i <= model_num; i++) { sum += ppg_data_500_buf[i]; // 求和 } avgValue = sum / model_num; // 求平均值 standard = (fabs(avgValue - last_average)) * 100; last_average = avgValue; #if ORGANISMS_EXIST_ENABLE if (bodyCheckSignal == BODY_CHECK_ENABLE) { // 在床变离床，有重物情况下若有体动则重新进行判断 if (CheckBed_standard > Huge_Movement_Threshold) { Dif_Count = 0; Count_Flag = 0; InBed_Count = 0; OffBed_Count = 0; Organisms_CountDoneFlag = 0; } } #endif } #if ORGANISMS_EXIST_ENABLE else if ((dbm_value_1310 > ON_BED_Threshold) && (dbm_value_1310 < OFF_BED_Threshold) && (InBed_Count < OffBed_Count)) // 有重物，都是不是人体 { if (bodyCheckSignal == BODY_CHECK_ENABLE) { equipment_status_value = OffBed_Status; opticalFibre_flg = 0; // 光纤 sensorLoad_flg = 0; // 传感器 lightSignal_flg = 0; // 光信号 health_flg = 1; // 1:健康; -1:不健康 // TODO:此处需要详细解析,有重物情况下若有体动则重新进行判断 if (CheckBed_standard > Huge_Movement_Threshold) { Count_Flag = 0; InBed_Count = 0; OffBed_Count = 0; Organisms_CountDoneFlag = 0; } } } #endif #endif } int Organisms_SurviveCount = -1; void get_opm_number(void) { uint8_t farray[4] = {0}; static char CountNumber = 0; static float Organisms_Survive_StandardDeviation[3] = {0.0f}; // 生物体存活标准差 static float Organisms_Survive_Buffer[ORGANISMS_EXIST_OneSec_COUNT] = {0.0f}; // 生物体存活缓存 value_get(0.0f); // ppg_data2_buf[wifi_len] = dbm_value_1310; ppg_data_500_buf[wifi_len_500] = dbm_value_1310; // BH_data_500[wifi_len_500] = (unsigned short int)(abs((int)(dbm_value_1310 * 1000))); BH_data_500[wifi_len_500] = (unsigned short int)((int)(ADC_1310 * 10000)); Calculate_1310_dbm_array[CountNumber] = dbm_value_1310; stage_len++; CountNumber++; if (CountNumber >= 50) CountNumber = 0; if (stage_len >= 50) { stage_len = 0; ppg_stage_buf[ppg_stage_index] = BH_data_500[wifi_len_500]; if (BH_data_500[wifi_len_500] > max_min2[0]) // 最大值 max_min2[0] = BH_data_500[wifi_len_500]; if (BH_data_500[wifi_len_500] < max_min2[1]) // 最小值 max_min2[1] = BH_data_500[wifi_len_500]; ppg_stage_index++; if (ppg_stage_index >= 10) { // printf("t max:%d t min:%d \n",max_min2[0],max_min2[1]); ppg_stage_index = 0; // InsertQueue(Stage_q, (unsigned short int *)ppg_stage_buf, 10, (unsigned short int *)max_min2); max_min2[0] = 0; max_min2[1] = 50000; } } if (wifi_len_500 >= model_num) { for (int i = 0; i < model_num; i++) { // wifi_opm_send_buf[17 + 4 * i] = wifi_opm_buf[17 + 4 * i]; // wifi_opm_send_buf[18 + 4 * i] = wifi_opm_buf[18 + 4 * i]; // wifi_opm_send_buf[19 + 4 * i] = wifi_opm_buf[19 + 4 * i]; // wifi_opm_send_buf[20 + 4 * i] = wifi_opm_buf[20 + 4 * i]; } wifi_len_500 = 0; wifi_len_500_flg = 1; #if ORGANISMS_EXIST_ENABLE if (bodyCheckSignal == BODY_CHECK_ENABLE) { Organisms_SurviveCount++; // 生物体检测 Organisms_ExistCheck(Organisms_Survive_Buffer); } #endif } // memcpy(farray, &dbm_value_1310, sizeof(dbm_value_1310)); #if ORGANISMS_EXIST_ENABLE if (bodyCheckSignal == BODY_CHECK_ENABLE) { Organisms_Survive_Buffer[wifi_len_500] = dbm_value_1310; } #endif // wifi_opm_buf[17 + 4 * wifi_len_500] = farray[0]; // wifi_opm_buf[18 + 4 * wifi_len_500] = farray[1]; // wifi_opm_buf[19 + 4 * wifi_len_500] = farray[2]; // wifi_opm_buf[20 + 4 * wifi_len_500] = farray[3]; wifi_len_500++; } double Organisms_Result = 0.0f; double Organisms_ResultSum = 0.0f; // 生物体结果累加值 double Organisms_AllSum = 0.0f; // 生物体总累加值 double Organisms_AllAvg = 0.0f; // 生物体总平均值 float Organisms_SurviveAvg[ORGANISMS_EXIST_ONCE_COUNT] = {0.0f}; // 生物体分平均值 double Organisms_Survive_StandardDeviation[ORGANISMS_EXIST_ONCE_COUNT] = {0.0f}; // 生物体分标准值 double Organisms_OldValue = 0.0f; double Organisms_ExistCheck(float *buf) { double Organisms_SurviveSum = 0.0f; // 生物体分累加值 double OrganismsStandardSum = 0.0f; // 生物体标准差累加值 // 求和 for (int i = 0; i < ORGANISMS_EXIST_OneSec_COUNT; i++) { Organisms_AllSum += buf[i]; Organisms_SurviveSum += buf[i]; } // 作均值 Organisms_SurviveAvg[Organisms_SurviveCount] = Organisms_SurviveSum / ORGANISMS_EXIST_OneSec_COUNT; for (int i = 0; i < ORGANISMS_EXIST_OneSec_COUNT; i++) { OrganismsStandardSum += my_pow((buf[i] - Organisms_SurviveAvg[Organisms_SurviveCount])); } // 求标准差 Organisms_Survive_StandardDeviation[Organisms_SurviveCount] = sqrt(OrganismsStandardSum / ORGANISMS_EXIST_OneSec_COUNT); memset(buf, 0, ORGANISMS_EXIST_OneSec_COUNT); // 计算 ORGANISMS_EXIST_ONCE_COUNT 秒的标准差，合成 if (Organisms_SurviveCount >= ORGANISMS_EXIST_ONCE_COUNT) { Organisms_SurviveCount = -1; Organisms_ResultSum = 0; Organisms_AllAvg = Organisms_AllSum / (ORGANISMS_EXIST_OneSec_COUNT * ORGANISMS_EXIST_ONCE_COUNT); for (int i = 0; i < ORGANISMS_EXIST_ONCE_COUNT; i++) { Organisms_ResultSum += (ORGANISMS_EXIST_OneSec_COUNT * ((my_pow(Organisms_Survive_StandardDeviation[i])) + (my_pow(Organisms_AllAvg - Organisms_SurviveAvg[i])))); } Organisms_Result = sqrt(Organisms_ResultSum / (ORGANISMS_EXIST_OneSec_COUNT * ORGANISMS_EXIST_ONCE_COUNT)); Organisms_Difference = Organisms_Result - Organisms_OldValue; Organisms_OldValue = Organisms_Result; Organisms_AllSum = 0; Organisms_OnceFlag = 1; } return Organisms_Result; } double my_pow(float value) { double result = 0.0f; result = value * value; return result; } /** * @function: * @brief: None * @return {*} * @author: lzc */ void ConvertMoveStd(void) { sum = 0; for (int i = 0; i <= model_num; i++) { sum += ppg_data_500_buf[i]; // 求和 } avgValue = sum / model_num; // 求平均值 standard = (fabs(avgValue - last_average)) * 100; last_average = avgValue; }