PX4 Firmware
PX4 Autopilot Software http://px4.io
FlightTaskManual.hpp
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 FlightTaskManual.hpp
36  *
37  * Linear and exponential map from stick inputs to range -1 and 1.
38  *
39  */
40 
41 #pragma once
42 
43 #include "FlightTask.hpp"
45 
47 {
48 public:
49  FlightTaskManual() = default;
50 
51  virtual ~FlightTaskManual() = default;
52 
54  bool updateInitialize() override;
55 
56 protected:
57 
58  bool _sticks_data_required = true; /**< let inherited task-class define if it depends on stick data */
59  matrix::Vector<float, 4> _sticks; /**< unmodified manual stick inputs */
60  matrix::Vector<float, 4> _sticks_expo; /**< modified manual sticks using expo function*/
61  int _gear_switch_old = manual_control_setpoint_s::SWITCH_POS_NONE; /**< old switch state*/
62 
63  float stickDeadzone() const { return _param_mpc_hold_dz.get(); }
64 
65 private:
66 
67  bool _evaluateSticks(); /**< checks and sets stick inputs */
68  void _applyGearSwitch(uint8_t gswitch); /**< Sets gears according to switch */
69 
71 
72  DEFINE_PARAMETERS_CUSTOM_PARENT(FlightTask,
73  (ParamFloat<px4::params::MPC_HOLD_DZ>) _param_mpc_hold_dz, /**< 0-deadzone around the center for the sticks */
74  (ParamFloat<px4::params::MPC_XY_MAN_EXPO>)
75  _param_mpc_xy_man_expo, /**< ratio of exponential curve for stick input in xy direction */
76  (ParamFloat<px4::params::MPC_Z_MAN_EXPO>)
77  _param_mpc_z_man_expo, /**< ratio of exponential curve for stick input in z direction */
78  (ParamFloat<px4::params::MPC_YAW_EXPO>)
79  _param_mpc_yaw_expo, /**< ratio of exponential curve for stick input in yaw for modes except acro */
80  (ParamFloat<px4::params::COM_RC_LOSS_T>) _param_com_rc_loss_t /**< time at which commander considers RC lost */
81  )
82 };
virtual ~FlightTaskManual()=default
bool _evaluateSticks()
checks and sets stick inputs
FlightTaskManual()=default
#define ORB_ID(_name)
Generates a pointer to the uORB metadata structure for a given topic.
Definition: uORB.h:87
Abstract base class for different advanced flight tasks like orbit, follow me, ...
bool applyCommandParameters(const vehicle_command_s &command) override
To be called to adopt parameters from an arrived vehicle command.
matrix::Vector< float, 4 > _sticks_expo
modified manual sticks using expo function
void _applyGearSwitch(uint8_t gswitch)
Sets gears according to switch.
matrix::Vector< float, 4 > _sticks
unmodified manual stick inputs
virtual bool applyCommandParameters(const vehicle_command_s &command)
To be called to adopt parameters from an arrived vehicle command.
Definition: FlightTask.hpp:86
bool updateInitialize() override
Call before activate() or update() to initialize time and input data.
int _gear_switch_old
old switch state
uORB::SubscriptionData< manual_control_setpoint_s > _sub_manual_control_setpoint
float stickDeadzone() const
bool _sticks_data_required
let inherited task-class define if it depends on stick data