NetworkDevices1.c.html 6.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215
  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. NetworkDevices1.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='NetInfo.c.html' title=' NetInfo.c '>PREV</a>]
  17. [<a href='toolkit.html' title=' Index '>HOME</a>]
  18. [<a href='NetworkDevices2.c.html' title=' NetworkDevices2.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 NetworkDevices1 (struct plc * plc, void * memory, size_t extent);
  64. *
  65. * plc.h
  66. *
  67. * return a list powerline network device addresses on a powerline
  68. * network; the list consists of a known device plus all others on
  69. * the same powerline network; the device is defined by the channel
  70. * peer address and appears first in the list;
  71. *
  72. * the device address must be explicit; it cannot be the broadcast
  73. * or localcast address;
  74. *
  75. *
  76. * Contributor(s):
  77. * Charles Maier &lt;cmaier@qca.qualcomm.com&gt;
  78. *
  79. *--------------------------------------------------------------------*/
  80. #ifndef NETWORKDEVICES1_SOURCE
  81. #define NETWORKDEVICES1_SOURCE
  82. #include &lt;stdint.h&gt;
  83. #include &lt;memory.h&gt;
  84. #include &quot;../tools/memory.h&quot;
  85. #include &quot;../tools/number.h&quot;
  86. #include &quot;../tools/types.h&quot;
  87. #include &quot;../tools/error.h&quot;
  88. #include &quot;../plc/plc.h&quot;
  89. signed NetworkDevices1 (struct plc * plc, void * memory, size_t extent)
  90. {
  91. extern const byte broadcast [ETHER_ADDR_LEN];
  92. extern const byte localcast [ETHER_ADDR_LEN];
  93. struct channel * channel = (struct channel *)(plc-&gt;channel);
  94. struct message * message = (struct message *)(plc-&gt;message);
  95. uint8_t * origin = (byte *)(memory);
  96. uint8_t * offset = (byte *)(memory);
  97. #ifndef __GNUC__
  98. #pragma pack (push,1)
  99. #endif
  100. struct __packed vs_nw_info_request
  101. {
  102. struct ethernet_hdr ethernet;
  103. struct qualcomm_hdr qualcomm;
  104. }
  105. * request = (struct vs_nw_info_request *)(message);
  106. struct __packed vs_nw_info_confirm
  107. {
  108. struct ethernet_hdr ethernet;
  109. struct qualcomm_hdr qualcomm;
  110. uint8_t data [1];
  111. }
  112. * confirm = (struct vs_nw_info_confirm *)(message);
  113. struct __packed station
  114. {
  115. uint8_t MAC [ETHER_ADDR_LEN];
  116. uint8_t TEI;
  117. uint8_t BDA [ETHER_ADDR_LEN];
  118. uint8_t AVGTX;
  119. uint8_t AVGRX;
  120. }
  121. * station;
  122. struct __packed network
  123. {
  124. uint8_t NID [7];
  125. uint8_t SNID;
  126. uint8_t TEI;
  127. uint8_t ROLE;
  128. uint8_t CCO_MAC [ETHER_ADDR_LEN];
  129. uint8_t CCO_TEI;
  130. uint8_t NUMSTAS;
  131. struct station stations [1];
  132. }
  133. * network;
  134. struct __packed networks
  135. {
  136. uint8_t NUMAVLNS;
  137. struct network networks [1];
  138. }
  139. * networks = (struct networks *) (confirm-&gt;data);
  140. #ifndef __GNUC__
  141. #pragma pack (pop)
  142. #endif
  143. ssize_t packetsize;
  144. if (!memcmp (channel-&gt;peer, broadcast, sizeof (channel-&gt;peer)))
  145. {
  146. error (1, EINVAL, &quot;Can't use broadcast address&quot;);
  147. }
  148. if (!memcmp (channel-&gt;peer, localcast, sizeof (channel-&gt;peer)))
  149. {
  150. error (1, EINVAL, &quot;Can't use localcast address&quot;);
  151. }
  152. memset (memory, 0, extent);
  153. memset (message, 0, sizeof (* message));
  154. EthernetHeader (&amp;request-&gt;ethernet, channel-&gt;peer, channel-&gt;host, channel-&gt;type);
  155. EthernetHeader (&amp;request-&gt;ethernet, channel-&gt;peer, channel-&gt;host, channel-&gt;type);
  156. QualcommHeader (&amp;request-&gt;qualcomm, 0, (VS_NW_INFO | MMTYPE_REQ));
  157. if (sendpacket (channel, message, (ETHER_MIN_LEN - ETHER_CRC_LEN)) &lt;= 0)
  158. {
  159. error (1, errno, CHANNEL_CANTSEND);
  160. }
  161. while ((packetsize = readpacket (channel, message, sizeof (* message))) &gt; 0)
  162. {
  163. if (UnwantedMessage (message, packetsize, 0, (VS_NW_INFO | MMTYPE_CNF)))
  164. {
  165. continue;
  166. }
  167. network = (struct network *)(&amp;networks-&gt;networks);
  168. while (networks-&gt;NUMAVLNS--)
  169. {
  170. if (extent &lt; sizeof (request-&gt;ethernet.OSA))
  171. {
  172. break;
  173. }
  174. memcpy (offset, request-&gt;ethernet.OSA, sizeof (request-&gt;ethernet.OSA));
  175. offset += sizeof (request-&gt;ethernet.OSA);
  176. extent -= sizeof (request-&gt;ethernet.OSA);
  177. station = (struct station *)(&amp;network-&gt;stations);
  178. while (network-&gt;NUMSTAS--)
  179. {
  180. if (extent &lt; sizeof (station-&gt;MAC))
  181. {
  182. break;
  183. }
  184. memcpy (offset, station-&gt;MAC, sizeof (station-&gt;MAC));
  185. offset += sizeof (station-&gt;MAC);
  186. extent -= sizeof (station-&gt;MAC);
  187. station++;
  188. }
  189. network = (struct network *)(station);
  190. }
  191. }
  192. return ((offset - origin) / ETHER_ADDR_LEN);
  193. }
  194. #endif
  195. </pre>
  196. <div class='footerlink'>
  197. [<a href='NetInfo.c.html' title=' NetInfo.c '>PREV</a>]
  198. [<a href='toolkit.html' title=' Index '>HOME</a>]
  199. [<a href='NetworkDevices2.c.html' title=' NetworkDevices2.c '>NEXT</a>]
  200. </div>
  201. </body>
  202. </html>