539 lines
14 KiB
C
539 lines
14 KiB
C
|
#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;
|
|||
|
|
}
|