SmartPDCode/f407/applications/sensor.c

#include "mb.h"
#include "lock.h"
#include "sensor.h"

typedef struct {
    lock_t        lck;
    
    sensor_all_t  all;
}sensor_handle_t;
static sensor_handle_t ssHandle={0};

int sensor_init(void)
{
    sensor_handle_t *h=&ssHandle;
    
    h->lck = lock_init();
    
    return 0;
}


int sensor_deinit(void)
{
    sensor_handle_t *h=&ssHandle;
    
    lock_deinit(h->lck);
    
    return 0;
}


int sensor_add(sensor_data_t *data)
{
    sensor_handle_t *h=&ssHandle;
    
    lock_on(h->lck);
    
    lock_off(h->lck);
    
    return 0;
}


int sensor_remove(sensor_data_t *data)
{
    sensor_handle_t *h=&ssHandle;
    
    lock_on(h->lck);
    
    lock_off(h->lck);
    
    return 0;
}


int sensor_query(sensor_data_t *data)
{
    int r=-1;
    sensor_handle_t *h=&ssHandle;

    if(!data) {
        return -1;
    }

    lock_on(h->lck);
    switch(data->info.type) {
        case SENSOR_TYPE_TEMP_HUMI:
        {
            uint16_t tmp[2];
            switch(data->info.subtype) {
                case SENSOR_TYPE_TEMP_HUMI_RSWSN01PVC:
                {
                    //r = g_modbus_read_x_reg(mm, addr, 0, 2, tmp);
                    if(r<=0) {
                        return -1 ;
                    }
                    data->samp.val[0] = tmp[1]/10.0f; //湿度值
                    data->samp.val[1] = tmp[0]/10.0f; //湿度值
                }
                break;

                case SENSOR_TYPE_TEMP_HUMI_HKSHT301T1H536VRS485:    //anderson
                {
                    //r = g_modbus_read_input_reg(mm, addr, 0, 2, tmp);
                    if (r <= 0) {
                        return -1;
                    }
                    data->samp.val[0] = tmp[0]/10.0f;   //温度值
                    data->samp.val[1] = tmp[1]/10.0f;   //湿度值
                }
                break;
            }
        }
        break;

        case SENSOR_TYPE_SMOKE:
        case SENSOR_TYPE_WATER:
        case SENSOR_TYPE_ACCESS:
        {
            //r = gpio_get(subaddr+GPIO_PD11);
            if(r<0) {
                return -1;
            }
            data->samp.flag = r;   //温度值
        }
        break;

        case SENSOR_TYPE_GAS:
        {
            uint16_t tmp;
            //r = g_modbus_read_x_reg(mm, addr, 19, 1, &tmp);
            if(r<=0) {
                return -1 ;
            }
            data->samp.val[0] = tmp; //气体浓度值
        }
        break;

        case SENSOR_TYPE_AIR_PRESS:
        {

        }
        break;

        case SENSOR_TYPE_AIR_COND:
        {

        }
        break;

        case SENSOR_TYPE_TEMP_DOUBLE:
        {
            uint16_t tmp[2];
            switch(data->info.subtype) {
                case SENSOR_TYPE_TEMP_HUMI_RSWSN01PVC:
                {
                    //r = g_modbus_read_input_reg(mm, addr, 0x0400, 1, &tmp[0]);
                    if (r <= 0) {
                        return -1;
                    }

                    //r = g_modbus_read_input_reg(mm, addr, 0x0401, 1, &tmp[1]);
                    if (r <= 0) {
                        return -1;
                    }
                    data->samp.val[0] = tmp[1]/10.0f;   //解算温度值
                    data->samp.val[1] = tmp[0]/10.0f;   //解算湿度值
                }
                break;
            }
        }
        break;

        case SENSOR_TYPE_TEMP:
        {
            uint16_t tmp;
            switch(data->info.subtype) {
                case SENSOR_TYPE_TEMP_BTG50H8EL3200:
                {
                    //r = g_modbus_read_x_reg(mm, addr, 0, 1, &tmp);
                    if (r <= 0) {
                        //printf("___ sensor BTG50H8EL3200 read failed, addr: %d, %s\n", addr, modbus_strerror(errno));
                        return -1;
                    }
                    data->samp.val[0] = tmp/10.0f - 50;
                    //printf("___ BTG50H8EL3200 read: 0x%04x, temp: %0.2f\n", tmp, data->val[0]);
                }
                break;
            }
        }
        break;

        case SENSOR_TYPE_LEAK:
        {
            switch(data->info.subtype) {
                case SENSOR_TYPE_LEAK_XWDC01A:
                {
                    uint16_t tmp[4]={0};
                    //r = g_modbus_read_input_reg(mm, addr, 0, 4, tmp);
                    if (r <= 0) {
                        //printf("___ sensor XWDC01A read failed, addr: %d, %s\n", addr, modbus_strerror(errno));
                        return -1;
                    }
                    //printf("___ XWDC01A read: 0x%04x, 0x%04x, 0x%04x, 0x%04x\n", tmp[0],tmp[1],tmp[2],tmp[3]);

                    data->samp.flag = 0;
                    if(tmp[0] || tmp[1]) {
                        data->samp.flag = 1;
                    }
                }
                break;
            }
        }
        break;
    }
    lock_off(h->lck);

    return r;
}

    
sensor_all_t* sensor_data_get(void)
{
    sensor_handle_t *h=&ssHandle;
    
    return &h->all;
}