OpenHarmony有氧拳击之设备端开发 精华

//E53_SC2模块MPU6050传感器数据处理主要流程
static void DataHandleTask(void)
{
    uint8_t ret;
    ret = E53SC2Init();//MPU6050传感器初始化及配置，配置为+—8g量程
    if (ret != 0) {
        printf("E53_SC2 Init failed!\r\n");
        return;
    }
    while (1)  {
        ret = E53SC2ReadData(&data);//MPU6050传感器寄存器数据读取
        if (ret != 0)  {
            printf("E53_SC2 Read Data!\r\n");
            return;
        }
        AccDataHandle(&data);//MPU6050传感器数据处理，转化为单位为g的数据
        if (myCaldata.Accel[ACCEL_X_AXIS] < 0) {
            myCaldata.Accel[ACCEL_X_AXIS] = myCaldata.Accel[ACCEL_X_AXIS] * -1.0; 
        }
        if (myCaldata.Accel[ACCEL_Y_AXIS] < 0) {
            myCaldata.Accel[ACCEL_Y_AXIS] = myCaldata.Accel[ACCEL_Y_AXIS] * -1.0; 
        }
        if (myCaldata.Accel[ACCEL_Z_AXIS] < 0) {
            myCaldata.Accel[ACCEL_Z_AXIS] = myCaldata.Accel[ACCEL_Z_AXIS] * -1.0; 
        }
        //判断实时数据是否大于拳击阈值Boxing_ACC，大于则设置事件
       if (myCaldata.Accel[ACCEL_X_AXIS] > Boxing_ACC ||                          myCaldata.Accel[ACCEL_Y_AXIS] > Boxing_ACC || myCaldata.Accel[ACCEL_Z_AXIS] > Boxing_ACC) {
            printf("MPU set flg\r\n");
            osEventFlagsSet(g_eventFlagsId, FLAGS_MSK1);//触发拳击事件
        }
        usleep(Delay_10ms);
    }
}
#define MAX_POS_NUM 32767
#define LSB 4096.0
//MPU6050传感器数据处理，转化为单位为g的数据
int AccDataHandle(E53SC2Data *dat)
{    //量程为+-8g，所以分辨率为4096
    if (dat->Accel[ACCEL_X_AXIS] <  MAX_POS_NUM) {
        myCaldata.Accel[ACCEL_X_AXIS] = dat->Accel[ACCEL_X_AXIS]/LSB;
    } else {
        myCaldata.Accel[ACCEL_X_AXIS] =(-1)* (dat->Accel[ACCEL_X_AXIS]-MAX_POS_NUM)/LSB;
    }
    if (dat->Accel[ACCEL_Y_AXIS] <  MAX_POS_NUM) {
        myCaldata.Accel[ACCEL_Y_AXIS] = dat->Accel[ACCEL_Y_AXIS]/LSB;
    } else {
        myCaldata.Accel[ACCEL_Y_AXIS] = (-1)*(dat->Accel[ACCEL_Y_AXIS]-MAX_POS_NUM)/LSB;
    }
    if (dat->Accel[ACCEL_Z_AXIS] <  MAX_POS_NUM) {
        myCaldata.Accel[ACCEL_Z_AXIS] = dat->Accel[ACCEL_Z_AXIS]/LSB;
    } else {
        myCaldata.Accel[ACCEL_Z_AXIS] =(-1)*(dat->Accel[ACCEL_Z_AXIS]-                   MAX_POS_NUM)/LSB;
    }
return 0;
}

static void TCPClientTask(void)
{
    // 在sock_fd 进行监听，在 new_fd 接收新的链接
    int sock_fd;
    uint32_t flags;
    struct sockaddr_in send_addr;   // 服务器的地址信息
    socklen_t addr_length = sizeof(send_addr);
    char recvBuf[recvLen];
    memset(recvBuf, '\0', sizeof(recvBuf));
    // 连接Wifi
    WifiConnect(CONFIG_WIFI_SSID, CONFIG_WIFI_PWD); 
    // 创建socket
    if ((sock_fd = socket(AF_INET, SOCK_STREAM, 0)) == -1) {
        perror("create socket failed!\r\n");
        exit(1);
    }
    // 初始化预连接的服务端地址
    send_addr.sin_family = AF_INET;
    send_addr.sin_port = htons(CONFIG_SERVER_PORT);
    send_addr.sin_addr.s_addr = inet_addr(CONFIG_SERVER_IP);
    addr_length = sizeof(send_addr);
    //连接
    connect(sock_fd,(struct sockaddr *)&send_addr, addr_length);
    printf("TCPClient connect success\r\n");


    while (1) {
        memset(recvBuf, '\0', sizeof(recvBuf));
  //等待事件是否触发
        flags = osEventFlagsWait(g_eventFlagsId, FLAGS_MSK1, osFlagsWaitAny, osWaitForever);
        printf("TCP get flag\r\n");
        sprintf(sendbuf,"right\r\n");
        send(sock_fd, sendbuf, strlen(sendbuf), 0);//tcp发出触发信息
        // 线程休眠一段时间
        usleep(Delay_100ms);//100ms
    }
    closesocket(sock_fd);
}