LIB_PLC/FbDeriveF.SCL at main · DIYPLC/LIB_PLC · 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
111
112
113
114
115
116
117
118
FUNCTION_BLOCK "FbDeriveF"
TITLE = 'Ïðîèçâîäíàÿ ñ ôèëüòðîì.'

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

AUTHOR  : VA
FAMILY  : LIB_PLC
VERSION : '2.2'

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

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

VAR // Âíóòðåííèå ïåðåìåííûå, ñîõðàíÿåìûå.
Dintegral :REAL := 0.0; // Èíòåãðàòîð.
END_VAR

BEGIN

// Ïðîèçâîäíàÿ ñ ôèëüòðîì.
//      DbDeriveF
//    +-----------+
//    | FbDeriveF |
// ->-|In      Out|->-
//   -|Kdf        |
//   -|Ts         |
//    +-----------+

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

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

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

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

// Âðåìåííàÿ õàðàêòåðèñòèêà.
//
// ^ Out
// |
// 1*            Y(t) = 0 - 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
// https://drive.google.com/drive/folders/16GDX0i07rwDrl_oPzL-lQAqMiAz3ouJV?usp=sharing

END_FUNCTION_BLOCK