RxRates2.c 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178
  1. /*====================================================================*
  2. *
  3. * Copyright (c) 2013 Qualcomm Atheros, Inc.
  4. *
  5. * All rights reserved.
  6. *
  7. * Redistribution and use in source and binary forms, with or
  8. * without modification, are permitted (subject to the limitations
  9. * in the disclaimer below) provided that the following conditions
  10. * are met:
  11. *
  12. * * Redistributions of source code must retain the above copyright
  13. * notice, this list of conditions and the following disclaimer.
  14. *
  15. * * Redistributions in binary form must reproduce the above
  16. * copyright notice, this list of conditions and the following
  17. * disclaimer in the documentation and/or other materials
  18. * provided with the distribution.
  19. *
  20. * * Neither the name of Qualcomm Atheros nor the names of
  21. * its contributors may be used to endorse or promote products
  22. * derived from this software without specific prior written
  23. * permission.
  24. *
  25. * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
  26. * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE
  27. * COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR
  28. * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  29. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  30. * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
  31. * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  32. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  33. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  34. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  35. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  36. * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
  37. * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  38. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  39. *
  40. *--------------------------------------------------------------------*/
  41. /*====================================================================*
  42. *
  43. * signed RxRates2 (struct plc * plc);
  44. *
  45. * plc.h
  46. *
  47. * An AR7x00 only version;
  48. *
  49. * Contributor(s):
  50. * Charles Maier
  51. *
  52. *--------------------------------------------------------------------*/
  53. #ifndef RXRATES2_SOURCE
  54. #define RXRATES2_SOURCE
  55. #include <stdint.h>
  56. #include <memory.h>
  57. #include "../tools/memory.h"
  58. #include "../tools/error.h"
  59. #include "../tools/flags.h"
  60. #include "../plc/plc.h"
  61. signed RxRates2 (struct plc * plc)
  62. {
  63. extern const byte broadcast [ETHER_ADDR_LEN];
  64. struct channel * channel = (struct channel *)(plc->channel);
  65. struct message * message = (struct message *)(plc->message);
  66. #ifndef __GNUC__
  67. #pragma pack (push,1)
  68. #endif
  69. struct __packed vs_nw_info_request
  70. {
  71. struct ethernet_hdr ethernet;
  72. struct qualcomm_fmi qualcomm;
  73. }
  74. * request = (struct vs_nw_info_request *)(message);
  75. struct __packed vs_nw_info_confirm
  76. {
  77. struct ethernet_hdr ethernet;
  78. struct qualcomm_fmi qualcomm;
  79. uint8_t SUB_VERSION;
  80. uint8_t Reserved;
  81. uint16_t DATA_LEN;
  82. uint8_t DATA [1];
  83. }
  84. * confirm = (struct vs_nw_info_confirm *)(message);
  85. struct __packed station
  86. {
  87. uint8_t MAC [ETHER_ADDR_LEN];
  88. uint8_t TEI;
  89. uint8_t Reserved [3];
  90. uint8_t BDA [ETHER_ADDR_LEN];
  91. uint16_t AVGTX;
  92. uint8_t COUPLING;
  93. uint8_t Reserved3;
  94. uint16_t AVGRX;
  95. uint16_t Reserved4;
  96. }
  97. * station;
  98. struct __packed network
  99. {
  100. uint8_t NID [7];
  101. uint8_t Reserved1 [2];
  102. uint8_t SNID;
  103. uint8_t TEI;
  104. uint8_t Reserved2 [4];
  105. uint8_t ROLE;
  106. uint8_t CCO_MAC [ETHER_ADDR_LEN];
  107. uint8_t CCO_TEI;
  108. uint8_t Reserved3 [3];
  109. uint8_t NUMSTAS;
  110. uint8_t Reserved4 [5];
  111. struct station stations [1];
  112. }
  113. * network;
  114. struct __packed networks
  115. {
  116. uint8_t Reserved;
  117. uint8_t NUMAVLNS;
  118. struct network networks [1];
  119. }
  120. * networks = (struct networks *) (confirm->DATA);
  121. #ifndef __GNUC__
  122. #pragma pack (pop)
  123. #endif
  124. memset (message, 0, sizeof (* message));
  125. EthernetHeader (&request->ethernet, channel->peer, channel->host, channel->type);
  126. QualcommHeader1 (&request->qualcomm, 1, (VS_NW_INFO | MMTYPE_REQ));
  127. plc->packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
  128. if (SendMME (plc) <= 0)
  129. {
  130. error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
  131. return (-1);
  132. }
  133. while (ReadMME (plc, 1, (VS_NW_INFO | MMTYPE_CNF)) > 0)
  134. {
  135. network = (struct network *)(&networks->networks);
  136. while (networks->NUMAVLNS--)
  137. {
  138. station = (struct station *)(&network->stations);
  139. while (network->NUMSTAS--)
  140. {
  141. if (memcmp (station->MAC, broadcast, sizeof (broadcast)))
  142. {
  143. station->AVGTX = LE16TOH (station->AVGTX);
  144. station->AVGRX = LE16TOH (station->AVGRX);
  145. if (_anyset (plc->flags, PLC_UNCODED_RATES))
  146. {
  147. station->AVGTX = ((station->AVGTX * 21) >> 4);
  148. station->AVGRX = ((station->AVGRX * 21) >> 4);
  149. }
  150. printf ("%d", _anyset (plc->flags, PLC_TXONLY)? station->AVGTX: station->AVGRX);
  151. if (network->NUMSTAS)
  152. {
  153. printf (", ");
  154. }
  155. }
  156. station++;
  157. }
  158. printf ("\n");
  159. network = (struct network *)(station);
  160. }
  161. }
  162. fflush (stdout);
  163. return (0);
  164. }
  165. #endif