123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151 |
- #ifndef PUSHBUTTON_SOURCE
- #define PUSHBUTTON_SOURCE
- #include <stdint.h>
- #include <memory.h>
- #include "../tools/error.h"
- #include "../tools/memory.h"
- #include "../plc/plc.h"
- signed PushButton (struct plc * plc)
- {
- struct channel * channel = (struct channel *)(plc->channel);
- struct message * message = (struct message *)(plc->message);
- #ifndef __GNUC__
- #pragma pack (push,1)
- #endif
- struct __packed ms_pb_enc_request
- {
- struct ethernet_hdr ethernet;
- struct homeplug_hdr homeplug;
- uint8_t PBACTION;
- }
- * request = (struct ms_pb_enc_request *) (message);
- struct __packed ms_pb_enc_confirm
- {
- struct ethernet_hdr ethernet;
- struct homeplug_hdr homeplug;
- uint8_t MSTATUS;
- uint8_t AVLNSTAT;
- }
- * confirm = (struct ms_pb_enc_confirm *) (message);
- #ifndef __GNUC__
- #pragma pack (pop)
- #endif
- if (plc->pushbutton == 1)
- {
- Request (plc, "Join Network");
- }
- if (plc->pushbutton == 2)
- {
- Request (plc, "Leave Network");
- }
- if (plc->pushbutton == 3)
- {
- Request (plc, "Fetch Network Status");
- }
- memset (message, 0, sizeof (* message));
- EthernetHeader (&request->ethernet, channel->peer, channel->host, channel->type);
- request->homeplug.MMV = 0;
- request->homeplug.MMTYPE = HTOLE16 (MS_PB_ENC | MMTYPE_REQ);
- request->PBACTION = plc->pushbutton;
- plc->packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
- if (SendMME (plc) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
- return (-1);
- }
- if (ReadMFG (plc, 0, (MS_PB_ENC | MMTYPE_CNF)) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
- return (-1);
- }
- if (confirm->MSTATUS)
- {
- Failure (plc, PLC_WONTDOIT);
- return (-1);
- }
- if (plc->pushbutton == 1)
- {
- Confirm (plc, "Joining ...");
- return (0);
- }
- if (plc->pushbutton == 2)
- {
- Confirm (plc, "Leaving ...");
- return (0);
- }
- if (plc->pushbutton == 3)
- {
- Confirm (plc, "Membership Status %d", confirm->AVLNSTAT);
- return (0);
- }
- Failure (plc, "Unexpected pushbutton action code");
- return (-1);
- }
- #endif
|