deac/osd-contiki
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

Merge pull request #1472 from alignan/pull/grove-gyro

Browse source 
Add support for the ITG-3200 3-axis gyroscope
This commit is contained in:
Antonio Lignan 2016-01-23 15:08:47 +01:00
commit 481bcd9e00
4 changed files with 1000 additions and 2 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

4
examples/zolertia/zoul/Makefile
View file

@ -3,10 +3,10 @@ DEFINES+=PROJECT_CONF_H=\"project-conf.h\"
CONTIKI_PROJECT = zoul-demo test-tsl2563 test-sht25 test-pwm test-power-mgmt CONTIKI_PROJECT = zoul-demo test-tsl2563 test-sht25 test-pwm test-power-mgmt
CONTIKI_PROJECT += test-bmp085-bmp180 test-motion test-rotation-sensor CONTIKI_PROJECT += test-bmp085-bmp180 test-motion test-rotation-sensor
CONTIKI_PROJECT += test-grove-light-sensor test-grove-loudness-sensor CONTIKI_PROJECT += test-grove-light-sensor test-grove-loudness-sensor
CONTIKI_PROJECT += test-weather-meter CONTIKI_PROJECT += test-weather-meter test-grove-gyro
CONTIKI_TARGET_SOURCEFILES += tsl2563.c sht25.c bmpx8x.c motion-sensor.c CONTIKI_TARGET_SOURCEFILES += tsl2563.c sht25.c bmpx8x.c motion-sensor.c
CONTIKI_TARGET_SOURCEFILES += adc-sensors.c weather-meter.c CONTIKI_TARGET_SOURCEFILES += adc-sensors.c weather-meter.c grove-gyro.c
all: $(CONTIKI_PROJECT) all: $(CONTIKI_PROJECT)

167
examples/zolertia/zoul/test-grove-gyro.c Normal file
View file

@ -0,0 +1,167 @@
/*
* Copyright (c) 2016, 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-examples
* @{
*
* \defgroup zoul-grove-gyro-test Grove's 3-axis gyroscope test application
*
* Demonstrates the use of the Grove's 3-axis gyroscope based on the ITG-3200
* @{
*
* \file
* Test file for the external Grove gyroscope
*
* \author
* Antonio Lignan <alinan@zolertia.com>
*/
/*---------------------------------------------------------------------------*/
#include <stdio.h>
#include "contiki.h"
#include "dev/i2c.h"
#include "dev/leds.h"
#include "dev/grove-gyro.h"
/*---------------------------------------------------------------------------*/
#define SENSOR_READ_INTERVAL (CLOCK_SECOND)
#define GROVE_GYRO_EXPECTED_ADDR GROVE_GYRO_ADDR
/*---------------------------------------------------------------------------*/
PROCESS(remote_grove_gyro_process, "Grove gyro test process");
AUTOSTART_PROCESSES(&remote_grove_gyro_process);
/*---------------------------------------------------------------------------*/
static struct etimer et;
/*---------------------------------------------------------------------------*/
static void
gyro_interrupt_callback(uint8_t status)
{
/* The interrupt indicates that new data is available, the status value
* returns the outcome of the read operation, check to validate if the
* data is valid to read
*/
leds_toggle(LEDS_PURPLE);
printf("Gyro: X_axis %u, Y_axis %u, Z_axis %u\n", gyro_values.x,
gyro_values.y,
gyro_values.z);
}
/*---------------------------------------------------------------------------*/
PROCESS_THREAD(remote_grove_gyro_process, ev, data)
{
PROCESS_BEGIN();
uint8_t aux;
/* Use Contiki's sensor macro to enable the sensor */
SENSORS_ACTIVATE(grove_gyro);
/* The sensor itself is in low-power mode, to power on just the sensor and not
* the 3 gyroscope axis use GROVE_GYRO_SENSOR. Alternatively the value
* GROVE_GYRO_ALL could also be used to power everything at once
*/
grove_gyro.configure(GROVE_GYRO_POWER_ON, GROVE_GYRO_SENSOR);
/* Read back the configured sensor I2C address to check if the sensor is
* working OK, this is the only case in which the value() returns a value
*/
aux = grove_gyro.value(GROVE_GYRO_ADDR);
if(aux == GROVE_GYRO_EXPECTED_ADDR) {
printf("Gyro sensor started with addr 0x%02X\n", GROVE_GYRO_EXPECTED_ADDR);
} else {
printf("Gyro sensor with unrecognized address 0x%02X\n", aux);
PROCESS_EXIT();
}
/* Register the interrupt handler */
GROVE_GYRO_REGISTER_INT(gyro_interrupt_callback);
/* The gyroscope sensor should be on now but the three gyroscope axis should
* be off, to enable a single axis or any combination of the 3 you can use as
* argument either GROVE_GYRO_X, GROVE_GYRO_Y, GROVE_GYRO_Z. To enable or
* disable the three axis alternatively use GROVE_GYRO_XYZ
*/
grove_gyro.configure(GROVE_GYRO_POWER_ON, GROVE_GYRO_XYZ);
/* Calibrate the sensor taking 200 samples every 5ms for the zero-point offset
* value, this has to be done manually and is up to the user
*/
grove_gyro.configure(GROVE_GYRO_CALIBRATE_ZERO, 1);
/* Enabling the data interrupt will feed data directly to the extern data
* structure and notify us about it, depending on the sampling rate and
* divisor this could generate many interrupts/second. A zero argument would
* disable the interrupts
*/
grove_gyro.configure(GROVE_GYRO_DATA_INTERRUPT, 1);
/* And periodically poll the sensor, values are in º/s */
while(1) {
etimer_set(&et, SENSOR_READ_INTERVAL);
PROCESS_WAIT_EVENT_UNTIL(etimer_expired(&et));
/* This sensor has a different operation from others using Contiki's sensor
* API, to make data acquisition we write the readings directly to the
* extern data structure, allowing to write more than 1 value at the same
* operation, and also allowing upon a data interrupt event to immediatly
* access the data. The return value of the value() call is then the status
* result of the read operation
*/
if(grove_gyro.value(GROVE_GYRO_XYZ) == GROVE_GYRO_SUCCESS) {
/* Converted values with a 2-digit precision */
printf("Gyro: X: %u.%u, Y: %u.%u, Z: %u.%u\n", gyro_values.x / 100,
gyro_values.x % 100,
gyro_values.y / 100,
gyro_values.y % 100,
gyro_values.z / 100,
gyro_values.z % 100);
} else {
printf("Error, enable the DEBUG flag in the grove-gyro driver for info,");
printf(" or check if the sensor is properly connected\n");
PROCESS_EXIT();
}
if(grove_gyro.value(GROVE_GYRO_TEMP) == GROVE_GYRO_SUCCESS) {
printf("Gyro: temperature %d.%02u C\n", gyro_values.temp / 100,
gyro_values.temp % 100);
} else {
printf("Error, enable the DEBUG flag in the grove-gyro driver for info,");
printf(" or check if the sensor is properly connected\n");
PROCESS_EXIT();
}
}
PROCESS_END();
}
/*---------------------------------------------------------------------------*/
/**
* @}
* @}
*/

647
platform/zoul/dev/grove-gyro.c Normal file
View file

@ -0,0 +1,647 @@
/*
* Copyright (c) 2016, 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.
*
* This file is part of the Contiki operating system.
*
*/
/*---------------------------------------------------------------------------*/
/**
* \addtogroup zoul-grove-gyro-sensor
* @{
*
* \file
* Grove's 3-axis gyroscope driver
* \author
* Antonio Lignan <alinan@zolertia.com>
*/
/*---------------------------------------------------------------------------*/
#include <stdio.h>
#include "contiki.h"
#include "dev/i2c.h"
#include "dev/grove-gyro.h"
#include "lib/sensors.h"
#include "dev/watchdog.h"
/*---------------------------------------------------------------------------*/
#define DEBUG 0
#if DEBUG
#define PRINTF(...) printf(__VA_ARGS__)
#else
#define PRINTF(...)
#endif
/*---------------------------------------------------------------------------*/
#define GROVE_GYRO_INT_PORT_BASE GPIO_PORT_TO_BASE(I2C_INT_PORT)
#define GROVE_GYRO_INT_PIN_MASK GPIO_PIN_MASK(I2C_INT_PIN)
/*---------------------------------------------------------------------------*/
static uint8_t enabled;
static uint8_t power_mgmt;
static uint8_t int_en;
/*---------------------------------------------------------------------------*/
grove_gyro_values_t gyro_values;
/*---------------------------------------------------------------------------*/
void (*grove_gyro_int_callback)(uint8_t value);
/*---------------------------------------------------------------------------*/
static uint16_t
grove_gyro_read_reg(uint8_t reg, uint8_t *buf, uint8_t num)
{
if((buf == NULL) || (num <= 0)) {
return GROVE_GYRO_ERROR;
}
i2c_master_enable();
if(i2c_single_send(GROVE_GYRO_ADDR, reg) == I2C_MASTER_ERR_NONE) {
if(i2c_burst_receive(GROVE_GYRO_ADDR, buf, num) == I2C_MASTER_ERR_NONE) {
return GROVE_GYRO_SUCCESS;
}
}
PRINTF("Gyro: failed to read from sensor\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_write_reg(uint8_t *buf, uint8_t num)
{
if((buf == NULL) || (num <= 0)) {
PRINTF("Gyro: invalid write values\n");
return GROVE_GYRO_ERROR;
}
i2c_master_enable();
if(i2c_burst_send(GROVE_GYRO_ADDR, buf, num) == I2C_MASTER_ERR_NONE) {
return GROVE_GYRO_SUCCESS;
}
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_sampdiv(uint8_t value)
{
uint8_t buf[2];
buf[0] = GROVE_GYRO_SMPLRT_DIV;
buf[1] = value;
if(grove_gyro_write_reg(buf, 2) == GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: new sampdiv 0x%02X\n", value);
return GROVE_GYRO_SUCCESS;
}
PRINTF("Gyro: failed to set sampdiv\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static uint8_t
grove_gyro_clear_interrupt(void)
{
uint8_t aux = 0;
/* Clear interrupt */
grove_gyro_read_reg(GROVE_GYRO_INT_STATUS, &aux, 1);
if(aux & GROVE_GYRO_INT_STATUS_DATA_RDY_MASK) {
return GROVE_GYRO_INT_STATUS_DATA_RDY_MASK;
}
return 0;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_interrupt(uint8_t value)
{
uint8_t buf[2];
buf[0] = GROVE_GYRO_INT_CFG;
buf[1] = value;
if(grove_gyro_write_reg(buf, 2) == GROVE_GYRO_SUCCESS){
PRINTF("Gyro: interrupt cfg 0x%02X\n", value);
return GROVE_GYRO_SUCCESS;
}
PRINTF("Gyro: failed to change interrupt config\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_reset(void)
{
uint8_t buf[2];
buf[0] = GROVE_GYRO_PWR_MGMT;
/* Read the power management status as well to force sync */
if(grove_gyro_read_reg(GROVE_GYRO_PWR_MGMT, &power_mgmt, 1) ==
GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: current power mgmt 0x%02X\n", power_mgmt);
buf[1] = power_mgmt + GROVE_GYRO_PWR_MGMT_RESET;
if(grove_gyro_write_reg(buf, 2) == GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: restarted with 0x%02X, now with default values\n", buf[1]);
return GROVE_GYRO_SUCCESS;
}
}
PRINTF("Gyro: failed to restart\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_osc(uint8_t value)
{
uint8_t buf[2];
buf[0] = GROVE_GYRO_PWR_MGMT;
/* Read the power management status as well to force sync */
if(grove_gyro_read_reg(GROVE_GYRO_PWR_MGMT, &power_mgmt, 1) ==
GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: current power mgmt 0x%02X\n", power_mgmt);
power_mgmt &= ~GROVE_GYRO_PWR_MGMT_CLK_SEL_MASK;
buf[1] = power_mgmt + value;
if(grove_gyro_write_reg(buf, 2) == GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: new clock source 0x%02X\n", buf[1]);
return GROVE_GYRO_SUCCESS;
}
}
PRINTF("Gyro: failed to change the clock source\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_power_mgmt(uint8_t value, uint8_t type)
{
uint8_t buf[2];
buf[0] = GROVE_GYRO_PWR_MGMT;
if((type != GROVE_GYRO_POWER_ON) && (type != GROVE_GYRO_POWER_OFF)) {
PRINTF("Gyro: invalid power command type\n");
return GROVE_GYRO_ERROR;
}
/* Read the power management status as well to force sync */
if(grove_gyro_read_reg(GROVE_GYRO_PWR_MGMT, &power_mgmt, 1) ==
GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: current power mgmt 0x%02X\n", power_mgmt);
if(type == GROVE_GYRO_POWER_ON) {
power_mgmt &= ~value;
} else {
power_mgmt |= value;
}
buf[1] = power_mgmt;
if(grove_gyro_write_reg(buf, 2) == GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: new power management register value 0x%02X\n", power_mgmt);
/* Power-up delay */
if(type == GROVE_GYRO_POWER_ON) {
clock_delay_usec(25000);
}
return GROVE_GYRO_SUCCESS;
}
}
PRINTF("Gyro: power management fail\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_dlpf(uint8_t value)
{
uint8_t buf[2];
buf[0] = GROVE_GYRO_DLPF_FS;
buf[1] = GROVE_GYRO_DLPF_FS_SEL + value;
if(grove_gyro_write_reg(buf, 2) == GROVE_GYRO_SUCCESS) {
/* Double-check */
if(grove_gyro_read_reg(GROVE_GYRO_DLPF_FS, &buf[0], 1) ==
GROVE_GYRO_SUCCESS) {
if(buf[0] == buf[1]) {
PRINTF("Gyro: updated lp/sr 0x%02X\n", buf[0]);
return GROVE_GYRO_SUCCESS;
} else {
PRINTF("Gyro: DLPF register value mismatch\n");
return GROVE_GYRO_ERROR;
}
}
}
PRINTF("Gyro: failed to change the lp/sr\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static uint16_t
grove_gyro_convert_to_value(uint16_t val)
{
uint32_t aux;
/* Convert from 2C's to 10's, as we care about º/s negative quantifier doesn't
* matter, so we ommit flaging the sign
*/
if(val & 0x8000) {
val = (~val + 1);
}
/* ITG-3200 datasheet: sensitivity 14.375 LSB/(º/s) to get º/s */
aux = val * 6956;
aux /= 1000;
return (uint16_t)aux;
}
/*---------------------------------------------------------------------------*/
static void
grove_gyro_convert(uint8_t *buf, uint8_t type)
{
uint16_t aux;
if(type & GROVE_GYRO_X) {
aux = (buf[0] << 8) + buf[1];
PRINTF("Gyro: X_axis (raw) 0x%02X\n", aux);
gyro_values.x = grove_gyro_convert_to_value(aux);
}
if(type & GROVE_GYRO_Y) {
aux = (buf[2] << 8) + buf[3];
PRINTF("Gyro: Y_axis (raw) 0x%02X\n", aux);
gyro_values.y = grove_gyro_convert_to_value(aux);
}
if(type & GROVE_GYRO_Z) {
aux = (buf[4] << 8) + buf[5];
PRINTF("Gyro: Z_axis (raw) 0x%02X\n", aux);
gyro_values.z = grove_gyro_convert_to_value(aux);
}
if(type == GROVE_GYRO_TEMP) {
aux = (buf[0] << 8) + buf[1];
PRINTF("Gyro: Temp (raw) 0x%02X\n", aux);
/* ITG-3200 datasheet: offset -13200, sensitivity 280 LSB/ºC */
aux = (aux + 13200) / 28;
aux += 350;
gyro_values.temp = (int16_t)aux;
}
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_read(int type)
{
uint8_t reg;
uint8_t len;
uint8_t buf_ptr;
uint8_t buf[GROVE_GYRO_MAX_DATA];
len = (type == GROVE_GYRO_XYZ) ? GROVE_GYRO_MAX_DATA : 2;
switch(type) {
case GROVE_GYRO_X:
case GROVE_GYRO_XYZ:
buf_ptr = 0;
reg = GROVE_GYRO_XOUT_H;
break;
case GROVE_GYRO_Y:
buf_ptr = 2;
reg = GROVE_GYRO_YOUT_H;
break;
case GROVE_GYRO_Z:
buf_ptr = 4;
reg = GROVE_GYRO_ZOUT_H;
break;
case GROVE_GYRO_TEMP:
buf_ptr = 0;
reg = GROVE_GYRO_TEMP_OUT_H;
break;
case GROVE_GYRO_ADDR:
buf_ptr = 0;
len = 1;
reg = GROVE_GYRO_WHO_AM_I;
break;
default:
PRINTF("Gyro: invalid value requested\n");
return GROVE_GYRO_ERROR;
}
if(grove_gyro_read_reg(reg, &buf[buf_ptr], len) == GROVE_GYRO_SUCCESS) {
if(type == GROVE_GYRO_ADDR) {
PRINTF("Gyro: I2C_addr 0x%02X\n", buf[0]);
return buf[0];
}
grove_gyro_convert(buf, type);
return GROVE_GYRO_SUCCESS;
}
PRINTF("Gyro: failed to change the lp/sr\n");
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
static int
grove_gyro_calibrate(void)
{
uint8_t i;
uint8_t buf[GROVE_GYRO_MAX_DATA];
uint8_t power_mgmt_backup;
uint32_t x, y, z;
/* Disable interrupts */
if(int_en) {
if(grove_gyro_interrupt(GROVE_GYRO_INT_CFG_DISABLE) == GROVE_GYRO_ERROR) {
PRINTF("Gyro: failed to disable the interrupts\n");
return GROVE_GYRO_ERROR;
}
GPIO_DISABLE_INTERRUPT(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
}
/* Turn on the 3-axis, save the current config */
if(grove_gyro_read_reg(GROVE_GYRO_PWR_MGMT, &power_mgmt_backup, 1) ==
GROVE_GYRO_ERROR) {
PRINTF("Gyro: failed to read power mgmt config\n");
return GROVE_GYRO_ERROR;
}
if(grove_gyro_power_mgmt(GROVE_GYRO_ALL, GROVE_GYRO_POWER_ON) ==
GROVE_GYRO_ERROR) {
PRINTF("Gyro: failed to bring sensor up\n");
return GROVE_GYRO_ERROR;
}
x = 0;
y = 0;
z = 0;
for (i = 0; i < GROVE_GYRO_CALIB_SAMPLES; i++){
clock_delay_usec(GROVE_GYRO_CALIB_TIME_US);
watchdog_periodic();
if(grove_gyro_read_reg(GROVE_GYRO_XOUT_H, buf, GROVE_GYRO_MAX_DATA) ==
GROVE_GYRO_SUCCESS) {
x += (buf[0] << 8) + buf[1];
y += (buf[2] << 8) + buf[3];
z += (buf[4] << 8) + buf[5];
}
}
gyro_values.x_offset = ABS(x)/GROVE_GYRO_CALIB_SAMPLES;
gyro_values.y_offset = ABS(y)/GROVE_GYRO_CALIB_SAMPLES;
gyro_values.z_offset = ABS(z)/GROVE_GYRO_CALIB_SAMPLES;
PRINTF("Gyro: x_offset (RAW) 0x%02X\n", gyro_values.x_offset);
PRINTF("Gyro: y_offset (RAW) 0x%02X\n", gyro_values.y_offset);
PRINTF("Gyro: z_offset (RAW) 0x%02X\n", gyro_values.z_offset);
gyro_values.x_offset = grove_gyro_convert_to_value(gyro_values.x_offset);
gyro_values.y_offset = grove_gyro_convert_to_value(gyro_values.y_offset);
gyro_values.z_offset = grove_gyro_convert_to_value(gyro_values.z_offset);
PRINTF("Gyro: x_offset (converted) %d\n", gyro_values.x_offset);
PRINTF("Gyro: y_offset (converted) %d\n", gyro_values.y_offset);
PRINTF("Gyro: z_offset (converted) %d\n", gyro_values.z_offset);
/* Cleaning up */
buf[0] = GROVE_GYRO_PWR_MGMT;
buf[1] = power_mgmt_backup;
if(grove_gyro_write_reg(&buf[0], 2) != GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: failed restoring power mgmt (0x%02X)\n", power_mgmt_backup);
return GROVE_GYRO_ERROR;
}
if(int_en) {
if(grove_gyro_interrupt(GROVE_GYRO_INT_CFG_RAW_READY_EN +
GROVE_GYRO_INT_CFG_LATCH_EN) == GROVE_GYRO_ERROR) {
PRINTF("Gyro: failed to enable the interrupt\n");
return GROVE_GYRO_ERROR;
}
GPIO_ENABLE_INTERRUPT(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
}
return GROVE_GYRO_SUCCESS;
}
/*---------------------------------------------------------------------------*/
PROCESS(grove_gyro_int_process, "Grove gyroscope interrupt process handler");
/*---------------------------------------------------------------------------*/
PROCESS_THREAD(grove_gyro_int_process, ev, data)
{
PROCESS_EXITHANDLER();
PROCESS_BEGIN();
static uint8_t axis_to_read = 0;
while(1) {
PROCESS_YIELD_UNTIL(ev == PROCESS_EVENT_POLL);
if(grove_gyro_clear_interrupt() == GROVE_GYRO_INT_STATUS_DATA_RDY_MASK) {
axis_to_read += (power_mgmt & GROVE_GYRO_X) ? 0: GROVE_GYRO_X;
axis_to_read += (power_mgmt & GROVE_GYRO_Y) ? 0: GROVE_GYRO_Y;
axis_to_read += (power_mgmt & GROVE_GYRO_Z) ? 0: GROVE_GYRO_Z;
if(grove_gyro_read(axis_to_read) == GROVE_GYRO_SUCCESS) {
grove_gyro_int_callback(GROVE_GYRO_SUCCESS);
}
}
}
PROCESS_END();
}
/*---------------------------------------------------------------------------*/
static void
grove_gyro_interrupt_handler(uint8_t port, uint8_t pin)
{
process_poll(&grove_gyro_int_process);
}
/*---------------------------------------------------------------------------*/
static int
value(int type)
{
if(!enabled) {
PRINTF("Gyro: sensor not started\n");
return GROVE_GYRO_ERROR;
}
if((type != GROVE_GYRO_X) && (type != GROVE_GYRO_Y) &&
(type != GROVE_GYRO_Z) && (type != GROVE_GYRO_XYZ) &&
(type != GROVE_GYRO_TEMP) && (type != GROVE_GYRO_ADDR)) {
PRINTF("Gyro: invalid value requested 0x%02X\n", type);
return GROVE_GYRO_ERROR;
}
if((type != GROVE_GYRO_TEMP) && (type != GROVE_GYRO_ADDR) &&
(type & power_mgmt)) {
PRINTF("Gyro: axis not enabled (0x%02X vs 0x%02X)\n", power_mgmt, type);
return GROVE_GYRO_ERROR;
}
return grove_gyro_read(type);
}
/*---------------------------------------------------------------------------*/
static int
configure(int type, int value)
{
if((type != GROVE_GYRO_ACTIVE) && (type != GROVE_GYRO_SAMPLE_RATE) &&
(type != GROVE_GYRO_SAMPLE_RATE_DIVIDER) && (type != GROVE_GYRO_POWER_ON) &&
(type != GROVE_GYRO_POWER_OFF) && (type != GROVE_GYRO_DATA_INTERRUPT) &&
(type != GROVE_GYRO_CALIBRATE_ZERO)) {
PRINTF("Gyro: option not supported\n");
return GROVE_GYRO_ERROR;
}
switch(type) {
case GROVE_GYRO_ACTIVE:
if(value) {
i2c_init(I2C_SDA_PORT, I2C_SDA_PIN, I2C_SCL_PORT, I2C_SCL_PIN,
I2C_SCL_FAST_BUS_SPEED);
/* Initialize the data structure values */
gyro_values.x = 0;
gyro_values.y = 0;
gyro_values.z = 0;
gyro_values.temp = 0;
gyro_values.x_offset = 0;
gyro_values.y_offset = 0;
gyro_values.z_offset = 0;
/* Make sure the sensor is on */
if(grove_gyro_power_mgmt(GROVE_GYRO_ALL, GROVE_GYRO_POWER_ON) !=
GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: failed to power on the sensor\n");
return GROVE_GYRO_ERROR;
}
/* Reset and configure as default with internal oscillator, 8KHz @ 2000
* degrees/s, no divider (full scale)
*/
if(grove_gyro_reset() == GROVE_GYRO_SUCCESS) {
if(grove_gyro_osc(GROVE_GYRO_DEFAULT_OSC) == GROVE_GYRO_SUCCESS) {
if(grove_gyro_dlpf(GROVE_GYRO_DLPF_FS_CGF_8KHZ_LP256HZ) ==
GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: started and configured\n");
/* Disable interrupts as default */
if(grove_gyro_interrupt(GROVE_GYRO_INT_CFG_DISABLE) ==
GROVE_GYRO_SUCCESS) {
PRINTF("Gyro: interrupts disabled\n");
/* And finally put the device in SLEEP mode, set also X, Y and Z
* in stand-by mode, whenever an axis is not used it should stay
* in this state to save power
*/
if(grove_gyro_power_mgmt(GROVE_GYRO_ALL, GROVE_GYRO_POWER_OFF) ==
GROVE_GYRO_SUCCESS) {
enabled = 1;
PRINTF("Gyro: axis and gyroscope in low-power mode now\n");
return GROVE_GYRO_SUCCESS;
}
}
}
}
}
return GROVE_GYRO_ERROR;
} else {
enabled = 0;
int_en = 0;
GPIO_DISABLE_INTERRUPT(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
grove_gyro_int_callback = NULL;
if(grove_gyro_interrupt(GROVE_GYRO_INT_CFG_DISABLE) ==
GROVE_GYRO_SUCCESS) {
return grove_gyro_power_mgmt(GROVE_GYRO_ALL, GROVE_GYRO_POWER_OFF);
}
PRINTF("Gyro: hw interrupt disabled but failed to disable sensor\n");
return GROVE_GYRO_ERROR;
}
if(!enabled) {
PRINTF("Gyro: sensor not started\n");
return GROVE_GYRO_ERROR;
}
case GROVE_GYRO_DATA_INTERRUPT:
if(!value) {
/* 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
*/
int_en = 0;
GPIO_DISABLE_INTERRUPT(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
return grove_gyro_interrupt(GROVE_GYRO_INT_CFG_DISABLE);
}
/* Enable interrupt and latch the pin until cleared */
if(grove_gyro_interrupt(GROVE_GYRO_INT_CFG_RAW_READY_EN +
GROVE_GYRO_INT_CFG_LATCH_EN) == GROVE_GYRO_ERROR) {
PRINTF("Gyro: failed to enable the interrupt\n");
return GROVE_GYRO_ERROR;
}
/* Default register configuration is active high, push-pull */
GPIO_SOFTWARE_CONTROL(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
GPIO_SET_INPUT(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
GPIO_DETECT_EDGE(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
GPIO_TRIGGER_SINGLE_EDGE(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
GPIO_DETECT_FALLING(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
gpio_register_callback(grove_gyro_interrupt_handler, I2C_INT_PORT,
I2C_INT_PIN);
/* Spin process until an interrupt is received */
process_start(&grove_gyro_int_process, NULL);
/* Enable interrupts */
int_en = 1;
GPIO_ENABLE_INTERRUPT(GROVE_GYRO_INT_PORT_BASE, GROVE_GYRO_INT_PIN_MASK);
ioc_set_over(I2C_INT_PORT, I2C_INT_PIN, IOC_OVERRIDE_PUE);
nvic_interrupt_enable(I2C_INT_VECTOR);
PRINTF("Gyro: Data interrupt configured\n");
return GROVE_GYRO_SUCCESS;
case GROVE_GYRO_SAMPLE_RATE:
if((value < GROVE_GYRO_DLPF_FS_CGF_8KHZ_LP256HZ) ||
(value > GROVE_GYRO_DLPF_FS_CGF_1KHZ_LP5HZ)) {
PRINTF("Gyro: invalid sample rate/filter configuration\n");
return GROVE_GYRO_ERROR;
}
return grove_gyro_dlpf(value);
case GROVE_GYRO_SAMPLE_RATE_DIVIDER:
if((value < 0) && (value > 0xFF)) {
PRINTF("Gyro: invalid sampling rate div, it must be an 8-bit value\n");
return GROVE_GYRO_ERROR;
}
return grove_gyro_sampdiv((uint8_t)value);
case GROVE_GYRO_POWER_ON:
case GROVE_GYRO_POWER_OFF:
/* We accept mask values to enable more than one axis at the same time */
if((value < GROVE_GYRO_Z) || (value > GROVE_GYRO_ALL)) {
PRINTF("Gyro: invalid power management setting\n");
return GROVE_GYRO_ERROR;
}
return grove_gyro_power_mgmt(value, type);
case GROVE_GYRO_CALIBRATE_ZERO:
return grove_gyro_calibrate();
default:
return GROVE_GYRO_ERROR;
}
return GROVE_GYRO_ERROR;
}
/*---------------------------------------------------------------------------*/
SENSORS_SENSOR(grove_gyro, GROVE_GYRO_STRING, value, configure, NULL);
/*---------------------------------------------------------------------------*/
/** @} */

184
platform/zoul/dev/grove-gyro.h Normal file
View file

@ -0,0 +1,184 @@
/*
* Copyright (c) 2016, 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.
*
* This file is part of the Contiki operating system.
*
*/
/*---------------------------------------------------------------------------*/
/**
* \addtogroup zoul-sensors
* @{
*
* \defgroup zoul-grove-gyro-sensor Grove 3-axis gyroscope based on ITG-3200
* @{
*
* \file
* Grove 3-axis gyroscope header file
* \author
* Antonio Lignan <alinan@zolertia.com>
*/
/*---------------------------------------------------------------------------*/
#include "lib/sensors.h"
/* -------------------------------------------------------------------------- */
#ifndef GROVE_GYRO_H_
#define GROVE_GYRO_H_
/* -------------------------------------------------------------------------- */
/**
* \name Callback function to handle the interrupt
* @{
*/
#define GROVE_GYRO_REGISTER_INT(ptr) grove_gyro_int_callback = ptr;
extern void (*grove_gyro_int_callback)(uint8_t value);
/** @} */
/* -------------------------------------------------------------------------- */
/**
* \name Gyroscope data values structure
* @{
*/
typedef struct {
uint16_t x;
uint16_t y;
uint16_t z;
uint16_t x_offset;
uint16_t y_offset;
uint16_t z_offset;
int16_t temp;
} grove_gyro_values_t;
extern grove_gyro_values_t gyro_values;
/** @} */
/* -------------------------------------------------------------------------- */
/**
* \name Grove 3-axis gyroscope address and registers
* @{
*/
#define GROVE_GYRO_ADDR 0x68
#define GROVE_GYRO_WHO_AM_I 0x00
#define GROVE_GYRO_SMPLRT_DIV 0x15
#define GROVE_GYRO_DLPF_FS 0x16
#define GROVE_GYRO_INT_CFG 0x17
#define GROVE_GYRO_INT_STATUS 0x1A
#define GROVE_GYRO_TEMP_OUT_H 0x1B
#define GROVE_GYRO_TEMP_OUT_L 0x1C
#define GROVE_GYRO_XOUT_H 0x1D
#define GROVE_GYRO_XOUT_L 0x1E
#define GROVE_GYRO_YOUT_H 0x1F
#define GROVE_GYRO_YOUT_L 0x20
#define GROVE_GYRO_ZOUT_H 0x21
#define GROVE_GYRO_ZOUT_L 0x22
#define GROVE_GYRO_PWR_MGMT 0x3E
/** @} */
/*--------------------------------------------------------------------------*/
/**
* \name Grove 3-axis gyroscope bitmasks and config
* @{
*/
#define GROVE_GYRO_DLPF_FS_SEL 0x18
#define GROVE_GYRO_DLPF_FS_CGF_8KHZ_LP256HZ 0x00
#define GROVE_GYRO_DLPF_FS_CGF_1KHZ_LP188HZ 0x01
#define GROVE_GYRO_DLPF_FS_CGF_1KHZ_LP98HZ 0x02
#define GROVE_GYRO_DLPF_FS_CGF_1KHZ_LP42HZ 0x03
#define GROVE_GYRO_DLPF_FS_CGF_1KHZ_LP20HZ 0x04
#define GROVE_GYRO_DLPF_FS_CGF_1KHZ_LP10HZ 0x05
#define GROVE_GYRO_DLPF_FS_CGF_1KHZ_LP5HZ 0x06
#define GROVE_GYRO_INT_CFG_RAW_READY_EN 0x01
#define GROVE_GYRO_INT_CFG_READY_EN 0x04
#define GROVE_GYRO_INT_CFG_LATCH_CLR_ANY 0x10
#define GROVE_GYRO_INT_CFG_LATCH_EN 0x20
#define GROVE_GYRO_INT_CFG_PIN_OPEN 0x40
#define GROVE_GYRO_INT_CFG_PIN_ACTL 0x80
#define GROVE_GYRO_INT_CFG_DISABLE 0x00
#define GROVE_GYRO_INT_STATUS_DATA_RDY_MASK 0x01
#define GROVE_GYRO_INT_STATUS_PLL_RDY_MASK 0x04
#define GROVE_GYRO_PWR_MGMT_CLK_SEL_INTOSC 0x00
#define GROVE_GYRO_PWR_MGMT_CLK_SEL_PLL_X 0x01
#define GROVE_GYRO_PWR_MGMT_CLK_SEL_PLL_Y 0x02
#define GROVE_GYRO_PWR_MGMT_CLK_SEL_PLL_Z 0x03
#define GROVE_GYRO_PWR_MGMT_CLK_SEL_EXT_32K 0x04
#define GROVE_GYRO_PWR_MGMT_CLK_SEL_EXT_19K 0x05
#define GROVE_GYRO_PWR_MGMT_STBY_ZG 0x08
#define GROVE_GYRO_PWR_MGMT_STBY_YG 0x10
#define GROVE_GYRO_PWR_MGMT_STBY_XG 0x20
#define GROVE_GYRO_PWR_MGMT_SLEEP 0x40
#define GROVE_GYRO_PWR_MGMT_RESET 0x80
#ifdef GROVE_GYRO_CONF_OSC
#define GROVE_GYRO_DEFAULT_OSC GROVE_GYRO_CONF_OSC
#else
#define GROVE_GYRO_DEFAULT_OSC GROVE_GYRO_PWR_MGMT_CLK_SEL_INTOSC
#endif
#define GROVE_GYRO_PWR_MGMT_CLK_SEL_MASK 0x07
#define GROVE_GYRO_MAX_DATA 0x06
/** @} */
/* -------------------------------------------------------------------------- */
/**
* \name Grove 3-axis gyroscope operation values
* @{
*/
/* Configure request type */
#define GROVE_GYRO_ACTIVE SENSORS_ACTIVE
#define GROVE_GYRO_DATA_INTERRUPT 0x01
#define GROVE_GYRO_SAMPLE_RATE 0x02
#define GROVE_GYRO_SAMPLE_RATE_DIVIDER 0x03
#define GROVE_GYRO_POWER_ON 0x04
#define GROVE_GYRO_POWER_OFF 0x05
#define GROVE_GYRO_CALIBRATE_ZERO 0x06
/* Sensor value request type, match to the stand-by mask to check if enabled */
#define GROVE_GYRO_X GROVE_GYRO_PWR_MGMT_STBY_XG
#define GROVE_GYRO_Y GROVE_GYRO_PWR_MGMT_STBY_YG
#define GROVE_GYRO_Z GROVE_GYRO_PWR_MGMT_STBY_ZG
#define GROVE_GYRO_SENSOR GROVE_GYRO_PWR_MGMT_SLEEP
#define GROVE_GYRO_XYZ (GROVE_GYRO_X + GROVE_GYRO_Y + \
GROVE_GYRO_Z)
#define GROVE_GYRO_ALL (GROVE_GYRO_XYZ + GROVE_GYRO_SENSOR)
#define GROVE_GYRO_TEMP 0x06
/* Return types */
#define GROVE_GYRO_ERROR (-1)
#define GROVE_GYRO_SUCCESS 0x00
/* Calibration constants */
#define GROVE_GYRO_CALIB_SAMPLES 200
#define GROVE_GYRO_CALIB_TIME_US 5000
/** @} */
/* -------------------------------------------------------------------------- */
#define GROVE_GYRO_STRING "Grove 3-axis gyroscope Sensor"
/* -------------------------------------------------------------------------- */
extern const struct sensors_sensor grove_gyro;
/* -------------------------------------------------------------------------- */
#endif /* ifndef GROVE_GYRO_H_ */
/**
* @}
* @}
*/