ampID.c.html 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426
  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. ampID.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='amphost.c.html' title=' amphost.c '>PREV</a>]
  17. [<a href='toolkit.html' title=' Index '>HOME</a>]
  18. [<a href='amplist.c.html' title=' amplist.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. * ampID.c - Atheros Powerline Device Identity
  64. *
  65. *
  66. * Contributor(s):
  67. * Charles Maier &lt;cmaier@qca.qualcomm.com&gt;
  68. *
  69. *--------------------------------------------------------------------*/
  70. /*====================================================================*&quot;
  71. * system header files;
  72. *--------------------------------------------------------------------*/
  73. #include &lt;unistd.h&gt;
  74. #include &lt;stdlib.h&gt;
  75. #include &lt;limits.h&gt;
  76. #include &lt;string.h&gt;
  77. #include &lt;ctype.h&gt;
  78. /*====================================================================*
  79. * custom header files;
  80. *--------------------------------------------------------------------*/
  81. #include &quot;../tools/getoptv.h&quot;
  82. #include &quot;../tools/putoptv.h&quot;
  83. #include &quot;../tools/memory.h&quot;
  84. #include &quot;../tools/number.h&quot;
  85. #include &quot;../tools/symbol.h&quot;
  86. #include &quot;../tools/types.h&quot;
  87. #include &quot;../tools/flags.h&quot;
  88. #include &quot;../tools/files.h&quot;
  89. #include &quot;../tools/error.h&quot;
  90. #include &quot;../plc/plc.h&quot;
  91. #include &quot;../ram/nvram.h&quot;
  92. #include &quot;../ram/sdram.h&quot;
  93. #include &quot;../nvm/nvm.h&quot;
  94. #include &quot;../pib/pib.h&quot;
  95. #include &quot;../mme/mme.h&quot;
  96. /*====================================================================*
  97. * custom source files;
  98. *--------------------------------------------------------------------*/
  99. #ifndef MAKEFILE
  100. #include &quot;../tools/getoptv.c&quot;
  101. #include &quot;../tools/putoptv.c&quot;
  102. #include &quot;../tools/version.c&quot;
  103. #include &quot;../tools/uintspec.c&quot;
  104. #include &quot;../tools/hexencode.c&quot;
  105. #include &quot;../tools/hexdecode.c&quot;
  106. #include &quot;../tools/todigit.c&quot;
  107. #include &quot;../tools/hexdump.c&quot;
  108. #include &quot;../tools/hexout.c&quot;
  109. #include &quot;../tools/error.c&quot;
  110. #include &quot;../tools/synonym.c&quot;
  111. #endif
  112. #ifndef MAKEFILE
  113. #include &quot;../mme/EthernetHeader.c&quot;
  114. #include &quot;../mme/QualcommHeader.c&quot;
  115. #include &quot;../mme/UnwantedMessage.c&quot;
  116. #include &quot;../plc/Display.c&quot;
  117. #include &quot;../plc/Devices.c&quot;
  118. #endif
  119. #ifndef MAKEFILE
  120. #include &quot;../ether/openchannel.c&quot;
  121. #include &quot;../ether/closechannel.c&quot;
  122. #include &quot;../ether/readpacket.c&quot;
  123. #include &quot;../ether/sendpacket.c&quot;
  124. #include &quot;../ether/channel.c&quot;
  125. #endif
  126. #ifndef MAKEFILE
  127. #include &quot;../mme/MMECode.c&quot;
  128. #endif
  129. /*====================================================================*
  130. * program constants;
  131. *--------------------------------------------------------------------*/
  132. #define INT6KID_DAK 0
  133. #define INT6KID_NMK 1
  134. #define INT6KID_MAC 2
  135. #define INT6KID_MFG 3
  136. #define INT6KID_USR 4
  137. #define INT6KID_NET 5
  138. /*====================================================================*
  139. *
  140. * void ReadKey1 (struct channel * channel, unsigned c, int key);
  141. *
  142. * read the first block of the PIB from a device then echo one of
  143. * several parameters on stdout as a string; program output can be
  144. * used in scripts to define variables or compare strings;
  145. *
  146. * this function is an abridged version of ReadParameters(); it reads only
  147. * the first 1024 bytes of the PIB then stops; most parameters of
  148. * general interest occur in that block;
  149. *
  150. *
  151. *--------------------------------------------------------------------*/
  152. static void ReadKey1 (struct channel * channel, unsigned c, int key)
  153. {
  154. struct message message;
  155. static signed count = 0;
  156. signed packetsize;
  157. #ifndef __GNUC__
  158. #pragma pack (push,1)
  159. #endif
  160. struct __packed vs_rd_mod_request
  161. {
  162. struct ethernet_hdr ethernet;
  163. struct qualcomm_hdr qualcomm;
  164. uint8_t MODULEID;
  165. uint8_t RESERVED;
  166. uint16_t MLENGTH;
  167. uint32_t MOFFSET;
  168. uint8_t DAK [16];
  169. }
  170. * request = (struct vs_rd_mod_request *)(&amp;message);
  171. struct __packed vs_rd_mod_confirm
  172. {
  173. struct ethernet_hdr ethernet;
  174. struct qualcomm_hdr qualcomm;
  175. uint8_t MSTATUS;
  176. uint8_t RESERVED1 [3];
  177. uint8_t MODULEID;
  178. uint8_t RESERVED2;
  179. uint16_t MLENGTH;
  180. uint32_t MOFFSET;
  181. uint32_t MCHKSUM;
  182. struct simple_pib pib;
  183. }
  184. * confirm = (struct vs_rd_mod_confirm *)(&amp;message);
  185. #ifndef __GNUC__
  186. #pragma pack (pop)
  187. #endif
  188. memset (&amp;message, 0, sizeof (message));
  189. EthernetHeader (&amp;request-&gt;ethernet, channel-&gt;peer, channel-&gt;host, channel-&gt;type);
  190. QualcommHeader (&amp;request-&gt;qualcomm, 0, (VS_RD_MOD | MMTYPE_REQ));
  191. request-&gt;MODULEID = VS_MODULE_PIB;
  192. request-&gt;MLENGTH = HTOLE16 (PLC_RECORD_SIZE);
  193. request-&gt;MOFFSET = HTOLE32 (0);
  194. if (sendpacket (channel, &amp;message, (ETHER_MIN_LEN - ETHER_CRC_LEN)) &lt; 0)
  195. {
  196. error (1, errno, CHANNEL_CANTSEND);
  197. }
  198. while ((packetsize = readpacket (channel, &amp;message, sizeof (message))) &gt; 0)
  199. {
  200. if (UnwantedMessage (&amp;message, packetsize, 0, (VS_RD_MOD | MMTYPE_CNF)))
  201. {
  202. continue;
  203. }
  204. if (confirm-&gt;MSTATUS)
  205. {
  206. error (0, 0, &quot;%s (%0X): &quot;, MMECode (confirm-&gt;qualcomm.MMTYPE, confirm-&gt;MSTATUS), confirm-&gt;MSTATUS);
  207. continue;
  208. }
  209. if (count++ &gt; 0)
  210. {
  211. putc (c, stdout);
  212. }
  213. if (key == INT6KID_MAC)
  214. {
  215. hexout (confirm-&gt;pib.MAC, sizeof (confirm-&gt;pib.MAC), HEX_EXTENDER, 0, stdout);
  216. continue;
  217. }
  218. if (key == INT6KID_DAK)
  219. {
  220. hexout (confirm-&gt;pib.DAK, sizeof (confirm-&gt;pib.DAK), HEX_EXTENDER, 0, stdout);
  221. continue;
  222. }
  223. if (key == INT6KID_NMK)
  224. {
  225. hexout (confirm-&gt;pib.NMK, sizeof (confirm-&gt;pib.NMK), HEX_EXTENDER, 0, stdout);
  226. continue;
  227. }
  228. if (key == INT6KID_MFG)
  229. {
  230. confirm-&gt;pib.MFG [PIB_HFID_LEN - 1] = (char)(0);
  231. printf (&quot;%s&quot;, confirm-&gt;pib.MFG);
  232. continue;
  233. }
  234. if (key == INT6KID_USR)
  235. {
  236. confirm-&gt;pib.USR [PIB_HFID_LEN - 1] = (char)(0);
  237. printf (&quot;%s&quot;, confirm-&gt;pib.USR);
  238. continue;
  239. }
  240. if (key == INT6KID_NET)
  241. {
  242. confirm-&gt;pib.NET [PIB_HFID_LEN - 1] = (char)(0);
  243. printf (&quot;%s&quot;, confirm-&gt;pib.NET);
  244. continue;
  245. }
  246. }
  247. if (packetsize &lt; 0)
  248. {
  249. error (1, errno, CHANNEL_CANTREAD);
  250. }
  251. return;
  252. }
  253. /*====================================================================*
  254. *
  255. * int main (int argc, char const * argv []);
  256. *
  257. *
  258. *
  259. *--------------------------------------------------------------------*/
  260. int main (int argc, char const * argv [])
  261. {
  262. extern struct channel channel;
  263. static char const * optv [] =
  264. {
  265. &quot;Ac:Dei:MnNqSUv&quot;,
  266. &quot;device&quot;,
  267. &quot;Qualcomm Atheros Powerline Device Identity&quot;,
  268. &quot;A\tEthernet address (MAC)&quot;,
  269. &quot;c c\tcharacter delimiter is (c)&quot;,
  270. &quot;D\tDevice Access Key (DAK)&quot;,
  271. &quot;e\tredirect stderr to stdout&quot;,
  272. #if defined (WINPCAP) || defined (LIBPCAP)
  273. &quot;i n\thost interface is (n) [&quot; LITERAL (CHANNEL_ETHNUMBER) &quot;]&quot;,
  274. #else
  275. &quot;i s\thost interface is (s) [&quot; LITERAL (CHANNEL_ETHDEVICE) &quot;]&quot;,
  276. #endif
  277. &quot;M\tNetwork Membership Key (NMK)&quot;,
  278. &quot;n\tappend newline on output&quot;,
  279. &quot;N\tnetwork HFID&quot;,
  280. &quot;q\tquiet mode&quot;,
  281. &quot;S\tmanufacturer HFID&quot;,
  282. &quot;U\tuser HFID&quot;,
  283. &quot;v\tverbose mode&quot;,
  284. (char const *) (0)
  285. };
  286. signed newline = '\n';
  287. signed key = INT6KID_DAK;
  288. flag_t flags = (flag_t)(0);
  289. signed c;
  290. if (getenv (PLCDEVICE))
  291. {
  292. #if defined (WINPCAP) || defined (LIBPCAP)
  293. channel.ifindex = atoi (getenv (PLCDEVICE));
  294. #else
  295. channel.ifname = strdup (getenv (PLCDEVICE));
  296. #endif
  297. }
  298. optind = 1;
  299. while ((c = getoptv (argc, argv, optv)) != -1)
  300. {
  301. switch (c)
  302. {
  303. case 'A':
  304. key = INT6KID_MAC;
  305. break;
  306. case 'c':
  307. newline = * optarg;
  308. break;
  309. case 'D':
  310. key = INT6KID_DAK;
  311. break;
  312. case 'e':
  313. dup2 (STDOUT_FILENO, STDERR_FILENO);
  314. break;
  315. case 'i':
  316. #if defined (WINPCAP) || defined (LIBPCAP)
  317. channel.ifindex = atoi (optarg);
  318. #else
  319. channel.ifname = optarg;
  320. #endif
  321. break;
  322. case 'M':
  323. key = INT6KID_NMK;
  324. break;
  325. case 'n':
  326. _setbits (flags, PLC_NEWLINE);
  327. break;
  328. case 'N':
  329. key = INT6KID_NET;
  330. break;
  331. case 'q':
  332. _setbits (channel.flags, CHANNEL_SILENCE);
  333. _setbits (flags, PLC_SILENCE);
  334. break;
  335. case 'S':
  336. key = INT6KID_MFG;
  337. break;
  338. case 'U':
  339. key = INT6KID_USR;
  340. break;
  341. case 'v':
  342. _setbits (channel.flags, CHANNEL_VERBOSE);
  343. _setbits (flags, PLC_VERBOSE);
  344. break;
  345. default:
  346. break;
  347. }
  348. }
  349. argc -= optind;
  350. argv += optind;
  351. openchannel (&amp;channel);
  352. if (!argc)
  353. {
  354. ReadKey1 (&amp;channel, newline, key);
  355. if (_anyset (flags, PLC_NEWLINE))
  356. {
  357. putc (newline, stdout);
  358. }
  359. }
  360. while ((argc) &amp;&amp; (* argv))
  361. {
  362. if (!hexencode (channel.peer, sizeof (channel.peer), synonym (* argv, devices, SIZEOF (devices))))
  363. {
  364. error (1, errno, PLC_BAD_MAC, * argv);
  365. }
  366. ReadKey1 (&amp;channel, newline, key);
  367. if (_anyset (flags, PLC_NEWLINE))
  368. {
  369. putc (newline, stdout);
  370. }
  371. argv++;
  372. argc--;
  373. }
  374. closechannel (&amp;channel);
  375. return (0);
  376. }
  377. </pre>
  378. <div class='footerlink'>
  379. [<a href='amphost.c.html' title=' amphost.c '>PREV</a>]
  380. [<a href='toolkit.html' title=' Index '>HOME</a>]
  381. [<a href='amplist.c.html' title=' amplist.c '>NEXT</a>]
  382. </div>
  383. </body>
  384. </html>