123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770 |
- /*====================================================================*
- *
- * 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.
- *
- *--------------------------------------------------------------------*/
- /*====================================================================r
- *
- * psnotch.c - Atheros Prescaler Notching Utility
- *
- * Atheros Powerline Toolkit;
- *
- * this program is the Atheros INT6000 Dynamic Notching Utility
- *
- * this program inspects the following frequency bands for SW signals:
- *
- * 120 m 2,300 - 2,495 kHz tropic band
- * 90 m 3,200 - 3,400 kHz tropic band
- * 75 m 3,900 - 4,000 kHz shared with the amateur radio 75/80 meter band
- * 60 m 4,750 - 5,060 kHz tropic band
- * 49 m 5,900 - 6,200 kHz
- * 40 m/41m 7,100 - 7,350 kHz shared with the amateur radio 40 meter band
- * 31 m 9,400 - 9,900 kHz Currently most heavily used band
- * 25 m 11,600 - 12,100 kHz
- * 22 m 13,570 - 13,870 kHz substantially used only in Eurasia
- * 19 m 15,100 - 15,800 kHz
- * 16 m 17,480 - 17,900 kHz
- * 15 m 18,900 - 19,020 kHz almost unused, could become a DRM band
- * 13 m 21,450 - 21,850 kHz
- * 11 m 25,600 - 26,100 kHz may be used for local DRM broadcasting
- *
- *
- * Contributor(s):
- * Nathaniel Houghton
- *
- *--------------------------------------------------------------------*/
- /*====================================================================*"
- * system header files;
- *--------------------------------------------------------------------*/
- #include <stdio.h>
- #include <ctype.h>
- #include <ctype.h>
- #include <sys/types.h>
- #include <sys/stat.h>
- #include <fcntl.h>
- #include <string.h>
- /*====================================================================*
- * custom header files;
- *--------------------------------------------------------------------*/
- #include "../tools/getoptv.h"
- #include "../tools/putoptv.h"
- #include "../tools/error.h"
- #include "../tools/flags.h"
- #include "../tools/chars.h"
- #include "../tools/number.h"
- /*====================================================================*
- * custom source files;
- *--------------------------------------------------------------------*/
- #ifndef MAKEFILE
- #include "../tools/getoptv.c"
- #include "../tools/putoptv.c"
- #include "../tools/version.c"
- #include "../tools/error.c"
- #include "../tools/uintspec.c"
- #include "../tools/todigit.c"
- #endif
- /*====================================================================*
- * program constants;
- *--------------------------------------------------------------------*/
- #define _PRINTF_DEBUG
- #define PSNOTCH_VERBOSE (1 << 0)
- #define PSNOTCH_SILENCE (1 << 1)
- #define PSNOTCH_COMMA (1 << 2)
- #define CARRIERS 1155
- #define TONES 917
- #define SLOTS 6
- #define INDEX_TO_FREQ(index) ((float)(index + 74)/40.96)
- #define FREQ_TO_INDEX(freq) ((unsigned)(40.96 * freq)-74)
- /*====================================================================*
- * program variables;
- *--------------------------------------------------------------------*/
- typedef struct carrier
- {
- uint16_t amplitude;
- uint8_t slots [SLOTS];
- }
- carrier;
- typedef struct map
- {
- unsigned slots;
- struct carrier carriers [CARRIERS];
- }
- map;
- uint8_t hambands [CARRIERS] =
- {
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 2,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 1,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0,
- 0
- };
- /*====================================================================*
- *
- * int read_scalers (struct map * map);
- *
- * read a prescaler file from stdin; permit comments and blank
- * input lines; the set of prescalers are technically known as
- * an amplitude map;
- *
- * an amplitude map consists an offset (frequency) and a scaler
- * (amplitude); we read, check and discard the offset but store
- * the scaler;
- *
- *--------------------------------------------------------------------*/
- void read_scalers (struct map * map)
- {
- unsigned carriers = 0;
- unsigned tones = 0;
- uint32_t carrier;
- uint32_t amplitude;
- signed c;
- while ((c = getc (stdin)) != EOF)
- {
- if (isspace (c))
- {
- continue;
- }
- if ((c == '#') || (c == ';'))
- {
- do
- {
- c = getc (stdin);
- }
- while (nobreak (c));
- continue;
- }
- carrier = 0;
- while (isdigit (c))
- {
- carrier *= 10;
- carrier += c - '0';
- c = getc (stdin);
- }
- if (carrier != carriers)
- {
- error (1, 0, "Prescaler %d/%d out of order", carrier, carriers);
- }
- if (carrier >= CARRIERS)
- {
- break;
- }
- while (isblank (c))
- {
- c = getc (stdin);
- }
- amplitude = 0;
- while (isxdigit (c))
- {
- amplitude *= 16;
- amplitude += todigit (c);
- c = getc (stdin);
- }
- map->carriers [carrier].amplitude = amplitude;
- if (amplitude)
- {
- tones++;
- }
- while ((c != EOF) && (c != '\n'))
- {
- c = getc (stdin);
- }
- carriers++;
- }
- if (carriers != CARRIERS)
- {
- error (1, 0, "Have %d amplitude map carriers but need %d", carriers, CARRIERS);
- }
- if (tones != TONES)
- {
- error (1, 0, "Expected %d amplitude map scalers but read %d", TONES, tones);
- }
- return;
- }
- /*====================================================================*
- *
- * void write_scalers (struct map * map);
- *
- * print amplitude map on stdout in a format suitabl for input to
- * program psin or the Windows Device Manager;
- *
- *
- *--------------------------------------------------------------------*/
- void write_scalers (struct map * map)
- {
- unsigned carrier = 0;
- for (carrier = 0; carrier < CARRIERS; carrier++)
- {
- printf ("%.8u %.8hX\n", carrier, map->carriers [carrier].amplitude);
- }
- return;
- }
- /*====================================================================*
- *
- * void read_tonemaps (struct map * map, FILE *fp);
- *
- * read tone map from a file; a tonemap file can be created using
- * program int6ktone;
- *
- * input consists of 1159 lines; the first line is a comment; the
- * next two lines contain GIL and AGC information; the remaining
- * 1155 lines consist of an offset follwed by 5 or 6 slot values;
- *
- * although 1155 values are read, the first 917 contain tonemap
- * data and rest contain 0 values; the 917 values correspond to
- * the 917 amplitude scalers;
- *
- * the tone map may be read either before or after the amplitude
- * map is read;
- *
- *
- *--------------------------------------------------------------------*/
- void read_tonemaps (struct map * map, FILE *fp)
- {
- uint8_t slots [SLOTS];
- unsigned tones = 0;
- unsigned tone = 0;
- unsigned slot = 0;
- signed c;
- map->slots = SLOTS;
- memset (slots, 0, sizeof (slots));
- while ((c = getc (fp)) != EOF)
- {
- if (c == '#')
- {
- while (((c = getc (fp)) != EOF) && (c != '\n'));
- }
- if (isspace (c))
- {
- continue;
- }
- tone = 0;
- while (isdigit (c))
- {
- tone *= 10;
- tone += c - '0';
- c = getc (fp);
- }
- if (tone != tones)
- {
- error (1, ECANCELED, "Tonemap %d/%d is out of order", tone, tones);
- }
- while (isblank (c))
- {
- c = getc (fp);
- }
- for (slot = 0; slot < SLOTS; slot++)
- {
- unsigned value = 0;
- while (isdigit (c))
- {
- value *= 10;
- value += c - '0';
- c = getc (fp);
- }
- map->carriers [tone].slots [slot] = value;
- while (isblank (c))
- {
- c = getc (fp);
- }
- }
- while ((c != EOF) && (c != '\n'))
- {
- c = getc (fp);
- }
- tones++;
- }
- if (tones != TONES)
- {
- error (0, 0, "Have %d tone map carriers but need %d", tones, TONES);
- }
- return;
- }
- /*====================================================================*
- *
- * void align_tones (struct map * map);
- *
- * the tonemap consists of 917 consecutive carriers the amplitude
- * map consists of 1155 carriers having 917 non-zero values; this
- * function distributes the tonemap entries so that they align to
- * corresponding amplitude map entries;
- *
- * alignment cannot be performed until both the amplitude map and
- * tone map have been read;
- *
- *
- *--------------------------------------------------------------------*/
- void align_tones (struct map * map)
- {
- unsigned carriers = CARRIERS;
- unsigned tones = TONES;
- while (carriers--)
- {
- if (map->carriers [carriers].amplitude)
- {
- if (tones)
- {
- tones--;
- memcpy (&map->carriers [carriers].slots, &map->carriers [tones].slots, SLOTS);
- memset (&map->carriers [tones].slots, 0, SLOTS);
- }
- }
- }
- return;
- }
- /*====================================================================*
- *
- * unsigned notch_tones (struct map * scalers, unsigned lower, unsigned upper);
- *
- * scan a range of tones for signals; signals are indicated by low
- * mean-square values computed across all slots for a given tone;
- *
- * there may not be much change from one carrier to the next; we
- * accentuate changes by squaring then summing slot values; this
- * produces a reasonably clean parabolic dip in the map where the
- * signal occurs;
- *
- * function watch_tones can be used to observe tone map values and
- * signal dips over a given range of map values; generally, it is
- * best to display a wider range of tones than those being notched;
- *
- *
- *--------------------------------------------------------------------*/
- unsigned notch_tones (struct map * map, unsigned lower, unsigned upper, unsigned limit)
- {
- unsigned slot;
- unsigned notch = 0;
- while (lower < upper)
- {
- unsigned total = 0;
- for (slot = 0; slot < map->slots; slot++)
- {
- unsigned value = 0;
- value = map->carriers [lower].slots [slot];
- value *= value;
- total += value;
- }
- if (slot)
- {
- total /= slot;
- }
- if (total < limit)
- {
- map->carriers [lower].amplitude = 0;
- notch = 2;
- }
- lower++;
- }
- return (notch);
- }
- /*====================================================================*
- *
- * void watch_tones (struct map * map, unsigned lower, unsigned upper);
- *
- * print amplitude and tone values over a given range along with a
- * plot of the values used to detect signal dips; for best effect,
- * the range used here should exceed the notching range to provide
- * context information;
- *
- *
- *--------------------------------------------------------------------*/
- void watch_tones (struct map * map, unsigned lower, unsigned upper)
- {
- unsigned slot;
- while (lower < upper)
- {
- unsigned total = 0;
- fprintf (stderr, "%04u %04X", lower, map->carriers [lower].amplitude);
- for (slot = 0; slot < map->slots; slot++)
- {
- unsigned value = 0;
- value = map->carriers [lower].slots [slot];
- fprintf (stderr, " %02X", value);
- value *= value;
- total += value;
- }
- if (slot)
- {
- total /= slot;
- }
- fprintf (stderr, " %6.3f ", INDEX_TO_FREQ (lower));
- while (total--)
- {
- fprintf (stderr, "#");
- }
- fprintf (stderr, "\n");
- lower++;
- }
- return;
- }
- /*====================================================================*
- *
- * void watch_tone2 (struct map * map, unsigned lower, unsigned upper);
- *
- * print amplitude and tone values over a given range along with a
- * plot of the values used to detect signal dips; for best effect,
- * the range used here should exceed the notching range to provide
- * context information;
- *
- *
- *--------------------------------------------------------------------*/
- void watch_tone2 (struct map * map, unsigned lower, unsigned upper)
- {
- unsigned slot;
- while (lower < upper)
- {
- unsigned total = 0;
- fprintf (stderr, "%u,%d", lower, map->carriers [lower].amplitude);
- for (slot = 0; slot < map->slots; slot++)
- {
- unsigned value = 0;
- value = map->carriers [lower].slots [slot];
- fprintf (stderr, ",%u", value);
- value *= value;
- total += value;
- }
- if (slot)
- {
- total /= slot;
- }
- fprintf (stderr, ",%u", total);
- fprintf (stderr, ",%6.3f", INDEX_TO_FREQ (lower));
- fprintf (stderr, "\n");
- lower++;
- }
- return;
- }
- /*====================================================================*
- *
- * int main (int argc, char const * argv[]);
- *
- * read an amplitude map from stdin and print a notched amplitude
- * map on stdout; use a tone map file to determine if a signal is
- * present where notching chould occur; notching ranges are input
- * as map offsets, not carrier frequencies;
- *
- *
- *--------------------------------------------------------------------*/
- int main (int argc, char const * argv [])
- {
- char const * optv [] =
- {
- "cf:l:L:t:u:U:qv",
- PUTOPTV_S_FILTER,
- "Atheros Prescaler Notching Utility",
- "c\tcomma delimited output",
- "f f\tread tonemap file (f)",
- "t n\tthreshold is (n) units",
- "l n\tlower notch range is (n)",
- "L n\tlower graph range is (n)",
- "u n\tupper notch range is (n)",
- "U n\tupper graph range is (n)",
- "v\tverbose output",
- (char const *)(0)
- };
- struct map map;
- FILE * fp = (FILE *)(0);
- unsigned lower = CARRIERS-1;
- unsigned upper = 0;
- unsigned LOWER = 0;
- unsigned UPPER = CARRIERS-1;
- signed limit = 4;
- signed status = 0;
- flag_t flags = (flag_t)(0);
- signed c;
- memset (&map, 0, sizeof (map));
- while ((c = getoptv (argc, argv, optv)) != -1)
- {
- switch (c)
- {
- case 'c':
- _setbits (flags, PSNOTCH_COMMA);
- break;
- case 'f':
- if ((fp = fopen (optarg, "rb")) == (FILE *)(0))
- {
- error (1, errno, "Can't open %s", optarg);
- }
- read_tonemaps (&map, fp);
- fclose (fp);
- break;
- case 'l':
- lower = (unsigned)(uintspec (optarg, 0, CARRIERS-1));
- break;
- case 'u':
- upper = (unsigned)(uintspec (optarg, 0, CARRIERS-1));
- break;
- case 'L':
- LOWER = (unsigned)(uintspec (optarg, 0, CARRIERS-1));
- break;
- case 'U':
- UPPER = (unsigned)(uintspec (optarg, 0, CARRIERS-1));
- break;
- case 't':
- limit = (signed)(uintspec (optarg, 0, 49));
- break;
- case 'q':
- _setbits (flags, PSNOTCH_SILENCE);
- break;
- case 'v':
- _setbits (flags, PSNOTCH_VERBOSE);
- break;
- default:
- break;
- }
- }
- argv += optind;
- argc -= optind;
- read_scalers (&map);
- align_tones (&map);
- if (_anyset (flags, PSNOTCH_COMMA))
- {
- watch_tone2 (&map, LOWER, UPPER);
- }
- else if (_anyset (flags, PSNOTCH_VERBOSE))
- {
- watch_tones (&map, LOWER, UPPER);
- }
- if (fp)
- {
- status = notch_tones (&map, lower, upper, limit);
- }
- write_scalers (&map);
- return (status);
- }
|