DeviceIdent.c.html 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165
  1. <?xml version='1.0' encoding='iso-8859-1'?>
  2. <!doctype html public '-//W3C//DTD XHTML 1.0 Strict//EN' 'http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd'>
  3. <html xmlns='http://www.w3c.org/1999/xhtml' lang='en-us'>
  4. <head>
  5. <title>
  6. DeviceIdent.c
  7. </title>
  8. <meta http-equiv='content-type' content='text/html;iso-8859-1'/>
  9. <meta name='generator' content='motley-tools 1.9.4 13:40:33 Feb 18 2015'/>
  10. <meta name='author' content='cmaier@cmassoc.net'/>
  11. <meta name='robots' content='noindex,nofollow'/>
  12. <link href='toolkit.css' rel='stylesheet' type='text/css'/>
  13. </head>
  14. <body>
  15. <div class='headerlink'>
  16. [<a href='decstring.c.html' title=' decstring.c '>PREV</a>]
  17. [<a href='toolkit.html' title=' Index '>HOME</a>]
  18. [<a href='Devices.c.html' title=' Devices.c '>NEXT</a>]
  19. </div>
  20. <pre>
  21. /*====================================================================*
  22. *
  23. * Copyright (c) 2013 Qualcomm Atheros, Inc.
  24. *
  25. * All rights reserved.
  26. *
  27. * Redistribution and use in source and binary forms, with or
  28. * without modification, are permitted (subject to the limitations
  29. * in the disclaimer below) provided that the following conditions
  30. * are met:
  31. *
  32. * * Redistributions of source code must retain the above copyright
  33. * notice, this list of conditions and the following disclaimer.
  34. *
  35. * * Redistributions in binary form must reproduce the above
  36. * copyright notice, this list of conditions and the following
  37. * disclaimer in the documentation and/or other materials
  38. * provided with the distribution.
  39. *
  40. * * Neither the name of Qualcomm Atheros nor the names of
  41. * its contributors may be used to endorse or promote products
  42. * derived from this software without specific prior written
  43. * permission.
  44. *
  45. * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
  46. * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE
  47. * COPYRIGHT HOLDERS AND CONTRIBUTORS &quot;AS IS&quot; AND ANY EXPRESS OR
  48. * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  49. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  50. * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
  51. * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  52. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  53. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  54. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  55. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  56. * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
  57. * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  58. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  59. *
  60. *--------------------------------------------------------------------*/
  61. /*====================================================================*
  62. *
  63. * signed DeviceIdent (struct plc * plc);
  64. *
  65. * plc.h
  66. *
  67. * This plugin for program plc reads the first block of a device
  68. * PIB using VS_RD_MOD and updates the plc structure with device
  69. * network identity information, including MAC, DAK and NMK;
  70. *
  71. *
  72. * Contributor(s):
  73. * Charles Maier &lt;cmaier@qca.qualcomm.com&gt;
  74. *
  75. *--------------------------------------------------------------------*/
  76. #ifndef DEVICEIDENT_SOURCE
  77. #define DEVICEIDENT_SOURCE
  78. #include &lt;string.h&gt;
  79. #include &quot;../plc/plc.h&quot;
  80. #include &quot;../tools/error.h&quot;
  81. #include &quot;../tools/flags.h&quot;
  82. #include &quot;../tools/memory.h&quot;
  83. #include &quot;../pib/pib.h&quot;
  84. signed DeviceIdent (struct plc * plc)
  85. {
  86. struct channel * channel = (struct channel *)(plc-&gt;channel);
  87. struct message * message = (struct message *)(plc-&gt;message);
  88. #ifndef __GNUC__
  89. #pragma pack (push,1)
  90. #endif
  91. struct __packed vs_rd_mod_request
  92. {
  93. struct ethernet_hdr ethernet;
  94. struct qualcomm_hdr qualcomm;
  95. uint8_t MODULEID;
  96. uint8_t MACCESS;
  97. uint16_t MLENGTH;
  98. uint32_t MOFFSET;
  99. uint8_t MSECRET [16];
  100. }
  101. * request = (struct vs_rd_mod_request *) (message);
  102. struct __packed vs_rd_mod_confirm
  103. {
  104. struct ethernet_hdr ethernet;
  105. struct qualcomm_hdr qualcomm;
  106. uint8_t MSTATUS;
  107. uint8_t RES [3];
  108. uint8_t MODULEID;
  109. uint8_t RESERVED;
  110. uint16_t MLENGTH;
  111. uint32_t MOFFSET;
  112. uint32_t MCHKSUM;
  113. struct simple_pib IDENT;
  114. }
  115. * confirm = (struct vs_rd_mod_confirm *) (message);
  116. #ifndef __GNUC__
  117. #pragma pack (pop)
  118. #endif
  119. memset (message, 0, sizeof (* message));
  120. EthernetHeader (&amp;request-&gt;ethernet, channel-&gt;peer, channel-&gt;host, channel-&gt;type);
  121. QualcommHeader (&amp;request-&gt;qualcomm, 0, (VS_RD_MOD | MMTYPE_REQ));
  122. plc-&gt;packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
  123. request-&gt;MODULEID = VS_MODULE_PIB;
  124. request-&gt;MLENGTH = HTOLE16 (sizeof (confirm-&gt;IDENT));
  125. request-&gt;MOFFSET = 0;
  126. if (SendMME (plc) &lt;= 0)
  127. {
  128. error (1, errno, CHANNEL_CANTSEND);
  129. }
  130. while (ReadMME (plc, 0, (VS_RD_MOD | MMTYPE_CNF)) &lt;= 0)
  131. {
  132. plc-&gt;flags |= PLC_BAILOUT;
  133. Failure (plc, PLC_NODETECT);
  134. }
  135. if (confirm-&gt;MSTATUS)
  136. {
  137. Failure (plc, PLC_WONTDOIT);
  138. }
  139. memcpy (plc-&gt;MAC, confirm-&gt;IDENT.MAC, sizeof (plc-&gt;MAC));
  140. memcpy (plc-&gt;DAK, confirm-&gt;IDENT.DAK, sizeof (plc-&gt;DAK));
  141. memcpy (plc-&gt;NMK, confirm-&gt;IDENT.NMK, sizeof (plc-&gt;NMK));
  142. return (0);
  143. }
  144. #endif
  145. </pre>
  146. <div class='footerlink'>
  147. [<a href='decstring.c.html' title=' decstring.c '>PREV</a>]
  148. [<a href='toolkit.html' title=' Index '>HOME</a>]
  149. [<a href='Devices.c.html' title=' Devices.c '>NEXT</a>]
  150. </div>
  151. </body>
  152. </html>