123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120 |
- #ifndef PLATFORM_SOURCE
- #define PLATFORM_SOURCE
- #include <memory.h>
- #include <errno.h>
- #include "../ether/channel.h"
- #include "../tools/memory.h"
- #include "../tools/symbol.h"
- #include "../tools/error.h"
- #include "../tools/flags.h"
- #include "../plc/plc.h"
- signed Platform (struct channel * channel, const uint8_t device [])
- {
- struct message message;
- ssize_t packetsize;
- #ifndef __GNUC__
- #pragma pack (push,1)
- #endif
- struct __packed vs_sw_ver_request
- {
- struct ethernet_hdr ethernet;
- struct qualcomm_hdr qualcomm;
- }
- * request = (struct vs_sw_ver_request *) (&message);
- struct __packed vs_sw_ver_confirm
- {
- struct ethernet_hdr ethernet;
- struct qualcomm_hdr qualcomm;
- uint8_t MSTATUS;
- uint8_t MDEVICEID;
- uint8_t MVERLENGTH;
- char MVERSION [PLC_VERSION_STRING];
- }
- * confirm = (struct vs_sw_ver_confirm *) (&message);
- #ifndef __GNUC__
- #pragma pack (pop)
- #endif
- memset (&message, 0, sizeof (message));
- EthernetHeader (&request->ethernet, device, channel->host, channel->type);
- QualcommHeader (&request->qualcomm, 0, (VS_SW_VER | MMTYPE_REQ));
- if (sendpacket (channel, &message, (ETHER_MIN_LEN - ETHER_CRC_LEN)) > 0)
- {
- while ((packetsize = readpacket (channel, &message, sizeof (message))) > 0)
- {
- if (!UnwantedMessage (&message, packetsize, 0, (VS_SW_VER | MMTYPE_CNF)))
- {
- chipset (confirm);
- printf (" %s", chipsetname (confirm->MDEVICEID));
- printf (" %s", confirm->MVERSION);
- return (0);
- }
- }
- }
- return (-1);
- }
- #endif
|