123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168 |
- #ifndef MODULESESSION_SOURCE
- #define MODULESESSION_SOURCE
- #include "../tools/error.h"
- #include "../plc/plc.h"
- signed ModuleSession (struct plc * plc, unsigned modules, struct vs_module_spec * vs_module_spec)
- {
- struct channel * channel = (struct channel *)(plc->channel);
- struct message * message = (struct message *)(plc->message);
- #ifndef __GNUC__
- #pragma pack (push,1)
- #endif
- struct __packed vs_module_operation_start_request
- {
- struct ethernet_hdr ethernet;
- struct qualcomm_hdr qualcomm;
- uint32_t RESERVED1;
- uint8_t NUM_OP_DATA;
- struct __packed
- {
- uint16_t MOD_OP;
- uint16_t MOD_OP_DATA_LEN;
- uint32_t MOD_OP_RSVD;
- uint32_t MOD_OP_SESSION_ID;
- uint8_t NUM_MODULES;
- }
- MODULE_SPEC;
- struct vs_module_spec MOD_OP_SPEC [10];
- }
- * request = (struct vs_module_operation_start_request *)(message);
- struct __packed vs_module_operation_start_confirm
- {
- struct ethernet_hdr ethernet;
- struct qualcomm_hdr qualcomm;
- uint16_t MSTATUS;
- uint16_t ERR_REC_CODE;
- uint32_t RESERVED;
- uint8_t NUM_OP_DATA;
- struct __packed
- {
- uint16_t MOD_OP;
- uint16_t MOD_OP_DATA_LEN;
- uint32_t MOD_OP_RSVD;
- uint32_t MOD_OP_SESSION_ID;
- uint8_t NUM_MODULES;
- }
- MODULE_SPEC;
- struct __packed
- {
- uint16_t MOD_STATUS;
- uint16_t ERR_REC_CODE;
- }
- MOD_OP_DATA [1];
- }
- * confirm = (struct vs_module_operation_start_confirm *)(message);
- #ifndef __GNUC__
- #pragma pack (pop)
- #endif
- unsigned timer = channel->timeout;
- struct vs_module_spec * request_spec = (struct vs_module_spec *)(&request->MOD_OP_SPEC);
- Request (plc, "Start Module Write Session");
- memset (message, 0, sizeof (* message));
- EthernetHeader (&request->ethernet, channel->peer, channel->host, channel->type);
- QualcommHeader (&request->qualcomm, 0, (VS_MODULE_OPERATION | MMTYPE_REQ));
- plc->packetsize = sizeof (* request);
- request->NUM_OP_DATA = 1;
- request->MODULE_SPEC.MOD_OP = HTOLE16 (PLC_MOD_OP_START_SESSION);
- request->MODULE_SPEC.MOD_OP_DATA_LEN = HTOLE16 ((uint16_t)(sizeof (request->MODULE_SPEC)) + modules * sizeof (struct vs_module_spec));
- request->MODULE_SPEC.MOD_OP_SESSION_ID = HTOLE32 (plc->cookie);
- request->MODULE_SPEC.NUM_MODULES = modules;
- while (modules--)
- {
- request_spec->MODULE_ID = HTOLE16 (vs_module_spec->MODULE_ID);
- request_spec->MODULE_SUB_ID = HTOLE16 (vs_module_spec->MODULE_SUB_ID);
- request_spec->MODULE_LENGTH = HTOLE32 (vs_module_spec->MODULE_LENGTH);
- request_spec->MODULE_CHKSUM = vs_module_spec->MODULE_CHKSUM;
- vs_module_spec++;
- request_spec++;
- }
- if (SendMME (plc) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
- return (-1);
- }
- channel->timeout = PLC_MODULE_REQUEST_TIMEOUT;
- do {
- if (ReadMME (plc, 0, (VS_MODULE_OPERATION | MMTYPE_CNF)) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
- channel->timeout = timer;
- return (-1);
- }
- } while (confirm->MODULE_SPEC.MOD_OP != HTOLE16 (PLC_MOD_OP_START_SESSION) ||
- confirm->MODULE_SPEC.MOD_OP_SESSION_ID != HTOLE32 (plc->cookie));
- channel->timeout = timer;
- if (confirm->MSTATUS)
- {
- Failure (plc, PLC_WONTDOIT);
- return (-1);
- }
- return (0);
- }
- #endif
|