LIB_PLC/FbFilterNaN.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
FUNCTION_BLOCK "FbFilterNaN"
TITLE = 'Ôèëüòð NaN è Inf äëÿ ÷èñåë REAL.'

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

AUTHOR  : VA
FAMILY  : LIB_PLC
VERSION : '2.2'

VAR_INPUT // Âõîäíûå ïåðåìåííûå, ñîõðàíÿåìûå.
In       :REAL := 0.0; // Âõîä.
ErrValue :REAL := 0.0  ; // Çíà÷åíèå äëÿ Out ïðè íå êîððåêòíîì çíà÷åíèè íà âõîäå In.
END_VAR

VAR_OUTPUT // Âûõîäíûå ïåðåìåííûå, ñîõðàíÿåìûå.
Out :REAL := 0.0  ; // Âûõîä.
Err :BOOL := FALSE; // Ôëàã îøèáêè.
END_VAR

VAR // Âíóòðåííèå ïåðåìåííûå, ñîõðàíÿåìûå.
Flag_nan_1   :BOOL := FALSE ; // Ôëàã íå ÷èñëî ìåòîä 1, ïî ñòàíäàðòó IEEE 754.
Flag_nan_2   :BOOL := FALSE ; // Ôëàã íå ÷èñëî ìåòîä 2, êàê â GCC.
Flag_nan_3   :BOOL := FALSE ; // Ôëàã íå ÷èñëî ìåòîä 3, ìàòåìàòè÷åñêîå îïðåäåëåíèå.
Flag_pos_inf :BOOL := FALSE ; // Ôëàã ïëþñ áåñêîíå÷íîñòü, ìàòåìàòè÷åñêîå îïðåäåëåíèå.
Flag_neg_inf :BOOL := FALSE ; // Ôëàã ìèíóñ áåñêîíå÷íîñòü, ìàòåìàòè÷åñêîå îïðåäåëåíèå.
ZERO         :REAL := 0.0   ; // 0 CONST
END_VAR

BEGIN

// Ôèëüòð NaN è Inf äëÿ ÷èñåë REAL.
//      DbFilterNaN
//    +-------------+
//    | FbFilterNaN |
// ->-|In        Out|->-
//   -|ErrValue  Err|-
//    +-------------+

// Åñëè In==(NaN èëè Inf èëè -Inf) òî Out=0 èíà÷å Out=In.
// DW#16#7F800000=DW#2#01111111_10000000_00000000_00000000
// Ñòàíäàðò IEEE 754.
ZERO := 0.0;
Flag_nan_1   := ((REAL_TO_DWORD(In) AND DW#16#7F800000) = DW#16#7F800000);
Flag_nan_2   := (In <> In);
Flag_nan_3   := ((ZERO / ZERO) = In);
Flag_pos_inf := (( 1.0 / ZERO) = In);
Flag_neg_inf := ((-1.0 / ZERO) = In);

Err := Flag_nan_1 OR Flag_nan_2 OR Flag_nan_3 OR Flag_pos_inf OR Flag_neg_inf;

IF (Err) THEN
Out := ErrValue;
// Ïî óìîë÷àíèþ ïðè îøèáêå íà âûõîäå áóäèò 0.
// Åñëè õîòèì ïîêàçàòü ïîñëåäíåå çíà÷åíèå áåç îøèáêè òî,
// ïðè âûçîâå äàííîãî áëîêà ñäåëàòü ïåòëþ ñ âûõîäà íà òàê:
// DbFilterNaN1.ErrValue := DbFilterNaN1.Out
// DbFilterNaN1();
ELSE
// Øòàòíûé ðåæèì ðàáîòû áåç îøèáîê.
Out := In;
END_IF;

// @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