PushButton.c 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151
  1. /*====================================================================*
  2. *
  3. * Copyright (c) 2013 Qualcomm Atheros, Inc.
  4. *
  5. * All rights reserved.
  6. *
  7. * Redistribution and use in source and binary forms, with or
  8. * without modification, are permitted (subject to the limitations
  9. * in the disclaimer below) provided that the following conditions
  10. * are met:
  11. *
  12. * * Redistributions of source code must retain the above copyright
  13. * notice, this list of conditions and the following disclaimer.
  14. *
  15. * * Redistributions in binary form must reproduce the above
  16. * copyright notice, this list of conditions and the following
  17. * disclaimer in the documentation and/or other materials
  18. * provided with the distribution.
  19. *
  20. * * Neither the name of Qualcomm Atheros nor the names of
  21. * its contributors may be used to endorse or promote products
  22. * derived from this software without specific prior written
  23. * permission.
  24. *
  25. * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
  26. * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE
  27. * COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR
  28. * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  29. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  30. * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
  31. * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  32. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  33. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  34. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  35. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  36. * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
  37. * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  38. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  39. *
  40. *--------------------------------------------------------------------*/
  41. /*====================================================================*
  42. *
  43. * signed PushButton (struct plc * plc);
  44. *
  45. * plc.h
  46. *
  47. * THis plugin for program plc emulates pushbutton functionality
  48. * using a MS_PB_ENC message;
  49. *
  50. *
  51. * Contributor(s):
  52. * Charles Maier
  53. *
  54. *--------------------------------------------------------------------*/
  55. #ifndef PUSHBUTTON_SOURCE
  56. #define PUSHBUTTON_SOURCE
  57. #include <stdint.h>
  58. #include <memory.h>
  59. #include "../tools/error.h"
  60. #include "../tools/memory.h"
  61. #include "../plc/plc.h"
  62. signed PushButton (struct plc * plc)
  63. {
  64. struct channel * channel = (struct channel *)(plc->channel);
  65. struct message * message = (struct message *)(plc->message);
  66. #ifndef __GNUC__
  67. #pragma pack (push,1)
  68. #endif
  69. struct __packed ms_pb_enc_request
  70. {
  71. struct ethernet_hdr ethernet;
  72. struct homeplug_hdr homeplug;
  73. uint8_t PBACTION;
  74. }
  75. * request = (struct ms_pb_enc_request *) (message);
  76. struct __packed ms_pb_enc_confirm
  77. {
  78. struct ethernet_hdr ethernet;
  79. struct homeplug_hdr homeplug;
  80. uint8_t MSTATUS;
  81. uint8_t AVLNSTAT;
  82. }
  83. * confirm = (struct ms_pb_enc_confirm *) (message);
  84. #ifndef __GNUC__
  85. #pragma pack (pop)
  86. #endif
  87. if (plc->pushbutton == 1)
  88. {
  89. Request (plc, "Join Network");
  90. }
  91. if (plc->pushbutton == 2)
  92. {
  93. Request (plc, "Leave Network");
  94. }
  95. if (plc->pushbutton == 3)
  96. {
  97. Request (plc, "Fetch Network Status");
  98. }
  99. memset (message, 0, sizeof (* message));
  100. EthernetHeader (&request->ethernet, channel->peer, channel->host, channel->type);
  101. request->homeplug.MMV = 0;
  102. request->homeplug.MMTYPE = HTOLE16 (MS_PB_ENC | MMTYPE_REQ);
  103. request->PBACTION = plc->pushbutton;
  104. plc->packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
  105. if (SendMME (plc) <= 0)
  106. {
  107. error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
  108. return (-1);
  109. }
  110. if (ReadMFG (plc, 0, (MS_PB_ENC | MMTYPE_CNF)) <= 0)
  111. {
  112. error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
  113. return (-1);
  114. }
  115. if (confirm->MSTATUS)
  116. {
  117. Failure (plc, PLC_WONTDOIT);
  118. return (-1);
  119. }
  120. if (plc->pushbutton == 1)
  121. {
  122. Confirm (plc, "Joining ...");
  123. return (0);
  124. }
  125. if (plc->pushbutton == 2)
  126. {
  127. Confirm (plc, "Leaving ...");
  128. return (0);
  129. }
  130. if (plc->pushbutton == 3)
  131. {
  132. Confirm (plc, "Membership Status %d", confirm->AVLNSTAT);
  133. return (0);
  134. }
  135. Failure (plc, "Unexpected pushbutton action code");
  136. return (-1);
  137. }
  138. #endif