@litmusio/miravo-cli-darwin-arm64 0.0.0-stage → 0.15.10

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.
Files changed (235) hide show
  1. package/LICENSE +199 -0
  2. package/NOTICE +9 -0
  3. package/README.md +6 -2
  4. package/THIRD_PARTY_LICENSES.txt +15289 -0
  5. package/THIRD_PARTY_NOTICES.md +995 -0
  6. package/console-dist/assets/AnimatePresence-DWGUB15i.js +9 -0
  7. package/console-dist/assets/activity-DruTYzT1.js +1 -0
  8. package/console-dist/assets/api-V5Tf5xfh.js +57 -0
  9. package/console-dist/assets/arrow-up-right-DOENs04V.js +1 -0
  10. package/console-dist/assets/asset-detail-D_icTa2K.js +1 -0
  11. package/console-dist/assets/asset-detail-actions-DIYego9D.js +1 -0
  12. package/console-dist/assets/backup-power-Q84DVs_z.js +1 -0
  13. package/console-dist/assets/badge-CdRB4Nd_.js +1 -0
  14. package/console-dist/assets/boiler-s_q0j7rz.js +1 -0
  15. package/console-dist/assets/by-path-Cm2TEP7z.js +1 -0
  16. package/console-dist/assets/check-BTUv4z-H.js +1 -0
  17. package/console-dist/assets/chevron-down-CqA_2_CH.js +1 -0
  18. package/console-dist/assets/chevron-right-CVrgKBLR.js +1 -0
  19. package/console-dist/assets/chiller-r7DzAhJq.js +1 -0
  20. package/console-dist/assets/chunk-6KYCQHYJ-ga3Yekab.js +3 -0
  21. package/console-dist/assets/circle-x-BRkh0A1P.js +1 -0
  22. package/console-dist/assets/commercial-building-Cezt2R6W.js +1 -0
  23. package/console-dist/assets/compressor-ChZLMC94.js +1 -0
  24. package/console-dist/assets/console-panel-BnSjjW6l.js +1 -0
  25. package/console-dist/assets/dialog-BYkdndf9.js +1 -0
  26. package/console-dist/assets/district-heating-By_6QdGQ.js +1 -0
  27. package/console-dist/assets/dom-BxZbg3NX.js +1 -0
  28. package/console-dist/assets/download-CvjDP5mu.js +1 -0
  29. package/console-dist/assets/fira-code-cyrillic-ext-wght-normal-DhYMMuQd.woff2 +0 -0
  30. package/console-dist/assets/fira-code-cyrillic-wght-normal-Y3u8pIsh.woff2 +0 -0
  31. package/console-dist/assets/fira-code-greek-ext-wght-normal-wWus70Ix.woff2 +0 -0
  32. package/console-dist/assets/fira-code-greek-wght-normal-B2SviObF.woff2 +0 -0
  33. package/console-dist/assets/fira-code-latin-ext-wght-normal-Dvfvaomy.woff2 +0 -0
  34. package/console-dist/assets/fira-code-latin-wght-normal-CHoedHDv.woff2 +0 -0
  35. package/console-dist/assets/fira-code-symbols2-wght-normal-CE6EOz_n.woff2 +0 -0
  36. package/console-dist/assets/floor-page-DIUJBBhh.js +1 -0
  37. package/console-dist/assets/floor-page-E-0txA4z.css +1 -0
  38. package/console-dist/assets/format-YLUJ7AXt.js +1 -0
  39. package/console-dist/assets/genset-C6_EUoFo.js +1 -0
  40. package/console-dist/assets/index-BrlZMcSu.js +15 -0
  41. package/console-dist/assets/index-eZjXAdLh.css +2 -0
  42. package/console-dist/assets/loader-circle-w3T2fxvn.js +1 -0
  43. package/console-dist/assets/login-CpbaxAVs.js +136 -0
  44. package/console-dist/assets/not-found-CZjkulKD.js +1 -0
  45. package/console-dist/assets/pharma-cleanroom-CT2M_Mbh.js +1 -0
  46. package/console-dist/assets/preload-helper-7y9sWmk5.js +1 -0
  47. package/console-dist/assets/react-DRt7cCXI.js +1 -0
  48. package/console-dist/assets/rolldown-runtime-BWaJ3C7D.js +1 -0
  49. package/console-dist/assets/rtu-ByogcRPI.js +1 -0
  50. package/console-dist/assets/runtime-link-D88Db2wY.js +1 -0
  51. package/console-dist/assets/schibsted-grotesk-latin-ext-wght-normal-hsMS0n0O.woff2 +0 -0
  52. package/console-dist/assets/schibsted-grotesk-latin-wght-normal-Bb8VGrTG.woff2 +0 -0
  53. package/console-dist/assets/server-B0q1NVkV.js +1 -0
  54. package/console-dist/assets/shallow-mIK1Qu8X.js +1 -0
  55. package/console-dist/assets/smart-factory-gfMWfMWM.js +1 -0
  56. package/console-dist/assets/source-host-miravo-BW-SKMTe.js +1 -0
  57. package/console-dist/assets/stages-EYRT12Yp.js +1 -0
  58. package/console-dist/assets/status-DQYLUbXs.js +1 -0
  59. package/console-dist/assets/tank-Btg5piqB.js +1 -0
  60. package/console-dist/assets/tooltip-Dfmuq2yz.js +1 -0
  61. package/console-dist/assets/trash-2-BAh5-hxl.js +1 -0
  62. package/console-dist/assets/triangle-alert-3Ab-dBrN.js +1 -0
  63. package/console-dist/assets/use-engine-command-mutation-BmSUqrCp.js +1 -0
  64. package/console-dist/assets/use-transition-navigate-DIfW9U34.js +2 -0
  65. package/console-dist/assets/useQuery-yLeYL5Es.js +1 -0
  66. package/console-dist/assets/utils-D6wrZy-b.js +1 -0
  67. package/console-dist/assets/validation-DEb_QCoK.js +1 -0
  68. package/console-dist/assets/vendor-charts-Bquh2dWE.js +56 -0
  69. package/console-dist/assets/vendor-table-5YnGQUhO.js +4 -0
  70. package/console-dist/assets/vendor-ui-BGeFlRLR.js +1 -0
  71. package/console-dist/assets/water-treatment-DbSVGWoj.js +1 -0
  72. package/console-dist/icon.png +0 -0
  73. package/console-dist/index.html +53 -0
  74. package/console-dist/miravo-logo.webp +0 -0
  75. package/licenses/EPL-2.0.txt +80 -0
  76. package/licenses/GCC-exception-3.1.txt +33 -0
  77. package/licenses/GPL-2.0-only.txt +117 -0
  78. package/licenses/GPL-3.0-only.txt +232 -0
  79. package/licenses/LGPL-2.1-only.txt +176 -0
  80. package/licenses/MPL-2.0.txt +373 -0
  81. package/licenses/OFL-1.1.txt +93 -0
  82. package/licenses/overrides/@headlessui+vue@1.7.23.txt +24 -0
  83. package/licenses/overrides/@next+env@16.4.6.txt +24 -0
  84. package/licenses/overrides/@radix-ui+react-compose-refs@1.1.2.txt +24 -0
  85. package/licenses/overrides/@radix-ui+react-context@1.1.2.txt +24 -0
  86. package/licenses/overrides/@radix-ui+react-direction@1.1.1.txt +24 -0
  87. package/licenses/overrides/@radix-ui+react-id@1.1.1.txt +24 -0
  88. package/licenses/overrides/@radix-ui+react-use-callback-ref@1.1.1.txt +24 -0
  89. package/licenses/overrides/@radix-ui+react-use-escape-keydown@1.1.1.txt +24 -0
  90. package/licenses/overrides/@radix-ui+react-use-layout-effect@1.1.1.txt +24 -0
  91. package/licenses/overrides/@radix-ui+react-use-rect@1.1.1.txt +24 -0
  92. package/licenses/overrides/@radix-ui+react-use-size@1.1.1.txt +24 -0
  93. package/licenses/overrides/@radix-ui+rect@1.1.1.txt +24 -0
  94. package/licenses/overrides/@replit+codemirror-css-color-picker@6.3.0.txt +6 -0
  95. package/licenses/overrides/@scalar+openapi-types@0.8.0.txt +24 -0
  96. package/licenses/overrides/@scalar+openapi-types@0.9.10.txt +24 -0
  97. package/licenses/overrides/@scalar+openapi-types@0.9.7.txt +24 -0
  98. package/licenses/overrides/@scalar+openapi-types@0.9.9.txt +24 -0
  99. package/licenses/overrides/@scalar+postman-to-openapi@0.7.1.txt +24 -0
  100. package/licenses/overrides/@scalar+schemas@0.19.0.txt +24 -0
  101. package/licenses/overrides/@scalar+workspace-store@0.46.3.txt +24 -0
  102. package/licenses/overrides/@scalar+workspace-store@0.75.0.txt +24 -0
  103. package/licenses/overrides/assert-plus@1.0.0.txt +24 -0
  104. package/licenses/overrides/client-only@0.0.1.txt +24 -0
  105. package/licenses/overrides/embla-carousel-react@8.6.0.txt +24 -0
  106. package/licenses/overrides/embla-carousel-reactive-utils@8.6.0.txt +24 -0
  107. package/licenses/overrides/embla-carousel@8.6.0.txt +24 -0
  108. package/licenses/overrides/fastdom@1.0.12.txt +12 -0
  109. package/licenses/overrides/precond@0.2.3.txt +22 -0
  110. package/licenses/overrides/react-remove-scroll-bar@2.3.8.txt +24 -0
  111. package/licenses/overrides/strictdom@1.0.1.txt +12 -0
  112. package/licenses/overrides/victory-vendor@36.9.2.txt +33 -0
  113. package/licenses/runtime/Bun-1.4.3-LICENSE.md +85 -0
  114. package/licenses/runtime/ICU-78.1-LICENSE.txt +568 -0
  115. package/licenses/runtime/bun-components/boringssl.txt +238 -0
  116. package/licenses/runtime/bun-components/brotli.txt +19 -0
  117. package/licenses/runtime/bun-components/c-ares.txt +24 -0
  118. package/licenses/runtime/bun-components/highway.txt +371 -0
  119. package/licenses/runtime/bun-components/libarchive.txt +65 -0
  120. package/licenses/runtime/bun-components/libbase64.txt +28 -0
  121. package/licenses/runtime/bun-components/libdeflate.txt +22 -0
  122. package/licenses/runtime/bun-components/libjpeg-turbo.txt +147 -0
  123. package/licenses/runtime/bun-components/libspng.txt +25 -0
  124. package/licenses/runtime/bun-components/libuv.txt +19 -0
  125. package/licenses/runtime/bun-components/libwebp.txt +30 -0
  126. package/licenses/runtime/bun-components/llvm.txt +311 -0
  127. package/licenses/runtime/bun-components/lol-html.txt +27 -0
  128. package/licenses/runtime/bun-components/ls-hpack.txt +21 -0
  129. package/licenses/runtime/bun-components/ls-qpack.txt +21 -0
  130. package/licenses/runtime/bun-components/lsquic-chrome.txt +32 -0
  131. package/licenses/runtime/bun-components/lsquic.txt +21 -0
  132. package/licenses/runtime/bun-components/mimalloc.txt +21 -0
  133. package/licenses/runtime/bun-components/picohttpparser.txt +24 -0
  134. package/licenses/runtime/bun-components/simdutf-apache.txt +201 -0
  135. package/licenses/runtime/bun-components/simdutf-mit.txt +18 -0
  136. package/licenses/runtime/bun-components/tigerbeetle.txt +177 -0
  137. package/licenses/runtime/bun-components/tinycc.txt +504 -0
  138. package/licenses/runtime/bun-components/typescript-go.txt +55 -0
  139. package/licenses/runtime/bun-components/usockets.txt +201 -0
  140. package/licenses/runtime/bun-components/uucode.txt +30 -0
  141. package/licenses/runtime/bun-components/uwebsockets.txt +201 -0
  142. package/licenses/runtime/bun-components/xxhash.txt +31 -0
  143. package/licenses/runtime/bun-components/zlib-ng.txt +19 -0
  144. package/licenses/runtime/bun-components/zstd-copying.txt +339 -0
  145. package/licenses/runtime/bun-components/zstd.txt +30 -0
  146. package/licenses/runtime/musl-1.2.6-COPYRIGHT.txt +193 -0
  147. package/miravo +4 -0
  148. package/native/S7-NOTICES.txt +11 -0
  149. package/native/miravo-s7.node +0 -0
  150. package/native/s7-source/CMakeLists.txt +23 -0
  151. package/native/s7-source/NODE-SNAP7-LICENSE +24 -0
  152. package/native/s7-source/addon.cpp +124 -0
  153. package/native/s7-source/bridge.cpp +150 -0
  154. package/native/s7-source/node-api-headers/LICENSE +21 -0
  155. package/native/s7-source/node-api-headers/include/js_native_api.h +591 -0
  156. package/native/s7-source/node-api-headers/include/js_native_api_types.h +213 -0
  157. package/native/s7-source/node-api-headers/include/node_api.h +265 -0
  158. package/native/s7-source/node-api-headers/include/node_api_types.h +58 -0
  159. package/native/s7-source/node-api-windows.h +78 -0
  160. package/native/s7-source/snap7/HISTORY.txt +277 -0
  161. package/native/s7-source/snap7/gpl.txt +674 -0
  162. package/native/s7-source/snap7/lgpl-3.0.txt +165 -0
  163. package/native/s7-source/snap7/src/core/miravo_request_validation.h +72 -0
  164. package/native/s7-source/snap7/src/core/s7_client.cpp +503 -0
  165. package/native/s7-source/snap7/src/core/s7_client.h +104 -0
  166. package/native/s7-source/snap7/src/core/s7_firmware.h +1256 -0
  167. package/native/s7-source/snap7/src/core/s7_isotcp.cpp +541 -0
  168. package/native/s7-source/snap7/src/core/s7_isotcp.h +271 -0
  169. package/native/s7-source/snap7/src/core/s7_micro_client.cpp +3328 -0
  170. package/native/s7-source/snap7/src/core/s7_micro_client.h +364 -0
  171. package/native/s7-source/snap7/src/core/s7_partner.cpp +1178 -0
  172. package/native/s7-source/snap7/src/core/s7_partner.h +284 -0
  173. package/native/s7-source/snap7/src/core/s7_peer.cpp +121 -0
  174. package/native/s7-source/snap7/src/core/s7_peer.h +58 -0
  175. package/native/s7-source/snap7/src/core/s7_server.cpp +2161 -0
  176. package/native/s7-source/snap7/src/core/s7_server.h +261 -0
  177. package/native/s7-source/snap7/src/core/s7_text.cpp +788 -0
  178. package/native/s7-source/snap7/src/core/s7_text.h +49 -0
  179. package/native/s7-source/snap7/src/core/s7_types.h +1066 -0
  180. package/native/s7-source/snap7/src/lib/snap7.def +129 -0
  181. package/native/s7-source/snap7/src/lib/snap7_libmain.cpp +1196 -0
  182. package/native/s7-source/snap7/src/lib/snap7_libmain.h +201 -0
  183. package/native/s7-source/snap7/src/sys/snap_msgsock.cpp +958 -0
  184. package/native/s7-source/snap7/src/sys/snap_msgsock.h +339 -0
  185. package/native/s7-source/snap7/src/sys/snap_platform.h +152 -0
  186. package/native/s7-source/snap7/src/sys/snap_sysutils.cpp +73 -0
  187. package/native/s7-source/snap7/src/sys/snap_sysutils.h +39 -0
  188. package/native/s7-source/snap7/src/sys/snap_tcpsrvr.cpp +487 -0
  189. package/native/s7-source/snap7/src/sys/snap_tcpsrvr.h +247 -0
  190. package/native/s7-source/snap7/src/sys/snap_threads.cpp +162 -0
  191. package/native/s7-source/snap7/src/sys/snap_threads.h +45 -0
  192. package/native/s7-source/snap7/src/sys/sol_threads.h +208 -0
  193. package/native/s7-source/snap7/src/sys/unix_threads.h +228 -0
  194. package/native/s7-source/snap7/src/sys/win_threads.h +159 -0
  195. package/nodesets/.ignore +1 -0
  196. package/nodesets/1.02/FTNIR.NodeSet2.xml +819 -0
  197. package/nodesets/1.02/Opc.Ua.Adi.NodeSet2.xml +8301 -0
  198. package/nodesets/1.02/Opc.Ua.Di.NodeSet2.xml +1785 -0
  199. package/nodesets/Opc.ISA95.NodeSet2.xml +3589 -0
  200. package/nodesets/Opc.Ua.AMB.NodeSet2.xml +1395 -0
  201. package/nodesets/Opc.Ua.Adi.NodeSet2.xml +8301 -0
  202. package/nodesets/Opc.Ua.Adi.Types.xsd +104 -0
  203. package/nodesets/Opc.Ua.AutoID.NodeSet2.xml +6062 -0
  204. package/nodesets/Opc.Ua.CNC.NodeSet.xml +15875 -0
  205. package/nodesets/Opc.Ua.CommercialKitchenEquipment.NodeSet2.xml +12096 -0
  206. package/nodesets/Opc.Ua.Di.NodeSet2.xml +6042 -0
  207. package/nodesets/Opc.Ua.Di.Types.xsd +161 -0
  208. package/nodesets/Opc.Ua.Eumabois.Nodeset2.xml +2483 -0
  209. package/nodesets/Opc.Ua.Gds.NodeSet2.xml +8282 -0
  210. package/nodesets/Opc.Ua.Glass.NodeSet2.xml +5100 -0
  211. package/nodesets/Opc.Ua.IA.NodeSet2.xml +1782 -0
  212. package/nodesets/Opc.Ua.IOLink.NodeSet2.xml +4374 -0
  213. package/nodesets/Opc.Ua.IOLinkIODD.NodeSet2.xml +139 -0
  214. package/nodesets/Opc.Ua.IRDI.NodeSet2.xml +2243 -0
  215. package/nodesets/Opc.Ua.Ijt.Base.NodeSet2.xml +19459 -0
  216. package/nodesets/Opc.Ua.Ijt.Tightening.NodeSet2.xml +883 -0
  217. package/nodesets/Opc.Ua.LADS.NodeSet2.xml +7086 -0
  218. package/nodesets/Opc.Ua.MachineTool.NodeSet2.xml +7884 -0
  219. package/nodesets/Opc.Ua.MachineVision.NodeSet2.xml +17324 -0
  220. package/nodesets/Opc.Ua.Machinery.Jobs.Nodeset2.xml +1249 -0
  221. package/nodesets/Opc.Ua.Machinery.NodeSet2.xml +2099 -0
  222. package/nodesets/Opc.Ua.Machinery.ProcessValues.NodeSet2.xml +1858 -0
  223. package/nodesets/Opc.Ua.Machinery_Result.NodeSet2.xml +2640 -0
  224. package/nodesets/Opc.Ua.MetalForming.NodeSet2.xml +1577 -0
  225. package/nodesets/Opc.Ua.NodeSet2.xml +81975 -0
  226. package/nodesets/Opc.Ua.PADIM.NodeSet2.xml +14131 -0
  227. package/nodesets/Opc.Ua.PackML.NodeSet2.xml +3030 -0
  228. package/nodesets/Opc.Ua.Robotics.NodeSet2.xml +7409 -0
  229. package/nodesets/Opc.Ua.Scales.NodeSet2.xml +15817 -0
  230. package/nodesets/Opc.Ua.Types.bsd +3499 -0
  231. package/nodesets/Opc.Ua.Weihenstephan.NodeSet2.xml +821 -0
  232. package/nodesets/Opc.Ua.Woodworking.NodeSet2.xml +17831 -0
  233. package/nodesets/UANodeSet.xsd +497 -0
  234. package/nodesets/opc.ua.isa95-jobcontrol.nodeset2.xml +4594 -0
  235. 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
+