123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193 |
- #include <stdio.h>
- #include <string.h>
- #include <unistd.h>
- #include "max30102.h"
- #include "algorithm.h"
- #include "cmsis_os2.h"
- #include "ohos_init.h"
- #define TASK_STACK_SIZE 1024 * 8
- #define TASK_PRIO 25
- uint32_t aun_ir_buffer[500];
- int32_t n_ir_buffer_length;
- uint32_t aun_red_buffer[500];
- int32_t n_sp02;
- int8_t ch_spo2_valid;
- int32_t n_heart_rate;
- int8_t ch_hr_valid;
- uint8_t uch_dummy;
- #define MAX_BRIGHTNESS 255
- static void ExampleTask(void)
- {
-
- uint32_t un_min, un_max, un_prev_data;
- int i;
- int32_t n_brightness;
- float f_temp;
- uint8_t temp_num=0;
- uint8_t temp[6]={0,0,0,0,0,0};
- uint8_t str[100];
- uint8_t dis_hr=0,dis_spo2=0;
- BoardInit();
- maxim_max30102_init();
- printf("\r\n MAX30102 init \r\n");
- un_min=0x3FFFF;
- un_max=0;
-
- n_ir_buffer_length=500;
-
- for(i=0;i<n_ir_buffer_length;i++)
- {
- while(GetInit()==1);
-
- max30102_FIFO_ReadBytes(REG_FIFO_DATA,temp);
- aun_red_buffer[i] = (long)((long)((long)temp[0]&0x03)<<16) | (long)temp[1]<<8 | (long)temp[2];
- aun_ir_buffer[i] = (long)((long)((long)temp[3] & 0x03)<<16) |(long)temp[4]<<8 | (long)temp[5];
-
- if(un_min>aun_red_buffer[i])
- un_min=aun_red_buffer[i];
- if(un_max<aun_red_buffer[i])
- un_max=aun_red_buffer[i];
-
-
-
-
- }
- un_prev_data=aun_red_buffer[i];
-
- maxim_heart_rate_and_oxygen_saturation(aun_ir_buffer, n_ir_buffer_length, aun_red_buffer, &n_sp02, &ch_spo2_valid, &n_heart_rate, &ch_hr_valid);
-
- while(1)
- {
- i=0;
- un_min=0x3FFFF;
- un_max=0;
-
-
- for(i=100;i<500;i++)
- {
- aun_red_buffer[i-100]=aun_red_buffer[i];
- aun_ir_buffer[i-100]=aun_ir_buffer[i];
-
-
- if(un_min>aun_red_buffer[i])
- un_min=aun_red_buffer[i];
- if(un_max<aun_red_buffer[i])
- un_max=aun_red_buffer[i];
- }
-
- for(i=400;i<500;i++)
- {
- un_prev_data=aun_red_buffer[i-1];
- while(GetInit()==1);
- max30102_FIFO_ReadBytes(REG_FIFO_DATA,temp);
- aun_red_buffer[i] = (long)((long)((long)temp[0]&0x03)<<16) | (long)temp[1]<<8 | (long)temp[2];
- aun_ir_buffer[i] = (long)((long)((long)temp[3] & 0x03)<<16) |(long)temp[4]<<8 | (long)temp[5];
-
- if(aun_red_buffer[i]>un_prev_data)
- {
- f_temp=aun_red_buffer[i]-un_prev_data;
- f_temp/=(un_max-un_min);
- f_temp*=MAX_BRIGHTNESS;
- n_brightness-=(int)f_temp;
- if(n_brightness<0)
- n_brightness=0;
- }
- else
- {
- f_temp=un_prev_data-aun_red_buffer[i];
- f_temp/=(un_max-un_min);
- f_temp*=MAX_BRIGHTNESS;
- n_brightness+=(int)f_temp;
- if(n_brightness>MAX_BRIGHTNESS)
- n_brightness=MAX_BRIGHTNESS;
- }
-
- if(ch_hr_valid == 1 && n_heart_rate<120)
- {
- dis_hr = n_heart_rate;
- dis_spo2 = n_sp02;
- }
- else
- {
- dis_hr = 0;
- dis_spo2 = 0;
- }
- }
-
-
-
-
-
-
-
-
-
-
- maxim_heart_rate_and_oxygen_saturation(aun_ir_buffer, n_ir_buffer_length, aun_red_buffer, &n_sp02, &ch_spo2_valid, &n_heart_rate, &ch_hr_valid);
- printf("HR=%i, ", n_heart_rate);
- printf("HRvalid=%i, ", ch_hr_valid);
-
-
- sleep(1);
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- }
- }
- static void ExampleEntry(void)
- {
- osThreadAttr_t attr;
- attr.name = "ExampleTask";
- attr.attr_bits = 0U;
- attr.cb_mem = NULL;
- attr.cb_size = 0U;
- attr.stack_mem = NULL;
- attr.stack_size = TASK_STACK_SIZE;
- attr.priority = TASK_PRIO;
- if (osThreadNew((osThreadFunc_t)ExampleTask, NULL, &attr) == NULL) {
- printf("Failed to create ExampleTask!\n");
- }
- }
- APP_FEATURE_INIT(ExampleEntry);
|