LIB_PLC/FbSimMotorGear.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
FUNCTION_BLOCK "FbSimMotorGear"
TITLE = 'Âèðòóàëüíûé ÌÝÎ äëÿ îòëàäêè øàãîâîãî ðåãóëÿòîðà.'

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

AUTHOR  : VA
FAMILY  : LIB_PLC
VERSION : '0.2'

VAR_INPUT // Âõîäíûå ïåðåìåííûå, ñîõðàíÿåìûå.
CmdOpen   :BOOL := FALSE; // Êîìàíäà íà îòêðûòèå +.
CmdClose  :BOOL := FALSE; // Êîìàíäà íà çàêðûòèå -.
TimeOpen  :REAL := 60.0 ; // Âðåìÿ íåîáõîäèìîå äëÿ îòêðûòèÿ çàäâèæêè [ñ].
TimeClose :REAL := 50.0 ; // Âðåìÿ íåîáõîäèìîå äëÿ çàêðûòèÿ çàäâèæêè [ñ].
Ts        :REAL := 0.1  ; // Øàã äèñêðåòèçàöèè ïî âðåìåíè â ñåêóíäàõ.
Reset     :BOOL := FALSE; // Ñáðîñ ïðè ïåðåçàãðóçêå.
END_VAR

VAR_OUTPUT // Âûõîäíûå ïåðåìåííûå, ñîõðàíÿåìûå.
Position    :REAL := 0.0  ; // Ïîëîæåíèå øòîêà 0...100 [%].
SensorOpen  :BOOL := FALSE; // Äàò÷èê íà îòêðûòèå çàäâèæêè.
SensorClose :BOOL := FALSE; // Äàò÷èê íà çàêðûòèå çàäâèæêè.
END_VAR

VAR_TEMP  // Âðåìåííûå ïåðåìåííûå, íå ñîõðàíÿåìûå.
SpeedPos :REAL; // Ñêîðîñòü îòêðûòèÿ.
SpeedNeg :REAL; // Ñêîðîñòü çàêðûòèÿ.
END_VAR

BEGIN

// Âèðòóàëüíûé ÌÝÎ äëÿ îòëàäêè øàãîâîãî ðåãóëÿòîðà.
//           DbSimMotorGear
//    +--------------------------+
//    |      FbSimMotorGear      |
// ->-|CmdOpen           Position|->-
// ->-|CmdClose        SensorOpen|-
//   -|TimeOpen       SensorClose|-
//   -|TimeClose                 |
//   -|Ts                        |
//   -|Reset                     |
//    +--------------------------+

IF(Reset) THEN
Position := 0.0;
END_IF;

SpeedPos := 100.0 / TimeOpen ; //[%/s]
SpeedNeg := 100.0 / TimeClose; //[%/s]

IF(CmdOpen) THEN
Position := Position + SpeedPos * Ts; //[%]
END_IF;

IF(CmdClose) THEN
Position := Position - SpeedNeg * Ts; //[%]
END_IF;

IF(Position >= 100.0) THEN
Position := 100.0;
SensorOpen := TRUE;
ELSE
SensorOpen := FALSE;
END_IF;

IF(Position <= 0.0) THEN
Position := 0.0;
SensorClose := TRUE;
ELSE
SensorClose := FALSE;
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