PX4 Firmware
PX4 Autopilot Software http://px4.io
BlockIntegralTrap.hpp
Go to the documentation of this file.
1
/****************************************************************************
2
*
3
* Copyright (C) 2012 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 blocks.h
36
*
37
* Controller library code
38
*/
39
40
#pragma once
41
42
#include <px4_platform_common/defines.h>
43
#include <assert.h>
44
#include <time.h>
45
#include <stdlib.h>
46
#include <math.h>
47
#include <
mathlib/math/test/test.hpp
>
48
#include <
mathlib/math/filter/LowPassFilter2p.hpp
>
49
50
#include "
block/Block.hpp
"
51
#include "
block/BlockParam.hpp
"
52
53
#include "
matrix/math.hpp
"
54
55
namespace
control
56
{
57
58
/**
59
* A trapezoidal integrator.
60
* http://en.wikipedia.org/wiki/Trapezoidal_rule
61
* A limiter is built into the class to bound the
62
* integral's internal state. This is important
63
* for windup protection.
64
* @see Limit
65
*/
66
class
__EXPORT
BlockIntegralTrap
:
public
SuperBlock
67
{
68
public
:
69
// methods
70
BlockIntegralTrap
(
SuperBlock
*parent,
const
char
*
name
) :
71
SuperBlock
(parent, name),
72
_u(0),
73
_y(0),
74
_limit(this,
""
) {}
75
virtual
~
BlockIntegralTrap
() =
default
;
76
float
update(
float
input);
77
// accessors
78
float
getU
() {
return
_u;}
79
float
getY
() {
return
_y;}
80
float
getMax
() {
return
_limit.getMax();}
81
void
setU
(
float
u) {_u = u;}
82
void
setY
(
float
y) {_y = y;}
83
protected
:
84
// attributes
85
float
_u
;
/**< previous input */
86
float
_y
;
/**< previous output */
87
BlockLimitSym
_limit
;
/**< limiter */
88
};
89
90
}
// namespace control
control::BlockIntegralTrap::setU
void setU(float u)
Definition:
BlockIntegralTrap.hpp:81
control::BlockIntegralTrap::_u
float _u
previous input
Definition:
BlockIntegralTrap.hpp:85
control::BlockIntegralTrap::getU
float getU()
Definition:
BlockIntegralTrap.hpp:78
control::BlockIntegralTrap::_limit
BlockLimitSym _limit
limiter
Definition:
BlockIntegralTrap.hpp:87
control::BlockLimitSym
A symmetric limiter/ saturation.
Definition:
BlockLimitSym.hpp:63
__EXPORT
Definition:
I2C.hpp:51
test.hpp
Controller library code.
Block.hpp
Controller library code.
control::BlockIntegralTrap::_y
float _y
previous output
Definition:
BlockIntegralTrap.hpp:86
control::BlockIntegralTrap::getMax
float getMax()
Definition:
BlockIntegralTrap.hpp:80
control::SuperBlock
Definition:
Block.hpp:94
math.hpp
control
Definition:
Block.cpp:45
control::BlockIntegralTrap::getY
float getY()
Definition:
BlockIntegralTrap.hpp:79
BlockParam.hpp
Controller library code.
control::BlockIntegralTrap::BlockIntegralTrap
BlockIntegralTrap(SuperBlock *parent, const char *name)
Definition:
BlockIntegralTrap.hpp:70
LowPassFilter2p.hpp
control::BlockIntegralTrap
A trapezoidal integrator.
Definition:
BlockIntegralTrap.hpp:66
name
const char * name
Definition:
tests_main.c:58
control::BlockIntegralTrap::setY
void setY(float y)
Definition:
BlockIntegralTrap.hpp:82
src
lib
controllib
BlockIntegralTrap.hpp
Generated by
1.8.13