123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253 |
- <?xml version='1.0' encoding='iso-8859-1'?>
- <!doctype html public '-//W3C//DTD XHTML 1.0 Strict//EN' 'http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd'>
- <html xmlns='http://www.w3c.org/1999/xhtml' lang='en-us'>
- <head>
- <title>
- ToneMaps1.c
- </title>
- <meta http-equiv='content-type' content='text/html;iso-8859-1'/>
- <meta name='generator' content='motley-tools 1.9.4 13:40:33 Feb 18 2015'/>
- <meta name='author' content='cmaier@cmassoc.net'/>
- <meta name='robots' content='noindex,nofollow'/>
- <link href='toolkit.css' rel='stylesheet' type='text/css'/>
- </head>
- <body>
- <div class='headerlink'>
- [<a href='todigit.c.html' title=' todigit.c '>PREV</a>]
- [<a href='toolkit.html' title=' Index '>HOME</a>]
- [<a href='ToneMaps2.c.html' title=' ToneMaps2.c '>NEXT</a>]
- </div>
- <pre>
- /*====================================================================*
- *
- * Copyright (c) 2013 Qualcomm Atheros, Inc.
- *
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or
- * without modification, are permitted (subject to the limitations
- * in the disclaimer below) provided that the following conditions
- * are met:
- *
- * * Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- *
- * * Redistributions in binary form must reproduce the above
- * copyright notice, this list of conditions and the following
- * disclaimer in the documentation and/or other materials
- * provided with the distribution.
- *
- * * Neither the name of Qualcomm Atheros nor the names of
- * its contributors may be used to endorse or promote products
- * derived from this software without specific prior written
- * permission.
- *
- * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
- * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE
- * COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR
- * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
- * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
- * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
- * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
- * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
- * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
- * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
- * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
- * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- *--------------------------------------------------------------------*/
- /*====================================================================*
- *
- * signed ToneMaps1 (struct plc * plc);
- *
- * plc.h
- *
- *
- * Contributor(s):
- * Charles Maier <cmaier@qca.qualcomm.com>
- *
- *--------------------------------------------------------------------*/
- #ifndef TONEMAPS1_SOURCE
- #define TONEMAPS1_SOURCE
- #include <stdio.h>
- #include <stdint.h>
- #include "../tools/flags.h"
- #include "../plc/plc.h"
- #include "../tools/error.h"
- #include "../tools/endian.h"
- #ifndef SIGNALTONOISE1_SOURCE
- static uint8_t const mod2bits [AMP_BITS] =
- {
- 0,
- 1,
- 2,
- 3,
- 4,
- 6,
- 8,
- 10,
- 12
- };
- static uint8_t const mod2db [AMP_BITS] =
- {
- 0,
- 2,
- 4,
- 7,
- 10,
- 16,
- 22,
- 28,
- 36
- };
- #endif
- signed ToneMaps1 (struct plc * plc)
- {
- extern uint8_t const mod2bits [AMP_BITS];
- struct channel * channel = (struct channel *)(plc->channel);
- struct message * message = (struct message *)(plc->message);
- byte tonemap [PLC_SLOTS] [INT_CARRIERS >> 1];
- uint16_t carriers = 0;
- uint16_t carrier = 0;
- uint8_t slots = 0;
- uint8_t slot = 0;
- #ifndef __GNUC__
- #pragma pack (push,1)
- #endif
- struct __packed vs_tone_slot_char_request
- {
- struct ethernet_hdr ethernet;
- struct qualcomm_hdr qualcomm;
- uint8_t MACADDRESS [ETHER_ADDR_LEN];
- uint8_t TMSLOT;
- }
- * request = (struct vs_tone_slot_char_request *) (message);
- struct __packed vs_tone_slot_char_confirm
- {
- struct ethernet_hdr ethernet;
- struct qualcomm_hdr qualcomm;
- uint8_t MSTATUS;
- uint8_t TMSLOT;
- uint8_t NUMTMS;
- uint16_t TMNUMACTCARRIERS;
- uint8_t MOD_CARRIER [INT_CARRIERS/2];
- uint8_t GIL;
- uint8_t AGC;
- }
- * confirm = (struct vs_tone_slot_char_confirm *) (message);
- #ifndef __GNUC__
- #pragma pack (pop)
- #endif
- memset (message, 0, sizeof (* message));
- EthernetHeader (&request->ethernet, channel->peer, channel->host, channel->type);
- QualcommHeader (&request->qualcomm, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_REQ));
- memcpy (request->MACADDRESS, plc->RDA, sizeof (request->MACADDRESS));
- request->TMSLOT = 0;
- plc->packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
- if (SendMME (plc) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
- return (-1);
- }
- if (ReadMME (plc, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_CNF)) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
- return (-1);
- }
- carriers = LE16TOH (confirm->TMNUMACTCARRIERS);
- slots = confirm->NUMTMS;
- if (!slots)
- {
- error (PLC_EXIT (plc), ECANCELED, "No Tone Maps Available");
- return (-1);
- }
- memset (tonemap, 0, sizeof (tonemap));
- for (slot = 0; slot < slots; slot++)
- {
- EthernetHeader (&request->ethernet, channel->peer, channel->host, channel->type);
- QualcommHeader (&request->qualcomm, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_REQ));
- memcpy (request->MACADDRESS, plc->RDA, sizeof (request->MACADDRESS));
- request->TMSLOT = slot;
- plc->packetsize = (ETHER_MIN_LEN - ETHER_CRC_LEN);
- if (SendMME (plc) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
- return (-1);
- }
- if (ReadMME (plc, 0, (VS_RX_TONE_MAP_CHAR | MMTYPE_CNF)) <= 0)
- {
- error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
- return (-1);
- }
- if (confirm->MSTATUS)
- {
- Failure (plc, PLC_WONTDOIT);
- return (-1);
- }
- memcpy (&tonemap [slot][0], confirm->MOD_CARRIER, sizeof (confirm->MOD_CARRIER));
- }
- while (carrier < carriers)
- {
- unsigned value = 0;
- unsigned scale = 0;
- unsigned index = carrier >> 1;
- printf ("% 04d", carrier);
- for (slot = 0; slot < PLC_SLOTS; slot++)
- {
- value = tonemap [slot][index];
- if ((carrier & 1))
- {
- value >>= 4;
- }
- value &= 0x0F;
- printf (" %02d", mod2bits [value]);
- value *= value;
- scale += value;
- }
- if (slots)
- {
- scale /= slots;
- }
- if (_anyset (plc->flags, PLC_GRAPH))
- {
- printf (" %03d ", scale);
- while (scale--)
- {
- printf ("#");
- }
- }
- printf ("\n");
- carrier++;
- }
- return (0);
- }
- #endif
- </pre>
- <div class='footerlink'>
- [<a href='todigit.c.html' title=' todigit.c '>PREV</a>]
- [<a href='toolkit.html' title=' Index '>HOME</a>]
- [<a href='ToneMaps2.c.html' title=' ToneMaps2.c '>NEXT</a>]
- </div>
- </body>
- </html>
|