guowenxue
2021-01-23 88f6121fabaa6b7b17a2d78a52ebef2ddda16104
add LUX sensor tsl2561 support in lightd
1 files modified
2 files added
241 ■■■■■ changed files
lightd/hal/hal.c 8 ●●●●● patch | view | raw | blame | history
lightd/hal/tsl2561.c 192 ●●●●● patch | view | raw | blame | history
lightd/hal/tsl2561.h 41 ●●●●● patch | view | raw | blame | history
lightd/hal/hal.c
@@ -12,6 +12,7 @@
 ********************************************************************************/
#include "lylib/logger.h"
#include "tsl2561.h"
#include "hal.h"
#define RPI_GPIONAME        "gpiochip0"
@@ -63,6 +64,13 @@
    {
    s_infrared_lines = gpiod_chip_get_line(s_chip, ctx->infrared_pin);
    gpiod_line_request_rising_edge_events(s_infrared_lines, "infrared");
    log_err("infrared GPIO input lines request for rising edge event ok\n");
    }
    if( tsl2561_init()< 0 )
    {
    log_err("LUX sensor TSL2561 initialise failure\n");
    return -2;
    }
lightd/hal/tsl2561.c
New file
@@ -0,0 +1,192 @@
/*********************************************************************************
 *      Copyright:  (C) 2019 LingYun IoT System Studio
 *                  All rights reserved.
 *
 *       Filename:  tsl2561.c
 *    Description:  This file is the Lux sensor TSL2561 API functions on RaspberryPi,
 *                  which connected to I2C-1
 *
 *        Version:  1.0.0(04/07/19)
 *         Author:  Guo Wenxue <guowenxue@gmail.com>
 *      ChangeLog:  1, Release initial version on "04/07/19 17:39:38"
 *
 ********************************************************************************/
#include <wiringPi.h>
#include <wiringPiI2C.h>
#include <string.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <math.h>
#include <errno.h>
#include <time.h>
#include <sys/ioctl.h>
#include <linux/i2c.h>
#include <linux/i2c-dev.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include "lylib/logger.h"
#include "lylib/util_time.h"
#include "tsl2561.h"
int s_tsl_fd = -1;
static const int  regs_addr[REG_COUNT]={DATA0LOW, DATA0HIGH, DATA1LOW, DATA1HIGH};
int tsl2561_init(void)
{
    if(s_tsl_fd > 0)
        return 0;
    if( (s_tsl_fd=open("/dev/i2c-1", O_RDWR)) < 0)
    {
        log_err("TSL2561 I2C device setup failure: %s\n", strerror(errno));
    return -1;
    }
    log_nrml("TSL2561 initialise ok, s_tsl_fd=%d\n", s_tsl_fd);
    return s_tsl_fd;
}
#define ON          1
#define OFF         0
int tsl2561_power(int cmd)
{
    struct i2c_msg               msg;
    struct i2c_rdwr_ioctl_data   data;
    unsigned char                buf[2];
    msg.addr= TSL2561_I2C_ADDR;
    msg.flags=0;  /* write */
    msg.len= 1;
    msg.buf= buf;
    data.nmsgs= 1;
    data.msgs= &msg;
    msg.buf[0]=CONTROL_REG;
    if( ioctl(s_tsl_fd, I2C_RDWR, &data) < 0 )
    {
        log_err("%s() ioctl failure: %s\n", __func__, strerror(errno));
    return -1;
    }
    if( cmd )
        msg.buf[0]=POWER_UP;
    else
        msg.buf[0]=POWER_DOWN;
    if( ioctl(s_tsl_fd, I2C_RDWR, &data) < 0 )
    {
        log_err("%s() ioctl failure: %s\n", __func__, strerror(errno));
    return -1;
    }
    return 0;
}
int tsl2561_readreg(unsigned char regaddr, unsigned char *regval)
{
    struct i2c_msg               msg;
    struct i2c_rdwr_ioctl_data   data;
    unsigned char                buf[2];
    msg.addr= TSL2561_I2C_ADDR;
    msg.flags=0;  /* write */
    msg.len= 1;
    msg.buf= buf;
    msg.buf[0] = regaddr;
    data.nmsgs= 1;
    data.msgs= &msg;
    if( ioctl(s_tsl_fd, I2C_RDWR, &data) < 0 )
    {
        log_err("%s() ioctl failure: %s\n", __func__, strerror(errno));
    return -1;
    }
    memset(buf, 0, sizeof(buf));
    msg.addr= TSL2561_I2C_ADDR;
    msg.flags=I2C_M_RD;  /* read */
    msg.len= 1;
    msg.buf= buf;
    data.nmsgs= 1;
    data.msgs= &msg;
    if( ioctl(s_tsl_fd, I2C_RDWR, &data) < 0 )
    {
        log_err("%s() ioctl failure: %s\n", __func__, strerror(errno));
    return -1;
    }
    *regval = msg.buf[0];
    return 0;
}
float tsl2561_get_lux(void)
{
    int                 i;
    unsigned char       reg_data[REG_COUNT];
    unsigned char       buf;
    int                 chn0_data = 0;
    int                 chn1_data = 0;
    float               div = 0.0;
    float               lux = 0.0;
    tsl2561_power(ON);
    msleep(410);  /* t(CONV) MAX 400ms */
    /* Read register Channel0 and channel1 data from register */
    for(i=0; i<REG_COUNT; i++)
    {
    tsl2561_readreg(regs_addr[i], &reg_data[i]);
    }
    chn0_data = reg_data[1]*256 + reg_data[0]; /* Channel0 = DATA0HIGH<<8 + DATA0LOW  */
    chn1_data = reg_data[3]*256 + reg_data[2]; /* channel1 = DATA1HIGH<<8 +  DATA1LOW */
    if( chn0_data<=0 || chn1_data<0 )
    {
        lux = 0.0;
        goto OUT;
    }
    div = (float)chn1_data / (float)chn0_data;
    if( div>0 && div<=0.5 )
        lux = 0.304*chn0_data-0.062*chn0_data*pow(div,1.4);
    else if( div>0.5 && div<=0.61 )
        lux = 0.0224*chn0_data-0.031*chn1_data;
    else if( div>0.61 && div<=0.8 )
        lux = 0.0128*chn0_data-0.0153*chn1_data;
    else if( div>0.8 && div<=1.3 )
        lux = 0.00146*chn0_data-0.00112*chn1_data;
    else if( div>1.3 )
        lux = 0.0;
    log_dbg("TSLl2561 get lux: %.3f\n", lux);
OUT:
    tsl2561_power(OFF);
}
lightd/hal/tsl2561.h
New file
@@ -0,0 +1,41 @@
/********************************************************************************
 *      Copyright:  (C) 2019 LingYun IoT System Studio
 *                  All rights reserved.
 *
 *       Filename:  tsl2561.h
 *    Description:  This head file is the Lux sensor TSL2561 API functions on RaspberryPi
 *
 *        Version:  1.0.0(04/07/19)
 *         Author:  Guo Wenxue <guowenxue@gmail.com>
 *      ChangeLog:  1, Release initial version on "04/07/19 17:42:35"
 *
 ********************************************************************************/
#ifndef  _TSL2561_H_
#define  _TSL2561_H_
#define TSL2561_I2C_ADDR                0x39
#define CONTROL_REG                     0x80
#define REG_COUNT                       4
#define POWER_UP                        0x03
#define POWER_DOWN                      0x00
/* Register Address  */
enum
{
    /* Channel_0 = DATA0HIGH<<8 + DATA0LOW */
    DATA0LOW = 0x8C,
    DATA0HIGH,
    /* Channel_1 = DATA1HIGH<<8 + DATA1LOW */
    DATA1LOW,
    DATA1HIGH,
};
extern int tsl2561_init(void);
extern float tsl2561_get_lux(void);
#endif   /* ----- #ifndef _TSL2561_H_  ----- */