Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
temp_temod.c
Go to the documentation of this file.
1/*
2 * Copyright (C) 2010 Martin Mueller
3 *
4 * This file is part of paparazzi.
5 *
6 * paparazzi is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2, or (at your option)
9 * any later version.
10 *
11 * paparazzi is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with paparazzi; see the file COPYING. If not, write to
18 * the Free Software Foundation, 59 Temple Place - Suite 330,
19 * Boston, MA 02111-1307, USA.
20 *
21 */
22
27
28
30#include "mcu_periph/i2c.h"
31#include "led.h"
32#include "mcu_periph/uart.h"
33#include "pprzlink/messages.h"
35
36// sd-log
37#if TEMP_TEMOD_SDLOG
39#include "modules/gps/gps.h"
40bool log_temod_started;
41#endif
42
45
46
47#ifndef TEMOD_I2C_DEV
48#define TEMOD_I2C_DEV i2c0
49#endif
50
51#ifndef TEMOD_TYPE
52#define TEMOD_TYPE TEMOD_I2C_R1
53#endif
54
55#define TEMOD_SLAVE_ADDR 0xF0
56
57void temod_init(void)
58{
59 tmd_trans.status = I2CTransDone;
60
61#if TEMP_TEMOD_SDLOG
62 log_temod_started = false;
63#endif
64}
65
67{
68 if (tmd_trans.status == I2CTransDone) {
70 }
71
72}
73
74void temod_event(void)
75{
76
77 if (tmd_trans.status == I2CTransSuccess) {
78
79 // if MSB is 1, sensor reports an error, skip value
80 if (bit_is_set(tmd_trans.buf[0], 7)) {
81 tmd_trans.status = I2CTransDone;
82 return;
83 }
84
85 uint16_t tmd_temperature;
86
87 /* read two byte temperature */
88 tmd_temperature = tmd_trans.buf[0] << 8;
89 tmd_temperature |= tmd_trans.buf[1];
90
91 ftmd_temperature = (tmd_temperature / TEMOD_TYPE) - 32.;
92
93 DOWNLINK_SEND_TMP_STATUS(DefaultChannel, DefaultDevice, &tmd_temperature, &ftmd_temperature);
94 tmd_trans.status = I2CTransDone;
95
96
97#if TEMP_TEMOD_SDLOG
98 if (pprzLogFile != -1) {
99 if (!log_temod_started) {
100 sdLogWriteLog(pprzLogFile, "TEMOD: Temp(degC) GPS_fix TOW(ms) Week Lat(1e7deg) Lon(1e7deg) HMSL(mm) gspeed(cm/s) course(1e7deg) climb(cm/s)\n");
101 log_temod_started = true;
102 }
103 else {
104 sdLogWriteLog(pprzLogFile, "temod: %9.4f %d %d %d %d %d %d %d %d %d\n",
106 gps.fix, gps.tow, gps.week,
107 gps.lla_pos.lat, gps.lla_pos.lon, gps.hmsl,
108 gps.gspeed, gps.course, -gps.ned_vel.z);
109 }
110 }
111#endif
112
113 }
114 else if (tmd_trans.status == I2CTransFailed) {
115 tmd_trans.status = I2CTransDone;
116 }
117}
118
struct GpsState gps
global GPS state
Definition gps.c:74
Device independent GPS code (interface).
bool i2c_receive(struct i2c_periph *p, struct i2c_transaction *t, uint8_t s_addr, uint16_t len)
Submit a read only transaction.
Definition i2c.c:212
@ I2CTransSuccess
transaction successfully finished by I2C driver
Definition i2c.h:58
@ I2CTransFailed
transaction failed
Definition i2c.h:59
@ I2CTransDone
transaction set to done by user level
Definition i2c.h:60
I2C transaction structure.
Definition i2c.h:94
Architecture independent I2C (Inter-Integrated Circuit Bus) API.
arch independent LED (Light Emitting Diodes) API
static FILE * pprzLogFile
SdioError sdLogWriteLog(const FileDes fd, const char *fmt,...)
void temod_init(void)
Definition temp_temod.c:57
void temod_event(void)
Definition temp_temod.c:74
#define TEMOD_SLAVE_ADDR
Definition temp_temod.c:55
#define TEMOD_I2C_DEV
Definition temp_temod.c:48
float ftmd_temperature
Definition temp_temod.c:43
void temod_periodic(void)
Definition temp_temod.c:66
#define TEMOD_TYPE
Definition temp_temod.c:52
struct i2c_transaction tmd_trans
Definition temp_temod.c:44
arch independent UART (Universal Asynchronous Receiver/Transmitter) API
unsigned short uint16_t
Typedef defining 16 bit unsigned short type.