evse_cm_mnbc_sound.c.html 8.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214
  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. evse_cm_mnbc_sound.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='evse_cm_atten_char.c.html' title=' evse_cm_atten_char.c '>PREV</a>]
  17. [<a href='toolkit.html' title=' Index '>HOME</a>]
  18. [<a href='evse_cm_set_key.c.html' title=' evse_cm_set_key.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 evse_cm_mnbc_sound (struct session * session, struct channel * channel, struct message * message);
  64. *
  65. * slac.h
  66. *
  67. * the GP specification recommends that the EVSE-HLE set an overall
  68. * timer once the cm_start_atten_char message is received and use it
  69. * to terminate the msound loop in case some msounds are lost;
  70. *
  71. * accept only CM_MNBC_SOUND.IND that match RunID from the earlier
  72. * CM_SLAC_PARAM.REQ and CM_START_ATTRN_CHAT.IND;
  73. *
  74. * each CM_MNBC_MSOUND.IND is accompanied by a CM_ATTEN_PROFILE.IND
  75. * but sometimes they arrive out of expected order;
  76. *
  77. * store the running total of CM_ATTEN_PROFILE.IND.AAG values in
  78. * the session variable and compute the average based on actual
  79. * number of sounds before returning;
  80. *
  81. *--------------------------------------------------------------------*/
  82. #ifndef EVSE_CM_MNBC_SOUND_SOURCE
  83. #define EVSE_CM_MNBC_SOUND_SOURCE
  84. #include &lt;stdio.h&gt;
  85. #include &lt;memory.h&gt;
  86. #include &lt;sys/time.h&gt;
  87. #include &quot;../ether/channel.h&quot;
  88. #include &quot;../tools/memory.h&quot;
  89. #include &quot;../tools/error.h&quot;
  90. #include &quot;../tools/flags.h&quot;
  91. #include &quot;../tools/timer.h&quot;
  92. #include &quot;../iso15118/slac.h&quot;
  93. signed evse_cm_mnbc_sound (struct session * session, struct channel * channel, struct message * message)
  94. {
  95. struct timeval ts;
  96. struct timeval tc;
  97. signed timer = 100 * session-&gt;TIME_OUT;
  98. unsigned AAG [SLAC_GROUPS];
  99. unsigned sounds = 0;
  100. ssize_t length;
  101. session-&gt;sounds = 0;
  102. memset (AAG, 0, sizeof (AAG));
  103. memset (session-&gt;AAG, 0, sizeof (session-&gt;AAG));
  104. if (gettimeofday (&amp; ts, NULL) == - 1)
  105. {
  106. slac_debug (session, 1, __func__, CANT_START_TIMER);
  107. }
  108. while ((length = readpacket (channel, message, sizeof (* message))) &gt;= 0)
  109. {
  110. struct homeplug * homeplug = (struct homeplug *) (message);
  111. if (! length)
  112. {
  113. }
  114. else if (ntohs (homeplug-&gt;ethernet.MTYPE) != ETH_P_HPAV)
  115. {
  116. slac_debug (session, session-&gt;exit, __func__, &quot;bad MTYPE&quot;);
  117. }
  118. else if (homeplug-&gt;homeplug.MMV != HOMEPLUG_MMV)
  119. {
  120. slac_debug (session, session-&gt;exit, __func__, &quot;bad MMV&quot;);
  121. }
  122. else if (LE16TOH (homeplug-&gt;homeplug.MMTYPE) == (CM_MNBC_SOUND | MMTYPE_IND))
  123. {
  124. struct cm_mnbc_sound_indicate * indicate = (struct cm_mnbc_sound_indicate *) (message);
  125. if (! memcmp (session-&gt;RunID, indicate-&gt;MSVarField.RunID, sizeof (session-&gt;RunID)))
  126. {
  127. slac_debug (session, 0, __func__, &quot;&lt;-- CM_MNBC_SOUND.IND (%d)&quot;, sounds);
  128. #if SLAC_DEBUG
  129. if (_anyset (session-&gt;flags, SLAC_VERBOSE))
  130. {
  131. char string [256];
  132. slac_debug (session, 0, __func__, &quot;CM_MNBC_SOUND.IND.APPLICATION_TYPE %d&quot;, indicate-&gt;APPLICATION_TYPE);
  133. slac_debug (session, 0, __func__, &quot;CM_MNBC_SOUND.IND.SECURITY_TYPE %d&quot;, indicate-&gt;SECURITY_TYPE);
  134. slac_debug (session, 0, __func__, &quot;CM_MNBC_SOUND.IND.MSVarField.SenderID %s&quot;, HEXSTRING (string, indicate-&gt;MSVarField.SenderID));
  135. slac_debug (session, 0, __func__, &quot;CM_MNBC_SOUND.IND.MSVarField.Count %d&quot;, indicate-&gt;MSVarField.CNT);
  136. slac_debug (session, 0, __func__, &quot;CM_MNBC_SOUND.IND.MSVarField.RunID %s&quot;, HEXSTRING (string, indicate-&gt;MSVarField.RunID));
  137. slac_debug (session, 0, __func__, &quot;CM_MNBC_SOUND.IND.MSVarField.RND %s&quot;, HEXSTRING (string, indicate-&gt;MSVarField.RND));
  138. }
  139. #endif
  140. if (memcmp (session-&gt;PEV_MAC, indicate-&gt;ethernet.OSA, sizeof (session-&gt;PEV_MAC)))
  141. {
  142. slac_debug (session, session-&gt;exit, __func__, &quot;Unexpected OSA&quot;);
  143. }
  144. sounds++;
  145. }
  146. }
  147. else if (LE16TOH (homeplug-&gt;homeplug.MMTYPE) == (CM_ATTEN_PROFILE | MMTYPE_IND))
  148. {
  149. struct cm_atten_profile_indicate * indicate = (struct cm_atten_profile_indicate *) (message);
  150. if (! memcmp (session-&gt;PEV_MAC, indicate-&gt;PEV_MAC, sizeof (session-&gt;PEV_MAC)))
  151. {
  152. slac_debug (session, 0, __func__, &quot;&lt;-- CM_ATTEN_PROFILE.IND (%d)&quot;, session-&gt;sounds);
  153. #if SLAC_DEBUG
  154. if (_anyset (session-&gt;flags, SLAC_VERBOSE))
  155. {
  156. char string [256];
  157. slac_debug (session, 0, __func__, &quot;CM_ATTEN_PROFILE.PEV_MAC %s&quot;, HEXSTRING (string, indicate-&gt;PEV_MAC));
  158. slac_debug (session, 0, __func__, &quot;CM_ATTEN_PROFILE.NumGroups %d&quot;, indicate-&gt;NumGroups);
  159. slac_debug (session, 0, __func__, &quot;CM_ATTEN_PROFILE.AAG %s&quot;, hexstring (string, sizeof (string), indicate-&gt;AAG, indicate-&gt;NumGroups));
  160. }
  161. #endif
  162. for (session-&gt;NumGroups = 0; session-&gt;NumGroups &lt; indicate-&gt;NumGroups; session-&gt;NumGroups++)
  163. {
  164. AAG [session-&gt;NumGroups] += indicate-&gt;AAG [session-&gt;NumGroups];
  165. }
  166. session-&gt;NumGroups = indicate-&gt;NumGroups;
  167. session-&gt;sounds++;
  168. }
  169. }
  170. if (gettimeofday (&amp; tc, NULL) == - 1)
  171. {
  172. slac_debug (session, 1, __func__, CANT_RESET_TIMER);
  173. }
  174. if ((MILLISECONDS (ts, tc) &lt; timer) &amp;&amp; (session-&gt;sounds &lt; session-&gt;NUM_SOUNDS))
  175. {
  176. continue;
  177. }
  178. if (session-&gt;sounds &gt; 0)
  179. {
  180. for (session-&gt;NumGroups = 0; session-&gt;NumGroups &lt; SLAC_GROUPS; ++ session-&gt;NumGroups)
  181. {
  182. session-&gt;AAG [session-&gt;NumGroups] = AAG [session-&gt;NumGroups] / session-&gt;sounds;
  183. }
  184. }
  185. return (0);
  186. }
  187. return (slac_debug (session, session-&gt;exit, __func__, &quot;Sound timeout&quot;));
  188. }
  189. #endif
  190. </pre>
  191. <div class='footerlink'>
  192. [<a href='evse_cm_atten_char.c.html' title=' evse_cm_atten_char.c '>PREV</a>]
  193. [<a href='toolkit.html' title=' Index '>HOME</a>]
  194. [<a href='evse_cm_set_key.c.html' title=' evse_cm_set_key.c '>NEXT</a>]
  195. </div>
  196. </body>
  197. </html>