Paparazzi UAS  v5.12_stable-4-g9b43e9b
Paparazzi is a free software Unmanned Aircraft System.
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Modules Pages
autopilot_generated.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) 2017 Gautier Hattenberger <gautier.hattenberger@enac.fr>
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, see
18  * <http://www.gnu.org/licenses/>.
19  */
20 
27 #define AUTOPILOT_CORE_AP_C
28 
30 #include "autopilot.h"
31 
33 #include "subsystems/commands.h"
34 #include "subsystems/actuators.h"
35 #include "subsystems/settings.h"
37 
38 #include "generated/settings.h"
39 
40 
42 {
43  // call generated init
44  autopilot_core_ap_init();
45  // copy generated mode to public mode (set at startup)
46  autopilot.mode = autopilot_mode_ap;
47 }
48 
49 
51 {
52 
53  autopilot_core_ap_periodic_task();
54 
55  // copy generated mode to public mode (may be changed on internal exceptions)
56  autopilot.mode = autopilot_mode_ap;
57 
58 #if defined MCU_SPI_LINK || defined MCU_UART_LINK || defined MCU_CAN_LINK
59  link_mcu_send();
60 #elif defined INTER_MCU && defined SINGLE_MCU
61 
62  inter_mcu_received_ap = true;
63 #endif
64 
65 }
66 
72 {
74 }
75 
76 
77 void autopilot_generated_set_mode(uint8_t new_autopilot_mode)
78 {
79  autopilot_core_ap_set_mode(new_autopilot_mode);
80  // copy generated mode to public mode
81  autopilot.mode = autopilot_mode_ap;
82 }
83 
84 
85 void autopilot_generated_set_motors_on(bool motors_on __attribute__((unused)))
86 {
87  // Do nothing on fixedwing ?
88 }
89 
90 static inline void copy_from_to_fbw(void)
91 {
92  PPRZ_MUTEX_LOCK(fbw_state_mtx);
93  PPRZ_MUTEX_LOCK(ap_state_mtx);
94 #ifdef SetAutoCommandsFromRC
95  SetAutoCommandsFromRC(ap_state->commands, fbw_state->channels);
96 #elif defined RADIO_YAW && defined COMMAND_YAW
97  ap_state->commands[COMMAND_YAW] = fbw_state->channels[RADIO_YAW];
98 #endif
99  PPRZ_MUTEX_UNLOCK(ap_state_mtx);
100  PPRZ_MUTEX_UNLOCK(fbw_state_mtx);
101 }
102 
104 {
105 
106  // update electrical from FBW
107  imcu_get_electrical(&vsupply, &current, &energy);
108 
109  // FIXME what to do here ?
111 
112 }
113 
void autopilot_generated_SetModeHandler(float mode)
AP mode setting handler.
#define RADIO_YAW
Definition: spektrum_arch.h:45
Periodic telemetry system header (includes downlink utility and generated code).
Autopilot generated implementation Calls the code generated from autopilot XML file.
int32_t current
Supply current in milliAmpere.
void autopilot_generated_init(void)
#define PPRZ_MUTEX_LOCK(_mtx)
Definition: pprz_mutex.h:46
volatile bool inter_mcu_received_ap
Definition: inter_mcu.c:41
void autopilot_generated_on_rc_frame(void)
struct fbw_state * fbw_state
Definition: inter_mcu.c:36
struct pprz_autopilot autopilot
Global autopilot structure.
Definition: autopilot.c:50
struct ap_state * ap_state
Definition: inter_mcu.c:37
float energy
Energy consumption (mAh) This is the ap copy of the measurement from fbw FIXME use electrical module ...
uint16_t vsupply
Supply voltage in deciVolt.
Hardware independent API for actuators (servos, motor controllers).
void autopilot_generated_set_mode(uint8_t new_autopilot_mode)
void autopilot_generated_set_motors_on(bool motors_on)
static void copy_from_to_fbw(void)
Hardware independent code for commands handling.
Core autopilot interface common to all firmwares.
unsigned char uint8_t
Definition: types.h:14
Persistent settings interface.
static uint8_t mode
mode holds the current sonar mode mode = 0 used at high altitude, uses 16 wave patterns mode = 1 used...
Definition: sonar_bebop.c:66
#define PPRZ_MUTEX_UNLOCK(_mtx)
Definition: pprz_mutex.h:47
uint8_t mode
current autopilot mode
Definition: autopilot.h:59
void autopilot_generated_periodic(void)