SignalToNoise1.c.html 7.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289
  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. SignalToNoise1.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='SHA256Write.c.html' title=' SHA256Write.c '>PREV</a>]
  17. [<a href='toolkit.html' title=' Index '>HOME</a>]
  18. [<a href='SignalToNoise2.c.html' title=' SignalToNoise2.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 SignalToNoise1 (struct plc * plc);
  64. *
  65. * plc.h
  66. *
  67. *
  68. * Contributor(s):
  69. * Charles Maier &lt;cmaier@qca.qualcomm.com&gt;
  70. *
  71. *--------------------------------------------------------------------*/
  72. #ifndef SIGNALTONOISE1_SOURCE
  73. #define SIGNALTONOISE1_SOURCE
  74. #include &lt;stdio.h&gt;
  75. #include &lt;stdint.h&gt;
  76. #include &quot;../tools/flags.h&quot;
  77. #include &quot;../tools/error.h&quot;
  78. #include &quot;../tools/endian.h&quot;
  79. #include &quot;../plc/plc.h&quot;
  80. #ifndef TONEMAPS1_SOURCE
  81. static uint8_t const mod2bits [AMP_BITS] =
  82. {
  83. 0,
  84. 1,
  85. 2,
  86. 3,
  87. 4,
  88. 6,
  89. 8,
  90. 10,
  91. 12
  92. };
  93. static uint8_t const mod2db [AMP_BITS] =
  94. {
  95. 0,
  96. 2,
  97. 4,
  98. 7,
  99. 10,
  100. 16,
  101. 22,
  102. 28,
  103. 36
  104. };
  105. #endif
  106. signed SignalToNoise1 (struct plc * plc)
  107. {
  108. struct channel * channel = (struct channel *)(plc-&gt;channel);
  109. struct message * message = (struct message *)(plc-&gt;message);
  110. byte tonemap [PLC_SLOTS + 1][AMP_CARRIERS &gt;&gt; 1];
  111. byte GIL [PLC_SLOTS];
  112. byte AGC [PLC_SLOTS];
  113. double SNR [PLC_SLOTS] =
  114. {
  115. 0.0
  116. };
  117. double BPC [PLC_SLOTS] =
  118. {
  119. 0.0
  120. };
  121. double AvgSNR = 0;
  122. double AvgBPC = 0;
  123. unsigned carriers = 0;
  124. unsigned carrier = 0;
  125. unsigned slots = 0;
  126. unsigned slot = 0;
  127. #ifndef __GNUC__
  128. #pragma pack (push,1)
  129. #endif
  130. struct __packed vs_tone_slot_char_request
  131. {
  132. struct ethernet_hdr ethernet;
  133. struct qualcomm_hdr qualcomm;
  134. uint8_t MACADDRESS [ETHER_ADDR_LEN];
  135. uint8_t TMSLOT;
  136. }
  137. * request = (struct vs_tone_slot_char_request *) (message);
  138. struct __packed vs_tone_slot_char_confirm
  139. {
  140. struct ethernet_hdr ethernet;
  141. struct qualcomm_hdr qualcomm;
  142. uint8_t MSTATUS;
  143. uint8_t TMSLOT;
  144. uint8_t NUMTMS;
  145. uint16_t TMNUMACTCARRIERS;
  146. uint8_t MOD_CARRIER [(INT_CARRIERS + 1) &gt;&gt; 1];
  147. uint8_t GIL;
  148. uint8_t AGC;
  149. }
  150. * confirm = (struct vs_tone_slot_char_confirm *) (message);
  151. #ifndef __GNUC__
  152. #pragma pack (pop)
  153. #endif
  154. memset (message, 0, sizeof (* message));
  155. EthernetHeader (&amp;request-&gt;ethernet, channel-&gt;peer, channel-&gt;host, channel-&gt;type);
  156. QualcommHeader (&amp;request-&gt;qualcomm, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_REQ));
  157. plc-&gt;packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
  158. memcpy (request-&gt;MACADDRESS, plc-&gt;RDA, sizeof (request-&gt;MACADDRESS));
  159. request-&gt;TMSLOT = 0;
  160. if (SendMME (plc) &lt;= 0)
  161. {
  162. error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
  163. return (-1);
  164. }
  165. if (ReadMME (plc, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_CNF)) &lt;= 0)
  166. {
  167. error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
  168. return (-1);
  169. }
  170. carriers = LE16TOH (confirm-&gt;TMNUMACTCARRIERS);
  171. slots = confirm-&gt;NUMTMS;
  172. if (!slots)
  173. {
  174. error (PLC_EXIT (plc), ECANCELED, &quot;No Tone Maps Available&quot;);
  175. return (-1);
  176. }
  177. memset (tonemap, 0, sizeof (tonemap));
  178. for (slot = 0; slot &lt; slots; slot++)
  179. {
  180. EthernetHeader (&amp;request-&gt;ethernet, channel-&gt;peer, channel-&gt;host, channel-&gt;type);
  181. QualcommHeader (&amp;request-&gt;qualcomm, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_REQ));
  182. memcpy (request-&gt;MACADDRESS, plc-&gt;RDA, sizeof (request-&gt;MACADDRESS));
  183. request-&gt;TMSLOT = slot;
  184. plc-&gt;packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
  185. if (SendMME (plc) &lt;= 0)
  186. {
  187. error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
  188. return (-1);
  189. }
  190. if (ReadMME (plc, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_CNF)) &lt;= 0)
  191. {
  192. error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
  193. return (-1);
  194. }
  195. if (confirm-&gt;MSTATUS)
  196. {
  197. Failure (plc, PLC_WONTDOIT);
  198. return (-1);
  199. }
  200. memcpy (&amp;tonemap [slot][0], confirm-&gt;MOD_CARRIER, sizeof (confirm-&gt;MOD_CARRIER));
  201. GIL [slot] = confirm-&gt;GIL;
  202. AGC [slot] = confirm-&gt;AGC;
  203. }
  204. while (carrier &lt; carriers)
  205. {
  206. unsigned value = 0;
  207. unsigned index = carrier &gt;&gt; 1;
  208. for (slot = 0; slot &lt; PLC_SLOTS; slot++)
  209. {
  210. value = tonemap [slot][index];
  211. if ((carrier &amp; 1))
  212. {
  213. value &gt;&gt;= 4;
  214. }
  215. value &amp;= 0x0F;
  216. BPC [slot] += mod2bits [value];
  217. SNR [slot] += mod2db [value];
  218. AvgBPC += mod2bits [value];
  219. AvgSNR += mod2db [value];
  220. }
  221. carrier++;
  222. }
  223. AvgBPC /= carriers;
  224. AvgBPC /= slots;
  225. AvgSNR /= carriers;
  226. AvgSNR /= slots;
  227. printf (&quot; SNR&quot;);
  228. for (slot = 0; slot &lt; slots; slot++)
  229. {
  230. printf (&quot; %8.3f&quot;, SNR [slot] / carriers);
  231. }
  232. printf (&quot; %8.3f&quot;, AvgSNR);
  233. printf (&quot; \n&quot;);
  234. printf (&quot; ATN&quot;);
  235. for (slot = 0; slot &lt; slots; slot++)
  236. {
  237. printf (&quot; %8.3f&quot;, SNR [slot] / carriers - 60);
  238. }
  239. printf (&quot; %8.3f&quot;, AvgSNR - 60);
  240. printf (&quot; \n&quot;);
  241. printf (&quot; BPC&quot;);
  242. for (slot = 0; slot &lt; slots; slot++)
  243. {
  244. printf (&quot; %8.3f&quot;, BPC [slot] / carriers);
  245. }
  246. printf (&quot; %8.3f&quot;, AvgBPC);
  247. printf (&quot; \n&quot;);
  248. printf (&quot; AGC&quot;);
  249. for (slot = 0; slot &lt; slots; slot++)
  250. {
  251. printf (&quot; %02d&quot;, AGC [slot]);
  252. }
  253. printf (&quot; \n&quot;);
  254. printf (&quot; GIL&quot;);
  255. for (slot = 0; slot &lt; slots; slot++)
  256. {
  257. printf (&quot; %02d&quot;, GIL [slot]);
  258. }
  259. printf (&quot; \n&quot;);
  260. return (0);
  261. }
  262. #endif
  263. </pre>
  264. <div class='footerlink'>
  265. [<a href='SHA256Write.c.html' title=' SHA256Write.c '>PREV</a>]
  266. [<a href='toolkit.html' title=' Index '>HOME</a>]
  267. [<a href='SignalToNoise2.c.html' title=' SignalToNoise2.c '>NEXT</a>]
  268. </div>
  269. </body>
  270. </html>