PX4 Firmware
PX4 Autopilot Software http://px4.io
crsf_telemetry.h
Go to the documentation of this file.
1
/****************************************************************************
2
*
3
* Copyright (c) 2018 PX4 Development Team. All rights reserved.
4
*
5
* Redistribution and use in source and binary forms, with or without
6
* modification, are permitted provided that the following conditions
7
* are met:
8
*
9
* 1. Redistributions of source code must retain the above copyright
10
* notice, this list of conditions and the following disclaimer.
11
* 2. Redistributions in binary form must reproduce the above copyright
12
* notice, this list of conditions and the following disclaimer in
13
* the documentation and/or other materials provided with the
14
* distribution.
15
* 3. Neither the name PX4 nor the names of its contributors may be
16
* used to endorse or promote products derived from this software
17
* without specific prior written permission.
18
*
19
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
22
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
23
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
24
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
25
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
26
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30
* POSSIBILITY OF SUCH DAMAGE.
31
*
32
****************************************************************************/
33
34
/**
35
* @file crsf_telemetry.h
36
*
37
* @author Beat Küng <beat-kueng@gmx.net>
38
*/
39
40
#pragma once
41
42
#include <
uORB/Subscription.hpp
>
43
#include <
uORB/topics/battery_status.h
>
44
#include <
uORB/topics/vehicle_attitude.h
>
45
#include <
uORB/topics/vehicle_gps_position.h
>
46
#include <
uORB/topics/vehicle_status.h
>
47
#include <
drivers/drv_hrt.h
>
48
49
#include <
matrix/math.hpp
>
50
#include <mathlib/mathlib.h>
51
52
using namespace
time_literals
;
53
54
/**
55
* High-level class that handles sending of CRSF telemetry data
56
*/
57
class
CRSFTelemetry
58
{
59
public
:
60
/**
61
* @param uart_fd file descriptor for the UART to use. It is expected to be configured
62
* already.
63
*/
64
CRSFTelemetry
(
int
uart_fd);
65
66
~
CRSFTelemetry
() =
default
;
67
68
/**
69
* Send telemetry data. Call this regularly (i.e. at 100Hz), it will automatically
70
* limit the sending rate.
71
* @return true if new data sent
72
*/
73
bool
update(
const
hrt_abstime
&now);
74
75
private
:
76
bool
send_battery();
77
bool
send_gps();
78
bool
send_attitude();
79
bool
send_flight_mode();
80
81
uORB::Subscription
_vehicle_gps_position_sub{
ORB_ID
(vehicle_gps_position)};
82
uORB::Subscription
_battery_status_sub{
ORB_ID
(
battery_status
)};
83
uORB::Subscription
_vehicle_attitude_sub{
ORB_ID
(vehicle_attitude)};
84
uORB::Subscription
_vehicle_status_sub{
ORB_ID
(vehicle_status)};
85
86
hrt_abstime
_last_update{0};
87
88
static
constexpr
int
num_data_types{4};
///< number of different telemetry data types
89
int
_next_type{0};
90
91
int
_uart_fd
;
92
};
battery_status.h
time_literals
Subscription.hpp
vehicle_status.h
drv_hrt.h
High-resolution timer with callouts and timekeeping.
ORB_ID
#define ORB_ID(_name)
Generates a pointer to the uORB metadata structure for a given topic.
Definition:
uORB.h:87
vehicle_attitude.h
math.hpp
CRSFTelemetry::_uart_fd
int _uart_fd
Definition:
crsf_telemetry.h:91
vehicle_gps_position.h
CRSFTelemetry
High-level class that handles sending of CRSF telemetry data.
Definition:
crsf_telemetry.h:57
hrt_abstime
__BEGIN_DECLS typedef uint64_t hrt_abstime
Absolute time, in microsecond units.
Definition:
drv_hrt.h:58
battery_status
Definition:
parameters.cpp:46
uORB::Subscription
Definition:
Subscription.hpp:54
src
drivers
rc_input
crsf_telemetry.h
Generated by
1.8.13