From 88f6121fabaa6b7b17a2d78a52ebef2ddda16104 Mon Sep 17 00:00:00 2001 From: guowenxue <guowenxue@gmail.com> Date: Sat, 23 Jan 2021 23:14:43 +0800 Subject: [PATCH] add LUX sensor tsl2561 support in lightd --- lightd/hal/hal.c | 8 + lightd/hal/tsl2561.c | 192 ++++++++++++++++++++++++++++++++++++++ lightd/hal/tsl2561.h | 41 ++++++++ 3 files changed, 241 insertions(+), 0 deletions(-) diff --git a/lightd/hal/hal.c b/lightd/hal/hal.c index 25ac288..4428bb6 100644 --- a/lightd/hal/hal.c +++ b/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; } diff --git a/lightd/hal/tsl2561.c b/lightd/hal/tsl2561.c new file mode 100644 index 0000000..3aaf087 --- /dev/null +++ b/lightd/hal/tsl2561.c @@ -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], ®_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); +} + + diff --git a/lightd/hal/tsl2561.h b/lightd/hal/tsl2561.h new file mode 100644 index 0000000..1b912a4 --- /dev/null +++ b/lightd/hal/tsl2561.h @@ -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_ ----- */ + -- Gitblit v1.9.1