@litmusio/miravo-cli-darwin-arm64 0.0.0-stage → 0.15.9
This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.
- package/LICENSE +199 -0
- package/NOTICE +9 -0
- package/README.md +6 -2
- package/THIRD_PARTY_LICENSES.txt +15289 -0
- package/THIRD_PARTY_NOTICES.md +995 -0
- package/console-dist/assets/AnimatePresence-DWGUB15i.js +9 -0
- package/console-dist/assets/activity-DruTYzT1.js +1 -0
- package/console-dist/assets/api-13R-Szmo.js +57 -0
- package/console-dist/assets/arrow-up-right-DOENs04V.js +1 -0
- package/console-dist/assets/asset-detail-D142l0Fv.js +1 -0
- package/console-dist/assets/asset-detail-actions-Cf9kIXus.js +1 -0
- package/console-dist/assets/backup-power-B2I59W_p.js +1 -0
- package/console-dist/assets/badge-CdRB4Nd_.js +1 -0
- package/console-dist/assets/boiler-s_q0j7rz.js +1 -0
- package/console-dist/assets/by-path-BVKB6Tic.js +1 -0
- package/console-dist/assets/check-BTUv4z-H.js +1 -0
- package/console-dist/assets/chevron-down-CqA_2_CH.js +1 -0
- package/console-dist/assets/chevron-right-CVrgKBLR.js +1 -0
- package/console-dist/assets/chiller-r7DzAhJq.js +1 -0
- package/console-dist/assets/chunk-6KYCQHYJ-ga3Yekab.js +3 -0
- package/console-dist/assets/circle-x-BRkh0A1P.js +1 -0
- package/console-dist/assets/commercial-building-YWHjdNWm.js +1 -0
- package/console-dist/assets/compressor-ChZLMC94.js +1 -0
- package/console-dist/assets/console-panel-CnTkf-Zr.js +1 -0
- package/console-dist/assets/dialog-BYkdndf9.js +1 -0
- package/console-dist/assets/district-heating-DaU-3LzU.js +1 -0
- package/console-dist/assets/dom-BxZbg3NX.js +1 -0
- package/console-dist/assets/download-CvjDP5mu.js +1 -0
- package/console-dist/assets/fira-code-cyrillic-ext-wght-normal-DhYMMuQd.woff2 +0 -0
- package/console-dist/assets/fira-code-cyrillic-wght-normal-Y3u8pIsh.woff2 +0 -0
- package/console-dist/assets/fira-code-greek-ext-wght-normal-wWus70Ix.woff2 +0 -0
- package/console-dist/assets/fira-code-greek-wght-normal-B2SviObF.woff2 +0 -0
- package/console-dist/assets/fira-code-latin-ext-wght-normal-Dvfvaomy.woff2 +0 -0
- package/console-dist/assets/fira-code-latin-wght-normal-CHoedHDv.woff2 +0 -0
- package/console-dist/assets/fira-code-symbols2-wght-normal-CE6EOz_n.woff2 +0 -0
- package/console-dist/assets/floor-page-CiAcIxAW.js +1 -0
- package/console-dist/assets/floor-page-E-0txA4z.css +1 -0
- package/console-dist/assets/format-YLUJ7AXt.js +1 -0
- package/console-dist/assets/genset-C6_EUoFo.js +1 -0
- package/console-dist/assets/index-Cf8qRbyA.js +15 -0
- package/console-dist/assets/index-eZjXAdLh.css +2 -0
- package/console-dist/assets/loader-circle-w3T2fxvn.js +1 -0
- package/console-dist/assets/login-DP7gR4IQ.js +136 -0
- package/console-dist/assets/not-found-DeZnLH0i.js +1 -0
- package/console-dist/assets/pharma-cleanroom-DvWD_xsO.js +1 -0
- package/console-dist/assets/preload-helper-7y9sWmk5.js +1 -0
- package/console-dist/assets/react-DRt7cCXI.js +1 -0
- package/console-dist/assets/rolldown-runtime-BWaJ3C7D.js +1 -0
- package/console-dist/assets/rtu-ByogcRPI.js +1 -0
- package/console-dist/assets/runtime-link-D88Db2wY.js +1 -0
- package/console-dist/assets/schibsted-grotesk-latin-ext-wght-normal-hsMS0n0O.woff2 +0 -0
- package/console-dist/assets/schibsted-grotesk-latin-wght-normal-Bb8VGrTG.woff2 +0 -0
- package/console-dist/assets/server-B0q1NVkV.js +1 -0
- package/console-dist/assets/shallow-mIK1Qu8X.js +1 -0
- package/console-dist/assets/smart-factory-gfMWfMWM.js +1 -0
- package/console-dist/assets/source-host-miravo-BW-SKMTe.js +1 -0
- package/console-dist/assets/stages-EYRT12Yp.js +1 -0
- package/console-dist/assets/status-DQYLUbXs.js +1 -0
- package/console-dist/assets/tank-Btg5piqB.js +1 -0
- package/console-dist/assets/tooltip-Dfmuq2yz.js +1 -0
- package/console-dist/assets/trash-2-BAh5-hxl.js +1 -0
- package/console-dist/assets/triangle-alert-3Ab-dBrN.js +1 -0
- package/console-dist/assets/use-engine-command-mutation-BXSIzBAw.js +1 -0
- package/console-dist/assets/use-transition-navigate-COPPNZaw.js +2 -0
- package/console-dist/assets/useQuery-BbehJ-ez.js +1 -0
- package/console-dist/assets/utils-D6wrZy-b.js +1 -0
- package/console-dist/assets/validation-6JNiaZvb.js +1 -0
- package/console-dist/assets/vendor-charts-Bquh2dWE.js +56 -0
- package/console-dist/assets/vendor-table-5YnGQUhO.js +4 -0
- package/console-dist/assets/vendor-ui-BGeFlRLR.js +1 -0
- package/console-dist/assets/water-treatment-BkzNjsHx.js +1 -0
- package/console-dist/icon.png +0 -0
- package/console-dist/index.html +53 -0
- package/console-dist/miravo-logo.webp +0 -0
- package/licenses/EPL-2.0.txt +80 -0
- package/licenses/GCC-exception-3.1.txt +33 -0
- package/licenses/GPL-2.0-only.txt +117 -0
- package/licenses/GPL-3.0-only.txt +232 -0
- package/licenses/LGPL-2.1-only.txt +176 -0
- package/licenses/MPL-2.0.txt +373 -0
- package/licenses/OFL-1.1.txt +93 -0
- package/licenses/overrides/@headlessui+vue@1.7.23.txt +24 -0
- package/licenses/overrides/@next+env@16.4.6.txt +24 -0
- package/licenses/overrides/@radix-ui+react-compose-refs@1.1.2.txt +24 -0
- package/licenses/overrides/@radix-ui+react-context@1.1.2.txt +24 -0
- package/licenses/overrides/@radix-ui+react-direction@1.1.1.txt +24 -0
- package/licenses/overrides/@radix-ui+react-id@1.1.1.txt +24 -0
- package/licenses/overrides/@radix-ui+react-use-callback-ref@1.1.1.txt +24 -0
- package/licenses/overrides/@radix-ui+react-use-escape-keydown@1.1.1.txt +24 -0
- package/licenses/overrides/@radix-ui+react-use-layout-effect@1.1.1.txt +24 -0
- package/licenses/overrides/@radix-ui+react-use-rect@1.1.1.txt +24 -0
- package/licenses/overrides/@radix-ui+react-use-size@1.1.1.txt +24 -0
- package/licenses/overrides/@radix-ui+rect@1.1.1.txt +24 -0
- package/licenses/overrides/@replit+codemirror-css-color-picker@6.3.0.txt +6 -0
- package/licenses/overrides/@scalar+openapi-types@0.8.0.txt +24 -0
- package/licenses/overrides/@scalar+openapi-types@0.9.10.txt +24 -0
- package/licenses/overrides/@scalar+openapi-types@0.9.7.txt +24 -0
- package/licenses/overrides/@scalar+openapi-types@0.9.9.txt +24 -0
- package/licenses/overrides/@scalar+postman-to-openapi@0.7.1.txt +24 -0
- package/licenses/overrides/@scalar+schemas@0.19.0.txt +24 -0
- package/licenses/overrides/@scalar+workspace-store@0.46.3.txt +24 -0
- package/licenses/overrides/@scalar+workspace-store@0.75.0.txt +24 -0
- package/licenses/overrides/assert-plus@1.0.0.txt +24 -0
- package/licenses/overrides/client-only@0.0.1.txt +24 -0
- package/licenses/overrides/embla-carousel-react@8.6.0.txt +24 -0
- package/licenses/overrides/embla-carousel-reactive-utils@8.6.0.txt +24 -0
- package/licenses/overrides/embla-carousel@8.6.0.txt +24 -0
- package/licenses/overrides/fastdom@1.0.12.txt +12 -0
- package/licenses/overrides/precond@0.2.3.txt +22 -0
- package/licenses/overrides/react-remove-scroll-bar@2.3.8.txt +24 -0
- package/licenses/overrides/strictdom@1.0.1.txt +12 -0
- package/licenses/overrides/victory-vendor@36.9.2.txt +33 -0
- package/licenses/runtime/Bun-1.4.3-LICENSE.md +85 -0
- package/licenses/runtime/ICU-78.1-LICENSE.txt +568 -0
- package/licenses/runtime/bun-components/boringssl.txt +238 -0
- package/licenses/runtime/bun-components/brotli.txt +19 -0
- package/licenses/runtime/bun-components/c-ares.txt +24 -0
- package/licenses/runtime/bun-components/highway.txt +371 -0
- package/licenses/runtime/bun-components/libarchive.txt +65 -0
- package/licenses/runtime/bun-components/libbase64.txt +28 -0
- package/licenses/runtime/bun-components/libdeflate.txt +22 -0
- package/licenses/runtime/bun-components/libjpeg-turbo.txt +147 -0
- package/licenses/runtime/bun-components/libspng.txt +25 -0
- package/licenses/runtime/bun-components/libuv.txt +19 -0
- package/licenses/runtime/bun-components/libwebp.txt +30 -0
- package/licenses/runtime/bun-components/llvm.txt +311 -0
- package/licenses/runtime/bun-components/lol-html.txt +27 -0
- package/licenses/runtime/bun-components/ls-hpack.txt +21 -0
- package/licenses/runtime/bun-components/ls-qpack.txt +21 -0
- package/licenses/runtime/bun-components/lsquic-chrome.txt +32 -0
- package/licenses/runtime/bun-components/lsquic.txt +21 -0
- package/licenses/runtime/bun-components/mimalloc.txt +21 -0
- package/licenses/runtime/bun-components/picohttpparser.txt +24 -0
- package/licenses/runtime/bun-components/simdutf-apache.txt +201 -0
- package/licenses/runtime/bun-components/simdutf-mit.txt +18 -0
- package/licenses/runtime/bun-components/tigerbeetle.txt +177 -0
- package/licenses/runtime/bun-components/tinycc.txt +504 -0
- package/licenses/runtime/bun-components/typescript-go.txt +55 -0
- package/licenses/runtime/bun-components/usockets.txt +201 -0
- package/licenses/runtime/bun-components/uucode.txt +30 -0
- package/licenses/runtime/bun-components/uwebsockets.txt +201 -0
- package/licenses/runtime/bun-components/xxhash.txt +31 -0
- package/licenses/runtime/bun-components/zlib-ng.txt +19 -0
- package/licenses/runtime/bun-components/zstd-copying.txt +339 -0
- package/licenses/runtime/bun-components/zstd.txt +30 -0
- package/licenses/runtime/musl-1.2.6-COPYRIGHT.txt +193 -0
- package/miravo +4 -0
- package/native/S7-NOTICES.txt +11 -0
- package/native/miravo-s7.node +0 -0
- package/native/s7-source/CMakeLists.txt +23 -0
- package/native/s7-source/NODE-SNAP7-LICENSE +24 -0
- package/native/s7-source/addon.cpp +124 -0
- package/native/s7-source/bridge.cpp +150 -0
- package/native/s7-source/node-api-headers/LICENSE +21 -0
- package/native/s7-source/node-api-headers/include/js_native_api.h +591 -0
- package/native/s7-source/node-api-headers/include/js_native_api_types.h +213 -0
- package/native/s7-source/node-api-headers/include/node_api.h +265 -0
- package/native/s7-source/node-api-headers/include/node_api_types.h +58 -0
- package/native/s7-source/node-api-windows.h +78 -0
- package/native/s7-source/snap7/HISTORY.txt +277 -0
- package/native/s7-source/snap7/gpl.txt +674 -0
- package/native/s7-source/snap7/lgpl-3.0.txt +165 -0
- package/native/s7-source/snap7/src/core/miravo_request_validation.h +72 -0
- package/native/s7-source/snap7/src/core/s7_client.cpp +503 -0
- package/native/s7-source/snap7/src/core/s7_client.h +104 -0
- package/native/s7-source/snap7/src/core/s7_firmware.h +1256 -0
- package/native/s7-source/snap7/src/core/s7_isotcp.cpp +541 -0
- package/native/s7-source/snap7/src/core/s7_isotcp.h +271 -0
- package/native/s7-source/snap7/src/core/s7_micro_client.cpp +3328 -0
- package/native/s7-source/snap7/src/core/s7_micro_client.h +364 -0
- package/native/s7-source/snap7/src/core/s7_partner.cpp +1178 -0
- package/native/s7-source/snap7/src/core/s7_partner.h +284 -0
- package/native/s7-source/snap7/src/core/s7_peer.cpp +121 -0
- package/native/s7-source/snap7/src/core/s7_peer.h +58 -0
- package/native/s7-source/snap7/src/core/s7_server.cpp +2161 -0
- package/native/s7-source/snap7/src/core/s7_server.h +261 -0
- package/native/s7-source/snap7/src/core/s7_text.cpp +788 -0
- package/native/s7-source/snap7/src/core/s7_text.h +49 -0
- package/native/s7-source/snap7/src/core/s7_types.h +1066 -0
- package/native/s7-source/snap7/src/lib/snap7.def +129 -0
- package/native/s7-source/snap7/src/lib/snap7_libmain.cpp +1196 -0
- package/native/s7-source/snap7/src/lib/snap7_libmain.h +201 -0
- package/native/s7-source/snap7/src/sys/snap_msgsock.cpp +958 -0
- package/native/s7-source/snap7/src/sys/snap_msgsock.h +339 -0
- package/native/s7-source/snap7/src/sys/snap_platform.h +152 -0
- package/native/s7-source/snap7/src/sys/snap_sysutils.cpp +73 -0
- package/native/s7-source/snap7/src/sys/snap_sysutils.h +39 -0
- package/native/s7-source/snap7/src/sys/snap_tcpsrvr.cpp +487 -0
- package/native/s7-source/snap7/src/sys/snap_tcpsrvr.h +247 -0
- package/native/s7-source/snap7/src/sys/snap_threads.cpp +162 -0
- package/native/s7-source/snap7/src/sys/snap_threads.h +45 -0
- package/native/s7-source/snap7/src/sys/sol_threads.h +208 -0
- package/native/s7-source/snap7/src/sys/unix_threads.h +228 -0
- package/native/s7-source/snap7/src/sys/win_threads.h +159 -0
- package/nodesets/.ignore +1 -0
- package/nodesets/1.02/FTNIR.NodeSet2.xml +819 -0
- package/nodesets/1.02/Opc.Ua.Adi.NodeSet2.xml +8301 -0
- package/nodesets/1.02/Opc.Ua.Di.NodeSet2.xml +1785 -0
- package/nodesets/Opc.ISA95.NodeSet2.xml +3589 -0
- package/nodesets/Opc.Ua.AMB.NodeSet2.xml +1395 -0
- package/nodesets/Opc.Ua.Adi.NodeSet2.xml +8301 -0
- package/nodesets/Opc.Ua.Adi.Types.xsd +104 -0
- package/nodesets/Opc.Ua.AutoID.NodeSet2.xml +6062 -0
- package/nodesets/Opc.Ua.CNC.NodeSet.xml +15875 -0
- package/nodesets/Opc.Ua.CommercialKitchenEquipment.NodeSet2.xml +12096 -0
- package/nodesets/Opc.Ua.Di.NodeSet2.xml +6042 -0
- package/nodesets/Opc.Ua.Di.Types.xsd +161 -0
- package/nodesets/Opc.Ua.Eumabois.Nodeset2.xml +2483 -0
- package/nodesets/Opc.Ua.Gds.NodeSet2.xml +8282 -0
- package/nodesets/Opc.Ua.Glass.NodeSet2.xml +5100 -0
- package/nodesets/Opc.Ua.IA.NodeSet2.xml +1782 -0
- package/nodesets/Opc.Ua.IOLink.NodeSet2.xml +4374 -0
- package/nodesets/Opc.Ua.IOLinkIODD.NodeSet2.xml +139 -0
- package/nodesets/Opc.Ua.IRDI.NodeSet2.xml +2243 -0
- package/nodesets/Opc.Ua.Ijt.Base.NodeSet2.xml +19459 -0
- package/nodesets/Opc.Ua.Ijt.Tightening.NodeSet2.xml +883 -0
- package/nodesets/Opc.Ua.LADS.NodeSet2.xml +7086 -0
- package/nodesets/Opc.Ua.MachineTool.NodeSet2.xml +7884 -0
- package/nodesets/Opc.Ua.MachineVision.NodeSet2.xml +17324 -0
- package/nodesets/Opc.Ua.Machinery.Jobs.Nodeset2.xml +1249 -0
- package/nodesets/Opc.Ua.Machinery.NodeSet2.xml +2099 -0
- package/nodesets/Opc.Ua.Machinery.ProcessValues.NodeSet2.xml +1858 -0
- package/nodesets/Opc.Ua.Machinery_Result.NodeSet2.xml +2640 -0
- package/nodesets/Opc.Ua.MetalForming.NodeSet2.xml +1577 -0
- package/nodesets/Opc.Ua.NodeSet2.xml +81975 -0
- package/nodesets/Opc.Ua.PADIM.NodeSet2.xml +14131 -0
- package/nodesets/Opc.Ua.PackML.NodeSet2.xml +3030 -0
- package/nodesets/Opc.Ua.Robotics.NodeSet2.xml +7409 -0
- package/nodesets/Opc.Ua.Scales.NodeSet2.xml +15817 -0
- package/nodesets/Opc.Ua.Types.bsd +3499 -0
- package/nodesets/Opc.Ua.Weihenstephan.NodeSet2.xml +821 -0
- package/nodesets/Opc.Ua.Woodworking.NodeSet2.xml +17831 -0
- package/nodesets/UANodeSet.xsd +497 -0
- package/nodesets/opc.ua.isa95-jobcontrol.nodeset2.xml +4594 -0
- package/package.json +34 -4
|
@@ -0,0 +1,2161 @@
|
|
|
1
|
+
/*=============================================================================|
|
|
2
|
+
| PROJECT SNAP7 1.3.0 |
|
|
3
|
+
|==============================================================================|
|
|
4
|
+
| Copyright (C) 2013, 2015 Davide Nardella |
|
|
5
|
+
| All rights reserved. |
|
|
6
|
+
|==============================================================================|
|
|
7
|
+
| SNAP7 is free software: you can redistribute it and/or modify |
|
|
8
|
+
| it under the terms of the Lesser GNU General Public License as published by |
|
|
9
|
+
| the Free Software Foundation, either version 3 of the License, or |
|
|
10
|
+
| (at your option) any later version. |
|
|
11
|
+
| |
|
|
12
|
+
| It means that you can distribute your commercial software linked with |
|
|
13
|
+
| SNAP7 without the requirement to distribute the source code of your |
|
|
14
|
+
| application and without the requirement that your application be itself |
|
|
15
|
+
| distributed under LGPL. |
|
|
16
|
+
| |
|
|
17
|
+
| SNAP7 is distributed in the hope that it will be useful, |
|
|
18
|
+
| but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
|
19
|
+
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
|
20
|
+
| Lesser GNU General Public License for more details. |
|
|
21
|
+
| |
|
|
22
|
+
| You should have received a copy of the GNU General Public License and a |
|
|
23
|
+
| copy of Lesser GNU General Public License along with Snap7. |
|
|
24
|
+
| If not, see http://www.gnu.org/licenses/ |
|
|
25
|
+
|=============================================================================*/
|
|
26
|
+
#include "s7_server.h"
|
|
27
|
+
#include "s7_firmware.h"
|
|
28
|
+
|
|
29
|
+
const byte BitMask[8] = {0x01,0x02,0x04,0x08,0x10,0x20,0x40,0x80};
|
|
30
|
+
|
|
31
|
+
//------------------------------------------------------------------------------
|
|
32
|
+
// ISO/TCP WORKER CLASS
|
|
33
|
+
//------------------------------------------------------------------------------
|
|
34
|
+
bool TIsoTcpWorker::IsoPerformCommand(int &Size)
|
|
35
|
+
{
|
|
36
|
+
return true;
|
|
37
|
+
}
|
|
38
|
+
//---------------------------------------------------------------------------
|
|
39
|
+
bool TIsoTcpWorker::ExecuteSend()
|
|
40
|
+
{
|
|
41
|
+
return true;
|
|
42
|
+
}
|
|
43
|
+
//---------------------------------------------------------------------------
|
|
44
|
+
bool TIsoTcpWorker::ExecuteRecv()
|
|
45
|
+
{
|
|
46
|
+
TPDUKind PduKind;
|
|
47
|
+
int PayloadSize;
|
|
48
|
+
|
|
49
|
+
if (CanRead(WorkInterval)) // should be Small to avoid time wait during the close
|
|
50
|
+
{
|
|
51
|
+
isoRecvPDU(&PDU);
|
|
52
|
+
if (LastTcpError==0)
|
|
53
|
+
{
|
|
54
|
+
IsoPeek(&PDU,PduKind);
|
|
55
|
+
// First check valid data incoming (most likely situation)
|
|
56
|
+
if (PduKind==pkValidData)
|
|
57
|
+
{
|
|
58
|
+
PayloadSize=PDUSize(&PDU)-DataHeaderSize;
|
|
59
|
+
return IsoPerformCommand(PayloadSize);
|
|
60
|
+
};
|
|
61
|
+
// Connection request incoming
|
|
62
|
+
if (PduKind==pkConnectionRequest)
|
|
63
|
+
{
|
|
64
|
+
IsoConfirmConnection(pdu_type_CC); // <- Connection confirm
|
|
65
|
+
return LastTcpError!=WSAECONNRESET;
|
|
66
|
+
};
|
|
67
|
+
// Disconnect request incoming (only for isotcp full complient equipment, not S7)
|
|
68
|
+
if (PduKind==pkDisconnectRequest)
|
|
69
|
+
{
|
|
70
|
+
IsoConfirmConnection(pdu_type_DC); // <- Disconnect confirm
|
|
71
|
+
return false;
|
|
72
|
+
};
|
|
73
|
+
// Empty fragment, maybe an ACK
|
|
74
|
+
if (PduKind==pkEmptyFragment)
|
|
75
|
+
{
|
|
76
|
+
PayloadSize=0;
|
|
77
|
+
return IsoPerformCommand(PayloadSize);
|
|
78
|
+
};
|
|
79
|
+
// Valid PDU format but we have to discard it
|
|
80
|
+
if (PduKind==pkUnrecognizedType)
|
|
81
|
+
{
|
|
82
|
+
return LastTcpError!=WSAECONNRESET;
|
|
83
|
+
};
|
|
84
|
+
// Here we have an Invalid PDU
|
|
85
|
+
Purge();
|
|
86
|
+
return true;
|
|
87
|
+
}
|
|
88
|
+
else
|
|
89
|
+
return LastTcpError!=WSAECONNRESET;
|
|
90
|
+
}
|
|
91
|
+
else
|
|
92
|
+
return true;
|
|
93
|
+
}
|
|
94
|
+
//---------------------------------------------------------------------------
|
|
95
|
+
bool TIsoTcpWorker::Execute()
|
|
96
|
+
{
|
|
97
|
+
return ExecuteSend() && ExecuteRecv();
|
|
98
|
+
}
|
|
99
|
+
//------------------------------------------------------------------------------
|
|
100
|
+
// S7 WORKER CLASS
|
|
101
|
+
//------------------------------------------------------------------------------
|
|
102
|
+
TS7Worker::TS7Worker()
|
|
103
|
+
{
|
|
104
|
+
// We skip RFC/ISO header, our PDU is the payload
|
|
105
|
+
PDUH_in =PS7ReqHeader(&PDU.Payload);
|
|
106
|
+
FPDULength=2048;
|
|
107
|
+
DBCnt =0;
|
|
108
|
+
LastBlk =Block_DB;
|
|
109
|
+
}
|
|
110
|
+
|
|
111
|
+
bool TS7Worker::ExecuteRecv()
|
|
112
|
+
{
|
|
113
|
+
WorkInterval=FServer->WorkInterval;
|
|
114
|
+
return TIsoTcpWorker::ExecuteRecv();
|
|
115
|
+
}
|
|
116
|
+
//------------------------------------------------------------------------------
|
|
117
|
+
#include "miravo_request_validation.h"
|
|
118
|
+
bool TS7Worker::CheckPDU_in(int PayloadSize)
|
|
119
|
+
{
|
|
120
|
+
if (!miravo_s7_validate_packet(reinterpret_cast<const uint8_t*>(PDUH_in), PayloadSize, FPDULength)) return false;
|
|
121
|
+
// Checks the size : packet size must match with header infos
|
|
122
|
+
int Size=SwapWord(PDUH_in->ParLen)+SwapWord(PDUH_in->DataLen)+ReqHeaderSize;
|
|
123
|
+
if (Size!=PayloadSize)
|
|
124
|
+
return false;
|
|
125
|
+
// Checks PDUType : must be 1 or 7
|
|
126
|
+
if ((PDUH_in->PDUType!=PduType_request) &&
|
|
127
|
+
(PDUH_in->PDUType!=PduType_userdata))
|
|
128
|
+
return false;
|
|
129
|
+
else
|
|
130
|
+
return true;
|
|
131
|
+
}
|
|
132
|
+
//------------------------------------------------------------------------------
|
|
133
|
+
byte TS7Worker::BCD(word Value)
|
|
134
|
+
{
|
|
135
|
+
return ((Value / 10) << 4) + (Value % 10);
|
|
136
|
+
}
|
|
137
|
+
//------------------------------------------------------------------------------
|
|
138
|
+
void TS7Worker::FillTime(PS7Time PTime)
|
|
139
|
+
{
|
|
140
|
+
time_t Now;
|
|
141
|
+
time(&Now);
|
|
142
|
+
struct tm *DT = localtime (&Now);
|
|
143
|
+
|
|
144
|
+
PTime->bcd_year=BCD(DT->tm_year-100);
|
|
145
|
+
PTime->bcd_mon =BCD(DT->tm_mon+1);
|
|
146
|
+
PTime->bcd_day =BCD(DT->tm_mday);
|
|
147
|
+
PTime->bcd_hour=BCD(DT->tm_hour);
|
|
148
|
+
PTime->bcd_min =BCD(DT->tm_min);
|
|
149
|
+
PTime->bcd_sec =BCD(DT->tm_sec);
|
|
150
|
+
PTime->bcd_himsec=0;
|
|
151
|
+
PTime->bcd_dow =BCD(DT->tm_wday);
|
|
152
|
+
}
|
|
153
|
+
//------------------------------------------------------------------------------
|
|
154
|
+
void TS7Worker::DoEvent(longword Code, word RetCode, word Param1, word Param2,
|
|
155
|
+
word Param3, word Param4)
|
|
156
|
+
{
|
|
157
|
+
FServer->DoEvent(ClientHandle,Code,RetCode,Param1,Param2,Param3,Param4);
|
|
158
|
+
}
|
|
159
|
+
//------------------------------------------------------------------------------
|
|
160
|
+
void TS7Worker::DoReadEvent(longword Code, word RetCode, word Param1, word Param2,
|
|
161
|
+
word Param3, word Param4)
|
|
162
|
+
{
|
|
163
|
+
FServer->DoReadEvent(ClientHandle,Code,RetCode,Param1,Param2,Param3,Param4);
|
|
164
|
+
}
|
|
165
|
+
//------------------------------------------------------------------------------
|
|
166
|
+
void TS7Worker::FragmentSkipped(int Size)
|
|
167
|
+
{
|
|
168
|
+
// do nothing could be used for debug purpose
|
|
169
|
+
}
|
|
170
|
+
//------------------------------------------------------------------------------
|
|
171
|
+
bool TS7Worker::IsoPerformCommand(int &Size)
|
|
172
|
+
{
|
|
173
|
+
// Checks for Ack fragment
|
|
174
|
+
if (Size==0)
|
|
175
|
+
return PerformPDUAck(Size);
|
|
176
|
+
// First checks PDU consistence
|
|
177
|
+
if (CheckPDU_in(Size))
|
|
178
|
+
{
|
|
179
|
+
switch (PDUH_in->PDUType)
|
|
180
|
+
{
|
|
181
|
+
case PduType_request : return PerformPDURequest(Size);
|
|
182
|
+
case PduType_userdata : return PerformPDUUsrData(Size);
|
|
183
|
+
}
|
|
184
|
+
}
|
|
185
|
+
else
|
|
186
|
+
DoEvent(evcPDUincoming, evrMalformedPDU, Size, 0, 0, 0);
|
|
187
|
+
return false;
|
|
188
|
+
}
|
|
189
|
+
//------------------------------------------------------------------------------
|
|
190
|
+
bool TS7Worker::PerformPDUAck(int &Size)
|
|
191
|
+
{
|
|
192
|
+
// here we could keep track of ack empty fragment for debug purpose
|
|
193
|
+
return true;
|
|
194
|
+
}
|
|
195
|
+
//------------------------------------------------------------------------------
|
|
196
|
+
bool TS7Worker::PerformPDURequest(int &Size)
|
|
197
|
+
{
|
|
198
|
+
pbyte P;
|
|
199
|
+
byte PDUFun;
|
|
200
|
+
bool Result = true;
|
|
201
|
+
|
|
202
|
+
// We have to store PDUfun since it will be overwritten
|
|
203
|
+
P = pbyte(PDUH_in)+ReqHeaderSize;
|
|
204
|
+
PDUFun=*P;
|
|
205
|
+
// Watches the function
|
|
206
|
+
switch (PDUFun)
|
|
207
|
+
{
|
|
208
|
+
case pduFuncRead : Result=PerformFunctionRead();
|
|
209
|
+
break;
|
|
210
|
+
case pduFuncWrite : Result=PerformFunctionWrite();
|
|
211
|
+
break;
|
|
212
|
+
case pduNegotiate : Result=PerformFunctionNegotiate();
|
|
213
|
+
break;
|
|
214
|
+
case pduStart :
|
|
215
|
+
case pduStop : Result=PerformFunctionControl(PDUFun);
|
|
216
|
+
break;
|
|
217
|
+
case pduStartUpload :
|
|
218
|
+
case pduUpload :
|
|
219
|
+
case pduEndUpload : Result=PerformFunctionUpload();
|
|
220
|
+
break;
|
|
221
|
+
case pduReqDownload : Result=PerformFunctionDownload();
|
|
222
|
+
break;
|
|
223
|
+
// <-- Further (custom) functions can be added here
|
|
224
|
+
default:
|
|
225
|
+
DoEvent(evcPDUincoming, evrCannotHandlePDU, Size, 0, 0, 0);
|
|
226
|
+
};
|
|
227
|
+
return Result;
|
|
228
|
+
}
|
|
229
|
+
//------------------------------------------------------------------------------
|
|
230
|
+
bool TS7Worker::PerformPDUUsrData(int &Size)
|
|
231
|
+
{
|
|
232
|
+
PS7ReqParams7 ReqParams;
|
|
233
|
+
byte Tg, SubFun;
|
|
234
|
+
bool Result = true;
|
|
235
|
+
// Set Pointer to request params
|
|
236
|
+
ReqParams=PS7ReqParams7(pbyte(PDUH_in)+ReqHeaderSize);
|
|
237
|
+
Tg=ReqParams->Tg;
|
|
238
|
+
SubFun=ReqParams->SubFun;
|
|
239
|
+
// Switch type_group
|
|
240
|
+
switch (Tg)
|
|
241
|
+
{
|
|
242
|
+
case grProgrammer : Result=PerformGroupProgrammer();
|
|
243
|
+
break;
|
|
244
|
+
case grCyclicData : Result=PerformGroupCyclicData();
|
|
245
|
+
break;
|
|
246
|
+
case grBlocksInfo : Result=PerformGroupBlockInfo();
|
|
247
|
+
break;
|
|
248
|
+
case grSZL : Result=PerformGroupSZL();
|
|
249
|
+
break;
|
|
250
|
+
case grPassword : Result=PerformGroupSecurity();
|
|
251
|
+
break;
|
|
252
|
+
case grClock : switch (SubFun)
|
|
253
|
+
{
|
|
254
|
+
case 0x01 : Result=PerformGetClock();
|
|
255
|
+
break;
|
|
256
|
+
case 0x02 : Result=PerformSetClock();
|
|
257
|
+
break;
|
|
258
|
+
};
|
|
259
|
+
break;
|
|
260
|
+
default:
|
|
261
|
+
DoEvent(evcPDUincoming, evrInvalidGroupUData, Tg, 0, 0, 0);
|
|
262
|
+
};
|
|
263
|
+
return Result;
|
|
264
|
+
}
|
|
265
|
+
//------------------------------------------------------------------------------
|
|
266
|
+
int TS7Worker::DataSizeByte(int WordLength)
|
|
267
|
+
{
|
|
268
|
+
switch (WordLength){
|
|
269
|
+
case S7WLBit : return 1; // S7 sends 1 byte per bit
|
|
270
|
+
case S7WLByte : return 1;
|
|
271
|
+
case S7WLChar : return 1;
|
|
272
|
+
case S7WLWord : return 2;
|
|
273
|
+
case S7WLDWord : return 4;
|
|
274
|
+
case S7WLInt : return 2;
|
|
275
|
+
case S7WLDInt : return 4;
|
|
276
|
+
case S7WLReal : return 4;
|
|
277
|
+
case S7WLCounter : return 2;
|
|
278
|
+
case S7WLTimer : return 2;
|
|
279
|
+
default : return 0;
|
|
280
|
+
}
|
|
281
|
+
}
|
|
282
|
+
//==============================================================================
|
|
283
|
+
// FUNCTION READ
|
|
284
|
+
//==============================================================================
|
|
285
|
+
word TS7Worker::RA_NotFound(PResFunReadItem ResItem, TEv &EV)
|
|
286
|
+
{
|
|
287
|
+
ResItem->DataLength=SwapWord(0x0004);
|
|
288
|
+
ResItem->ReturnCode=Code7ResItemNotAvailable;
|
|
289
|
+
ResItem->TransportSize=0x00;
|
|
290
|
+
EV.EvRetCode=evrErrAreaNotFound;
|
|
291
|
+
return 0;
|
|
292
|
+
}
|
|
293
|
+
//------------------------------------------------------------------------------
|
|
294
|
+
word TS7Worker::RA_OutOfRange(PResFunReadItem ResItem, TEv &EV)
|
|
295
|
+
{
|
|
296
|
+
ResItem->DataLength=SwapWord(0x0004);
|
|
297
|
+
ResItem->ReturnCode=Code7AddressOutOfRange;
|
|
298
|
+
ResItem->TransportSize=0x00;
|
|
299
|
+
EV.EvRetCode=evrErrOutOfRange;
|
|
300
|
+
return 0;
|
|
301
|
+
}
|
|
302
|
+
//------------------------------------------------------------------------------
|
|
303
|
+
word TS7Worker::RA_SizeOverPDU(PResFunReadItem ResItem, TEv &EV)
|
|
304
|
+
{
|
|
305
|
+
ResItem->DataLength=SwapWord(0x0004);
|
|
306
|
+
ResItem->ReturnCode=byte(SwapWord(Code7DataOverPDU));
|
|
307
|
+
ResItem->TransportSize=0x00;
|
|
308
|
+
EV.EvRetCode=evrErrOverPDU;
|
|
309
|
+
return 0;
|
|
310
|
+
}
|
|
311
|
+
//------------------------------------------------------------------------------
|
|
312
|
+
PS7Area TS7Worker::GetArea(byte S7Code, word index)
|
|
313
|
+
{
|
|
314
|
+
switch(S7Code)
|
|
315
|
+
{
|
|
316
|
+
case S7AreaPE : return FServer->HA[srvAreaPE];
|
|
317
|
+
case S7AreaPA : return FServer->HA[srvAreaPA];
|
|
318
|
+
case S7AreaMK : return FServer->HA[srvAreaMK];
|
|
319
|
+
case S7AreaCT : return FServer->HA[srvAreaCT];
|
|
320
|
+
case S7AreaTM : return FServer->HA[srvAreaTM];
|
|
321
|
+
case S7AreaDB : return FServer->FindDB(index);
|
|
322
|
+
default : return NULL;
|
|
323
|
+
};
|
|
324
|
+
}
|
|
325
|
+
//------------------------------------------------------------------------------
|
|
326
|
+
word TS7Worker::ReadArea(PResFunReadItem ResItemData, PReqFunReadItem ReqItemPar,
|
|
327
|
+
int &PDURemainder, TEv &EV)
|
|
328
|
+
{
|
|
329
|
+
PS7Area P;
|
|
330
|
+
word DBNum = 0;
|
|
331
|
+
word Elements;
|
|
332
|
+
longword Start, Size, ASize, AStart;
|
|
333
|
+
longword *PAdd;
|
|
334
|
+
byte BitIndex, ByteVal;
|
|
335
|
+
int Multiplier;
|
|
336
|
+
void *Source = NULL;
|
|
337
|
+
PSnapCriticalSection pcs;
|
|
338
|
+
|
|
339
|
+
P=NULL;
|
|
340
|
+
EV.EvStart =0;
|
|
341
|
+
EV.EvSize =0;
|
|
342
|
+
EV.EvRetCode =0;
|
|
343
|
+
EV.EvIndex =0;
|
|
344
|
+
|
|
345
|
+
EV.EvArea=ReqItemPar->Area;
|
|
346
|
+
// Get Pointer to selected Area
|
|
347
|
+
|
|
348
|
+
if (ReqItemPar->Area==S7AreaDB)
|
|
349
|
+
{
|
|
350
|
+
DBNum=SwapWord(ReqItemPar->DBNumber);
|
|
351
|
+
EV.EvIndex=DBNum;
|
|
352
|
+
};
|
|
353
|
+
|
|
354
|
+
if (!FServer->ResourceLess)
|
|
355
|
+
{
|
|
356
|
+
P = GetArea(ReqItemPar->Area, DBNum);
|
|
357
|
+
if (P == NULL)
|
|
358
|
+
return RA_NotFound(ResItemData, EV);
|
|
359
|
+
}
|
|
360
|
+
|
|
361
|
+
// Calcs the amount
|
|
362
|
+
Multiplier = DataSizeByte(ReqItemPar->TransportSize);
|
|
363
|
+
if (Multiplier==0)
|
|
364
|
+
return RA_OutOfRange(ResItemData, EV);
|
|
365
|
+
|
|
366
|
+
// Checks timers/counters coherence
|
|
367
|
+
if ((ReqItemPar->Area==S7AreaTM) ^ (ReqItemPar->TransportSize==S7WLTimer))
|
|
368
|
+
return RA_OutOfRange(ResItemData, EV);
|
|
369
|
+
|
|
370
|
+
if ((ReqItemPar->Area==S7AreaCT) ^ (ReqItemPar->TransportSize==S7WLCounter))
|
|
371
|
+
return RA_OutOfRange(ResItemData, EV);
|
|
372
|
+
|
|
373
|
+
// Calcs size
|
|
374
|
+
Elements = SwapWord(ReqItemPar->Length);
|
|
375
|
+
Size=Multiplier*Elements;
|
|
376
|
+
EV.EvSize=Size;
|
|
377
|
+
|
|
378
|
+
// The sum of the items must not exceed the PDU size negotiated
|
|
379
|
+
if (PDURemainder-Size<=0)
|
|
380
|
+
return RA_SizeOverPDU(ResItemData, EV);
|
|
381
|
+
else
|
|
382
|
+
PDURemainder-=Size;
|
|
383
|
+
|
|
384
|
+
// More then 1 bit is not supported by S7 CPU
|
|
385
|
+
if ((ReqItemPar->TransportSize==S7WLBit) && (Size>1))
|
|
386
|
+
return RA_OutOfRange(ResItemData, EV);
|
|
387
|
+
|
|
388
|
+
// Calcs the start point
|
|
389
|
+
PAdd=(longword*)(&ReqItemPar->Area); // points to area since we need 4 bytes for a pointer
|
|
390
|
+
Start=SwapDWord(*PAdd & 0xFFFFFF00);
|
|
391
|
+
|
|
392
|
+
// Checks if the address is not multiple of 8 when transport size is neither bit nor timer nor counter
|
|
393
|
+
if (
|
|
394
|
+
(ReqItemPar->TransportSize!=S7WLBit) &&
|
|
395
|
+
(ReqItemPar->TransportSize!=S7WLTimer) &&
|
|
396
|
+
(ReqItemPar->TransportSize!=S7WLCounter) &&
|
|
397
|
+
((Start % 8) !=0)
|
|
398
|
+
)
|
|
399
|
+
return RA_OutOfRange(ResItemData, EV);
|
|
400
|
+
|
|
401
|
+
// AStart is only for callback
|
|
402
|
+
if ((ReqItemPar->TransportSize != S7WLBit) && (ReqItemPar->TransportSize != S7WLCounter) && (ReqItemPar->TransportSize != S7WLTimer))
|
|
403
|
+
AStart = Start >> 3;
|
|
404
|
+
else
|
|
405
|
+
AStart = Start;
|
|
406
|
+
|
|
407
|
+
if ((ReqItemPar->TransportSize == S7WLCounter) || (ReqItemPar->TransportSize == S7WLTimer))
|
|
408
|
+
{
|
|
409
|
+
Start = Start >> 1; // 1 Timer or Counter = 2 bytes
|
|
410
|
+
}
|
|
411
|
+
else
|
|
412
|
+
{
|
|
413
|
+
BitIndex =Start & 0x07; // start bit
|
|
414
|
+
Start =Start >> 3; // start byte
|
|
415
|
+
}
|
|
416
|
+
|
|
417
|
+
EV.EvStart=Start;
|
|
418
|
+
|
|
419
|
+
// Checks bounds
|
|
420
|
+
if (!FServer->ResourceLess)
|
|
421
|
+
{
|
|
422
|
+
ASize = P->Size; // Area size
|
|
423
|
+
if (Start + Size > ASize)
|
|
424
|
+
return RA_OutOfRange(ResItemData, EV);
|
|
425
|
+
Source = P->PData + Start;
|
|
426
|
+
}
|
|
427
|
+
|
|
428
|
+
// Read Event (before copy data)
|
|
429
|
+
DoReadEvent(evcDataRead,0,EV.EvArea,EV.EvIndex,EV.EvStart,EV.EvSize);
|
|
430
|
+
|
|
431
|
+
if (FServer->ResourceLess)
|
|
432
|
+
{
|
|
433
|
+
memset(&ResItemData->Data, 0, Size);
|
|
434
|
+
if (!FServer->DoReadArea(ClientHandle, EV.EvArea, EV.EvIndex, AStart, Elements, ReqItemPar->TransportSize, &ResItemData->Data))
|
|
435
|
+
return RA_NotFound(ResItemData, EV);
|
|
436
|
+
}
|
|
437
|
+
else
|
|
438
|
+
{
|
|
439
|
+
// Lock the area
|
|
440
|
+
pcs = P->cs;
|
|
441
|
+
pcs->Enter();
|
|
442
|
+
// Get Data
|
|
443
|
+
memcpy(&ResItemData->Data, Source, Size);
|
|
444
|
+
// Unlock the area
|
|
445
|
+
pcs->Leave();
|
|
446
|
+
}
|
|
447
|
+
|
|
448
|
+
ResItemData->ReturnCode=0xFF;
|
|
449
|
+
// Set Result transport size and, for bit, performs the mask
|
|
450
|
+
switch (ReqItemPar->TransportSize)
|
|
451
|
+
{
|
|
452
|
+
case S7WLBit:
|
|
453
|
+
{
|
|
454
|
+
ByteVal=ResItemData->Data[0];
|
|
455
|
+
|
|
456
|
+
if ((ByteVal & BitMask[BitIndex])!=0)
|
|
457
|
+
ResItemData->Data[0]=0x01;
|
|
458
|
+
else
|
|
459
|
+
ResItemData->Data[0]=0x00;
|
|
460
|
+
|
|
461
|
+
ResItemData->TransportSize=TS_ResBit;
|
|
462
|
+
ResItemData->DataLength=SwapWord(Size);
|
|
463
|
+
};break;
|
|
464
|
+
case S7WLByte:
|
|
465
|
+
case S7WLWord:
|
|
466
|
+
case S7WLDWord:
|
|
467
|
+
{
|
|
468
|
+
ResItemData->TransportSize=TS_ResByte;
|
|
469
|
+
ResItemData->DataLength=SwapWord(Size*8);
|
|
470
|
+
};break;
|
|
471
|
+
case S7WLInt:
|
|
472
|
+
case S7WLDInt:
|
|
473
|
+
{
|
|
474
|
+
ResItemData->TransportSize=TS_ResInt;
|
|
475
|
+
ResItemData->DataLength=SwapWord(Size*8);
|
|
476
|
+
};break;
|
|
477
|
+
case S7WLReal:
|
|
478
|
+
{
|
|
479
|
+
ResItemData->TransportSize=TS_ResReal;
|
|
480
|
+
ResItemData->DataLength=SwapWord(Size);
|
|
481
|
+
};break;
|
|
482
|
+
case S7WLChar:
|
|
483
|
+
case S7WLTimer:
|
|
484
|
+
case S7WLCounter:
|
|
485
|
+
{
|
|
486
|
+
ResItemData->TransportSize=TS_ResOctet;
|
|
487
|
+
ResItemData->DataLength=SwapWord(Size);
|
|
488
|
+
};break;
|
|
489
|
+
default :
|
|
490
|
+
{
|
|
491
|
+
ResItemData->TransportSize=TS_ResByte;
|
|
492
|
+
ResItemData->DataLength=SwapWord(Size*8);
|
|
493
|
+
};break;
|
|
494
|
+
}
|
|
495
|
+
EV.EvRetCode=evrNoError;
|
|
496
|
+
return Size;
|
|
497
|
+
}
|
|
498
|
+
//------------------------------------------------------------------------------
|
|
499
|
+
bool TS7Worker::PerformFunctionRead()
|
|
500
|
+
{
|
|
501
|
+
PReqFunReadParams ReqParams;
|
|
502
|
+
PResFunReadParams ResParams;
|
|
503
|
+
TResFunReadData ResData;
|
|
504
|
+
TS7Answer23 Answer;
|
|
505
|
+
uintptr_t Offset;
|
|
506
|
+
word ItemSize;
|
|
507
|
+
int ItemsCount, c,
|
|
508
|
+
TotalSize,
|
|
509
|
+
PDURemainder;
|
|
510
|
+
TEv EV;
|
|
511
|
+
|
|
512
|
+
PDURemainder=FPDULength;
|
|
513
|
+
// Stage 1 : Setup pointers and initial check
|
|
514
|
+
ReqParams=PReqFunReadParams(pbyte(PDUH_in)+sizeof(TS7ReqHeader));
|
|
515
|
+
ResParams=PResFunReadParams(pbyte(&Answer)+ResHeaderSize23); // Params after the header
|
|
516
|
+
|
|
517
|
+
// trunk to 20 max items.
|
|
518
|
+
if (ReqParams->ItemsCount>MaxVars)
|
|
519
|
+
ReqParams->ItemsCount=MaxVars;
|
|
520
|
+
|
|
521
|
+
ItemsCount=ReqParams->ItemsCount;
|
|
522
|
+
|
|
523
|
+
// Stage 2 : gather data
|
|
524
|
+
Offset=sizeof(TResFunReadParams); // = 2
|
|
525
|
+
|
|
526
|
+
for (c = 0; c < ItemsCount; c++)
|
|
527
|
+
{
|
|
528
|
+
ResData[c]=PResFunReadItem(pbyte(ResParams)+Offset);
|
|
529
|
+
ItemSize=ReadArea(ResData[c],&ReqParams->Items[c],PDURemainder, EV);
|
|
530
|
+
|
|
531
|
+
// S7 doesn't xfer odd byte amount
|
|
532
|
+
if ((c<ItemsCount-1) && (ItemSize % 2 != 0))
|
|
533
|
+
ItemSize++;
|
|
534
|
+
|
|
535
|
+
Offset+=(ItemSize+4);
|
|
536
|
+
// For multiple items we have to create multiple events
|
|
537
|
+
if (ItemsCount>1)
|
|
538
|
+
DoEvent(evcDataRead,EV.EvRetCode,EV.EvArea,EV.EvIndex,EV.EvStart,EV.EvSize);
|
|
539
|
+
}
|
|
540
|
+
// Stage 3 : finalize the answer and send the packet
|
|
541
|
+
Answer.Header.P=0x32;
|
|
542
|
+
Answer.Header.PDUType=0x03;
|
|
543
|
+
Answer.Header.AB_EX=0x0000;
|
|
544
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
545
|
+
Answer.Header.ParLen=SwapWord(sizeof(TResFunReadParams));
|
|
546
|
+
Answer.Header.Error=0x0000; // this is zero, we will find the error in ResData.ReturnCode
|
|
547
|
+
Answer.Header.DataLen=SwapWord(word(Offset)-2);
|
|
548
|
+
|
|
549
|
+
ResParams->FunRead =ReqParams->FunRead;
|
|
550
|
+
ResParams->ItemCount=ReqParams->ItemsCount;
|
|
551
|
+
|
|
552
|
+
TotalSize=ResHeaderSize23+int(Offset);
|
|
553
|
+
isoSendBuffer(&Answer, TotalSize);
|
|
554
|
+
|
|
555
|
+
// For single item (most likely case) it's better to work with the event after
|
|
556
|
+
// we sent the answer
|
|
557
|
+
if (ItemsCount==1)
|
|
558
|
+
DoEvent(evcDataRead,EV.EvRetCode,EV.EvArea,EV.EvIndex,EV.EvStart,EV.EvSize);
|
|
559
|
+
|
|
560
|
+
return true;
|
|
561
|
+
}
|
|
562
|
+
//==============================================================================
|
|
563
|
+
// FUNCTION WRITE
|
|
564
|
+
//==============================================================================
|
|
565
|
+
byte TS7Worker::WA_NotFound(TEv &EV)
|
|
566
|
+
{
|
|
567
|
+
EV.EvRetCode=evrErrAreaNotFound;
|
|
568
|
+
return Code7ResItemNotAvailable;
|
|
569
|
+
}
|
|
570
|
+
//------------------------------------------------------------------------------
|
|
571
|
+
byte TS7Worker::WA_InvalidTransportSize(TEv &EV)
|
|
572
|
+
{
|
|
573
|
+
EV.EvRetCode=evrErrTransportSize;
|
|
574
|
+
return Code7InvalidTransportSize;
|
|
575
|
+
}
|
|
576
|
+
//------------------------------------------------------------------------------
|
|
577
|
+
byte TS7Worker::WA_OutOfRange(TEv &EV)
|
|
578
|
+
{
|
|
579
|
+
EV.EvRetCode=evrErrOutOfRange;
|
|
580
|
+
return Code7AddressOutOfRange;
|
|
581
|
+
}
|
|
582
|
+
//------------------------------------------------------------------------------
|
|
583
|
+
byte TS7Worker::WA_DataSizeMismatch(TEv &EV)
|
|
584
|
+
{
|
|
585
|
+
EV.EvRetCode=evrDataSizeMismatch;
|
|
586
|
+
return Code7WriteDataSizeMismatch;
|
|
587
|
+
}
|
|
588
|
+
//------------------------------------------------------------------------------
|
|
589
|
+
byte TS7Worker::WriteArea(PReqFunWriteDataItem ReqItemData, PReqFunWriteItem ReqItemPar,
|
|
590
|
+
TEv &EV)
|
|
591
|
+
{
|
|
592
|
+
int Multiplier;
|
|
593
|
+
PS7Area P = NULL;
|
|
594
|
+
word DBNum = 0;
|
|
595
|
+
word Elements;
|
|
596
|
+
longword *PAdd;
|
|
597
|
+
PSnapCriticalSection pcs;
|
|
598
|
+
longword Start, Size, ASize, DataLen, AStart;
|
|
599
|
+
pbyte Target = NULL;
|
|
600
|
+
byte BitIndex;
|
|
601
|
+
|
|
602
|
+
EV.EvStart =0;
|
|
603
|
+
EV.EvSize =0;
|
|
604
|
+
EV.EvRetCode =evrNoError;
|
|
605
|
+
EV.EvIndex =0;
|
|
606
|
+
|
|
607
|
+
EV.EvArea=ReqItemPar->Area;
|
|
608
|
+
// Get Pointer to selected Area
|
|
609
|
+
if (ReqItemPar->Area==S7AreaDB)
|
|
610
|
+
{
|
|
611
|
+
DBNum=SwapWord(ReqItemPar->DBNumber);
|
|
612
|
+
EV.EvIndex=DBNum;
|
|
613
|
+
};
|
|
614
|
+
|
|
615
|
+
if (!FServer->ResourceLess)
|
|
616
|
+
{
|
|
617
|
+
P=GetArea(ReqItemPar->Area, DBNum);
|
|
618
|
+
if (P==NULL)
|
|
619
|
+
return WA_NotFound(EV);
|
|
620
|
+
}
|
|
621
|
+
|
|
622
|
+
// Calcs the amount
|
|
623
|
+
Multiplier = DataSizeByte(ReqItemPar->TransportSize);
|
|
624
|
+
if (Multiplier==0)
|
|
625
|
+
return WA_InvalidTransportSize(EV);
|
|
626
|
+
|
|
627
|
+
// Checks timers/counters coherence
|
|
628
|
+
if ((ReqItemPar->Area==S7AreaTM) ^ (ReqItemPar->TransportSize==S7WLTimer))
|
|
629
|
+
return WA_OutOfRange(EV);
|
|
630
|
+
|
|
631
|
+
if ((ReqItemPar->Area==S7AreaCT) ^ (ReqItemPar->TransportSize==S7WLCounter))
|
|
632
|
+
return WA_OutOfRange(EV);
|
|
633
|
+
|
|
634
|
+
// Calcs size
|
|
635
|
+
Elements = SwapWord(ReqItemPar->Length);
|
|
636
|
+
Size = Multiplier*Elements;
|
|
637
|
+
EV.EvSize=Size;
|
|
638
|
+
|
|
639
|
+
// More) 1 bit is not supported by S7 CPU
|
|
640
|
+
if ((ReqItemPar->TransportSize==S7WLBit) && (Size>1))
|
|
641
|
+
return WA_OutOfRange(EV);
|
|
642
|
+
|
|
643
|
+
// Calcs the start point ??
|
|
644
|
+
PAdd=(longword*)&ReqItemPar->Area; // points to area since we need 4 bytes for a pointer
|
|
645
|
+
Start=SwapDWord(*PAdd & 0xFFFFFF00);
|
|
646
|
+
|
|
647
|
+
// Checks if the address is not multiple of 8 when transport size is neither bit nor timer nor counter
|
|
648
|
+
if (
|
|
649
|
+
(ReqItemPar->TransportSize!=S7WLBit) &&
|
|
650
|
+
(ReqItemPar->TransportSize!=S7WLTimer) &&
|
|
651
|
+
(ReqItemPar->TransportSize!=S7WLCounter) &&
|
|
652
|
+
((Start % 8) !=0)
|
|
653
|
+
)
|
|
654
|
+
return WA_OutOfRange(EV);
|
|
655
|
+
|
|
656
|
+
// AStart is only for callback
|
|
657
|
+
if ((ReqItemPar->TransportSize != S7WLBit) && (ReqItemPar->TransportSize != S7WLCounter) && (ReqItemPar->TransportSize != S7WLTimer))
|
|
658
|
+
AStart = Start >> 3;
|
|
659
|
+
else
|
|
660
|
+
AStart = Start;
|
|
661
|
+
|
|
662
|
+
if ((ReqItemPar->TransportSize == S7WLCounter) || (ReqItemPar->TransportSize == S7WLTimer))
|
|
663
|
+
{
|
|
664
|
+
Start = Start >> 1; // 1 Timer or Counter = 2 bytes
|
|
665
|
+
}
|
|
666
|
+
else
|
|
667
|
+
{
|
|
668
|
+
BitIndex = Start & 0x07; // start bit
|
|
669
|
+
Start = Start >> 3; // start byte
|
|
670
|
+
}
|
|
671
|
+
EV.EvStart =Start;
|
|
672
|
+
|
|
673
|
+
if (!FServer->ResourceLess)
|
|
674
|
+
{
|
|
675
|
+
// Checks bounds
|
|
676
|
+
ASize = P->Size; // Area size
|
|
677
|
+
if (Start + Size > ASize)
|
|
678
|
+
return WA_OutOfRange(EV);
|
|
679
|
+
Target = pbyte(P->PData + Start);
|
|
680
|
+
}
|
|
681
|
+
// Checks data size coherence
|
|
682
|
+
DataLen=SwapWord(ReqItemData->DataLength);
|
|
683
|
+
|
|
684
|
+
if ((ReqItemData->TransportSize!=TS_ResOctet) && (ReqItemData->TransportSize!=TS_ResReal) && (ReqItemData->TransportSize!=TS_ResBit))
|
|
685
|
+
DataLen=DataLen / 8;
|
|
686
|
+
|
|
687
|
+
if (DataLen!=Size)
|
|
688
|
+
return WA_DataSizeMismatch(EV);
|
|
689
|
+
|
|
690
|
+
if (FServer->ResourceLess)
|
|
691
|
+
{
|
|
692
|
+
if (!FServer->DoWriteArea(ClientHandle, EV.EvArea, EV.EvIndex, AStart, Elements, ReqItemPar->TransportSize, &ReqItemData->Data[0]))
|
|
693
|
+
return WA_NotFound(EV);
|
|
694
|
+
}
|
|
695
|
+
else
|
|
696
|
+
{
|
|
697
|
+
if (ReqItemPar->TransportSize==S7WLBit)
|
|
698
|
+
{
|
|
699
|
+
if ((ReqItemData->Data[0] & 0x01) != 0) // bit set
|
|
700
|
+
*Target=*Target | BitMask[BitIndex];
|
|
701
|
+
else // bit reset
|
|
702
|
+
*Target=*Target & (~BitMask[BitIndex]);
|
|
703
|
+
}
|
|
704
|
+
else {
|
|
705
|
+
// Lock the area
|
|
706
|
+
pcs = P->cs;
|
|
707
|
+
pcs->Enter();
|
|
708
|
+
// Write Data
|
|
709
|
+
memcpy(Target, &ReqItemData->Data[0], Size);
|
|
710
|
+
pcs->Leave();
|
|
711
|
+
};
|
|
712
|
+
}
|
|
713
|
+
|
|
714
|
+
return 0xFF;
|
|
715
|
+
}
|
|
716
|
+
//------------------------------------------------------------------------------
|
|
717
|
+
bool TS7Worker::PerformFunctionWrite()
|
|
718
|
+
{
|
|
719
|
+
PReqFunWriteParams ReqParams;
|
|
720
|
+
TReqFunWriteData ReqData;
|
|
721
|
+
PResFunWrite ResData;
|
|
722
|
+
TS7Answer23 Answer;
|
|
723
|
+
int L;
|
|
724
|
+
|
|
725
|
+
uintptr_t StartData;
|
|
726
|
+
int c, ItemsCount;
|
|
727
|
+
int ResDSize;
|
|
728
|
+
TEv EV;
|
|
729
|
+
|
|
730
|
+
// Stage 1 : Setup pointers and initial check
|
|
731
|
+
ReqParams=PReqFunWriteParams(pbyte(PDUH_in)+sizeof(TS7ReqHeader));
|
|
732
|
+
ResData =PResFunWrite(pbyte(&Answer)+ResHeaderSize23);
|
|
733
|
+
|
|
734
|
+
StartData=sizeof(TS7ReqHeader)+SwapWord(PDUH_in->ParLen);
|
|
735
|
+
|
|
736
|
+
ItemsCount=ReqParams->ItemsCount;
|
|
737
|
+
ResDSize =ResHeaderSize23+2+ItemsCount;
|
|
738
|
+
for (c = 0; c < ItemsCount; c++)
|
|
739
|
+
{
|
|
740
|
+
ReqData[c]=PReqFunWriteDataItem(pbyte(PDUH_in)+StartData);
|
|
741
|
+
|
|
742
|
+
if ((ReqData[c]->TransportSize == TS_ResOctet) || (ReqData[c]->TransportSize == TS_ResReal) || (ReqData[c]->TransportSize == TS_ResBit))
|
|
743
|
+
L = SwapWord(ReqData[c]->DataLength);
|
|
744
|
+
else
|
|
745
|
+
L = (SwapWord(ReqData[c]->DataLength) / 8);
|
|
746
|
+
|
|
747
|
+
StartData+=L+4;
|
|
748
|
+
// the datalength is always even
|
|
749
|
+
if ( L % 2 != 0) StartData++;
|
|
750
|
+
}
|
|
751
|
+
|
|
752
|
+
ResData->FunWrite =pduFuncWrite;
|
|
753
|
+
ResData->ItemCount=ReqParams->ItemsCount;
|
|
754
|
+
|
|
755
|
+
// Stage 2 : Write data
|
|
756
|
+
for (c = 0; c < ItemsCount; c++)
|
|
757
|
+
{
|
|
758
|
+
ResData->Data[c]=WriteArea(ReqData[c],&ReqParams->Items[c], EV);
|
|
759
|
+
// For multiple items we have to create multiple events
|
|
760
|
+
if (ItemsCount>1)
|
|
761
|
+
DoEvent(evcDataWrite,EV.EvRetCode,EV.EvArea,EV.EvIndex,EV.EvStart,EV.EvSize);
|
|
762
|
+
}
|
|
763
|
+
|
|
764
|
+
// Stage 3 : finalize the answer
|
|
765
|
+
Answer.Header.P=0x32;
|
|
766
|
+
Answer.Header.PDUType=0x03;
|
|
767
|
+
Answer.Header.AB_EX=0x0000;
|
|
768
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
769
|
+
Answer.Header.ParLen=SwapWord(0x02);
|
|
770
|
+
Answer.Header.Error=0x0000; // this is zero, we will find the error in ResData.ReturnCode if any
|
|
771
|
+
Answer.Header.DataLen=SwapWord(ItemsCount);
|
|
772
|
+
|
|
773
|
+
isoSendBuffer(&Answer,ResDSize);
|
|
774
|
+
// For single item (most likely case) it's better to fire the event after
|
|
775
|
+
// we sent the answer
|
|
776
|
+
if (ItemsCount==1)
|
|
777
|
+
DoEvent(evcDataWrite,EV.EvRetCode,EV.EvArea,EV.EvIndex,EV.EvStart,EV.EvSize);
|
|
778
|
+
return true;
|
|
779
|
+
}
|
|
780
|
+
//==============================================================================
|
|
781
|
+
// FUNCTION NEGOTIATE
|
|
782
|
+
//==============================================================================
|
|
783
|
+
bool TS7Worker::PerformFunctionNegotiate()
|
|
784
|
+
{
|
|
785
|
+
PReqFunNegotiateParams ReqParams;
|
|
786
|
+
PResFunNegotiateParams ResParams;
|
|
787
|
+
word ReqLen;
|
|
788
|
+
TS7Answer23 Answer;
|
|
789
|
+
int Size;
|
|
790
|
+
|
|
791
|
+
// Setup pointers
|
|
792
|
+
ReqParams=PReqFunNegotiateParams(pbyte(PDUH_in)+sizeof(TS7ReqHeader));
|
|
793
|
+
ResParams=PResFunNegotiateParams(pbyte(&Answer)+sizeof(TS7ResHeader23));
|
|
794
|
+
// Prepares the answer
|
|
795
|
+
Answer.Header.P=0x32;
|
|
796
|
+
Answer.Header.PDUType=0x03;
|
|
797
|
+
Answer.Header.AB_EX=0x0000;
|
|
798
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
799
|
+
Answer.Header.ParLen=SwapWord(sizeof(TResFunNegotiateParams));
|
|
800
|
+
Answer.Header.DataLen=0x0000;
|
|
801
|
+
Answer.Header.Error=0x0000;
|
|
802
|
+
// Params point at the end of the header
|
|
803
|
+
ResParams->FunNegotiate=pduNegotiate;
|
|
804
|
+
ResParams->Unknown=0x0;
|
|
805
|
+
// We offer the same
|
|
806
|
+
ResParams->ParallelJobs_1=ReqParams->ParallelJobs_1;
|
|
807
|
+
ResParams->ParallelJobs_2=ReqParams->ParallelJobs_2;
|
|
808
|
+
|
|
809
|
+
if (FServer->ForcePDU == 0)
|
|
810
|
+
{
|
|
811
|
+
ReqLen = SwapWord(ReqParams->PDULength);
|
|
812
|
+
if (ReqLen<MinPduSize)
|
|
813
|
+
ResParams->PDULength = SwapWord(MinPduSize);
|
|
814
|
+
else
|
|
815
|
+
if (ReqLen>IsoPayload_Size)
|
|
816
|
+
ResParams->PDULength = SwapWord(IsoPayload_Size);
|
|
817
|
+
else
|
|
818
|
+
ResParams->PDULength = ReqParams->PDULength;
|
|
819
|
+
}
|
|
820
|
+
else
|
|
821
|
+
ResParams->PDULength = SwapWord(FServer->ForcePDU);
|
|
822
|
+
|
|
823
|
+
FPDULength=SwapWord(ResParams->PDULength); // Stores the value
|
|
824
|
+
// Sends the answer
|
|
825
|
+
Size=sizeof(TS7ResHeader23) + sizeof(TResFunNegotiateParams);
|
|
826
|
+
isoSendBuffer(&Answer, Size);
|
|
827
|
+
// Store the event
|
|
828
|
+
DoEvent(evcNegotiatePDU, evrNoError, FPDULength, 0, 0, 0);
|
|
829
|
+
return true;
|
|
830
|
+
}
|
|
831
|
+
//==============================================================================
|
|
832
|
+
// FUNCTION CONTROL
|
|
833
|
+
//==============================================================================
|
|
834
|
+
bool TS7Worker::PerformFunctionControl(byte PduFun)
|
|
835
|
+
{
|
|
836
|
+
TS7Answer23 Answer;
|
|
837
|
+
PResFunCtrl ResParams;
|
|
838
|
+
word ParLen;
|
|
839
|
+
word CtrlCode;
|
|
840
|
+
|
|
841
|
+
// Setup pointer
|
|
842
|
+
ResParams=PResFunCtrl(pbyte(&Answer)+sizeof(TS7ResHeader23));
|
|
843
|
+
// Prepares the answer
|
|
844
|
+
Answer.Header.P=0x32;
|
|
845
|
+
Answer.Header.PDUType=0x03;
|
|
846
|
+
Answer.Header.AB_EX=0x0000;
|
|
847
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
848
|
+
Answer.Header.ParLen=SwapWord(0x0001); // We send only Res fun without para
|
|
849
|
+
Answer.Header.DataLen=0x0000;
|
|
850
|
+
Answer.Header.Error=0x0000;
|
|
851
|
+
ResParams->ResFun=PduFun;
|
|
852
|
+
ResParams->para =0x00;
|
|
853
|
+
|
|
854
|
+
ParLen=SwapWord(PDUH_in->ParLen);
|
|
855
|
+
if (PduFun==pduStop)
|
|
856
|
+
CtrlCode=CodeControlStop;
|
|
857
|
+
else
|
|
858
|
+
{
|
|
859
|
+
switch (ParLen)
|
|
860
|
+
{
|
|
861
|
+
case 16 : CtrlCode=CodeControlCompress; break;
|
|
862
|
+
case 18 : CtrlCode=CodeControlCpyRamRom; break;
|
|
863
|
+
case 20 : CtrlCode=CodeControlWarmStart; break;
|
|
864
|
+
case 22 : CtrlCode=CodeControlColdStart; break;
|
|
865
|
+
case 26 : CtrlCode=CodeControlInsDel; break;
|
|
866
|
+
default : CtrlCode=CodeControlUnknown;
|
|
867
|
+
}
|
|
868
|
+
}
|
|
869
|
+
// Sends the answer
|
|
870
|
+
isoSendBuffer(&Answer,sizeof(TS7ResHeader23)+1);
|
|
871
|
+
// Stores the event
|
|
872
|
+
DoEvent(evcControl,0,CtrlCode,0,0,0);
|
|
873
|
+
|
|
874
|
+
if ((CtrlCode==CodeControlWarmStart) || (CtrlCode==CodeControlColdStart))
|
|
875
|
+
FServer->CpuStatus=S7CpuStatusRun;
|
|
876
|
+
|
|
877
|
+
if (CtrlCode==CodeControlStop)
|
|
878
|
+
FServer->CpuStatus=S7CpuStatusStop;
|
|
879
|
+
|
|
880
|
+
return true;
|
|
881
|
+
}
|
|
882
|
+
//==============================================================================
|
|
883
|
+
// FUNCTION UPLOAD
|
|
884
|
+
//==============================================================================
|
|
885
|
+
bool TS7Worker::PerformFunctionUpload()
|
|
886
|
+
{
|
|
887
|
+
TS7Answer23 Answer;
|
|
888
|
+
|
|
889
|
+
// Upload is not implemented, however to avoid that S7 manager hangs
|
|
890
|
+
// we simulate a cpu read/write protected.
|
|
891
|
+
// We can see the directory but can't upload/download anything
|
|
892
|
+
|
|
893
|
+
// Prepares the answer
|
|
894
|
+
Answer.Header.P=0x32;
|
|
895
|
+
Answer.Header.PDUType =pduResponse;
|
|
896
|
+
Answer.Header.AB_EX=0x0000;
|
|
897
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
898
|
+
Answer.Header.ParLen=0;
|
|
899
|
+
Answer.Header.DataLen=0;
|
|
900
|
+
Answer.Header.Error=SwapWord(Code7NeedPassword);
|
|
901
|
+
// Sends the answer
|
|
902
|
+
isoSendBuffer(&Answer,sizeof(TS7ResHeader23));
|
|
903
|
+
|
|
904
|
+
DoEvent(evcUpload,evrCannotUpload,evsStartUpload,0,0,0);
|
|
905
|
+
return true;
|
|
906
|
+
}
|
|
907
|
+
//==============================================================================
|
|
908
|
+
// FUNCTION DOWNLOAD
|
|
909
|
+
//==============================================================================
|
|
910
|
+
bool TS7Worker::PerformFunctionDownload()
|
|
911
|
+
{
|
|
912
|
+
TS7Answer23 Answer;
|
|
913
|
+
|
|
914
|
+
// Download is not implemented, however to avoid that S7 manager hangs
|
|
915
|
+
// we simulate a cpu read/write protected.
|
|
916
|
+
// We can see the directory but can't upload/download anything
|
|
917
|
+
|
|
918
|
+
// Prepares the answer
|
|
919
|
+
Answer.Header.P=0x32;
|
|
920
|
+
Answer.Header.PDUType =pduResponse;
|
|
921
|
+
Answer.Header.AB_EX=0x0000;
|
|
922
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
923
|
+
Answer.Header.ParLen=0;
|
|
924
|
+
Answer.Header.DataLen=0;
|
|
925
|
+
Answer.Header.Error=SwapWord(Code7NeedPassword);
|
|
926
|
+
// Sends the answer
|
|
927
|
+
isoSendBuffer(&Answer,sizeof(TS7ResHeader23));
|
|
928
|
+
|
|
929
|
+
DoEvent(evcUpload,evrCannotDownload, evsStartDownload,0,0,0);
|
|
930
|
+
return true;
|
|
931
|
+
}
|
|
932
|
+
//==============================================================================
|
|
933
|
+
// FUNCTIONS PROGRAMMER AND CYCLIC DATA (NOT IMPLEMENTED...yet)
|
|
934
|
+
//==============================================================================
|
|
935
|
+
bool TS7Worker::PerformGroupProgrammer()
|
|
936
|
+
{
|
|
937
|
+
DoEvent(evcPDUincoming,evrNotImplemented,grProgrammer,0,0,0);
|
|
938
|
+
return true;
|
|
939
|
+
}
|
|
940
|
+
//------------------------------------------------------------------------------
|
|
941
|
+
bool TS7Worker::PerformGroupCyclicData()
|
|
942
|
+
{
|
|
943
|
+
DoEvent(evcPDUincoming,evrNotImplemented,grCyclicData,0,0,0);
|
|
944
|
+
return true;
|
|
945
|
+
}
|
|
946
|
+
//==============================================================================
|
|
947
|
+
// BLOCK(S) INFO FUNCTIONS
|
|
948
|
+
//==============================================================================
|
|
949
|
+
void TS7Worker::BLK_ListAll(TCB &CB)
|
|
950
|
+
{
|
|
951
|
+
PDataFunListAll Data;
|
|
952
|
+
int TotalSize;
|
|
953
|
+
|
|
954
|
+
TotalSize = ResHeaderSize17+sizeof(TResFunGetBlockInfo)+sizeof(TDataFunListAll);
|
|
955
|
+
// Prepares the answer
|
|
956
|
+
CB.Answer.Header.P=0x32;
|
|
957
|
+
CB.Answer.Header.PDUType=PduType_userdata;
|
|
958
|
+
CB.Answer.Header.AB_EX=0x0000;
|
|
959
|
+
CB.Answer.Header.Sequence=PDUH_in->Sequence;
|
|
960
|
+
CB.Answer.Header.ParLen =SwapWord(sizeof(TResFunGetBlockInfo));
|
|
961
|
+
CB.Answer.Header.DataLen=SwapWord(sizeof(TDataFunListAll));
|
|
962
|
+
|
|
963
|
+
CB.ResParams->Head[0]=CB.ReqParams->Head[0];
|
|
964
|
+
CB.ResParams->Head[1]=CB.ReqParams->Head[1];
|
|
965
|
+
CB.ResParams->Head[2]=CB.ReqParams->Head[2];
|
|
966
|
+
CB.ResParams->Plen =0x08;
|
|
967
|
+
CB.ResParams->Uk =0x12;
|
|
968
|
+
CB.ResParams->Tg =0x83; // Type response, group functions info
|
|
969
|
+
CB.ResParams->SubFun=SFun_ListAll;
|
|
970
|
+
|
|
971
|
+
CB.ResParams->Seq =CB.ReqParams->Seq;
|
|
972
|
+
CB.ResParams->Rsvd =0x0000;
|
|
973
|
+
CB.ResParams->ErrNo =0x0000;
|
|
974
|
+
|
|
975
|
+
Data=PDataFunListAll(pbyte(&CB.Answer)+ResHeaderSize17+sizeof(TResFunGetBlockInfo));
|
|
976
|
+
Data->RetVal=0xFF;
|
|
977
|
+
Data->TRSize=TS_ResOctet;
|
|
978
|
+
Data->Length=SwapWord(28); // 28 = Size of TDataFunListAll.Blocks
|
|
979
|
+
// Fill elements, only DB will have a valid number
|
|
980
|
+
Data->Blocks[0].Zero=0x30;
|
|
981
|
+
Data->Blocks[0].BType=Block_OB;
|
|
982
|
+
Data->Blocks[0].BCount=0x0000; // We don't have OBs
|
|
983
|
+
Data->Blocks[1].Zero=0x30;
|
|
984
|
+
Data->Blocks[1].BType=Block_FB;
|
|
985
|
+
Data->Blocks[1].BCount=0x0000; // We don't have FBs
|
|
986
|
+
Data->Blocks[2].Zero=0x30;
|
|
987
|
+
Data->Blocks[2].BType=Block_FC;
|
|
988
|
+
Data->Blocks[2].BCount=0x0000; // We don't have FCs
|
|
989
|
+
Data->Blocks[3].Zero=0x30;
|
|
990
|
+
Data->Blocks[3].BType=Block_DB;
|
|
991
|
+
Data->Blocks[3].BCount=SwapWord(FServer->DBCount); // Most likely we HAVE DBs
|
|
992
|
+
Data->Blocks[4].Zero=0x30;
|
|
993
|
+
Data->Blocks[4].BType=Block_SDB;
|
|
994
|
+
Data->Blocks[4].BCount=0x0000; // We don't have SDBs
|
|
995
|
+
Data->Blocks[5].Zero=0x30;
|
|
996
|
+
Data->Blocks[5].BType=Block_SFC;
|
|
997
|
+
Data->Blocks[5].BCount=0x0000; // We don't have SFCs
|
|
998
|
+
Data->Blocks[6].Zero=0x30;
|
|
999
|
+
Data->Blocks[6].BType=Block_SFB;
|
|
1000
|
+
Data->Blocks[6].BCount=0x0000; // We don't have SFBs
|
|
1001
|
+
// Sends
|
|
1002
|
+
isoSendBuffer(&CB.Answer,TotalSize);
|
|
1003
|
+
DoEvent(evcDirectory, 0, evsGetBlockList, 0, 0, 0);
|
|
1004
|
+
}
|
|
1005
|
+
//------------------------------------------------------------------------------
|
|
1006
|
+
void TS7Worker::BLK_NoResource_ListBoT(PDataFunGetBot Data, TCB &CB)
|
|
1007
|
+
{
|
|
1008
|
+
CB.DataLength =4;
|
|
1009
|
+
DBCnt =0; // Reset counter
|
|
1010
|
+
CB.Answer.Header.DataLen=SwapWord(CB.DataLength);
|
|
1011
|
+
CB.ResParams->ErrNo =0x0ED2; // function in error
|
|
1012
|
+
Data->RetVal =0x0A; // No resource available
|
|
1013
|
+
Data->TSize =0x00; // No transport size;
|
|
1014
|
+
Data->DataLen =0x0000; // No data;
|
|
1015
|
+
CB.evError =evrResNotFound;
|
|
1016
|
+
}
|
|
1017
|
+
//------------------------------------------------------------------------------
|
|
1018
|
+
void TS7Worker::BLK_ListBoT(byte BlockType, bool Start, TCB &CB)
|
|
1019
|
+
{
|
|
1020
|
+
PDataFunGetBot Data;
|
|
1021
|
+
int MaxItems, TotalSize, cnt;
|
|
1022
|
+
int HiBound = FServer->DBLimit+1;
|
|
1023
|
+
|
|
1024
|
+
CB.evError=0;
|
|
1025
|
+
MaxItems=(FPDULength - 32) / 4;
|
|
1026
|
+
// Prepares the answer
|
|
1027
|
+
CB.Answer.Header.P=0x32;
|
|
1028
|
+
CB.Answer.Header.PDUType=PduType_userdata;
|
|
1029
|
+
CB.Answer.Header.AB_EX=0x0000;
|
|
1030
|
+
CB.Answer.Header.Sequence=PDUH_in->Sequence;
|
|
1031
|
+
CB.Answer.Header.ParLen =SwapWord(sizeof(TResFunGetBlockInfo));
|
|
1032
|
+
|
|
1033
|
+
CB.ResParams->Head[0]=CB.ReqParams->Head[0];
|
|
1034
|
+
CB.ResParams->Head[1]=CB.ReqParams->Head[1];
|
|
1035
|
+
CB.ResParams->Head[2]=CB.ReqParams->Head[2];
|
|
1036
|
+
CB.ResParams->Plen =0x08;
|
|
1037
|
+
CB.ResParams->Uk =0x12;
|
|
1038
|
+
CB.ResParams->Tg =0x83; // Type response, group functions info
|
|
1039
|
+
CB.ResParams->SubFun=SFun_ListBoT;
|
|
1040
|
+
CB.ResParams->Seq =CB.ReqParams->Seq;
|
|
1041
|
+
CB.ResParams->Rsvd =0x0000;
|
|
1042
|
+
Data=PDataFunGetBot(pbyte(&CB.Answer)+ResHeaderSize17+sizeof(TResFunGetBlockInfo));
|
|
1043
|
+
|
|
1044
|
+
if (BlockType==Block_DB)
|
|
1045
|
+
{
|
|
1046
|
+
cnt =0; // Local couter
|
|
1047
|
+
if (Start)
|
|
1048
|
+
DBCnt=-1; // Global counter
|
|
1049
|
+
|
|
1050
|
+
if (FServer->DBCount>0)
|
|
1051
|
+
{
|
|
1052
|
+
while ((cnt<MaxItems) && (DBCnt<HiBound))
|
|
1053
|
+
{
|
|
1054
|
+
DBCnt++;
|
|
1055
|
+
if (FServer->DB[DBCnt]!=NULL)
|
|
1056
|
+
{
|
|
1057
|
+
Data->Items[cnt].BlockNum=SwapWord(FServer->DB[DBCnt]->Number);
|
|
1058
|
+
Data->Items[cnt].Unknown =0x22;
|
|
1059
|
+
Data->Items[cnt].BlockLang=0x05;
|
|
1060
|
+
cnt++;
|
|
1061
|
+
};
|
|
1062
|
+
};
|
|
1063
|
+
|
|
1064
|
+
if ((cnt<MaxItems) || (DBCnt==HiBound))
|
|
1065
|
+
{
|
|
1066
|
+
DBCnt=0; // Finished
|
|
1067
|
+
CB.ResParams->Rsvd=0x0023;
|
|
1068
|
+
}
|
|
1069
|
+
else
|
|
1070
|
+
CB.ResParams->Rsvd=0x0123;
|
|
1071
|
+
|
|
1072
|
+
if (cnt>0)
|
|
1073
|
+
{
|
|
1074
|
+
CB.ResParams->ErrNo =0x0000;
|
|
1075
|
+
Data->TSize =TS_ResOctet;
|
|
1076
|
+
Data->RetVal=0xFF;
|
|
1077
|
+
CB.DataLength=4+(cnt*word(sizeof(TDataFunGetBotItem)));
|
|
1078
|
+
CB.Answer.Header.DataLen=SwapWord(CB.DataLength);
|
|
1079
|
+
Data->DataLen=SwapWord(CB.DataLength-4);
|
|
1080
|
+
}
|
|
1081
|
+
else
|
|
1082
|
+
BLK_NoResource_ListBoT(Data, CB);
|
|
1083
|
+
}
|
|
1084
|
+
else
|
|
1085
|
+
BLK_NoResource_ListBoT(Data, CB);
|
|
1086
|
+
}
|
|
1087
|
+
else // we store only DBs
|
|
1088
|
+
BLK_NoResource_ListBoT(Data, CB);
|
|
1089
|
+
|
|
1090
|
+
TotalSize = ResHeaderSize17+sizeof(TResFunGetBlockInfo)+CB.DataLength;
|
|
1091
|
+
isoSendBuffer(&CB.Answer,TotalSize);
|
|
1092
|
+
if (Start)
|
|
1093
|
+
DoEvent(evcDirectory, CB.evError, evsStartListBoT, BlockType, 0, 0);
|
|
1094
|
+
else
|
|
1095
|
+
DoEvent(evcDirectory, CB.evError, evsListBoT, BlockType, 0, 0);
|
|
1096
|
+
}
|
|
1097
|
+
//------------------------------------------------------------------------------
|
|
1098
|
+
void TS7Worker::BLK_NoResource_GetBlkInfo(PResDataBlockInfo Data, TCB &CB)
|
|
1099
|
+
{
|
|
1100
|
+
CB.DataLength =4;
|
|
1101
|
+
CB.Answer.Header.DataLen=SwapWord(CB.DataLength);
|
|
1102
|
+
CB.ResParams->ErrNo =0x09D2; // function in error
|
|
1103
|
+
Data->RetVal =0x0A; // No resource available
|
|
1104
|
+
Data->TSize =0x00; // No transport size;
|
|
1105
|
+
Data->Length =0x0000; // No data;
|
|
1106
|
+
CB.evError =evrResNotFound;
|
|
1107
|
+
}
|
|
1108
|
+
//------------------------------------------------------------------------------
|
|
1109
|
+
void TS7Worker::BLK_GetBlockNum_GetBlkInfo(int &BlkNum, PReqDataBlockInfo ReqData)
|
|
1110
|
+
{
|
|
1111
|
+
BlkNum = (ReqData->AsciiBlk[4] - 0x30) +
|
|
1112
|
+
(ReqData->AsciiBlk[3] - 0x30) * 10 +
|
|
1113
|
+
(ReqData->AsciiBlk[2] - 0x30) * 100 +
|
|
1114
|
+
(ReqData->AsciiBlk[1] - 0x30) * 1000 +
|
|
1115
|
+
(ReqData->AsciiBlk[0] - 0x30) * 10000;
|
|
1116
|
+
|
|
1117
|
+
if (BlkNum>65535)
|
|
1118
|
+
BlkNum=-1;
|
|
1119
|
+
}
|
|
1120
|
+
//------------------------------------------------------------------------------
|
|
1121
|
+
void TS7Worker::BLK_DoBlockInfo_GetBlkInfo(PS7Area DB, PResDataBlockInfo Data, TCB &CB)
|
|
1122
|
+
{
|
|
1123
|
+
// Prepares the answer
|
|
1124
|
+
CB.Answer.Header.P=0x32;
|
|
1125
|
+
CB.Answer.Header.PDUType=PduType_userdata;
|
|
1126
|
+
CB.Answer.Header.AB_EX=0x0000;
|
|
1127
|
+
CB.Answer.Header.Sequence=PDUH_in->Sequence;
|
|
1128
|
+
CB.Answer.Header.ParLen =SwapWord(sizeof(TResFunGetBlockInfo));
|
|
1129
|
+
|
|
1130
|
+
CB.ResParams->Head[0]=CB.ReqParams->Head[0];
|
|
1131
|
+
CB.ResParams->Head[1]=CB.ReqParams->Head[1];
|
|
1132
|
+
CB.ResParams->Head[2]=CB.ReqParams->Head[2];
|
|
1133
|
+
CB.ResParams->Plen =0x08;
|
|
1134
|
+
CB.ResParams->Uk =0x12;
|
|
1135
|
+
CB.ResParams->Tg =0x83; // Type response, group functions info
|
|
1136
|
+
CB.ResParams->SubFun=SFun_BlkInfo;
|
|
1137
|
+
CB.ResParams->Seq =CB.ReqParams->Seq;
|
|
1138
|
+
CB.ResParams->Rsvd =0x0000;
|
|
1139
|
+
CB.ResParams->ErrNo =0x0000;
|
|
1140
|
+
|
|
1141
|
+
CB.DataLength =sizeof(TResDataBlockInfo);
|
|
1142
|
+
CB.Answer.Header.DataLen=SwapWord(CB.DataLength);
|
|
1143
|
+
CB.ResParams->ErrNo =0x0000;
|
|
1144
|
+
|
|
1145
|
+
Data->RetVal =0xFF;
|
|
1146
|
+
Data->TSize =TS_ResOctet;
|
|
1147
|
+
Data->Length =SwapWord(78); // this struct - RetValData->Tsize and length
|
|
1148
|
+
Data->Cst_b =0x01;
|
|
1149
|
+
Data->BlkType =0x00;
|
|
1150
|
+
Data->Cst_w1 =0x4A00;
|
|
1151
|
+
Data->Cst_w2 =0x0022;
|
|
1152
|
+
Data->Cst_pp =0x7070;
|
|
1153
|
+
Data->Unknown_1 =0x01;
|
|
1154
|
+
Data->BlkFlags =0x01;
|
|
1155
|
+
Data->BlkLang =BlockLangDB;
|
|
1156
|
+
Data->SubBlkType =0x0A;
|
|
1157
|
+
Data->CodeTime_dy =SwapWord(5800);// Nov/18/1999 my princess's birthdate
|
|
1158
|
+
Data->IntfTime_dy =Data->CodeTime_dy;
|
|
1159
|
+
Data->LocDataLen =0x0000;
|
|
1160
|
+
Data->BlkNumber =SwapWord(DB->Number);
|
|
1161
|
+
Data->SbbLen =0x1400;
|
|
1162
|
+
Data->AddLen =0x0000;
|
|
1163
|
+
Data->MC7Len =SwapWord(DB->Size);
|
|
1164
|
+
Data->LenLoadMem =SwapDWord(DB->Size+92);
|
|
1165
|
+
Data->Version =0x01;
|
|
1166
|
+
Data->Unknown_2 =0x00;
|
|
1167
|
+
Data->BlkChksum =0x0000;
|
|
1168
|
+
}
|
|
1169
|
+
//------------------------------------------------------------------------------
|
|
1170
|
+
void TS7Worker::BLK_GetBlkInfo(TCB &CB)
|
|
1171
|
+
{
|
|
1172
|
+
PReqDataBlockInfo ReqData;
|
|
1173
|
+
PResDataBlockInfo Data;
|
|
1174
|
+
int BlkNum;
|
|
1175
|
+
PS7Area BlkDB;
|
|
1176
|
+
byte BlkTypeInfo;
|
|
1177
|
+
int TotalSize;
|
|
1178
|
+
|
|
1179
|
+
CB.evError=0;
|
|
1180
|
+
Data =PResDataBlockInfo(pbyte(&CB.Answer)+ResHeaderSize17+sizeof(TResFunGetBlockInfo));
|
|
1181
|
+
ReqData=PReqDataBlockInfo(pbyte(PDUH_in)+ReqHeaderSize+sizeof(TReqFunGetBlockInfo));
|
|
1182
|
+
memset(Data,0,sizeof(TResDataBlockInfo)); // many fields are 0
|
|
1183
|
+
|
|
1184
|
+
BLK_GetBlockNum_GetBlkInfo(BlkNum, ReqData);
|
|
1185
|
+
BlkTypeInfo=ReqData->BlkType;
|
|
1186
|
+
if (BlkTypeInfo==Block_DB)
|
|
1187
|
+
{
|
|
1188
|
+
if (BlkNum>=0)
|
|
1189
|
+
{
|
|
1190
|
+
BlkDB=FServer->FindDB(BlkNum);
|
|
1191
|
+
if (BlkDB!=NULL)
|
|
1192
|
+
BLK_DoBlockInfo_GetBlkInfo(BlkDB, Data, CB);
|
|
1193
|
+
else
|
|
1194
|
+
BLK_NoResource_GetBlkInfo(Data, CB);
|
|
1195
|
+
}
|
|
1196
|
+
else
|
|
1197
|
+
BLK_NoResource_GetBlkInfo(Data, CB);
|
|
1198
|
+
}
|
|
1199
|
+
else
|
|
1200
|
+
BLK_NoResource_GetBlkInfo(Data, CB);
|
|
1201
|
+
|
|
1202
|
+
TotalSize = ResHeaderSize17+sizeof(TResFunGetBlockInfo)+sizeof(TResDataBlockInfo);
|
|
1203
|
+
isoSendBuffer(&CB.Answer, TotalSize);
|
|
1204
|
+
DoEvent(evcDirectory,CB.evError,evsGetBlockInfo,BlkTypeInfo,BlkNum,0);
|
|
1205
|
+
}
|
|
1206
|
+
//------------------------------------------------------------------------------
|
|
1207
|
+
bool TS7Worker::PerformGroupBlockInfo()
|
|
1208
|
+
{
|
|
1209
|
+
TCB CB;
|
|
1210
|
+
pbyte BlockType;
|
|
1211
|
+
|
|
1212
|
+
// Setup pointers
|
|
1213
|
+
CB.ReqParams=PReqFunGetBlockInfo(pbyte(PDUH_in)+ReqHeaderSize);
|
|
1214
|
+
CB.ResParams=PResFunGetBlockInfo(pbyte(&CB.Answer)+ResHeaderSize17);
|
|
1215
|
+
BlockType =pbyte(PDUH_in)+23;
|
|
1216
|
+
|
|
1217
|
+
switch (CB.ReqParams->SubFun)
|
|
1218
|
+
{
|
|
1219
|
+
case SFun_ListAll : BLK_ListAll(CB); break; // List all blocks
|
|
1220
|
+
case SFun_ListBoT :
|
|
1221
|
+
{
|
|
1222
|
+
if (CB.ReqParams->Plen==4)
|
|
1223
|
+
{
|
|
1224
|
+
LastBlk=*BlockType;
|
|
1225
|
+
BLK_ListBoT(*BlockType, true, CB); // start sequence from beginning
|
|
1226
|
+
}
|
|
1227
|
+
else
|
|
1228
|
+
BLK_ListBoT(LastBlk, false, CB); // Continue sequence
|
|
1229
|
+
}; break;
|
|
1230
|
+
case SFun_BlkInfo : BLK_GetBlkInfo(CB); // Get Block info
|
|
1231
|
+
}
|
|
1232
|
+
return true;
|
|
1233
|
+
}
|
|
1234
|
+
//==============================================================================
|
|
1235
|
+
// FUNCTION SZL
|
|
1236
|
+
//==============================================================================
|
|
1237
|
+
void TS7Worker::SZLNotAvailable()
|
|
1238
|
+
{
|
|
1239
|
+
SZL.Answer.Header.DataLen=SwapWord(sizeof(SZLNotAvail));
|
|
1240
|
+
SZL.ResParams->Err = 0x02D4;
|
|
1241
|
+
memcpy(SZL.ResData, &SZLNotAvail, sizeof(SZLNotAvail));
|
|
1242
|
+
isoSendBuffer(&SZL.Answer,26);
|
|
1243
|
+
SZL.SZLDone=false;
|
|
1244
|
+
}
|
|
1245
|
+
void TS7Worker::SZLSystemState()
|
|
1246
|
+
{
|
|
1247
|
+
SZL.Answer.Header.DataLen=SwapWord(sizeof(SZLSysState));
|
|
1248
|
+
SZL.ResParams->Err =0x0000;
|
|
1249
|
+
memcpy(SZL.ResData,&SZLSysState,sizeof(SZLSysState));
|
|
1250
|
+
isoSendBuffer(&SZL.Answer,28);
|
|
1251
|
+
SZL.SZLDone=true;
|
|
1252
|
+
|
|
1253
|
+
}
|
|
1254
|
+
void TS7Worker::SZLData(void *P, int len)
|
|
1255
|
+
{
|
|
1256
|
+
int MaxSzl=FPDULength-22;
|
|
1257
|
+
|
|
1258
|
+
if (len>MaxSzl) {
|
|
1259
|
+
len=MaxSzl;
|
|
1260
|
+
}
|
|
1261
|
+
|
|
1262
|
+
SZL.Answer.Header.DataLen=SwapWord(word(len));
|
|
1263
|
+
SZL.ResParams->Err =0x0000;
|
|
1264
|
+
SZL.ResParams->resvd=0x0000; // this is the end, no more packets
|
|
1265
|
+
memcpy(SZL.ResData, P, len);
|
|
1266
|
+
|
|
1267
|
+
SZL.ResData[2]=((len-4)>>8) & 0xFF;
|
|
1268
|
+
SZL.ResData[3]=(len-4) & 0xFF;
|
|
1269
|
+
|
|
1270
|
+
isoSendBuffer(&SZL.Answer,22+len);
|
|
1271
|
+
SZL.SZLDone=true;
|
|
1272
|
+
}
|
|
1273
|
+
// this block is dynamic (contains date/time and cpu status)
|
|
1274
|
+
void TS7Worker::SZL_ID424()
|
|
1275
|
+
{
|
|
1276
|
+
PS7Time PTime;
|
|
1277
|
+
pbyte PStatus;
|
|
1278
|
+
|
|
1279
|
+
SZL.Answer.Header.DataLen=SwapWord(sizeof(SZL_ID_0424_IDX_XXXX));
|
|
1280
|
+
SZL.ResParams->Err =0x0000;
|
|
1281
|
+
PTime=PS7Time(pbyte(SZL.ResData)+24);
|
|
1282
|
+
PStatus =pbyte(SZL.ResData)+15;
|
|
1283
|
+
memcpy(SZL.ResData,&SZL_ID_0424_IDX_XXXX,sizeof(SZL_ID_0424_IDX_XXXX));
|
|
1284
|
+
FillTime(PTime);
|
|
1285
|
+
*PStatus=FServer->CpuStatus;
|
|
1286
|
+
SZL.SZLDone=true;
|
|
1287
|
+
isoSendBuffer(&SZL.Answer,22+sizeof(SZL_ID_0424_IDX_XXXX));
|
|
1288
|
+
}
|
|
1289
|
+
|
|
1290
|
+
void TS7Worker::SZL_ID131_IDX003()
|
|
1291
|
+
{
|
|
1292
|
+
word len = sizeof(SZL_ID_0131_IDX_0003);
|
|
1293
|
+
SZL.Answer.Header.DataLen=SwapWord(len);
|
|
1294
|
+
SZL.ResParams->Err =0x0000;
|
|
1295
|
+
SZL.ResParams->resvd=0x0000; // this is the end, no more packets
|
|
1296
|
+
memcpy(SZL.ResData, &SZL_ID_0131_IDX_0003, len);
|
|
1297
|
+
// Set the max consistent data window to PDU size
|
|
1298
|
+
SZL.ResData[18]=((FPDULength)>>8) & 0xFF;
|
|
1299
|
+
SZL.ResData[19]=(FPDULength) & 0xFF;
|
|
1300
|
+
|
|
1301
|
+
isoSendBuffer(&SZL.Answer,22+len);
|
|
1302
|
+
SZL.SZLDone=true;
|
|
1303
|
+
}
|
|
1304
|
+
|
|
1305
|
+
bool TS7Worker::PerformGroupSZL()
|
|
1306
|
+
{
|
|
1307
|
+
SZL.SZLDone=false;
|
|
1308
|
+
// Setup pointers
|
|
1309
|
+
SZL.ReqParams=PReqFunReadSZLFirst(pbyte(PDUH_in)+ReqHeaderSize);
|
|
1310
|
+
SZL.ResParams=PS7ResParams7(pbyte(&SZL.Answer)+ResHeaderSize17);
|
|
1311
|
+
SZL.ResData =pbyte(&SZL.Answer)+ResHeaderSize17+sizeof(TS7Params7);
|
|
1312
|
+
// Prepare Answer header
|
|
1313
|
+
SZL.Answer.Header.P=0x32;
|
|
1314
|
+
SZL.Answer.Header.PDUType=PduType_userdata;
|
|
1315
|
+
SZL.Answer.Header.AB_EX=0x0000;
|
|
1316
|
+
SZL.Answer.Header.Sequence=PDUH_in->Sequence;
|
|
1317
|
+
SZL.Answer.Header.ParLen =SwapWord(sizeof(TS7Params7));
|
|
1318
|
+
|
|
1319
|
+
SZL.ResParams->Head[0]=SZL.ReqParams->Head[0];
|
|
1320
|
+
SZL.ResParams->Head[1]=SZL.ReqParams->Head[1];
|
|
1321
|
+
SZL.ResParams->Head[2]=SZL.ReqParams->Head[2];
|
|
1322
|
+
SZL.ResParams->Plen =0x08;
|
|
1323
|
+
SZL.ResParams->Uk =0x12;
|
|
1324
|
+
SZL.ResParams->Tg =0x84; // Type response + group szl
|
|
1325
|
+
SZL.ResParams->SubFun=SZL.ReqParams->SubFun;
|
|
1326
|
+
SZL.ResParams->Seq =SZL.ReqParams->Seq;
|
|
1327
|
+
SZL.ResParams->resvd=0x0000; // this is the end, no more packets
|
|
1328
|
+
|
|
1329
|
+
// only two subfunction are defined : 0x01 read, 0x02 system state
|
|
1330
|
+
if (SZL.ResParams->SubFun==0x02) // 0x02 = subfunction system state
|
|
1331
|
+
{
|
|
1332
|
+
SZLSystemState();
|
|
1333
|
+
return true;
|
|
1334
|
+
};
|
|
1335
|
+
if (SZL.ResParams->SubFun!=0x01)
|
|
1336
|
+
{
|
|
1337
|
+
SZLNotAvailable();
|
|
1338
|
+
return true;
|
|
1339
|
+
};
|
|
1340
|
+
// From here we assume subfunction = 0x01
|
|
1341
|
+
SZL.ReqData=PS7ReqSZLData(pbyte(PDUH_in)+ReqHeaderSize+sizeof(TReqFunReadSZLFirst));// Data after params
|
|
1342
|
+
|
|
1343
|
+
SZL.ID=SwapWord(SZL.ReqData->ID);
|
|
1344
|
+
SZL.Index=SwapWord(SZL.ReqData->Index);
|
|
1345
|
+
|
|
1346
|
+
// Switch prebuilt Data Bank (they come from a physical CPU)
|
|
1347
|
+
switch (SZL.ID)
|
|
1348
|
+
{
|
|
1349
|
+
case 0x0000 : SZLData(&SZL_ID_0000_IDX_XXXX,sizeof(SZL_ID_0000_IDX_XXXX));break;
|
|
1350
|
+
case 0x0F00 : SZLData(&SZL_ID_0F00_IDX_XXXX,sizeof(SZL_ID_0F00_IDX_XXXX));break;
|
|
1351
|
+
case 0x0002 : SZLData(&SZL_ID_0002_IDX_XXXX,sizeof(SZL_ID_0002_IDX_XXXX));break;
|
|
1352
|
+
case 0x0011 : SZLData(&SZL_ID_0011_IDX_XXXX,sizeof(SZL_ID_0011_IDX_XXXX));break;
|
|
1353
|
+
case 0x0012 : SZLData(&SZL_ID_0012_IDX_XXXX,sizeof(SZL_ID_0012_IDX_XXXX));break;
|
|
1354
|
+
case 0x0013 : SZLData(&SZL_ID_0013_IDX_XXXX,sizeof(SZL_ID_0013_IDX_XXXX));break;
|
|
1355
|
+
case 0x0014 : SZLData(&SZL_ID_0014_IDX_XXXX,sizeof(SZL_ID_0014_IDX_XXXX));break;
|
|
1356
|
+
case 0x0015 : SZLData(&SZL_ID_0015_IDX_XXXX,sizeof(SZL_ID_0015_IDX_XXXX));break;
|
|
1357
|
+
case 0x0F14 : SZLData(&SZL_ID_0F14_IDX_XXXX,sizeof(SZL_ID_0F14_IDX_XXXX));break;
|
|
1358
|
+
case 0x0019 : SZLData(&SZL_ID_0019_IDX_XXXX,sizeof(SZL_ID_0019_IDX_XXXX));break;
|
|
1359
|
+
case 0x0F19 : SZLData(&SZL_ID_0F19_IDX_XXXX,sizeof(SZL_ID_0F19_IDX_XXXX));break;
|
|
1360
|
+
case 0x001C : SZLData(&SZL_ID_001C_IDX_XXXX,sizeof(SZL_ID_001C_IDX_XXXX));break;
|
|
1361
|
+
case 0x0F1C : SZLData(&SZL_ID_0F1C_IDX_XXXX,sizeof(SZL_ID_0F1C_IDX_XXXX));break;
|
|
1362
|
+
case 0x0036 : SZLData(&SZL_ID_0036_IDX_XXXX,sizeof(SZL_ID_0036_IDX_XXXX));break;
|
|
1363
|
+
case 0x0F36 : SZLData(&SZL_ID_0F36_IDX_XXXX,sizeof(SZL_ID_0F36_IDX_XXXX));break;
|
|
1364
|
+
case 0x0025 : SZLData(&SZL_ID_0025_IDX_XXXX,sizeof(SZL_ID_0025_IDX_XXXX));break;
|
|
1365
|
+
case 0x0F25 : SZLData(&SZL_ID_0F25_IDX_XXXX,sizeof(SZL_ID_0F25_IDX_XXXX));break;
|
|
1366
|
+
case 0x0037 : SZLData(&SZL_ID_0037_IDX_XXXX,sizeof(SZL_ID_0037_IDX_XXXX));break;
|
|
1367
|
+
case 0x0F37 : SZLData(&SZL_ID_0F37_IDX_XXXX,sizeof(SZL_ID_0F37_IDX_XXXX));break;
|
|
1368
|
+
case 0x0074 : SZLData(&SZL_ID_0074_IDX_XXXX,sizeof(SZL_ID_0074_IDX_XXXX));break;
|
|
1369
|
+
case 0x0F74 : SZLData(&SZL_ID_0F74_IDX_XXXX,sizeof(SZL_ID_0F74_IDX_XXXX));break;
|
|
1370
|
+
case 0x0591 : SZLData(&SZL_ID_0591_IDX_XXXX,sizeof(SZL_ID_0591_IDX_XXXX));break;
|
|
1371
|
+
case 0x0A91 : SZLData(&SZL_ID_0A91_IDX_XXXX,sizeof(SZL_ID_0A91_IDX_XXXX));break;
|
|
1372
|
+
case 0x0F92 : SZLData(&SZL_ID_0F92_IDX_XXXX,sizeof(SZL_ID_0F92_IDX_XXXX));break;
|
|
1373
|
+
case 0x0294 : SZLData(&SZL_ID_0294_IDX_XXXX,sizeof(SZL_ID_0294_IDX_XXXX));break;
|
|
1374
|
+
case 0x0794 : SZLData(&SZL_ID_0794_IDX_XXXX,sizeof(SZL_ID_0794_IDX_XXXX));break;
|
|
1375
|
+
case 0x0F94 : SZLData(&SZL_ID_0F94_IDX_XXXX,sizeof(SZL_ID_0F94_IDX_XXXX));break;
|
|
1376
|
+
case 0x0095 : SZLData(&SZL_ID_0095_IDX_XXXX,sizeof(SZL_ID_0095_IDX_XXXX));break;
|
|
1377
|
+
case 0x0F95 : SZLData(&SZL_ID_0F95_IDX_XXXX,sizeof(SZL_ID_0F95_IDX_XXXX));break;
|
|
1378
|
+
case 0x00A0 : SZLData(&SZL_ID_00A0_IDX_XXXX,sizeof(SZL_ID_00A0_IDX_XXXX));break;
|
|
1379
|
+
case 0x0FA0 : SZLData(&SZL_ID_0FA0_IDX_XXXX,sizeof(SZL_ID_0FA0_IDX_XXXX));break;
|
|
1380
|
+
case 0x0017 : SZLData(&SZL_ID_0017_IDX_XXXX,sizeof(SZL_ID_0017_IDX_XXXX));break;
|
|
1381
|
+
case 0x0F17 : SZLData(&SZL_ID_0F17_IDX_XXXX,sizeof(SZL_ID_0F17_IDX_XXXX));break;
|
|
1382
|
+
case 0x0018 : SZLData(&SZL_ID_0018_IDX_XXXX,sizeof(SZL_ID_0018_IDX_XXXX));break;
|
|
1383
|
+
case 0x0F18 : SZLData(&SZL_ID_0F18_IDX_XXXX,sizeof(SZL_ID_0F18_IDX_XXXX));break;
|
|
1384
|
+
case 0x001A : SZLData(&SZL_ID_001A_IDX_XXXX,sizeof(SZL_ID_001A_IDX_XXXX));break;
|
|
1385
|
+
case 0x0F1A : SZLData(&SZL_ID_0F1A_IDX_XXXX,sizeof(SZL_ID_0F1A_IDX_XXXX));break;
|
|
1386
|
+
case 0x001B : SZLData(&SZL_ID_001B_IDX_XXXX,sizeof(SZL_ID_001B_IDX_XXXX));break;
|
|
1387
|
+
case 0x0F1B : SZLData(&SZL_ID_0F1B_IDX_XXXX,sizeof(SZL_ID_0F1B_IDX_XXXX));break;
|
|
1388
|
+
case 0x0021 : SZLData(&SZL_ID_0021_IDX_XXXX,sizeof(SZL_ID_0021_IDX_XXXX));break;
|
|
1389
|
+
case 0x0A21 : SZLData(&SZL_ID_0A21_IDX_XXXX,sizeof(SZL_ID_0A21_IDX_XXXX));break;
|
|
1390
|
+
case 0x0F21 : SZLData(&SZL_ID_0F21_IDX_XXXX,sizeof(SZL_ID_0F21_IDX_XXXX));break;
|
|
1391
|
+
case 0x0023 : SZLData(&SZL_ID_0023_IDX_XXXX,sizeof(SZL_ID_0023_IDX_XXXX));break;
|
|
1392
|
+
case 0x0F23 : SZLData(&SZL_ID_0F23_IDX_XXXX,sizeof(SZL_ID_0F23_IDX_XXXX));break;
|
|
1393
|
+
case 0x0024 : SZLData(&SZL_ID_0024_IDX_XXXX,sizeof(SZL_ID_0024_IDX_XXXX));break;
|
|
1394
|
+
case 0x0124 : SZLData(&SZL_ID_0124_IDX_XXXX,sizeof(SZL_ID_0124_IDX_XXXX));break;
|
|
1395
|
+
case 0x0424 : SZL_ID424();break;
|
|
1396
|
+
case 0x0038 : SZLData(&SZL_ID_0038_IDX_XXXX,sizeof(SZL_ID_0038_IDX_XXXX));break;
|
|
1397
|
+
case 0x0F38 : SZLData(&SZL_ID_0F38_IDX_XXXX,sizeof(SZL_ID_0F38_IDX_XXXX));break;
|
|
1398
|
+
case 0x003A : SZLData(&SZL_ID_003A_IDX_XXXX,sizeof(SZL_ID_003A_IDX_XXXX));break;
|
|
1399
|
+
case 0x0F3A : SZLData(&SZL_ID_0F3A_IDX_XXXX,sizeof(SZL_ID_0F3A_IDX_XXXX));break;
|
|
1400
|
+
case 0x0F9A : SZLData(&SZL_ID_0F9A_IDX_XXXX,sizeof(SZL_ID_0F9A_IDX_XXXX));break;
|
|
1401
|
+
case 0x0D91 : switch(SZL.Index){
|
|
1402
|
+
case 0x0000 : SZLData(&SZL_ID_0D91_IDX_0000,sizeof(SZL_ID_0D91_IDX_0000));break;
|
|
1403
|
+
default: SZLNotAvailable();break;
|
|
1404
|
+
};
|
|
1405
|
+
break;
|
|
1406
|
+
case 0x0092 : switch(SZL.Index){
|
|
1407
|
+
case 0x0000 : SZLData(&SZL_ID_0092_IDX_0000,sizeof(SZL_ID_0092_IDX_0000));break;
|
|
1408
|
+
default : SZLNotAvailable();break;
|
|
1409
|
+
};break;
|
|
1410
|
+
case 0x0292 : switch(SZL.Index){
|
|
1411
|
+
case 0x0000 : SZLData(&SZL_ID_0292_IDX_0000,sizeof(SZL_ID_0292_IDX_0000));break;
|
|
1412
|
+
default : SZLNotAvailable();break;
|
|
1413
|
+
};break;
|
|
1414
|
+
case 0x0692 : switch(SZL.Index){
|
|
1415
|
+
case 0x0000 : SZLData(&SZL_ID_0692_IDX_0000,sizeof(SZL_ID_0692_IDX_0000));break;
|
|
1416
|
+
default : SZLNotAvailable();break;
|
|
1417
|
+
};break;
|
|
1418
|
+
case 0x0094 : switch(SZL.Index){
|
|
1419
|
+
case 0x0000 : SZLData(&SZL_ID_0094_IDX_0000,sizeof(SZL_ID_0094_IDX_0000));break;
|
|
1420
|
+
default : SZLNotAvailable();break;
|
|
1421
|
+
};break;
|
|
1422
|
+
case 0x0D97 : switch(SZL.Index){
|
|
1423
|
+
case 0x0000 : SZLData(&SZL_ID_0D97_IDX_0000,sizeof(SZL_ID_0D97_IDX_0000));break;
|
|
1424
|
+
default : SZLNotAvailable();break;
|
|
1425
|
+
};break;
|
|
1426
|
+
case 0x0111 : switch(SZL.Index){
|
|
1427
|
+
case 0x0001 : SZLData(&SZL_ID_0111_IDX_0001,sizeof(SZL_ID_0111_IDX_0001));break;
|
|
1428
|
+
case 0x0006 : SZLData(&SZL_ID_0111_IDX_0006,sizeof(SZL_ID_0111_IDX_0006));break;
|
|
1429
|
+
case 0x0007 : SZLData(&SZL_ID_0111_IDX_0007,sizeof(SZL_ID_0111_IDX_0007));break;
|
|
1430
|
+
default : SZLNotAvailable();break;
|
|
1431
|
+
};break;
|
|
1432
|
+
case 0x0F11 : switch(SZL.Index){
|
|
1433
|
+
case 0x0001 : SZLData(&SZL_ID_0F11_IDX_0001,sizeof(SZL_ID_0F11_IDX_0001));break;
|
|
1434
|
+
case 0x0006 : SZLData(&SZL_ID_0F11_IDX_0006,sizeof(SZL_ID_0F11_IDX_0006));break;
|
|
1435
|
+
case 0x0007 : SZLData(&SZL_ID_0F11_IDX_0007,sizeof(SZL_ID_0F11_IDX_0007));break;
|
|
1436
|
+
default : SZLNotAvailable();break;
|
|
1437
|
+
};break;
|
|
1438
|
+
case 0x0112 : switch(SZL.Index){
|
|
1439
|
+
case 0x0000 : SZLData(&SZL_ID_0112_IDX_0000,sizeof(SZL_ID_0112_IDX_0000));break;
|
|
1440
|
+
case 0x0100 : SZLData(&SZL_ID_0112_IDX_0100,sizeof(SZL_ID_0112_IDX_0100));break;
|
|
1441
|
+
case 0x0200 : SZLData(&SZL_ID_0112_IDX_0200,sizeof(SZL_ID_0112_IDX_0200));break;
|
|
1442
|
+
case 0x0400 : SZLData(&SZL_ID_0112_IDX_0400,sizeof(SZL_ID_0112_IDX_0400));break;
|
|
1443
|
+
default : SZLNotAvailable();break;
|
|
1444
|
+
};break;
|
|
1445
|
+
case 0x0F12 : switch(SZL.Index){
|
|
1446
|
+
case 0x0000 : SZLData(&SZL_ID_0F12_IDX_0000,sizeof(SZL_ID_0F12_IDX_0000));break;
|
|
1447
|
+
case 0x0100 : SZLData(&SZL_ID_0F12_IDX_0100,sizeof(SZL_ID_0F12_IDX_0100));break;
|
|
1448
|
+
case 0x0200 : SZLData(&SZL_ID_0F12_IDX_0200,sizeof(SZL_ID_0F12_IDX_0200));break;
|
|
1449
|
+
case 0x0400 : SZLData(&SZL_ID_0F12_IDX_0400,sizeof(SZL_ID_0F12_IDX_0400));break;
|
|
1450
|
+
default : SZLNotAvailable();break;
|
|
1451
|
+
};break;
|
|
1452
|
+
case 0x0113 : switch(SZL.Index){
|
|
1453
|
+
case 0x0001 : SZLData(&SZL_ID_0113_IDX_0001,sizeof(SZL_ID_0113_IDX_0001));break;
|
|
1454
|
+
default : SZLNotAvailable();break;
|
|
1455
|
+
};break;
|
|
1456
|
+
case 0x0115 : switch(SZL.Index){
|
|
1457
|
+
case 0x0800 : SZLData(&SZL_ID_0115_IDX_0800,sizeof(SZL_ID_0115_IDX_0800));break;
|
|
1458
|
+
default : SZLNotAvailable();break;
|
|
1459
|
+
};break;
|
|
1460
|
+
case 0x011C : switch(SZL.Index){
|
|
1461
|
+
case 0x0001 : SZLData(&SZL_ID_011C_IDX_0001,sizeof(SZL_ID_011C_IDX_0001));break;
|
|
1462
|
+
case 0x0002 : SZLData(&SZL_ID_011C_IDX_0002,sizeof(SZL_ID_011C_IDX_0002));break;
|
|
1463
|
+
case 0x0003 : SZLData(&SZL_ID_011C_IDX_0003,sizeof(SZL_ID_011C_IDX_0003));break;
|
|
1464
|
+
case 0x0004 : SZLData(&SZL_ID_011C_IDX_0004,sizeof(SZL_ID_011C_IDX_0004));break;
|
|
1465
|
+
case 0x0005 : SZLData(&SZL_ID_011C_IDX_0005,sizeof(SZL_ID_011C_IDX_0005));break;
|
|
1466
|
+
case 0x0007 : SZLData(&SZL_ID_011C_IDX_0007,sizeof(SZL_ID_011C_IDX_0007));break;
|
|
1467
|
+
case 0x0008 : SZLData(&SZL_ID_011C_IDX_0008,sizeof(SZL_ID_011C_IDX_0008));break;
|
|
1468
|
+
case 0x0009 : SZLData(&SZL_ID_011C_IDX_0009,sizeof(SZL_ID_011C_IDX_0009));break;
|
|
1469
|
+
case 0x000A : SZLData(&SZL_ID_011C_IDX_000A,sizeof(SZL_ID_011C_IDX_000A));break;
|
|
1470
|
+
case 0x000B : SZLData(&SZL_ID_011C_IDX_000B,sizeof(SZL_ID_011C_IDX_000B));break;
|
|
1471
|
+
default : SZLNotAvailable();break;
|
|
1472
|
+
};break;
|
|
1473
|
+
case 0x0222 : switch(SZL.Index){
|
|
1474
|
+
case 0x0001 : SZLData(&SZL_ID_0222_IDX_0001,sizeof(SZL_ID_0222_IDX_0001));break;
|
|
1475
|
+
case 0x000A : SZLData(&SZL_ID_0222_IDX_000A,sizeof(SZL_ID_0222_IDX_000A));break;
|
|
1476
|
+
case 0x0014 : SZLData(&SZL_ID_0222_IDX_0014,sizeof(SZL_ID_0222_IDX_0014));break;
|
|
1477
|
+
case 0x0028 : SZLData(&SZL_ID_0222_IDX_0028,sizeof(SZL_ID_0222_IDX_0028));break;
|
|
1478
|
+
case 0x0050 : SZLData(&SZL_ID_0222_IDX_0050,sizeof(SZL_ID_0222_IDX_0050));break;
|
|
1479
|
+
case 0x0064 : SZLData(&SZL_ID_0222_IDX_0064,sizeof(SZL_ID_0222_IDX_0064));break;
|
|
1480
|
+
default : SZLNotAvailable();break;
|
|
1481
|
+
};break;
|
|
1482
|
+
case 0x0125 : switch(SZL.Index){
|
|
1483
|
+
case 0x0000 : SZLData(&SZL_ID_0125_IDX_0000,sizeof(SZL_ID_0125_IDX_0000));break;
|
|
1484
|
+
case 0x0001 : SZLData(&SZL_ID_0125_IDX_0001,sizeof(SZL_ID_0125_IDX_0001));break;
|
|
1485
|
+
default : SZLNotAvailable();break;
|
|
1486
|
+
};break;
|
|
1487
|
+
case 0x0225 : switch(SZL.Index){
|
|
1488
|
+
case 0x0001 : SZLData(&SZL_ID_0225_IDX_0001,sizeof(SZL_ID_0225_IDX_0001));break;
|
|
1489
|
+
default : SZLNotAvailable();break;
|
|
1490
|
+
};break;
|
|
1491
|
+
case 0x0131 : switch(SZL.Index){
|
|
1492
|
+
case 0x0001 : SZLData(&SZL_ID_0131_IDX_0001,sizeof(SZL_ID_0131_IDX_0001));break;
|
|
1493
|
+
case 0x0002 : SZLData(&SZL_ID_0131_IDX_0002,sizeof(SZL_ID_0131_IDX_0002));break;
|
|
1494
|
+
case 0x0003 : SZL_ID131_IDX003();break;
|
|
1495
|
+
case 0x0004 : SZLData(&SZL_ID_0131_IDX_0004,sizeof(SZL_ID_0131_IDX_0004));break;
|
|
1496
|
+
case 0x0005 : SZLData(&SZL_ID_0131_IDX_0005,sizeof(SZL_ID_0131_IDX_0005));break;
|
|
1497
|
+
case 0x0006 : SZLData(&SZL_ID_0131_IDX_0006,sizeof(SZL_ID_0131_IDX_0006));break;
|
|
1498
|
+
case 0x0007 : SZLData(&SZL_ID_0131_IDX_0007,sizeof(SZL_ID_0131_IDX_0007));break;
|
|
1499
|
+
case 0x0008 : SZLData(&SZL_ID_0131_IDX_0008,sizeof(SZL_ID_0131_IDX_0008));break;
|
|
1500
|
+
case 0x0009 : SZLData(&SZL_ID_0131_IDX_0009,sizeof(SZL_ID_0131_IDX_0009));break;
|
|
1501
|
+
default : SZLNotAvailable();break;
|
|
1502
|
+
};break;
|
|
1503
|
+
case 0x0117 : switch(SZL.Index){
|
|
1504
|
+
case 0x0000 : SZLData(&SZL_ID_0117_IDX_0000,sizeof(SZL_ID_0117_IDX_0000));break;
|
|
1505
|
+
case 0x0001 : SZLData(&SZL_ID_0117_IDX_0001,sizeof(SZL_ID_0117_IDX_0001));break;
|
|
1506
|
+
case 0x0002 : SZLData(&SZL_ID_0117_IDX_0002,sizeof(SZL_ID_0117_IDX_0002));break;
|
|
1507
|
+
case 0x0003 : SZLData(&SZL_ID_0117_IDX_0003,sizeof(SZL_ID_0117_IDX_0003));break;
|
|
1508
|
+
case 0x0004 : SZLData(&SZL_ID_0117_IDX_0004,sizeof(SZL_ID_0117_IDX_0004));break;
|
|
1509
|
+
default : SZLNotAvailable();break;
|
|
1510
|
+
};break;
|
|
1511
|
+
case 0x0118 : switch(SZL.Index){
|
|
1512
|
+
case 0x0000 : SZLData(&SZL_ID_0118_IDX_0000,sizeof(SZL_ID_0118_IDX_0000));break;
|
|
1513
|
+
case 0x0001 : SZLData(&SZL_ID_0118_IDX_0001,sizeof(SZL_ID_0118_IDX_0001));break;
|
|
1514
|
+
case 0x0002 : SZLData(&SZL_ID_0118_IDX_0002,sizeof(SZL_ID_0118_IDX_0002));break;
|
|
1515
|
+
case 0x0003 : SZLData(&SZL_ID_0118_IDX_0003,sizeof(SZL_ID_0118_IDX_0003));break;
|
|
1516
|
+
default : SZLNotAvailable();break;
|
|
1517
|
+
};break;
|
|
1518
|
+
case 0x0132 : switch(SZL.Index){
|
|
1519
|
+
case 0x0001 : SZLData(&SZL_ID_0132_IDX_0001,sizeof(SZL_ID_0132_IDX_0001));break;
|
|
1520
|
+
case 0x0002 : SZLData(&SZL_ID_0132_IDX_0002,sizeof(SZL_ID_0132_IDX_0002));break;
|
|
1521
|
+
case 0x0003 : SZLData(&SZL_ID_0132_IDX_0003,sizeof(SZL_ID_0132_IDX_0003));break;
|
|
1522
|
+
case 0x0004 : SZLData(&SZL_ID_0132_IDX_0004,sizeof(SZL_ID_0132_IDX_0004));break;
|
|
1523
|
+
case 0x0005 : SZLData(&SZL_ID_0132_IDX_0005,sizeof(SZL_ID_0132_IDX_0005));break;
|
|
1524
|
+
case 0x0006 : SZLData(&SZL_ID_0132_IDX_0006,sizeof(SZL_ID_0132_IDX_0006));break;
|
|
1525
|
+
case 0x0007 : SZLData(&SZL_ID_0132_IDX_0007,sizeof(SZL_ID_0132_IDX_0007));break;
|
|
1526
|
+
case 0x0008 : SZLData(&SZL_ID_0132_IDX_0008,sizeof(SZL_ID_0132_IDX_0008));break;
|
|
1527
|
+
case 0x0009 : SZLData(&SZL_ID_0132_IDX_0009,sizeof(SZL_ID_0132_IDX_0009));break;
|
|
1528
|
+
case 0x000A : SZLData(&SZL_ID_0132_IDX_000A,sizeof(SZL_ID_0132_IDX_000A));break;
|
|
1529
|
+
case 0x000B : SZLData(&SZL_ID_0132_IDX_000B,sizeof(SZL_ID_0132_IDX_000B));break;
|
|
1530
|
+
case 0x000C : SZLData(&SZL_ID_0132_IDX_000C,sizeof(SZL_ID_0132_IDX_000C));break;
|
|
1531
|
+
default : SZLNotAvailable();break;
|
|
1532
|
+
};break;
|
|
1533
|
+
case 0x0137 : switch(SZL.Index){
|
|
1534
|
+
case 0x07FE : SZLData(&SZL_ID_0137_IDX_07FE,sizeof(SZL_ID_0137_IDX_07FE));break;
|
|
1535
|
+
default : SZLNotAvailable();break;
|
|
1536
|
+
};break;
|
|
1537
|
+
case 0x01A0 : switch(SZL.Index){
|
|
1538
|
+
case 0x0000 : SZLData(&SZL_ID_01A0_IDX_0000,sizeof(SZL_ID_01A0_IDX_0000));break;
|
|
1539
|
+
case 0x0001 : SZLData(&SZL_ID_01A0_IDX_0001,sizeof(SZL_ID_01A0_IDX_0001));break;
|
|
1540
|
+
case 0x0002 : SZLData(&SZL_ID_01A0_IDX_0002,sizeof(SZL_ID_01A0_IDX_0002));break;
|
|
1541
|
+
case 0x0003 : SZLData(&SZL_ID_01A0_IDX_0003,sizeof(SZL_ID_01A0_IDX_0003));break;
|
|
1542
|
+
case 0x0004 : SZLData(&SZL_ID_01A0_IDX_0004,sizeof(SZL_ID_01A0_IDX_0004));break;
|
|
1543
|
+
case 0x0005 : SZLData(&SZL_ID_01A0_IDX_0005,sizeof(SZL_ID_01A0_IDX_0005));break;
|
|
1544
|
+
case 0x0006 : SZLData(&SZL_ID_01A0_IDX_0006,sizeof(SZL_ID_01A0_IDX_0006));break;
|
|
1545
|
+
case 0x0007 : SZLData(&SZL_ID_01A0_IDX_0007,sizeof(SZL_ID_01A0_IDX_0007));break;
|
|
1546
|
+
case 0x0008 : SZLData(&SZL_ID_01A0_IDX_0008,sizeof(SZL_ID_01A0_IDX_0008));break;
|
|
1547
|
+
case 0x0009 : SZLData(&SZL_ID_01A0_IDX_0009,sizeof(SZL_ID_01A0_IDX_0009));break;
|
|
1548
|
+
case 0x000A : SZLData(&SZL_ID_01A0_IDX_000A,sizeof(SZL_ID_01A0_IDX_000A));break;
|
|
1549
|
+
case 0x000B : SZLData(&SZL_ID_01A0_IDX_000B,sizeof(SZL_ID_01A0_IDX_000B));break;
|
|
1550
|
+
case 0x000C : SZLData(&SZL_ID_01A0_IDX_000C,sizeof(SZL_ID_01A0_IDX_000C));break;
|
|
1551
|
+
case 0x000D : SZLData(&SZL_ID_01A0_IDX_000D,sizeof(SZL_ID_01A0_IDX_000D));break;
|
|
1552
|
+
case 0x000E : SZLData(&SZL_ID_01A0_IDX_000E,sizeof(SZL_ID_01A0_IDX_000E));break;
|
|
1553
|
+
case 0x000F : SZLData(&SZL_ID_01A0_IDX_000F,sizeof(SZL_ID_01A0_IDX_000F));break;
|
|
1554
|
+
case 0x0010 : SZLData(&SZL_ID_01A0_IDX_0010,sizeof(SZL_ID_01A0_IDX_0010));break;
|
|
1555
|
+
case 0x0011 : SZLData(&SZL_ID_01A0_IDX_0011,sizeof(SZL_ID_01A0_IDX_0011));break;
|
|
1556
|
+
case 0x0012 : SZLData(&SZL_ID_01A0_IDX_0012,sizeof(SZL_ID_01A0_IDX_0012));break;
|
|
1557
|
+
case 0x0013 : SZLData(&SZL_ID_01A0_IDX_0013,sizeof(SZL_ID_01A0_IDX_0013));break;
|
|
1558
|
+
case 0x0014 : SZLData(&SZL_ID_01A0_IDX_0014,sizeof(SZL_ID_01A0_IDX_0014));break;
|
|
1559
|
+
case 0x0015 : SZLData(&SZL_ID_01A0_IDX_0015,sizeof(SZL_ID_01A0_IDX_0015));break;
|
|
1560
|
+
default : SZLNotAvailable();break;
|
|
1561
|
+
};break;
|
|
1562
|
+
case 0x0174 : switch(SZL.Index){
|
|
1563
|
+
case 0x0001 : SZLData(&SZL_ID_0174_IDX_0001,sizeof(SZL_ID_0174_IDX_0001));break;
|
|
1564
|
+
case 0x0004 : SZLData(&SZL_ID_0174_IDX_0004,sizeof(SZL_ID_0174_IDX_0004));break;
|
|
1565
|
+
case 0x0005 : SZLData(&SZL_ID_0174_IDX_0005,sizeof(SZL_ID_0174_IDX_0005));break;
|
|
1566
|
+
case 0x0006 : SZLData(&SZL_ID_0174_IDX_0006,sizeof(SZL_ID_0174_IDX_0006));break;
|
|
1567
|
+
case 0x000B : SZLData(&SZL_ID_0174_IDX_000B,sizeof(SZL_ID_0174_IDX_000B));break;
|
|
1568
|
+
case 0x000C : SZLData(&SZL_ID_0174_IDX_000C,sizeof(SZL_ID_0174_IDX_000C));break;
|
|
1569
|
+
default : SZLNotAvailable();break;
|
|
1570
|
+
};break;
|
|
1571
|
+
case 0x0194 : switch(SZL.Index){
|
|
1572
|
+
case 0x0064 : SZLData(&SZL_ID_0194_IDX_0064,sizeof(SZL_ID_0194_IDX_0064));break;
|
|
1573
|
+
default : SZLNotAvailable();break;
|
|
1574
|
+
};break;
|
|
1575
|
+
case 0x0694 : switch(SZL.Index){
|
|
1576
|
+
case 0x0064 : SZLData(&SZL_ID_0694_IDX_0064,sizeof(SZL_ID_0694_IDX_0064));break;
|
|
1577
|
+
default : SZLNotAvailable();break;
|
|
1578
|
+
};break;
|
|
1579
|
+
case 0x0232 : switch(SZL.Index){
|
|
1580
|
+
case 0x0001 : SZLData(&SZL_ID_0232_IDX_0001,sizeof(SZL_ID_0232_IDX_0001));break;
|
|
1581
|
+
case 0x0004 : SZLData(&SZL_ID_0232_IDX_0004,sizeof(SZL_ID_0232_IDX_0004));break;
|
|
1582
|
+
default : SZLNotAvailable();break;
|
|
1583
|
+
};break;
|
|
1584
|
+
case 0x0C91 : switch(SZL.Index){
|
|
1585
|
+
case 0x07FE : SZLData(&SZL_ID_0C91_IDX_07FE,sizeof(SZL_ID_0C91_IDX_07FE));break;
|
|
1586
|
+
default : SZLNotAvailable();break;
|
|
1587
|
+
};break;
|
|
1588
|
+
default : SZLNotAvailable();break;
|
|
1589
|
+
}
|
|
1590
|
+
// Event
|
|
1591
|
+
if (SZL.SZLDone)
|
|
1592
|
+
DoEvent(evcReadSZL,evrNoError,SZL.ID,SZL.Index,0,0);
|
|
1593
|
+
else
|
|
1594
|
+
DoEvent(evcReadSZL,evrInvalidSZL,SZL.ID,SZL.Index,0,0);
|
|
1595
|
+
return true;
|
|
1596
|
+
}
|
|
1597
|
+
//------------------------------------------------------------------------------
|
|
1598
|
+
bool TS7Worker::PerformGroupSecurity()
|
|
1599
|
+
{
|
|
1600
|
+
PReqFunSecurity ReqParams;
|
|
1601
|
+
PResParamsSecurity ResParams;
|
|
1602
|
+
PResDataSecurity ResData;
|
|
1603
|
+
TS7Answer17 Answer;
|
|
1604
|
+
int TotalSize;
|
|
1605
|
+
|
|
1606
|
+
ReqParams=PReqFunSecurity(pbyte(PDUH_in)+ReqHeaderSize);
|
|
1607
|
+
ResParams=PResParamsSecurity(pbyte(&Answer)+ResHeaderSize17);
|
|
1608
|
+
ResData =PResDataSecurity(pbyte(ResParams)+sizeof(TResParamsSecurity));
|
|
1609
|
+
|
|
1610
|
+
// Prepares the answer
|
|
1611
|
+
Answer.Header.P=0x32;
|
|
1612
|
+
Answer.Header.PDUType=PduType_userdata;
|
|
1613
|
+
Answer.Header.AB_EX=0x0000;
|
|
1614
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
1615
|
+
Answer.Header.ParLen =SwapWord(sizeof(TResParamsSecurity));
|
|
1616
|
+
Answer.Header.DataLen=SwapWord(0x0004);
|
|
1617
|
+
// Params
|
|
1618
|
+
ResParams->Head[0]=ReqParams->Head[0];
|
|
1619
|
+
ResParams->Head[1]=ReqParams->Head[1];
|
|
1620
|
+
ResParams->Head[2]=ReqParams->Head[2];
|
|
1621
|
+
ResParams->Plen =0x08;
|
|
1622
|
+
ResParams->Uk =0x12;
|
|
1623
|
+
ResParams->Tg =0x85; // Type response, group functions info
|
|
1624
|
+
ResParams->SubFun=ReqParams->SubFun;
|
|
1625
|
+
ResParams->Seq =ReqParams->Seq;
|
|
1626
|
+
ResParams->resvd =0x0000;
|
|
1627
|
+
ResParams->Err =0x0000;
|
|
1628
|
+
// Data
|
|
1629
|
+
ResData->Ret =0x0A;
|
|
1630
|
+
ResData->TS =0x00;
|
|
1631
|
+
ResData->DLen=0x0000;
|
|
1632
|
+
|
|
1633
|
+
TotalSize=26;
|
|
1634
|
+
isoSendBuffer(&Answer,TotalSize);
|
|
1635
|
+
|
|
1636
|
+
switch (ReqParams->SubFun)
|
|
1637
|
+
{
|
|
1638
|
+
case SFun_EnterPwd : DoEvent(evcSecurity,evrNoError,evsSetPassword,0,0,0); break;
|
|
1639
|
+
case SFun_CancelPwd : DoEvent(evcSecurity,evrNoError,evsClrPassword,0,0,0); break;
|
|
1640
|
+
default : DoEvent(evcSecurity,evrNoError,evsUnknown,0,0,0);
|
|
1641
|
+
};
|
|
1642
|
+
|
|
1643
|
+
return true;
|
|
1644
|
+
}
|
|
1645
|
+
//------------------------------------------------------------------------------
|
|
1646
|
+
bool TS7Worker::PerformGetClock()
|
|
1647
|
+
{
|
|
1648
|
+
PS7ReqParams7 ReqParams;
|
|
1649
|
+
PS7ResParams7 ResParams;
|
|
1650
|
+
TS7Answer17 Answer;
|
|
1651
|
+
PResDataGetTime Data;
|
|
1652
|
+
PS7Time PTime;
|
|
1653
|
+
int TotalSize;
|
|
1654
|
+
|
|
1655
|
+
ReqParams=PS7ReqParams7(pbyte(PDUH_in)+ReqHeaderSize);
|
|
1656
|
+
ResParams=PS7ResParams7(pbyte(&Answer)+ResHeaderSize17);
|
|
1657
|
+
Data =PResDataGetTime(pbyte(&Answer)+ResHeaderSize17+sizeof(TS7Params7));
|
|
1658
|
+
PTime =PS7Time(pbyte(Data)+6);
|
|
1659
|
+
|
|
1660
|
+
// Prepares the answer
|
|
1661
|
+
Answer.Header.P=0x32;
|
|
1662
|
+
Answer.Header.PDUType=PduType_userdata;
|
|
1663
|
+
Answer.Header.AB_EX=0x0000;
|
|
1664
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
1665
|
+
Answer.Header.ParLen =SwapWord(sizeof(TS7Params7));
|
|
1666
|
+
Answer.Header.DataLen=SwapWord(sizeof(TResDataGetTime));
|
|
1667
|
+
|
|
1668
|
+
ResParams->Head[0]=ReqParams->Head[0];
|
|
1669
|
+
ResParams->Head[1]=ReqParams->Head[1];
|
|
1670
|
+
ResParams->Head[2]=ReqParams->Head[2];
|
|
1671
|
+
ResParams->Plen =0x08;
|
|
1672
|
+
ResParams->Uk =0x12;
|
|
1673
|
+
ResParams->Tg =0x87; // Type response, group functions info
|
|
1674
|
+
ResParams->SubFun=ReqParams->SubFun;
|
|
1675
|
+
ResParams->Seq =ReqParams->Seq;
|
|
1676
|
+
ResParams->resvd =0x0000;
|
|
1677
|
+
ResParams->Err =0x0000;
|
|
1678
|
+
|
|
1679
|
+
Data->RetVal =0xFF;
|
|
1680
|
+
Data->TSize =TS_ResOctet;
|
|
1681
|
+
Data->Length =SwapWord(10);
|
|
1682
|
+
Data->Rsvd =0x00;
|
|
1683
|
+
Data->HiYear =0x20; // Year 2000 +
|
|
1684
|
+
FillTime(PTime);
|
|
1685
|
+
|
|
1686
|
+
TotalSize=36;
|
|
1687
|
+
isoSendBuffer(&Answer,TotalSize);
|
|
1688
|
+
DoEvent(evcClock,evrNoError,evsGetClock,0,0,0);
|
|
1689
|
+
return true;
|
|
1690
|
+
}
|
|
1691
|
+
//------------------------------------------------------------------------------
|
|
1692
|
+
bool TS7Worker::PerformSetClock()
|
|
1693
|
+
{
|
|
1694
|
+
PS7ReqParams7 ReqParams;
|
|
1695
|
+
PS7ResParams7 ResParams;
|
|
1696
|
+
PResDataSetTime Data;
|
|
1697
|
+
TS7Answer17 Answer;
|
|
1698
|
+
int TotalSize;
|
|
1699
|
+
|
|
1700
|
+
ReqParams=PS7ReqParams7(pbyte(PDUH_in)+ReqHeaderSize);
|
|
1701
|
+
ResParams=PS7ResParams7(pbyte(&Answer)+ResHeaderSize17);
|
|
1702
|
+
Data =PResDataSetTime(pbyte(&Answer)+ResHeaderSize17+sizeof(TS7Params7));
|
|
1703
|
+
|
|
1704
|
+
// Prepares the answer
|
|
1705
|
+
Answer.Header.P=0x32;
|
|
1706
|
+
Answer.Header.PDUType=PduType_userdata;
|
|
1707
|
+
Answer.Header.AB_EX=0x0000;
|
|
1708
|
+
Answer.Header.Sequence=PDUH_in->Sequence;
|
|
1709
|
+
Answer.Header.ParLen =SwapWord(sizeof(TS7Params7));
|
|
1710
|
+
Answer.Header.DataLen=SwapWord(sizeof(TResDataSetTime));
|
|
1711
|
+
|
|
1712
|
+
ResParams->Head[0]=ReqParams->Head[0];
|
|
1713
|
+
ResParams->Head[1]=ReqParams->Head[1];
|
|
1714
|
+
ResParams->Head[2]=ReqParams->Head[2];
|
|
1715
|
+
ResParams->Plen =0x08;
|
|
1716
|
+
ResParams->Uk =0x12;
|
|
1717
|
+
ResParams->Tg =0x87; // Type response, group functions info
|
|
1718
|
+
ResParams->SubFun=ReqParams->SubFun;
|
|
1719
|
+
ResParams->Seq =ReqParams->Seq;
|
|
1720
|
+
ResParams->resvd =0x0000;
|
|
1721
|
+
ResParams->Err =0x0000;
|
|
1722
|
+
|
|
1723
|
+
Data->RetVal =0x0A;
|
|
1724
|
+
Data->TSize =0x00;
|
|
1725
|
+
Data->Length =0x0000;
|
|
1726
|
+
|
|
1727
|
+
TotalSize=26;
|
|
1728
|
+
isoSendBuffer(&Answer,TotalSize);
|
|
1729
|
+
DoEvent(evcClock,evrNoError,evsSetClock,0,0,0);
|
|
1730
|
+
return true;
|
|
1731
|
+
}
|
|
1732
|
+
//------------------------------------------------------------------------------
|
|
1733
|
+
// S7 SERVER CLASS
|
|
1734
|
+
//------------------------------------------------------------------------------
|
|
1735
|
+
TSnap7Server::TSnap7Server()
|
|
1736
|
+
{
|
|
1737
|
+
CSRWHook = new TSnapCriticalSection();
|
|
1738
|
+
OnReadEvent=NULL;
|
|
1739
|
+
memset(&DB,0,sizeof(DB));
|
|
1740
|
+
memset(&HA,0,sizeof(HA));
|
|
1741
|
+
DBCount=0;
|
|
1742
|
+
DBLimit=0;
|
|
1743
|
+
ForcePDU = 0;
|
|
1744
|
+
ResourceLess = false;
|
|
1745
|
+
LocalPort=isoTcpPort;
|
|
1746
|
+
CpuStatus=S7CpuStatusRun;
|
|
1747
|
+
WorkInterval=100;
|
|
1748
|
+
}
|
|
1749
|
+
//------------------------------------------------------------------------------
|
|
1750
|
+
TSnap7Server::~TSnap7Server()
|
|
1751
|
+
{
|
|
1752
|
+
DisposeAll();
|
|
1753
|
+
delete CSRWHook;
|
|
1754
|
+
}
|
|
1755
|
+
//------------------------------------------------------------------------------
|
|
1756
|
+
PWorkerSocket TSnap7Server::CreateWorkerSocket(socket_t Sock)
|
|
1757
|
+
{
|
|
1758
|
+
PWorkerSocket Result;
|
|
1759
|
+
Result = new TS7Worker();
|
|
1760
|
+
Result->SetSocket(Sock);
|
|
1761
|
+
PS7Worker(Result)->FServer=this;
|
|
1762
|
+
return Result;
|
|
1763
|
+
}
|
|
1764
|
+
//------------------------------------------------------------------------------
|
|
1765
|
+
PS7Area TSnap7Server::FindDB(word DBNumber)
|
|
1766
|
+
{
|
|
1767
|
+
int c;
|
|
1768
|
+
int max=DBLimit+1;
|
|
1769
|
+
|
|
1770
|
+
for (c=0; c<max; c++)
|
|
1771
|
+
{
|
|
1772
|
+
if (DB[c]!=NULL)
|
|
1773
|
+
{
|
|
1774
|
+
if (DB[c]->Number==DBNumber)
|
|
1775
|
+
{
|
|
1776
|
+
return DB[c];
|
|
1777
|
+
}
|
|
1778
|
+
}
|
|
1779
|
+
}
|
|
1780
|
+
return NULL;
|
|
1781
|
+
}
|
|
1782
|
+
//------------------------------------------------------------------------------
|
|
1783
|
+
int TSnap7Server::IndexOfDB(word DBNumber)
|
|
1784
|
+
{
|
|
1785
|
+
int c;
|
|
1786
|
+
int max=DBLimit+1;
|
|
1787
|
+
|
|
1788
|
+
for (c=0; c<max; c++)
|
|
1789
|
+
{
|
|
1790
|
+
if (DB[c]!=NULL)
|
|
1791
|
+
{
|
|
1792
|
+
if (DB[c]->Number==DBNumber)
|
|
1793
|
+
{
|
|
1794
|
+
return c;
|
|
1795
|
+
}
|
|
1796
|
+
}
|
|
1797
|
+
}
|
|
1798
|
+
return -1;
|
|
1799
|
+
}
|
|
1800
|
+
//------------------------------------------------------------------------------
|
|
1801
|
+
int TSnap7Server::FindFirstFreeDB()
|
|
1802
|
+
{
|
|
1803
|
+
int c;
|
|
1804
|
+
for (c=0; c < MaxDB; c++)
|
|
1805
|
+
{
|
|
1806
|
+
if (DB[c]==NULL)
|
|
1807
|
+
return c;
|
|
1808
|
+
}
|
|
1809
|
+
return -1;
|
|
1810
|
+
}
|
|
1811
|
+
//------------------------------------------------------------------------------
|
|
1812
|
+
int TSnap7Server::RegisterDB(word Number, void *pUsrData, word Size)
|
|
1813
|
+
{
|
|
1814
|
+
PS7Area TheArea;
|
|
1815
|
+
int index;
|
|
1816
|
+
|
|
1817
|
+
if (pUsrData==0)
|
|
1818
|
+
return errSrvDBNullPointer;
|
|
1819
|
+
|
|
1820
|
+
if (FindDB(Number)!=NULL)
|
|
1821
|
+
return errSrvAreaAlreadyExists;
|
|
1822
|
+
|
|
1823
|
+
index=FindFirstFreeDB();
|
|
1824
|
+
if (index==-1)
|
|
1825
|
+
return errSrvTooManyDB;
|
|
1826
|
+
|
|
1827
|
+
TheArea =new TS7Area;
|
|
1828
|
+
TheArea->Number=Number;
|
|
1829
|
+
TheArea->cs=new TSnapCriticalSection();
|
|
1830
|
+
TheArea->PData=pbyte(pUsrData);
|
|
1831
|
+
TheArea->Size=Size;
|
|
1832
|
+
DB[index]=TheArea;
|
|
1833
|
+
DBCount++;
|
|
1834
|
+
if (DBLimit<index)
|
|
1835
|
+
DBLimit=index;
|
|
1836
|
+
return 0;
|
|
1837
|
+
}
|
|
1838
|
+
//------------------------------------------------------------------------------
|
|
1839
|
+
void TSnap7Server::DisposeAll()
|
|
1840
|
+
{
|
|
1841
|
+
PS7Area TheDB;
|
|
1842
|
+
int c;
|
|
1843
|
+
// Unregister DBs
|
|
1844
|
+
for (c = 0; c < MaxDB; c++)
|
|
1845
|
+
{
|
|
1846
|
+
if (DB[c]!=NULL)
|
|
1847
|
+
{
|
|
1848
|
+
// Unregister should be done with the server in stop mode
|
|
1849
|
+
// however we can minimize the risk...
|
|
1850
|
+
TheDB=DB[c];
|
|
1851
|
+
DB[c]=NULL;
|
|
1852
|
+
if (TheDB->cs!=0)
|
|
1853
|
+
delete TheDB->cs;
|
|
1854
|
+
delete TheDB;
|
|
1855
|
+
}
|
|
1856
|
+
}
|
|
1857
|
+
DBCount=0;
|
|
1858
|
+
// Unregister other
|
|
1859
|
+
for (c = srvAreaPE; c < srvAreaDB; c++)
|
|
1860
|
+
UnregisterSys(c);
|
|
1861
|
+
}
|
|
1862
|
+
//------------------------------------------------------------------------------
|
|
1863
|
+
int TSnap7Server::RegisterSys(int AreaCode, void *pUsrData, word Size)
|
|
1864
|
+
{
|
|
1865
|
+
PS7Area TheArea;
|
|
1866
|
+
|
|
1867
|
+
if (pUsrData==0)
|
|
1868
|
+
return errSrvDBNullPointer;
|
|
1869
|
+
|
|
1870
|
+
if ((AreaCode<srvAreaPE) || (AreaCode>srvAreaTM))
|
|
1871
|
+
return errSrvUnknownArea;
|
|
1872
|
+
|
|
1873
|
+
if (HA[AreaCode]==0)
|
|
1874
|
+
{
|
|
1875
|
+
TheArea=new TS7Area;
|
|
1876
|
+
TheArea->cs=new TSnapCriticalSection();
|
|
1877
|
+
TheArea->PData=pbyte(pUsrData);
|
|
1878
|
+
TheArea->Size=Size;
|
|
1879
|
+
HA[AreaCode]=TheArea;
|
|
1880
|
+
return 0;
|
|
1881
|
+
}
|
|
1882
|
+
else
|
|
1883
|
+
return errSrvAreaAlreadyExists;
|
|
1884
|
+
}
|
|
1885
|
+
//------------------------------------------------------------------------------
|
|
1886
|
+
int TSnap7Server::UnregisterDB(word DBNumber)
|
|
1887
|
+
{
|
|
1888
|
+
PS7Area TheDB;
|
|
1889
|
+
int index = IndexOfDB(DBNumber);
|
|
1890
|
+
if (index==-1)
|
|
1891
|
+
return errSrvInvalidParams;
|
|
1892
|
+
|
|
1893
|
+
// Unregister should be done with the server in stop mode
|
|
1894
|
+
// however we can minimize the risk...
|
|
1895
|
+
TheDB=DB[index];
|
|
1896
|
+
DB[index]=NULL;
|
|
1897
|
+
if (TheDB->cs!=NULL)
|
|
1898
|
+
delete TheDB->cs;
|
|
1899
|
+
delete TheDB;
|
|
1900
|
+
DBCount--;
|
|
1901
|
+
|
|
1902
|
+
return 0;
|
|
1903
|
+
}
|
|
1904
|
+
//------------------------------------------------------------------------------
|
|
1905
|
+
int TSnap7Server::UnregisterSys(int AreaCode)
|
|
1906
|
+
{
|
|
1907
|
+
PS7Area TheArea;
|
|
1908
|
+
if (HA[AreaCode]!=NULL)
|
|
1909
|
+
{
|
|
1910
|
+
// Unregister should be done with the server in stop mode
|
|
1911
|
+
// however we can minimize the risk...
|
|
1912
|
+
TheArea=HA[AreaCode];
|
|
1913
|
+
HA[AreaCode]=NULL;
|
|
1914
|
+
if (TheArea->cs!=NULL)
|
|
1915
|
+
delete TheArea->cs;
|
|
1916
|
+
delete TheArea;
|
|
1917
|
+
}
|
|
1918
|
+
return 0;
|
|
1919
|
+
}
|
|
1920
|
+
//------------------------------------------------------------------------------
|
|
1921
|
+
int TSnap7Server::StartTo(const char *Address)
|
|
1922
|
+
{
|
|
1923
|
+
return TCustomMsgServer::StartTo(Address, LocalPort);
|
|
1924
|
+
}
|
|
1925
|
+
//------------------------------------------------------------------------------
|
|
1926
|
+
int TSnap7Server::GetParam(int ParamNumber, void *pValue)
|
|
1927
|
+
{
|
|
1928
|
+
switch (ParamNumber)
|
|
1929
|
+
{
|
|
1930
|
+
case p_u16_LocalPort:
|
|
1931
|
+
*Puint16_t(pValue)=LocalPort;
|
|
1932
|
+
break;
|
|
1933
|
+
case p_i32_WorkInterval:
|
|
1934
|
+
*Pint32_t(pValue)=WorkInterval;
|
|
1935
|
+
break;
|
|
1936
|
+
case p_i32_MaxClients:
|
|
1937
|
+
*Pint32_t(pValue)=MaxClients;
|
|
1938
|
+
break;
|
|
1939
|
+
case p_i32_PDURequest:
|
|
1940
|
+
*Pint32_t(pValue) = ForcePDU;
|
|
1941
|
+
break;
|
|
1942
|
+
default: return errSrvInvalidParamNumber;
|
|
1943
|
+
}
|
|
1944
|
+
return 0;
|
|
1945
|
+
}
|
|
1946
|
+
//------------------------------------------------------------------------------
|
|
1947
|
+
int TSnap7Server::SetParam(int ParamNumber, void *pValue)
|
|
1948
|
+
{
|
|
1949
|
+
switch (ParamNumber)
|
|
1950
|
+
{
|
|
1951
|
+
case p_u16_LocalPort:
|
|
1952
|
+
if (Status == SrvStopped)
|
|
1953
|
+
LocalPort = *Puint16_t(pValue);
|
|
1954
|
+
else
|
|
1955
|
+
return errSrvCannotChangeParam;
|
|
1956
|
+
break;
|
|
1957
|
+
case p_i32_PDURequest:
|
|
1958
|
+
if (Status == SrvStopped)
|
|
1959
|
+
{
|
|
1960
|
+
int PDU = *Pint32_t(pValue);
|
|
1961
|
+
if (PDU == 0)
|
|
1962
|
+
ForcePDU = 0; // ForcePDU=0 --> The server accepts the client's proposal
|
|
1963
|
+
else
|
|
1964
|
+
{
|
|
1965
|
+
if ((PDU < MinPduSize) || (PDU>IsoPayload_Size))
|
|
1966
|
+
return errSrvInvalidParams; // Wrong value
|
|
1967
|
+
else
|
|
1968
|
+
ForcePDU = PDU; // The server imposes ForcePDU as PDU size
|
|
1969
|
+
}
|
|
1970
|
+
}
|
|
1971
|
+
else
|
|
1972
|
+
return errSrvCannotChangeParam;
|
|
1973
|
+
break;
|
|
1974
|
+
case p_i32_WorkInterval:
|
|
1975
|
+
WorkInterval=*Pint32_t(pValue);
|
|
1976
|
+
break;
|
|
1977
|
+
case p_i32_MaxClients:
|
|
1978
|
+
if (ClientsCount==0 && Status==SrvStopped)
|
|
1979
|
+
MaxClients=*Pint32_t(pValue);
|
|
1980
|
+
else
|
|
1981
|
+
return errSrvCannotChangeParam;
|
|
1982
|
+
break;
|
|
1983
|
+
default: return errSrvInvalidParamNumber;
|
|
1984
|
+
}
|
|
1985
|
+
return 0;
|
|
1986
|
+
}
|
|
1987
|
+
//------------------------------------------------------------------------------
|
|
1988
|
+
int TSnap7Server::RegisterArea(int AreaCode, word Index, void *pUsrData, word Size)
|
|
1989
|
+
{
|
|
1990
|
+
if (AreaCode==srvAreaDB)
|
|
1991
|
+
return RegisterDB(Index, pUsrData, Size);
|
|
1992
|
+
else
|
|
1993
|
+
return RegisterSys(AreaCode,pUsrData, Size);
|
|
1994
|
+
}
|
|
1995
|
+
//------------------------------------------------------------------------------
|
|
1996
|
+
int TSnap7Server::UnregisterArea(int AreaCode, word Index)
|
|
1997
|
+
{
|
|
1998
|
+
if (AreaCode==srvAreaDB)
|
|
1999
|
+
return UnregisterDB(Index);
|
|
2000
|
+
else
|
|
2001
|
+
if ((AreaCode>=srvAreaPE) && (AreaCode<=srvAreaTM))
|
|
2002
|
+
return UnregisterSys(AreaCode);
|
|
2003
|
+
else
|
|
2004
|
+
return errSrvInvalidParams;
|
|
2005
|
+
}
|
|
2006
|
+
//------------------------------------------------------------------------------
|
|
2007
|
+
int TSnap7Server::LockArea(int AreaCode, word DBNumber)
|
|
2008
|
+
{
|
|
2009
|
+
int index;
|
|
2010
|
+
|
|
2011
|
+
if ((AreaCode>=srvAreaPE) && (AreaCode<=srvAreaTM))
|
|
2012
|
+
{
|
|
2013
|
+
if (HA[AreaCode]!=0)
|
|
2014
|
+
{
|
|
2015
|
+
HA[AreaCode]->cs->Enter();
|
|
2016
|
+
return 0;
|
|
2017
|
+
}
|
|
2018
|
+
else
|
|
2019
|
+
return errSrvInvalidParams;
|
|
2020
|
+
}
|
|
2021
|
+
else
|
|
2022
|
+
if (AreaCode==srvAreaDB)
|
|
2023
|
+
{
|
|
2024
|
+
index=IndexOfDB(DBNumber);
|
|
2025
|
+
if (index!=-1)
|
|
2026
|
+
{
|
|
2027
|
+
DB[index]->cs->Enter();
|
|
2028
|
+
return 0;
|
|
2029
|
+
}
|
|
2030
|
+
else
|
|
2031
|
+
return errSrvInvalidParams;
|
|
2032
|
+
}
|
|
2033
|
+
else
|
|
2034
|
+
return errSrvInvalidParams;
|
|
2035
|
+
}
|
|
2036
|
+
//------------------------------------------------------------------------------
|
|
2037
|
+
int TSnap7Server::UnlockArea(int AreaCode, word DBNumber)
|
|
2038
|
+
{
|
|
2039
|
+
int index;
|
|
2040
|
+
|
|
2041
|
+
if ((AreaCode>=srvAreaPE) && (AreaCode<=srvAreaTM))
|
|
2042
|
+
{
|
|
2043
|
+
if (HA[AreaCode]!=0)
|
|
2044
|
+
{
|
|
2045
|
+
HA[AreaCode]->cs->Leave();
|
|
2046
|
+
return 0;
|
|
2047
|
+
}
|
|
2048
|
+
else
|
|
2049
|
+
return errSrvInvalidParams;
|
|
2050
|
+
}
|
|
2051
|
+
else
|
|
2052
|
+
if (AreaCode==srvAreaDB)
|
|
2053
|
+
{
|
|
2054
|
+
index=IndexOfDB(DBNumber);
|
|
2055
|
+
if (index!=-1)
|
|
2056
|
+
{
|
|
2057
|
+
DB[index]->cs->Leave();
|
|
2058
|
+
return 0;
|
|
2059
|
+
}
|
|
2060
|
+
else
|
|
2061
|
+
return errSrvInvalidParams;
|
|
2062
|
+
}
|
|
2063
|
+
else
|
|
2064
|
+
return errSrvInvalidParams;
|
|
2065
|
+
}
|
|
2066
|
+
//------------------------------------------------------------------------------
|
|
2067
|
+
int TSnap7Server::SetReadEventsCallBack(pfn_SrvCallBack PCallBack, void *UsrPtr)
|
|
2068
|
+
{
|
|
2069
|
+
OnReadEvent = PCallBack;
|
|
2070
|
+
FReadUsrPtr = UsrPtr;
|
|
2071
|
+
return 0;
|
|
2072
|
+
}
|
|
2073
|
+
//---------------------------------------------------------------------------
|
|
2074
|
+
int TSnap7Server::SetRWAreaCallBack(pfn_RWAreaCallBack PCallBack, void *UsrPtr)
|
|
2075
|
+
{
|
|
2076
|
+
OnRWArea = PCallBack;
|
|
2077
|
+
FRWAreaUsrPtr = UsrPtr;
|
|
2078
|
+
ResourceLess = OnRWArea != NULL;
|
|
2079
|
+
return 0;
|
|
2080
|
+
}
|
|
2081
|
+
//---------------------------------------------------------------------------
|
|
2082
|
+
void TSnap7Server::DoReadEvent(int Sender, longword Code, word RetCode, word Param1,
|
|
2083
|
+
word Param2, word Param3, word Param4)
|
|
2084
|
+
{
|
|
2085
|
+
TSrvEvent SrvReadEvent;
|
|
2086
|
+
if (!Destroying && (OnReadEvent != NULL))
|
|
2087
|
+
{
|
|
2088
|
+
CSEvent->Enter();
|
|
2089
|
+
|
|
2090
|
+
time(&SrvReadEvent.EvtTime);
|
|
2091
|
+
SrvReadEvent.EvtSender = Sender;
|
|
2092
|
+
SrvReadEvent.EvtCode = Code;
|
|
2093
|
+
SrvReadEvent.EvtRetCode = RetCode;
|
|
2094
|
+
SrvReadEvent.EvtParam1 = Param1;
|
|
2095
|
+
SrvReadEvent.EvtParam2 = Param2;
|
|
2096
|
+
SrvReadEvent.EvtParam3 = Param3;
|
|
2097
|
+
SrvReadEvent.EvtParam4 = Param4;
|
|
2098
|
+
|
|
2099
|
+
try
|
|
2100
|
+
{ // callback is outside here, we have to shield it
|
|
2101
|
+
OnReadEvent(FReadUsrPtr, &SrvReadEvent, sizeof (TSrvEvent));
|
|
2102
|
+
} catch (...)
|
|
2103
|
+
{
|
|
2104
|
+
};
|
|
2105
|
+
CSEvent->Leave();
|
|
2106
|
+
};
|
|
2107
|
+
}
|
|
2108
|
+
//---------------------------------------------------------------------------
|
|
2109
|
+
bool TSnap7Server::DoReadArea(int Sender, int Area, int DBNumber, int Start, int Size, int WordLen, void *pUsrData)
|
|
2110
|
+
{
|
|
2111
|
+
TS7Tag Tag;
|
|
2112
|
+
bool Result = false;
|
|
2113
|
+
if (!Destroying && (OnRWArea != NULL))
|
|
2114
|
+
{
|
|
2115
|
+
|
|
2116
|
+
try
|
|
2117
|
+
{
|
|
2118
|
+
Tag.Area = Area;
|
|
2119
|
+
Tag.DBNumber = DBNumber;
|
|
2120
|
+
Tag.Start = Start;
|
|
2121
|
+
Tag.Size = Size;
|
|
2122
|
+
Tag.WordLen = WordLen;
|
|
2123
|
+
// callback is outside here, we have to shield it
|
|
2124
|
+
Result = OnRWArea(FRWAreaUsrPtr, Sender, OperationRead, &Tag, pUsrData) == 0;
|
|
2125
|
+
}
|
|
2126
|
+
catch (...)
|
|
2127
|
+
{
|
|
2128
|
+
Result = false;
|
|
2129
|
+
};
|
|
2130
|
+
|
|
2131
|
+
}
|
|
2132
|
+
return Result;
|
|
2133
|
+
}
|
|
2134
|
+
//---------------------------------------------------------------------------
|
|
2135
|
+
bool TSnap7Server::DoWriteArea(int Sender, int Area, int DBNumber, int Start, int Size, int WordLen, void *pUsrData)
|
|
2136
|
+
{
|
|
2137
|
+
TS7Tag Tag;
|
|
2138
|
+
bool Result = false;
|
|
2139
|
+
if (!Destroying && (OnRWArea != NULL))
|
|
2140
|
+
{
|
|
2141
|
+
|
|
2142
|
+
try
|
|
2143
|
+
{
|
|
2144
|
+
Tag.Area = Area;
|
|
2145
|
+
Tag.DBNumber = DBNumber;
|
|
2146
|
+
Tag.Start = Start;
|
|
2147
|
+
Tag.Size = Size;
|
|
2148
|
+
Tag.WordLen = WordLen;
|
|
2149
|
+
// callback is outside here, we have to shield it
|
|
2150
|
+
Result = OnRWArea(FRWAreaUsrPtr, Sender, OperationWrite, &Tag, pUsrData) == 0;
|
|
2151
|
+
}
|
|
2152
|
+
catch (...)
|
|
2153
|
+
{
|
|
2154
|
+
Result = false;
|
|
2155
|
+
};
|
|
2156
|
+
|
|
2157
|
+
}
|
|
2158
|
+
return Result;
|
|
2159
|
+
}
|
|
2160
|
+
|
|
2161
|
+
|