nes-proj/arch/platform/zoul/dev/tsl256x.c

/*
 * Copyright (c) 2015, Zolertia - http://www.zolertia.com
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of the Institute nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 */
/*---------------------------------------------------------------------------*/
/**
 * \addtogroup zoul-tsl256x-sensor
 * @{
 *
 * \file
 *  Driver for the external TSL256X light sensor
 *
 * \author
 *         Antonio Lignan <alinan@zolertia.com>
 *         Toni Lozano <tlozano@zolertia.com>
 */
/*---------------------------------------------------------------------------*/
#include "contiki.h"
#include "dev/i2c.h"
#include "dev/gpio.h"
#include "dev/gpio-hal.h"
#include "dev/zoul-sensors.h"
#include "lib/sensors.h"
#include "tsl256x.h"
/*---------------------------------------------------------------------------*/
#define DEBUG 0
#if DEBUG
#define PRINTF(...) printf(__VA_ARGS__)
#else
#define PRINTF(...)
#endif
/*---------------------------------------------------------------------------*/
#define TSL256X_INT_PORT_BASE  GPIO_PORT_TO_BASE(I2C_INT_PORT)
#define TSL256X_INT_PIN_MASK   GPIO_PIN_MASK(I2C_INT_PIN)
/*---------------------------------------------------------------------------*/
static uint8_t enabled;
static uint8_t gain;
static uint8_t timming;
/*---------------------------------------------------------------------------*/
void (*tsl256x_int_callback)(uint8_t value);
/*---------------------------------------------------------------------------*/
static uint16_t
calculate_lux(uint8_t *buf)
{
  uint32_t ch0, ch1, chscale = 0;
  uint32_t ratio = 0;
  uint32_t lratio, tmp = 0;
  uint16_t buffer[2];

  /* The calculations below assume the integration time is 402ms and the gain
   * is 16x (nominal), if not then it is required to normalize the reading
   * before converting to lux
   */

  buffer[0] = (buf[1] << 8 | (buf[0]));
  buffer[1] = (buf[3] << 8 | (buf[2]));

  switch(timming) {
  case TSL256X_TIMMING_INTEG_402MS:
    chscale = (1 << CH_SCALE);
    break;
  case TSL256X_TIMMING_INTEG_101MS:
    chscale = CHSCALE_TINT1;
    break;
  case TSL256X_TIMMING_INTEG_13_7MS:
    chscale = CHSCALE_TINT0;
    break;
  }

  if(!gain) {
    chscale = chscale << 4;
  }

  ch0 = (buffer[0] * chscale) >> CH_SCALE;
  ch1 = (buffer[1] * chscale) >> CH_SCALE;

  if(ch0 > 0) {
    ratio = (ch1 << CH_SCALE);
    ratio = ratio / ch0;
  }

  lratio = (ratio + 1) >> 1;

  if((lratio >= 0) && (lratio <= K1T)) {
    tmp = (ch0 * B1T) - (ch1 * M1T);
  } else if(lratio <= K2T) {
    tmp = (ch0 * B2T) - (ch1 * M2T);
  } else if(lratio <= K3T) {
    tmp = (ch0 * B3T) - (ch1 * M3T);
  } else if(lratio <= K4T) {
    tmp = (ch0 * B4T) - (ch1 * M4T);
  } else if(lratio <= K5T) {
    tmp = (ch0 * B5T) - (ch1 * M5T);
  } else if(lratio <= K6T) {
    tmp = (ch0 * B6T) - (ch1 * M6T);
  } else if(lratio <= K7T) {
    tmp = (ch0 * B7T) - (ch1 * M7T);
  } else if(lratio > K8T) {
    tmp = (ch0 * B8T) - (ch1 * M8T);
  }

  if(tmp < 0) {
    tmp = 0;
  }

  tmp += (1 << (LUX_SCALE - 1));
  return tmp >> LUX_SCALE;
}
/*---------------------------------------------------------------------------*/
static int
tsl256x_read_reg(uint8_t reg, uint8_t *buf, uint8_t regNum)
{
  i2c_master_enable();
  if(i2c_single_send(TSL256X_ADDR, reg) == I2C_MASTER_ERR_NONE) {
    while(i2c_master_busy());
    if(i2c_burst_receive(TSL256X_ADDR, buf, regNum) == I2C_MASTER_ERR_NONE) {
      return TSL256X_SUCCESS;
    }
  }
  return TSL256X_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
tsl256x_write_reg(uint8_t *buf, uint8_t num)
{
  if((buf == NULL) || (num <= 0)) {
    PRINTF("TSL256X: invalid write values\n");
    return TSL256X_ERROR;
  }

  i2c_master_enable();
  if(i2c_burst_send(TSL256X_ADDR, buf, num) == I2C_MASTER_ERR_NONE) {
    return TSL256X_SUCCESS;
  }
  return TSL256X_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
tsl256x_on(void)
{
  uint8_t buf[2];
  buf[0] = (TSL256X_COMMAND + TSL256X_CONTROL);
  buf[1] = TSL256X_CONTROL_POWER_ON;

  if(tsl256x_write_reg(buf, 2) == I2C_MASTER_ERR_NONE) {
    if(i2c_single_receive(TSL256X_ADDR, &buf[0]) == I2C_MASTER_ERR_NONE) {
      if((buf[0] & 0x0F) == TSL256X_CONTROL_POWER_ON) {
        PRINTF("TSL256X: powered on\n");
        return TSL256X_SUCCESS;
      }
    }
  }

  PRINTF("TSL256X: failed to power on\n");
  return TSL256X_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
tsl256x_id_register(uint8_t *buf)
{
  if(tsl256x_read_reg((TSL256X_COMMAND + TSL256X_ID_REG),
                      buf, 1) == TSL256X_SUCCESS) {
    PRINTF("TSL256X: partnum/revnum 0x%02X\n", *buf);
    return TSL256X_SUCCESS;
  }

  return TSL256X_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
tsl256x_off(void)
{
  uint8_t buf[2];
  buf[0] = (TSL256X_COMMAND + TSL256X_CONTROL);
  buf[1] = TSL256X_CONTROL_POWER_OFF;

  if(tsl256x_write_reg(buf, 2) == I2C_MASTER_ERR_NONE) {
    PRINTF("TSL256X: powered off\n");
    return TSL256X_SUCCESS;
  }

  PRINTF("TSL256X: failed to power off\n");
  return TSL256X_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
tsl256x_clear_interrupt(void)
{
  uint8_t buf = (TSL256X_COMMAND + TSL256X_CLEAR_INTERRUPT);
  if(tsl256x_write_reg(&buf, 1) != I2C_MASTER_ERR_NONE) {
    PRINTF("TSL256X: failed to clear the interrupt\n");
    return TSL256X_ERROR;
  }
  return TSL256X_SUCCESS;
}
/*---------------------------------------------------------------------------*/
static int
tsl256x_read_sensor(uint16_t *lux)
{
  uint8_t buf[4];

  /* This is hardcoded to use word write/read operations */
  if(tsl256x_read_reg((TSL256X_COMMAND + TSL256X_D0LOW),
                      &buf[0], 2) == TSL256X_SUCCESS) {
    if(tsl256x_read_reg((TSL256X_COMMAND + TSL256X_D1LOW),
                        &buf[2], 2) == TSL256X_SUCCESS) {

      PRINTF("TSL256X: CH0 0x%02X%02X CH1 0x%02X%02X\n", buf[1], buf[0],
             buf[3], buf[2]);
      *lux = calculate_lux(buf);
      return TSL256X_SUCCESS;
    }
  }
  PRINTF("TSL256X: failed to read\n");
  return TSL256X_ERROR;
}
/*---------------------------------------------------------------------------*/
PROCESS(tsl256x_int_process, "TSL256X interrupt process handler");
/*---------------------------------------------------------------------------*/
PROCESS_THREAD(tsl256x_int_process, ev, data)
{
  PROCESS_EXITHANDLER();
  PROCESS_BEGIN();

  while(1) {
    PROCESS_YIELD_UNTIL(ev == PROCESS_EVENT_POLL);
    tsl256x_clear_interrupt();
    tsl256x_int_callback(0);
  }
  PROCESS_END();
}
/*---------------------------------------------------------------------------*/
static void
tsl256x_interrupt_handler(gpio_hal_pin_mask_t pin_mask)
{
  /* There's no alert/interruption flag to check, clear the interruption by
   * writting to the CLEAR bit in the COMMAND register
   */
  process_poll(&tsl256x_int_process);
}
/*---------------------------------------------------------------------------*/
static gpio_hal_event_handler_t tsl256x_handler = {
  .next = NULL,
  .handler = tsl256x_interrupt_handler,
  .pin_mask = gpio_hal_pin_to_mask(I2C_INT_PIN) << (I2C_INT_PORT << 3),
};
/*---------------------------------------------------------------------------*/
static int
configure(int type, int value)
{
  uint8_t buf[3];

  if((type != TSL256X_ACTIVE) && (type != TSL256X_INT_OVER) &&
     (type != TSL256X_INT_BELOW) && (type != TSL256X_INT_DISABLE) &&
     (type != TSL256X_TIMMING_CFG)) {
    PRINTF("TSL256X: invalid start value\n");
    return TSL256X_ERROR;
  }

  /* As default the power-on values of the sensor are gain 1X, 402ms integration
   * time (not nominal), with manual control disabled
   */

  if(type == TSL256X_ACTIVE) {
    if(value) {
      i2c_init(I2C_SDA_PORT, I2C_SDA_PIN, I2C_SCL_PORT, I2C_SCL_PIN,
               I2C_SCL_NORMAL_BUS_SPEED);

      /*  Initialize interrupts handlers */
      tsl256x_int_callback = NULL;

      /* Power on the sensor and check for the part number */
      if(tsl256x_on() == TSL256X_SUCCESS) {
        if(tsl256x_id_register(&buf[0]) == TSL256X_SUCCESS) {
          if((buf[0] & TSL256X_ID_PARTNO_MASK) == TSL256X_EXPECTED_PARTNO) {

            /* Read the timming/gain configuration */
            if(tsl256x_read_reg((TSL256X_COMMAND + TSL256X_TIMMING),
                                &buf[0], 1) == TSL256X_SUCCESS) {
              gain = buf[0] & TSL256X_TIMMING_GAIN;
              timming = buf[0] & TSL256X_TIMMING_INTEG_MASK;
              PRINTF("TSL256X: enabled, timming %u gain %u\n", timming, gain);

              /* Restart the over interrupt threshold */
              buf[0] = (TSL256X_COMMAND + TSL256X_THRHIGHLOW);
              buf[1] = 0xFF;
              buf[2] = 0xFF;

              if(tsl256x_write_reg(buf, 3) != TSL256X_SUCCESS) {
                PRINTF("TSL256X: failed to clear over interrupt\n");
                return TSL256X_ERROR;
              }

              /* Restart the below interrupt threshold */
              buf[0] = (TSL256X_COMMAND + TSL256X_THRLOWLOW);
              buf[1] = 0x00;
              buf[2] = 0x00;

              if(tsl256x_write_reg(buf, 3) != TSL256X_SUCCESS) {
                PRINTF("TSL256X: failed to clear below interrupt\n");
                return TSL256X_ERROR;
              }

              /* Clear any pending interrupt */
              if(tsl256x_clear_interrupt() == TSL256X_SUCCESS) {
                enabled = 1;
                return TSL256X_SUCCESS;
              }
            }
          }
        }
      }
      return TSL256X_ERROR;
    } else {
      if(tsl256x_off() == TSL256X_SUCCESS) {
        PRINTF("TSL256X: stopped\n");
        enabled = 0;
        return TSL256X_SUCCESS;
      }
      return TSL256X_ERROR;
    }
  }

  if(!enabled) {
    PRINTF("TSL256X: sensor not started\n");
    return TSL256X_ERROR;
  }

  if(type == TSL256X_INT_DISABLE) {

    /* Ensure the GPIO doesn't generate more interrupts, this may affect others
     * I2C digital sensors using the bus and sharing this pin, so an user may
     * comment the line below
     */
    GPIO_DISABLE_INTERRUPT(TSL256X_INT_PORT_BASE, TSL256X_INT_PIN_MASK);

    /* This also wipes out the persistance value, to be reconfigured when
     * enabling back the interruption
     */
    buf[0] = (TSL256X_COMMAND + TSL256X_INTERRUPT);
    buf[1] = TSL256X_INTR_DISABLED;

    if(tsl256x_write_reg(buf, 2) != TSL256X_SUCCESS) {
      PRINTF("TSL256X: failed to disable the interrupt\n");
      return TSL256X_ERROR;
    }
    return TSL256X_SUCCESS;
  }

  /* Configure the timming and gain */
  if(type == TSL256X_TIMMING_CFG) {
    if((value != TSL256X_G16X_402MS) && (value != TSL256X_G1X_402MS) &&
       (value != TSL256X_G1X_101MS) && (value != TSL256X_G1X_13_7MS)) {
      PRINTF("TSL256X: invalid timming configuration values\n");
      return TSL256X_ERROR;
    }

    buf[0] = (TSL256X_COMMAND + TSL256X_TIMMING);
    buf[1] = value;

    if(tsl256x_write_reg(buf, 2) == TSL256X_SUCCESS) {
      if(value == TSL256X_G16X_402MS) {
        gain = 1;
      }

      switch(value) {
      case TSL256X_G16X_402MS:
      case TSL256X_G1X_402MS:
        timming = TSL256X_TIMMING_INTEG_402MS;
        break;
      case TSL256X_G1X_101MS:
        timming = TSL256X_TIMMING_INTEG_101MS;
        break;
      case TSL256X_G1X_13_7MS:
        timming = TSL256X_TIMMING_INTEG_13_7MS;
        break;
      }

      PRINTF("TSL256X: new timming %u gain %u\n", timming, gain);
      return TSL256X_SUCCESS;
    }
    PRINTF("TSL256X: failed to configure timming\n");
    return TSL256X_ERROR;
  }

  /* From here we handle the interrupt configuration, it requires the interrupt
   * callback handler to have been previously set using the TSL256X_REGISTER_INT
   * macro
   */

  buf[1] = ((uint8_t *)&value)[0];
  buf[2] = ((uint8_t *)&value)[1];

  if(type == TSL256X_INT_OVER) {
    buf[0] = (TSL256X_COMMAND + TSL256X_THRHIGHLOW);
  } else if(type == TSL256X_INT_BELOW) {
    buf[0] = (TSL256X_COMMAND + TSL256X_THRLOWLOW);
  }

  if(tsl256x_write_reg(buf, 3) != TSL256X_SUCCESS) {
    PRINTF("TSL256X: failed to set interrupt level\n");
    return TSL256X_ERROR;
  }

  /* Now configure the interruption register (level interrupt, 2 integration
   * cycles after threshold has been reached (roughly 804ms if timming is 402ms)
   */
  buf[0] = (TSL256X_COMMAND + TSL256X_INTERRUPT);
  buf[1] = (TSL256X_INTR_LEVEL << TSL256X_INTR_SHIFT);
  buf[1] += TSL256X_INT_PERSIST_2_CYCLES;

  if(tsl256x_write_reg(buf, 2) != TSL256X_SUCCESS) {
    PRINTF("TSL256X: failed to enable interrupt\n");
    return TSL256X_ERROR;
  }

  /* Configure the interrupts pins */
  GPIO_SOFTWARE_CONTROL(TSL256X_INT_PORT_BASE, TSL256X_INT_PIN_MASK);
  GPIO_SET_INPUT(TSL256X_INT_PORT_BASE, TSL256X_INT_PIN_MASK);

  /* Pull-up resistor, detect falling edge */
  GPIO_DETECT_EDGE(TSL256X_INT_PORT_BASE, TSL256X_INT_PIN_MASK);
  GPIO_TRIGGER_SINGLE_EDGE(TSL256X_INT_PORT_BASE, TSL256X_INT_PIN_MASK);
  GPIO_DETECT_FALLING(TSL256X_INT_PORT_BASE, TSL256X_INT_PIN_MASK);
  gpio_hal_register_handler(&tsl256x_handler);

  /* Spin process until an interrupt is received */
  process_start(&tsl256x_int_process, NULL);

  /* Enable interrupts */
  GPIO_ENABLE_INTERRUPT(TSL256X_INT_PORT_BASE, TSL256X_INT_PIN_MASK);

  /* The RE-Mote revision A has this pin shared and with a pull-down resistor,
   * for other platforms (like the firefly), change to enable pull-up internal
   * resistor instead if no external pull-up is present.
   */
  ioc_set_over(I2C_INT_PORT, I2C_INT_PIN, IOC_OVERRIDE_PUE);
  NVIC_EnableIRQ(I2C_INT_VECTOR);

  PRINTF("TSL256X: Interrupt configured\n");
  return TSL256X_SUCCESS;
}
/*---------------------------------------------------------------------------*/
static int
status(int type)
{
  switch(type) {
  case SENSORS_ACTIVE:
  case SENSORS_READY:
    return enabled;
  }
  return 0;
}
/*---------------------------------------------------------------------------*/
static int
value(int type)
{
  uint16_t lux;

  if(!enabled) {
    PRINTF("TSL256X: sensor not started\n");
    return TSL256X_ERROR;
  }

  if(type == TSL256X_VAL_READ) {
    if(tsl256x_read_sensor(&lux) != TSL256X_ERROR) {
      return lux;
    }
    PRINTF("TSL256X: fail to read\n");
  }
  return TSL256X_ERROR;
}
/*---------------------------------------------------------------------------*/
SENSORS_SENSOR(tsl256x, TSL256X_SENSOR, value, configure, status);
/*---------------------------------------------------------------------------*/
/** @} */