SCL_regulation_control/FbFilterA.SCL at main · komatic1/SCL_regulation_control · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
FUNCTION_BLOCK "FbFilterA"
TITLE = 'Ôèëüòð àïåðèîäè÷åñêèé.'

{ S7_read_back := 'true' ;
  S7_blockview := 'big'  }

AUTHOR  : VA
FAMILY  : LIB_PLC
VERSION : '2.1'

VAR_INPUT // Âõîäíûå ïåðåìåííûå, ñîõðàíÿåìûå.
In :REAL := 0.0; // Âõîäíîé ñèãíàë äî ôèëüòðàöèè.
Tf :REAL := 1.0; // Ïîñòîÿííàÿ âðåìåíè ôèëüòðà [ñ].
Ts :REAL := 0.1; // Øàã äèñêðåòèçàöèè ïî âðåìåíè [ñ].
END_VAR

VAR_OUTPUT // Âûõîäíûå ïåðåìåííûå, ñîõðàíÿåìûå.
Out :REAL := 0.0; // Âûõîäíîé ñèãíàë ïîñëå ôèëüòðàöèè.
END_VAR

VAR_TEMP // Âíóòðåííèå ïåðåìåííûå, íå ñîõðàíÿåìûå.
Tmp :REAL; // Âðåìåííàÿ ïåðåìåííàÿ âõîä èíòåãðàòîðà.
END_VAR

BEGIN

// Ôèëüòð àïåðèîäè÷åñêèé.
//      DbFilterA
//    +-----------+
//    | FbFilterA |
// ->-|In      Out|->-
//   -|Tf         |
//   -|Ts         |
//    +-----------+

// W(s) = 1 / (1 + Tf * s) ïðè Ts->0.
IF (Tf <= 0.0) THEN
Out := In;
ELSE
Tmp := (In - Out) / Tf;
Out := Out + Tmp * Ts;
END_IF;

// Âíóòðåííÿÿ ñõåìà ôèëüòðà.
//
//          Âû÷èòàíèå   Äåëåíèå      Èíòåãðèðîâàíèå
//            +---+     +------+     +----------+
// In ----->--| + |     |   1  | Tmp |  Ts * z  |
//            |   |-->--| ---- |-->--| -------- |--+-->-- Out
//      +-->--| - |     |  Tf  |     |   z - 1  |  |
//      |     +---+     +------+     +----------+  |
//      |                                          |
//      +------------------------------------------+

// Óñëîâíîå ãðàôè÷åñêîå îáîçíà÷åíèå (ïðèáëèæåííîå).
//
//    +--------------+
//    |      1       |
// ->-| ------------ |->-
//    |  Tf * s + 1  |
//    +--------------+

// Ýëåêòðè÷åñêàÿ ñõåìà ôèëüòðà.
//
//         R
// +    +-----+              +
// o----|     |----o---------o
//      +-----+    |
//                 | C
//               -----
// U In          -----   U Out
//                 |
// -               |         -
// o---------------o---------o
// Tf = R * C ([ñ] = [Îì] * [Ô])

// Âðåìåííàÿ õàðàêòåðèñòèêà.
//
// ^ Out
// |
// 1         *** Y(t) = 1 - exp(-(t/Tf))
// |      *
// |    *
// |  *
// | *
// 0---------------> t[s]
//
// ^ In
// |
// 1************ X(t) = 1
// |
// |
// |
// |
// 0---------------> t[s]

// @COPYLEFT ALL WRONGS RESERVED :)
// Author: VA
// Contacts: DIY.PLC.314@gmail.com
// Date start LIB_PLC: 2014
// License: GNU GPL-2.0-or-later
// https://www.gnu.org/licenses/old-licenses/gpl-2.0.html
// https://www.youtube.com/watch?v=n1F_MfLRlX0
// https://www.youtube.com/@DIY_PLC
// https://github.com/DIYPLC/LIB_PLC
// https://oshwlab.com/diy.plc.314/PLC_HW1_SW1
// https://3dtoday.ru/3d-models/mechanical-parts/body/korpus-na-din-reiku
// https://t.me/DIY_PLC

END_FUNCTION_BLOCK