Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
meteo_france_DAQ.c
Go to the documentation of this file.
1/*
2 * Copyright (C) 2014 Gautier Hattenberger
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
33
35
36#include "state.h"
37#include "autopilot.h"
42
43#include "modules/gps/gps.h"
45
48
49#ifndef MF_DAQ_POWER_INIT
50#define MF_DAQ_POWER_INIT TRUE
51#endif
52
53#if !(defined MF_DAQ_POWER_PORT) && !(defined MF_DAQ_POWER_PIN)
54INFO("MF_DAQ power pin is not defined")
55#endif
56
57void init_mf_daq(void)
58{
59 mf_daq.nb = 0;
61#if (defined MF_DAQ_POWER_PORT) && (defined MF_DAQ_POWER_PIN)
62 gpio_setup_output(MF_DAQ_POWER_PORT, MF_DAQ_POWER_PIN);
63#endif
65 log_started = false;
66}
67
69{
70 // Send aircraft state to DAQ board
71 DOWNLINK_SEND_MF_DAQ_STATE(extra_pprz_tp, EXTRA_DOWNLINK_DEVICE,
72 &autopilot.flight_time,
90}
91
93{
94 // Send report over normal telemetry
95 if (mf_daq.nb > 0) {
96 DOWNLINK_SEND_PAYLOAD_FLOAT(DefaultChannel, DefaultDevice, 9, mf_daq.values);
97 }
98 // Test if log is started
99 if (pprzLogFile != -1) {
100 if (log_started == FALSE) {
101 // Log MD5SUM once
102 DOWNLINK_SEND_ALIVE(pprzlog_tp, chibios_sdlog, 16, MD5SUM);
103 log_started = true;
104 }
105 // Log GPS for time reference
106 uint8_t foo = 0;
107 int16_t climb = -gps.ned_vel.z;
108 int16_t course = (DegOfRad(gps.course) / ((int32_t)1e6));
109 struct UtmCoor_f utm = *stateGetPositionUtm_f();
110 int32_t east = utm.east * 100;
111 int32_t north = utm.north * 100;
112 DOWNLINK_SEND_GPS(pprzlog_tp, chibios_sdlog, &gps.fix,
113 &east, &north, &course, &gps.hmsl, &gps.gspeed, &climb,
114 &gps.week, &gps.tow, &utm.zone, &foo);
115 }
116}
117
119{
120 mf_daq.nb = pprzlink_get_PAYLOAD_FLOAT_values_length(buf);
121 if (mf_daq.nb > 0) {
122 if (mf_daq.nb > MF_DAQ_SIZE) { mf_daq.nb = MF_DAQ_SIZE; }
123 // Store data struct directly from buf
124 float *b = pprzlink_get_DL_PAYLOAD_FLOAT_values(buf);
125 memcpy(mf_daq.values, b, mf_daq.nb * sizeof(float));
126 // Log on SD card
127 if (log_started) {
128 DOWNLINK_SEND_PAYLOAD_FLOAT(pprzlog_tp, chibios_sdlog, mf_daq.nb, mf_daq.values);
129 DOWNLINK_SEND_MF_DAQ_STATE(pprzlog_tp, chibios_sdlog,
130 &autopilot.flight_time,
137 &stateGetAccelNed_f()->x,
138 &stateGetAccelNed_f()->y,
139 &stateGetAccelNed_f()->z,
140 &stateGetSpeedEnu_f()->x,
141 &stateGetSpeedEnu_f()->y,
142 &stateGetSpeedEnu_f()->z,
143 &stateGetPositionLla_f()->lat,
144 &stateGetPositionLla_f()->lon,
148 }
149 }
150}
151
152
static int16_t course[3]
struct pprz_autopilot autopilot
Global autopilot structure.
Definition autopilot.c:50
Core autopilot interface common to all firmwares.
void gpio_setup_output(ioportid_t port, uint16_t gpios)
Setup one or more pins of the given GPIO port as outputs.
Definition gpio_arch.c:33
struct pprz_transport extra_pprz_tp
Extra datalink and telemetry using PPRZ protocol.
struct GpsState gps
global GPS state
Definition gps.c:74
Device independent GPS code (interface).
static struct NedCoor_f * stateGetAccelNed_f(void)
Get acceleration in NED coordinates (float).
Definition state.h:1214
static struct FloatEulers * stateGetNedToBodyEulers_f(void)
Get vehicle body attitude euler angles (float).
Definition state.h:1325
static struct LlaCoor_f * stateGetPositionLla_f(void)
Get position in LLA coordinates (float).
Definition state.h:868
static struct UtmCoor_f * stateGetPositionUtm_f(void)
Get position in UTM coordinates (float).
Definition state.h:832
static struct FloatRates * stateGetBodyRates_f(void)
Get vehicle body angular rate (float).
Definition state.h:1392
static struct EnuCoor_f * stateGetSpeedEnu_f(void)
Get ground speed in local ENU coordinates (float).
Definition state.h:1069
static struct FloatVect2 * stateGetHorizontalWindspeed_f(void)
Get horizontal windspeed (float).
Definition state.h:1585
static float p[2][2]
static FILE * pprzLogFile
uint16_t foo
Definition main_demo5.c:58
void mf_daq_send_state(void)
void parse_mf_daq_msg(uint8_t *buf)
#define MF_DAQ_POWER_INIT
void mf_daq_send_report(void)
bool log_started
void init_mf_daq(void)
struct MF_DAQ mf_daq
Communication module with the Data Acquisition board from Meteo France.
#define MF_DAQ_SIZE
#define meteo_france_DAQ_SetPower(_x)
float alt
in meters (above WGS84 reference ellipsoid or above MSL)
uint8_t zone
UTM zone number.
float east
in meters
float north
in meters
position in UTM coordinates Units: meters
struct pprzlog_transport pprzlog_tp
PPRZLOG transport structure.
Definition pprzlog_tp.c:29
Initialize pprzlog transport.
chibios_sdlog structure
API to get/set the generic vehicle states.
#define FALSE
Definition std.h:5
int int32_t
Typedef defining 32 bit int type.
short int16_t
Typedef defining 16 bit short type.
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.
float b
Definition wedgebug.c:202