Auterion App SDK
Auterion SDK is a library that can be used by AuterionOS apps to communicate with the system.
Loading...
Searching...
No Matches
stick_shaping.hpp
1/****************************************************************************
2 *
3 * Copyright (c) 2017-2022 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#pragma once
35
36#include <algorithm>
37#include <cmath>
38
39namespace auterion {
51template <typename Type>
52Type expo(Type value, Type e) {
53 const Type x = std::clamp(value, Type(-1), Type(1));
54 const Type ec = std::clamp(e, Type(0), Type(1));
55 return (1 - ec) * x + ec * x * x * x;
56}
57
66template <typename Type>
67Type deadzone(Type value, Type dz) {
68 const Type x = std::clamp(value, Type(-1), Type(1));
69 const Type dzc = std::clamp(dz, Type(0), Type(0.99));
70 if (std::abs(x) <= dzc) {
71 return Type(0);
72 }
73 return (x - std::copysign(dzc, x)) / (1 - dzc);
74}
75
77} // namespace auterion
Type deadzone(Type value, Type dz)
Zeroes stick inputs within the deadzone and rescales the rest back to [-1, 1], as in PX4 (mathlib Fun...
Definition stick_shaping.hpp:67
Type expo(Type value, Type e)
Blends a linear and a cubic stick response, as in PX4 (mathlib Functions.hpp)
Definition stick_shaping.hpp:52