diff --git a/conf/airframes/mm/fixed-wing/funjetmm.xml b/conf/airframes/mm/fixed-wing/funjetmm.xml index f8ebbe9620..aaef743332 100755 --- a/conf/airframes/mm/fixed-wing/funjetmm.xml +++ b/conf/airframes/mm/fixed-wing/funjetmm.xml @@ -60,17 +60,18 @@ - + + + + + diff --git a/conf/modules/humid_sht_i2c.xml b/conf/modules/humid_sht_i2c.xml new file mode 100644 index 0000000000..415b5cb57b --- /dev/null +++ b/conf/modules/humid_sht_i2c.xml @@ -0,0 +1,21 @@ + + + + + +
+ +
+ + + + + + + + + + diff --git a/sw/airborne/modules/meteo/humid_sht_i2c.c b/sw/airborne/modules/meteo/humid_sht_i2c.c new file mode 100644 index 0000000000..4134e0a54b --- /dev/null +++ b/sw/airborne/modules/meteo/humid_sht_i2c.c @@ -0,0 +1,207 @@ +/* + * $Id$ + * + * Copyright (C) 2010 Martin Mueller + * + * This file is part of paparazzi. + * + * paparazzi is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2, or (at your option) + * any later version. + * + * paparazzi is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with paparazzi; see the file COPYING. If not, write to + * the Free Software Foundation, 59 Temple Place - Suite 330, + * Boston, MA 02111-1307, USA. + * + */ + +/** \file humid_sht_i2c.c + * \brief Sensirion SHT25 humidity/temperature sensor interface + * + */ + + +#include "humid_sht_i2c.h" + +#include "i2c.h" +#include "uart.h" +#include "messages.h" +#include "downlink.h" + +#ifndef SHT_I2C_DEV +#define SHT_I2C_DEV i2c0 +#endif + +#define SHT_SLAVE_ADDR 0x80 + +struct i2c_transaction sht_trans; +uint8_t sht_status; +uint8_t sht_serial[8] = {0}; +uint32_t sht_serial1=0, sht_serial2=0; +uint16_t humidsht, tempsht; +float fhumidsht, ftempsht; + +int8_t humid_sht_crc(volatile uint8_t* data) { + uint8_t i, bit, crc = 0; + + for (i = 0; i < 2; i++) { + crc ^= (data[i]); + for (bit = 8; bit > 0; bit--) { + if (crc & 0x80) + crc = (crc << 1) ^ 0x131; + else + crc = (crc << 1); + } + } + if (crc != data[2]) + return -1; + else + return 0; +} + +void humid_sht_init(void) { + sht_status = SHT_UNINIT; +} + +void humid_sht_periodic( void ) { + switch (sht_status) { + + case SHT_UNINIT: + /* do soft reset, then wait at least 15ms */ + sht_status = SHT_RESET; + sht_trans.buf[0] = SHT_SOFT_RESET; + I2CTransmit(SHT_I2C_DEV, sht_trans, SHT_SLAVE_ADDR, 1); + break; + + case SHT_SERIAL: + /* get serial number part 1 */ + sht_status = SHT_SERIAL1; + sht_trans.buf[0] = 0xFA; + sht_trans.buf[1] = 0x0F; + I2CTransceive(SHT_I2C_DEV, sht_trans, SHT_SLAVE_ADDR, 2, 8); + break; + + case SHT_SERIAL1: + case SHT_SERIAL2: + break; + + default: + /* trigger temp measurement, no master hold */ + sht_trans.buf[0] = SHT_TRIGGER_TEMP; + sht_status = SHT_TRIG_TEMP; + I2CTransmit(SHT_I2C_DEV, sht_trans, SHT_SLAVE_ADDR, 1); + /* send serial number every 30 seconds */ + RunOnceEvery((4*30), DOWNLINK_SEND_SHT_SERIAL(DefaultChannel, &sht_serial1, &sht_serial2)); + break; + } +} + +/* needs 85ms delay from temp trigger measurement */ +void humid_sht_p_temp( void ) { + if (sht_status == SHT_GET_TEMP) { + /* get temp */ + sht_status = SHT_READ_TEMP; + I2CReceive(SHT_I2C_DEV, sht_trans, SHT_SLAVE_ADDR, 3); + } +} + +/* needs 29ms delay from humid trigger measurement */ +void humid_sht_p_humid( void ) { + if (sht_status == SHT_GET_HUMID) { + /* read humid */ + sht_status = SHT_READ_HUMID; + I2CReceive(SHT_I2C_DEV, sht_trans, SHT_SLAVE_ADDR, 3); + } +} + +void humid_sht_event( void ) { + if (sht_trans.status == I2CTransSuccess) { + switch (sht_status) { + + case SHT_TRIG_TEMP: + sht_status = SHT_GET_TEMP; + sht_trans.status = I2CTransDone; + break; + + case SHT_READ_TEMP: + /* read temperature */ + tempsht = (sht_trans.buf[0] << 8) | sht_trans.buf[1]; + tempsht &= 0xFFFC; + if (humid_sht_crc(sht_trans.buf) == 0) { + /* trigger humid measurement, no master hold */ + sht_trans.buf[0] = SHT_TRIGGER_HUMID; + sht_status = SHT_TRIG_HUMID; + I2CTransmit(SHT_I2C_DEV, sht_trans, SHT_SLAVE_ADDR, 1); + } + else { + /* checksum error, restart */ + sht_status = SHT_IDLE; + sht_trans.status == I2CTransDone; + } + break; + + case SHT_TRIG_HUMID: + sht_status = SHT_GET_HUMID; + sht_trans.status = I2CTransDone; + break; + + case SHT_READ_HUMID: + /* read humidity */ + humidsht = (sht_trans.buf[0] << 8) | sht_trans.buf[1]; + humidsht &= 0xFFFC; + fhumidsht = -6. + 125. / 65536. * humidsht; + ftempsht = -46.85 + 175.72 / 65536. * tempsht; + + sht_status = SHT_IDLE; + sht_trans.status = I2CTransDone; + + if (humid_sht_crc(sht_trans.buf) == 0) { + DOWNLINK_SEND_SHT_STATUS(DefaultChannel, &humidsht, &tempsht, &fhumidsht, &ftempsht); + } + break; + + case SHT_RESET: + sht_status = SHT_SERIAL; + sht_trans.status = I2CTransDone; + break; + + case SHT_SERIAL1: + /* read serial number part 1 */ + sht_serial[5] = sht_trans.buf[0]; + sht_serial[4] = sht_trans.buf[2]; + sht_serial[3] = sht_trans.buf[4]; + sht_serial[2] = sht_trans.buf[6]; + /* get serial number part 2 */ + sht_status = SHT_SERIAL2; + sht_trans.buf[0] = 0xFC; + sht_trans.buf[1] = 0xC9; + I2CTransceive(SHT_I2C_DEV, sht_trans, SHT_SLAVE_ADDR, 2, 6); + break; + + case SHT_SERIAL2: + /* read serial number part 2 */ + sht_serial[1] = sht_trans.buf[0]; + sht_serial[0] = sht_trans.buf[1]; + sht_serial[7] = sht_trans.buf[3]; + sht_serial[6] = sht_trans.buf[4]; + sht_serial1=sht_serial[7]<<24|sht_serial[6]<<16|sht_serial[5]<<8|sht_serial[4]; + sht_serial2=sht_serial[3]<<24|sht_serial[2]<<16|sht_serial[1]<<8|sht_serial[0]; + DOWNLINK_SEND_SHT_SERIAL(DefaultChannel, &sht_serial1, &sht_serial2); + sht_status = SHT_IDLE; + sht_trans.status = I2CTransDone; + break; + + default: + sht_trans.status = I2CTransDone; + break; + } + } +} + diff --git a/sw/airborne/modules/meteo/humid_sht_i2c.h b/sw/airborne/modules/meteo/humid_sht_i2c.h new file mode 100644 index 0000000000..746717a607 --- /dev/null +++ b/sw/airborne/modules/meteo/humid_sht_i2c.h @@ -0,0 +1,39 @@ +#ifndef HUMID_SHT_I2C_H +#define HUMID_SHT_I2C_H + +#include "std.h" + +#define SHT_WRITE_USER 0xE6 +#define SHT_READ_USER 0xE7 +#define SHT_TRIGGER_TEMP 0xF3 +#define SHT_TRIGGER_HUMID 0xF5 +#define SHT_SOFT_RESET 0xFE + +enum sht_stat{ + SHT_UNINIT, + SHT_IDLE, + SHT_RESET, + SHT_SERIAL, + SHT_SERIAL1, + SHT_SERIAL2, + SHT_SET_CONFIG, + SHT_READ_SERIAL, + SHT_TRIG_TEMP, + SHT_GET_TEMP, + SHT_READ_TEMP, + SHT_TRIG_HUMID, + SHT_GET_HUMID, + SHT_READ_HUMID +}; + +int8_t humid_sht_crc(volatile uint8_t* data); +void humid_sht_init(void); +void humid_sht_periodic(void); +void humid_sht_p_temp(void); +void humid_sht_p_humid(void); +void humid_sht_event(void); + +extern uint16_t humidsht, tempsht; +extern float fhumidsht, ftempsht; + +#endif