nps_radio_control_spektrum.c File Reference

#include "nps_radio_control_spektrum.h"
#include "nps_radio_control.h"
#include <glib.h>
#include <stdio.h>
#include <termios.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <string.h>
#include <errno.h>
#include <inttypes.h>

Include dependency graph for nps_radio_control_spektrum.c:

Go to the source code of this file.

Macros
#define	IUCLC   0
#define	CHANNEL_OF_FRAME(i)   ((((frame_buf[2*i]<<8) + frame_buf[2*i+1])&0x03FF)-512)
#define	SYNC_1   0x03
#define	SYNC_2   0x12
#define	STA_UNINIT   0
#define	STA_GOT_SYNC_1   1
#define	STA_GOT_SYNC_2   2
#define	FRAME_LEN   14

Functions
static gboolean	on_serial_data_received (GIOChannel *source, GIOCondition condition, gpointer data)
static void	parse_data (char *buf, int len)
static void	handle_frame (void)
int	nps_radio_control_spektrum_init (const char *device)

Variables
static int	sp_fd
uint8_t	status = STA_UNINIT
static uint8_t	frame_buf [FRAME_LEN]
static uint32_t	idx = 0

Macro Definition Documentation

#define CHANNEL_OF_FRAME

(

i

)

((((frame_buf[2*i]<<8) + frame_buf[2*i+1])&0x03FF)-512)

Definition at line 20 of file nps_radio_control_spektrum.c.

Referenced by handle_frame().

#define FRAME_LEN   14

Definition at line 103 of file nps_radio_control_spektrum.c.

Referenced by parse_data().

#define IUCLC   0

Definition at line 17 of file nps_radio_control_spektrum.c.

Referenced by nps_radio_control_spektrum_init().

#define STA_GOT_SYNC_1   1

Definition at line 98 of file nps_radio_control_spektrum.c.

Referenced by parse_data().

#define STA_GOT_SYNC_2   2

Definition at line 99 of file nps_radio_control_spektrum.c.

Referenced by parse_data().

#define STA_UNINIT   0

Definition at line 97 of file nps_radio_control_spektrum.c.

Referenced by parse_data().

#define SYNC_1   0x03

Definition at line 94 of file nps_radio_control_spektrum.c.

Referenced by parse_data().

#define SYNC_2   0x12

Definition at line 95 of file nps_radio_control_spektrum.c.

Referenced by parse_data().

Function Documentation

static void handle_frame ( void  )

static

Definition at line 141 of file nps_radio_control_spektrum.c.

References CHANNEL_OF_FRAME, NpsRadioControl::mode, nps_radio_control, NpsRadioControl::pitch, NpsRadioControl::roll, NpsRadioControl::throttle, and NpsRadioControl::yaw.

Referenced by parse_data().

Here is the caller graph for this function:

int nps_radio_control_spektrum_init

(

const char *

device

)

Definition at line 31 of file nps_radio_control_spektrum.c.

References B115200, channel, IUCLC, on_serial_data_received(), and sp_fd.

Referenced by nps_radio_control_init().

Here is the call graph for this function:

Here is the caller graph for this function:

static gboolean on_serial_data_received ( GIOChannel *  source, GIOCondition  condition, gpointer  data  )

static

Definition at line 74 of file nps_radio_control_spektrum.c.

References parse_data(), and TRUE.

Referenced by nps_radio_control_spektrum_init().

Here is the call graph for this function:

Here is the caller graph for this function:

static void parse_data ( char *  buf, int  len  )

static

Definition at line 107 of file nps_radio_control_spektrum.c.

References FRAME_LEN, handle_frame(), idx, STA_GOT_SYNC_1, STA_GOT_SYNC_2, STA_UNINIT, SYNC_1, and SYNC_2.

Referenced by on_serial_data_received().

Here is the call graph for this function:

Here is the caller graph for this function:

Variable Documentation

uint8_t frame_buf[FRAME_LEN]

static

Definition at line 104 of file nps_radio_control_spektrum.c.

uint32_t idx = 0

static

Definition at line 105 of file nps_radio_control_spektrum.c.

Referenced by ahrs_switch(), attitude_ref_quat_float_idx_set_omega_p(), attitude_ref_quat_float_idx_set_omega_q(), attitude_ref_quat_float_idx_set_omega_r(), attitude_ref_quat_float_schedule(), baro_cb(), find_launch_index(), i2c_submit(), image_show_points_color(), mavlink_common_message_handler(), mtostk_populate_float_array_from_buffer(), mtostk_populate_uuid_from_buffer(), nps_ins_data_loop(), nps_ins_fill_buffer(), parse_data(), px4flow_i2c_periodic(), range_msg_callback(), spi_submit(), stabilization_attitude_gain_schedule(), superbitrf_gen_dsmx_channels(), and vn200_read_message().

int sp_fd

static

Definition at line 22 of file nps_radio_control_spektrum.c.

Referenced by nps_radio_control_spektrum_init().

uint8_t status = STA_UNINIT

Definition at line 101 of file nps_radio_control_spektrum.c.

Referenced by acInfoCalcPositionEnu_f(), acInfoCalcPositionEnu_i(), acInfoCalcPositionLla_f(), acInfoCalcPositionLla_i(), acInfoCalcPositionUtm_f(), acInfoCalcPositionUtm_i(), acInfoCalcVelocityEnu_f(), acInfoCalcVelocityEnu_i(), acInfoGetPositionEnu_f(), acInfoGetPositionEnu_i(), acInfoGetPositionLla_f(), acInfoGetPositionLla_i(), acInfoGetPositionUtm_f(), acInfoGetPositionUtm_i(), acInfoGetVelocityEnu_f(), acInfoGetVelocityEnu_i(), formation_flight(), jevois_mavlink_event(), lidar_lite_downlink(), lidar_sf11_downlink(), mavlink_event(), ms45xx_i2c_event(), msgqueue_pop_timeout(), parseFormationStatus(), sdlog_check_free_space(), send_sdlog_status(), send_superbit(), set_ac_info_lla(), set_ac_info_utm(), start_formation(), stop_formation(), tcas_periodic_task_1Hz(), and updateFormationStatus().