123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417 |
- /*
- * ddbridge-core.c: Digital Devices bridge core functions
- *
- * Copyright (C) 2010-2017 Digital Devices GmbH
- * Marcus Metzler <mocm@metzlerbros.de>
- * Ralph Metzler <rjkm@metzlerbros.de>
- *
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License
- * version 2 only, as published by the Free Software Foundation.
- *
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * To obtain the license, point your browser to
- * http://www.gnu.org/copyleft/gpl.html
- */
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/interrupt.h>
- #include <linux/delay.h>
- #include <linux/slab.h>
- #include <linux/poll.h>
- #include <linux/io.h>
- #include <linux/pci.h>
- #include <linux/pci_ids.h>
- #include <linux/timer.h>
- #include <linux/i2c.h>
- #include <linux/swab.h>
- #include <linux/vmalloc.h>
- #include "ddbridge.h"
- #include "ddbridge-i2c.h"
- #include "ddbridge-regs.h"
- #include "ddbridge-max.h"
- #include "ddbridge-ci.h"
- #include "ddbridge-io.h"
- #include "tda18271c2dd.h"
- #include "stv6110x.h"
- #include "stv090x.h"
- #include "lnbh24.h"
- #include "drxk.h"
- #include "stv0367.h"
- #include "stv0367_priv.h"
- #include "cxd2841er.h"
- #include "tda18212.h"
- #include "stv0910.h"
- #include "stv6111.h"
- #include "lnbh25.h"
- #include "cxd2099.h"
- #include "dvb_dummy_fe.h"
- /****************************************************************************/
- #define DDB_MAX_ADAPTER 64
- /****************************************************************************/
- DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
- static int adapter_alloc;
- module_param(adapter_alloc, int, 0444);
- MODULE_PARM_DESC(adapter_alloc,
- "0-one adapter per io, 1-one per tab with io, 2-one per tab, 3-one for all");
- static int ci_bitrate = 70000;
- module_param(ci_bitrate, int, 0444);
- MODULE_PARM_DESC(ci_bitrate, " Bitrate in KHz for output to CI.");
- static int ts_loop = -1;
- module_param(ts_loop, int, 0444);
- MODULE_PARM_DESC(ts_loop, "TS in/out test loop on port ts_loop");
- static int xo2_speed = 2;
- module_param(xo2_speed, int, 0444);
- MODULE_PARM_DESC(xo2_speed, "default transfer speed for xo2 based duoflex, 0=55,1=75,2=90,3=104 MBit/s, default=2, use attribute to change for individual cards");
- #ifdef __arm__
- static int alt_dma = 1;
- #else
- static int alt_dma;
- #endif
- module_param(alt_dma, int, 0444);
- MODULE_PARM_DESC(alt_dma, "use alternative DMA buffer handling");
- static int no_init;
- module_param(no_init, int, 0444);
- MODULE_PARM_DESC(no_init, "do not initialize most devices");
- static int stv0910_single;
- module_param(stv0910_single, int, 0444);
- MODULE_PARM_DESC(stv0910_single, "use stv0910 cards as single demods");
- static int dma_buf_num = 8;
- module_param(dma_buf_num, int, 0444);
- MODULE_PARM_DESC(dma_buf_num, "Number of DMA buffers, possible values: 8-32");
- static int dma_buf_size = 21;
- module_param(dma_buf_size, int, 0444);
- MODULE_PARM_DESC(dma_buf_size,
- "DMA buffer size as multiple of 128*47, possible values: 1-43");
- static int dummy_tuner;
- module_param(dummy_tuner, int, 0444);
- MODULE_PARM_DESC(dummy_tuner,
- "attach dummy tuner to port 0 on Octopus V3 or Octopus Mini cards");
- /****************************************************************************/
- static DEFINE_MUTEX(redirect_lock);
- static struct workqueue_struct *ddb_wq;
- static struct ddb *ddbs[DDB_MAX_ADAPTER];
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- struct ddb_irq *ddb_irq_set(struct ddb *dev, u32 link, u32 nr,
- void (*handler)(void *), void *data)
- {
- struct ddb_irq *irq = &dev->link[link].irq[nr];
- irq->handler = handler;
- irq->data = data;
- return irq;
- }
- static void ddb_set_dma_table(struct ddb_io *io)
- {
- struct ddb *dev = io->port->dev;
- struct ddb_dma *dma = io->dma;
- u32 i;
- u64 mem;
- if (!dma)
- return;
- for (i = 0; i < dma->num; i++) {
- mem = dma->pbuf[i];
- ddbwritel(dev, mem & 0xffffffff, dma->bufregs + i * 8);
- ddbwritel(dev, mem >> 32, dma->bufregs + i * 8 + 4);
- }
- dma->bufval = ((dma->div & 0x0f) << 16) |
- ((dma->num & 0x1f) << 11) |
- ((dma->size >> 7) & 0x7ff);
- }
- static void ddb_set_dma_tables(struct ddb *dev)
- {
- u32 i;
- for (i = 0; i < DDB_MAX_PORT; i++) {
- if (dev->port[i].input[0])
- ddb_set_dma_table(dev->port[i].input[0]);
- if (dev->port[i].input[1])
- ddb_set_dma_table(dev->port[i].input[1]);
- if (dev->port[i].output)
- ddb_set_dma_table(dev->port[i].output);
- }
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- static void ddb_redirect_dma(struct ddb *dev,
- struct ddb_dma *sdma,
- struct ddb_dma *ddma)
- {
- u32 i, base;
- u64 mem;
- sdma->bufval = ddma->bufval;
- base = sdma->bufregs;
- for (i = 0; i < ddma->num; i++) {
- mem = ddma->pbuf[i];
- ddbwritel(dev, mem & 0xffffffff, base + i * 8);
- ddbwritel(dev, mem >> 32, base + i * 8 + 4);
- }
- }
- static int ddb_unredirect(struct ddb_port *port)
- {
- struct ddb_input *oredi, *iredi = NULL;
- struct ddb_output *iredo = NULL;
- /* dev_info(port->dev->dev,
- * "unredirect %d.%d\n", port->dev->nr, port->nr);
- */
- mutex_lock(&redirect_lock);
- if (port->output->dma->running) {
- mutex_unlock(&redirect_lock);
- return -EBUSY;
- }
- oredi = port->output->redi;
- if (!oredi)
- goto done;
- if (port->input[0]) {
- iredi = port->input[0]->redi;
- iredo = port->input[0]->redo;
- if (iredo) {
- iredo->port->output->redi = oredi;
- if (iredo->port->input[0]) {
- iredo->port->input[0]->redi = iredi;
- ddb_redirect_dma(oredi->port->dev,
- oredi->dma, iredo->dma);
- }
- port->input[0]->redo = NULL;
- ddb_set_dma_table(port->input[0]);
- }
- oredi->redi = iredi;
- port->input[0]->redi = NULL;
- }
- oredi->redo = NULL;
- port->output->redi = NULL;
- ddb_set_dma_table(oredi);
- done:
- mutex_unlock(&redirect_lock);
- return 0;
- }
- static int ddb_redirect(u32 i, u32 p)
- {
- struct ddb *idev = ddbs[(i >> 4) & 0x3f];
- struct ddb_input *input, *input2;
- struct ddb *pdev = ddbs[(p >> 4) & 0x3f];
- struct ddb_port *port;
- if (!idev || !pdev)
- return -EINVAL;
- if (!idev->has_dma || !pdev->has_dma)
- return -EINVAL;
- port = &pdev->port[p & 0x0f];
- if (!port->output)
- return -EINVAL;
- if (ddb_unredirect(port))
- return -EBUSY;
- if (i == 8)
- return 0;
- input = &idev->input[i & 7];
- if (!input)
- return -EINVAL;
- mutex_lock(&redirect_lock);
- if (port->output->dma->running || input->dma->running) {
- mutex_unlock(&redirect_lock);
- return -EBUSY;
- }
- input2 = port->input[0];
- if (input2) {
- if (input->redi) {
- input2->redi = input->redi;
- input->redi = NULL;
- } else {
- input2->redi = input;
- }
- }
- input->redo = port->output;
- port->output->redi = input;
- ddb_redirect_dma(input->port->dev, input->dma, port->output->dma);
- mutex_unlock(&redirect_lock);
- return 0;
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- static void dma_free(struct pci_dev *pdev, struct ddb_dma *dma, int dir)
- {
- int i;
- if (!dma)
- return;
- for (i = 0; i < dma->num; i++) {
- if (dma->vbuf[i]) {
- if (alt_dma) {
- dma_unmap_single(&pdev->dev, dma->pbuf[i],
- dma->size,
- dir ? DMA_TO_DEVICE :
- DMA_FROM_DEVICE);
- kfree(dma->vbuf[i]);
- dma->vbuf[i] = NULL;
- } else {
- dma_free_coherent(&pdev->dev, dma->size,
- dma->vbuf[i], dma->pbuf[i]);
- }
- dma->vbuf[i] = NULL;
- }
- }
- }
- static int dma_alloc(struct pci_dev *pdev, struct ddb_dma *dma, int dir)
- {
- int i;
- if (!dma)
- return 0;
- for (i = 0; i < dma->num; i++) {
- if (alt_dma) {
- dma->vbuf[i] = kmalloc(dma->size, __GFP_RETRY_MAYFAIL);
- if (!dma->vbuf[i])
- return -ENOMEM;
- dma->pbuf[i] = dma_map_single(&pdev->dev,
- dma->vbuf[i],
- dma->size,
- dir ? DMA_TO_DEVICE :
- DMA_FROM_DEVICE);
- if (dma_mapping_error(&pdev->dev, dma->pbuf[i])) {
- kfree(dma->vbuf[i]);
- dma->vbuf[i] = NULL;
- return -ENOMEM;
- }
- } else {
- dma->vbuf[i] = dma_alloc_coherent(&pdev->dev,
- dma->size,
- &dma->pbuf[i],
- GFP_KERNEL);
- if (!dma->vbuf[i])
- return -ENOMEM;
- }
- }
- return 0;
- }
- int ddb_buffers_alloc(struct ddb *dev)
- {
- int i;
- struct ddb_port *port;
- for (i = 0; i < dev->port_num; i++) {
- port = &dev->port[i];
- switch (port->class) {
- case DDB_PORT_TUNER:
- if (port->input[0]->dma)
- if (dma_alloc(dev->pdev, port->input[0]->dma, 0)
- < 0)
- return -1;
- if (port->input[1]->dma)
- if (dma_alloc(dev->pdev, port->input[1]->dma, 0)
- < 0)
- return -1;
- break;
- case DDB_PORT_CI:
- case DDB_PORT_LOOP:
- if (port->input[0]->dma)
- if (dma_alloc(dev->pdev, port->input[0]->dma, 0)
- < 0)
- return -1;
- if (port->output->dma)
- if (dma_alloc(dev->pdev, port->output->dma, 1)
- < 0)
- return -1;
- break;
- default:
- break;
- }
- }
- ddb_set_dma_tables(dev);
- return 0;
- }
- void ddb_buffers_free(struct ddb *dev)
- {
- int i;
- struct ddb_port *port;
- for (i = 0; i < dev->port_num; i++) {
- port = &dev->port[i];
- if (port->input[0] && port->input[0]->dma)
- dma_free(dev->pdev, port->input[0]->dma, 0);
- if (port->input[1] && port->input[1]->dma)
- dma_free(dev->pdev, port->input[1]->dma, 0);
- if (port->output && port->output->dma)
- dma_free(dev->pdev, port->output->dma, 1);
- }
- }
- static void calc_con(struct ddb_output *output, u32 *con, u32 *con2, u32 flags)
- {
- struct ddb *dev = output->port->dev;
- u32 bitrate = output->port->obr, max_bitrate = 72000;
- u32 gap = 4, nco = 0;
- *con = 0x1c;
- if (output->port->gap != 0xffffffff) {
- flags |= 1;
- gap = output->port->gap;
- max_bitrate = 0;
- }
- if (dev->link[0].info->type == DDB_OCTOPUS_CI && output->port->nr > 1) {
- *con = 0x10c;
- if (dev->link[0].ids.regmapid >= 0x10003 && !(flags & 1)) {
- if (!(flags & 2)) {
- /* NCO */
- max_bitrate = 0;
- gap = 0;
- if (bitrate != 72000) {
- if (bitrate >= 96000) {
- *con |= 0x800;
- } else {
- *con |= 0x1000;
- nco = (bitrate * 8192 + 71999)
- / 72000;
- }
- }
- } else {
- /* Divider and gap */
- *con |= 0x1810;
- if (bitrate <= 64000) {
- max_bitrate = 64000;
- nco = 8;
- } else if (bitrate <= 72000) {
- max_bitrate = 72000;
- nco = 7;
- } else {
- max_bitrate = 96000;
- nco = 5;
- }
- }
- } else {
- if (bitrate > 72000) {
- *con |= 0x810; /* 96 MBit/s and gap */
- max_bitrate = 96000;
- }
- *con |= 0x10; /* enable gap */
- }
- }
- if (max_bitrate > 0) {
- if (bitrate > max_bitrate)
- bitrate = max_bitrate;
- if (bitrate < 31000)
- bitrate = 31000;
- gap = ((max_bitrate - bitrate) * 94) / bitrate;
- if (gap < 2)
- *con &= ~0x10; /* Disable gap */
- else
- gap -= 2;
- if (gap > 127)
- gap = 127;
- }
- *con2 = (nco << 16) | gap;
- }
- static void ddb_output_start(struct ddb_output *output)
- {
- struct ddb *dev = output->port->dev;
- u32 con = 0x11c, con2 = 0;
- spin_lock_irq(&output->dma->lock);
- output->dma->cbuf = 0;
- output->dma->coff = 0;
- output->dma->stat = 0;
- ddbwritel(dev, 0, DMA_BUFFER_CONTROL(output->dma));
- if (output->port->input[0]->port->class == DDB_PORT_LOOP)
- con = (1UL << 13) | 0x14;
- else
- calc_con(output, &con, &con2, 0);
- ddbwritel(dev, 0, TS_CONTROL(output));
- ddbwritel(dev, 2, TS_CONTROL(output));
- ddbwritel(dev, 0, TS_CONTROL(output));
- ddbwritel(dev, con, TS_CONTROL(output));
- ddbwritel(dev, con2, TS_CONTROL2(output));
- ddbwritel(dev, output->dma->bufval,
- DMA_BUFFER_SIZE(output->dma));
- ddbwritel(dev, 0, DMA_BUFFER_ACK(output->dma));
- ddbwritel(dev, 1, DMA_BASE_READ);
- ddbwritel(dev, 7, DMA_BUFFER_CONTROL(output->dma));
- ddbwritel(dev, con | 1, TS_CONTROL(output));
- output->dma->running = 1;
- spin_unlock_irq(&output->dma->lock);
- }
- static void ddb_output_stop(struct ddb_output *output)
- {
- struct ddb *dev = output->port->dev;
- spin_lock_irq(&output->dma->lock);
- ddbwritel(dev, 0, TS_CONTROL(output));
- ddbwritel(dev, 0, DMA_BUFFER_CONTROL(output->dma));
- output->dma->running = 0;
- spin_unlock_irq(&output->dma->lock);
- }
- static void ddb_input_stop(struct ddb_input *input)
- {
- struct ddb *dev = input->port->dev;
- u32 tag = DDB_LINK_TAG(input->port->lnr);
- spin_lock_irq(&input->dma->lock);
- ddbwritel(dev, 0, tag | TS_CONTROL(input));
- ddbwritel(dev, 0, DMA_BUFFER_CONTROL(input->dma));
- input->dma->running = 0;
- spin_unlock_irq(&input->dma->lock);
- }
- static void ddb_input_start(struct ddb_input *input)
- {
- struct ddb *dev = input->port->dev;
- spin_lock_irq(&input->dma->lock);
- input->dma->cbuf = 0;
- input->dma->coff = 0;
- input->dma->stat = 0;
- ddbwritel(dev, 0, DMA_BUFFER_CONTROL(input->dma));
- ddbwritel(dev, 0, TS_CONTROL(input));
- ddbwritel(dev, 2, TS_CONTROL(input));
- ddbwritel(dev, 0, TS_CONTROL(input));
- ddbwritel(dev, input->dma->bufval,
- DMA_BUFFER_SIZE(input->dma));
- ddbwritel(dev, 0, DMA_BUFFER_ACK(input->dma));
- ddbwritel(dev, 1, DMA_BASE_WRITE);
- ddbwritel(dev, 3, DMA_BUFFER_CONTROL(input->dma));
- ddbwritel(dev, 0x09, TS_CONTROL(input));
- if (input->port->type == DDB_TUNER_DUMMY)
- ddbwritel(dev, 0x000fff01, TS_CONTROL2(input));
- input->dma->running = 1;
- spin_unlock_irq(&input->dma->lock);
- }
- static void ddb_input_start_all(struct ddb_input *input)
- {
- struct ddb_input *i = input;
- struct ddb_output *o;
- mutex_lock(&redirect_lock);
- while (i && (o = i->redo)) {
- ddb_output_start(o);
- i = o->port->input[0];
- if (i)
- ddb_input_start(i);
- }
- ddb_input_start(input);
- mutex_unlock(&redirect_lock);
- }
- static void ddb_input_stop_all(struct ddb_input *input)
- {
- struct ddb_input *i = input;
- struct ddb_output *o;
- mutex_lock(&redirect_lock);
- ddb_input_stop(input);
- while (i && (o = i->redo)) {
- ddb_output_stop(o);
- i = o->port->input[0];
- if (i)
- ddb_input_stop(i);
- }
- mutex_unlock(&redirect_lock);
- }
- static u32 ddb_output_free(struct ddb_output *output)
- {
- u32 idx, off, stat = output->dma->stat;
- s32 diff;
- idx = (stat >> 11) & 0x1f;
- off = (stat & 0x7ff) << 7;
- if (output->dma->cbuf != idx) {
- if ((((output->dma->cbuf + 1) % output->dma->num) == idx) &&
- (output->dma->size - output->dma->coff <= (2 * 188)))
- return 0;
- return 188;
- }
- diff = off - output->dma->coff;
- if (diff <= 0 || diff > (2 * 188))
- return 188;
- return 0;
- }
- static ssize_t ddb_output_write(struct ddb_output *output,
- const __user u8 *buf, size_t count)
- {
- struct ddb *dev = output->port->dev;
- u32 idx, off, stat = output->dma->stat;
- u32 left = count, len;
- idx = (stat >> 11) & 0x1f;
- off = (stat & 0x7ff) << 7;
- while (left) {
- len = output->dma->size - output->dma->coff;
- if ((((output->dma->cbuf + 1) % output->dma->num) == idx) &&
- off == 0) {
- if (len <= 188)
- break;
- len -= 188;
- }
- if (output->dma->cbuf == idx) {
- if (off > output->dma->coff) {
- len = off - output->dma->coff;
- len -= (len % 188);
- if (len <= 188)
- break;
- len -= 188;
- }
- }
- if (len > left)
- len = left;
- if (copy_from_user(output->dma->vbuf[output->dma->cbuf] +
- output->dma->coff,
- buf, len))
- return -EIO;
- if (alt_dma)
- dma_sync_single_for_device(
- dev->dev,
- output->dma->pbuf[output->dma->cbuf],
- output->dma->size, DMA_TO_DEVICE);
- left -= len;
- buf += len;
- output->dma->coff += len;
- if (output->dma->coff == output->dma->size) {
- output->dma->coff = 0;
- output->dma->cbuf = ((output->dma->cbuf + 1) %
- output->dma->num);
- }
- ddbwritel(dev,
- (output->dma->cbuf << 11) |
- (output->dma->coff >> 7),
- DMA_BUFFER_ACK(output->dma));
- }
- return count - left;
- }
- static u32 ddb_input_avail(struct ddb_input *input)
- {
- struct ddb *dev = input->port->dev;
- u32 idx, off, stat = input->dma->stat;
- u32 ctrl = ddbreadl(dev, DMA_BUFFER_CONTROL(input->dma));
- idx = (stat >> 11) & 0x1f;
- off = (stat & 0x7ff) << 7;
- if (ctrl & 4) {
- dev_err(dev->dev, "IA %d %d %08x\n", idx, off, ctrl);
- ddbwritel(dev, stat, DMA_BUFFER_ACK(input->dma));
- return 0;
- }
- if (input->dma->cbuf != idx)
- return 188;
- return 0;
- }
- static ssize_t ddb_input_read(struct ddb_input *input,
- __user u8 *buf, size_t count)
- {
- struct ddb *dev = input->port->dev;
- u32 left = count;
- u32 idx, free, stat = input->dma->stat;
- int ret;
- idx = (stat >> 11) & 0x1f;
- while (left) {
- if (input->dma->cbuf == idx)
- return count - left;
- free = input->dma->size - input->dma->coff;
- if (free > left)
- free = left;
- if (alt_dma)
- dma_sync_single_for_cpu(
- dev->dev,
- input->dma->pbuf[input->dma->cbuf],
- input->dma->size, DMA_FROM_DEVICE);
- ret = copy_to_user(buf, input->dma->vbuf[input->dma->cbuf] +
- input->dma->coff, free);
- if (ret)
- return -EFAULT;
- input->dma->coff += free;
- if (input->dma->coff == input->dma->size) {
- input->dma->coff = 0;
- input->dma->cbuf = (input->dma->cbuf + 1) %
- input->dma->num;
- }
- left -= free;
- buf += free;
- ddbwritel(dev,
- (input->dma->cbuf << 11) | (input->dma->coff >> 7),
- DMA_BUFFER_ACK(input->dma));
- }
- return count;
- }
- /****************************************************************************/
- /****************************************************************************/
- static ssize_t ts_write(struct file *file, const __user char *buf,
- size_t count, loff_t *ppos)
- {
- struct dvb_device *dvbdev = file->private_data;
- struct ddb_output *output = dvbdev->priv;
- struct ddb *dev = output->port->dev;
- size_t left = count;
- int stat;
- if (!dev->has_dma)
- return -EINVAL;
- while (left) {
- if (ddb_output_free(output) < 188) {
- if (file->f_flags & O_NONBLOCK)
- break;
- if (wait_event_interruptible(
- output->dma->wq,
- ddb_output_free(output) >= 188) < 0)
- break;
- }
- stat = ddb_output_write(output, buf, left);
- if (stat < 0)
- return stat;
- buf += stat;
- left -= stat;
- }
- return (left == count) ? -EAGAIN : (count - left);
- }
- static ssize_t ts_read(struct file *file, __user char *buf,
- size_t count, loff_t *ppos)
- {
- struct dvb_device *dvbdev = file->private_data;
- struct ddb_output *output = dvbdev->priv;
- struct ddb_input *input = output->port->input[0];
- struct ddb *dev = output->port->dev;
- size_t left = count;
- int stat;
- if (!dev->has_dma)
- return -EINVAL;
- while (left) {
- if (ddb_input_avail(input) < 188) {
- if (file->f_flags & O_NONBLOCK)
- break;
- if (wait_event_interruptible(
- input->dma->wq,
- ddb_input_avail(input) >= 188) < 0)
- break;
- }
- stat = ddb_input_read(input, buf, left);
- if (stat < 0)
- return stat;
- left -= stat;
- buf += stat;
- }
- return (count && (left == count)) ? -EAGAIN : (count - left);
- }
- static __poll_t ts_poll(struct file *file, poll_table *wait)
- {
- struct dvb_device *dvbdev = file->private_data;
- struct ddb_output *output = dvbdev->priv;
- struct ddb_input *input = output->port->input[0];
- __poll_t mask = 0;
- poll_wait(file, &input->dma->wq, wait);
- poll_wait(file, &output->dma->wq, wait);
- if (ddb_input_avail(input) >= 188)
- mask |= EPOLLIN | EPOLLRDNORM;
- if (ddb_output_free(output) >= 188)
- mask |= EPOLLOUT | EPOLLWRNORM;
- return mask;
- }
- static int ts_release(struct inode *inode, struct file *file)
- {
- struct dvb_device *dvbdev = file->private_data;
- struct ddb_output *output = NULL;
- struct ddb_input *input = NULL;
- if (dvbdev) {
- output = dvbdev->priv;
- input = output->port->input[0];
- }
- if ((file->f_flags & O_ACCMODE) == O_RDONLY) {
- if (!input)
- return -EINVAL;
- ddb_input_stop(input);
- } else if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
- if (!output)
- return -EINVAL;
- ddb_output_stop(output);
- }
- return dvb_generic_release(inode, file);
- }
- static int ts_open(struct inode *inode, struct file *file)
- {
- int err;
- struct dvb_device *dvbdev = file->private_data;
- struct ddb_output *output = NULL;
- struct ddb_input *input = NULL;
- if (dvbdev) {
- output = dvbdev->priv;
- input = output->port->input[0];
- }
- if ((file->f_flags & O_ACCMODE) == O_RDONLY) {
- if (!input)
- return -EINVAL;
- if (input->redo || input->redi)
- return -EBUSY;
- } else if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
- if (!output)
- return -EINVAL;
- } else {
- return -EINVAL;
- }
- err = dvb_generic_open(inode, file);
- if (err < 0)
- return err;
- if ((file->f_flags & O_ACCMODE) == O_RDONLY)
- ddb_input_start(input);
- else if ((file->f_flags & O_ACCMODE) == O_WRONLY)
- ddb_output_start(output);
- return err;
- }
- static const struct file_operations ci_fops = {
- .owner = THIS_MODULE,
- .read = ts_read,
- .write = ts_write,
- .open = ts_open,
- .release = ts_release,
- .poll = ts_poll,
- .mmap = NULL,
- };
- static struct dvb_device dvbdev_ci = {
- .priv = NULL,
- .readers = 1,
- .writers = 1,
- .users = 2,
- .fops = &ci_fops,
- };
- /****************************************************************************/
- /****************************************************************************/
- static int locked_gate_ctrl(struct dvb_frontend *fe, int enable)
- {
- struct ddb_input *input = fe->sec_priv;
- struct ddb_port *port = input->port;
- struct ddb_dvb *dvb = &port->dvb[input->nr & 1];
- int status;
- if (enable) {
- mutex_lock(&port->i2c_gate_lock);
- status = dvb->i2c_gate_ctrl(fe, 1);
- } else {
- status = dvb->i2c_gate_ctrl(fe, 0);
- mutex_unlock(&port->i2c_gate_lock);
- }
- return status;
- }
- static int demod_attach_drxk(struct ddb_input *input)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- struct drxk_config config;
- memset(&config, 0, sizeof(config));
- config.adr = 0x29 + (input->nr & 1);
- config.microcode_name = "drxk_a3.mc";
- dvb->fe = dvb_attach(drxk_attach, &config, i2c);
- if (!dvb->fe) {
- dev_err(dev, "No DRXK found!\n");
- return -ENODEV;
- }
- dvb->fe->sec_priv = input;
- dvb->i2c_gate_ctrl = dvb->fe->ops.i2c_gate_ctrl;
- dvb->fe->ops.i2c_gate_ctrl = locked_gate_ctrl;
- return 0;
- }
- static int tuner_attach_tda18271(struct ddb_input *input)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- struct dvb_frontend *fe;
- if (dvb->fe->ops.i2c_gate_ctrl)
- dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 1);
- fe = dvb_attach(tda18271c2dd_attach, dvb->fe, i2c, 0x60);
- if (dvb->fe->ops.i2c_gate_ctrl)
- dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 0);
- if (!fe) {
- dev_err(dev, "No TDA18271 found!\n");
- return -ENODEV;
- }
- return 0;
- }
- /******************************************************************************/
- /******************************************************************************/
- /******************************************************************************/
- static struct stv0367_config ddb_stv0367_config[] = {
- {
- .demod_address = 0x1f,
- .xtal = 27000000,
- .if_khz = 0,
- .if_iq_mode = FE_TER_NORMAL_IF_TUNER,
- .ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
- .clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
- }, {
- .demod_address = 0x1e,
- .xtal = 27000000,
- .if_khz = 0,
- .if_iq_mode = FE_TER_NORMAL_IF_TUNER,
- .ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
- .clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
- },
- };
- static int demod_attach_stv0367(struct ddb_input *input)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- /* attach frontend */
- dvb->fe = dvb_attach(stv0367ddb_attach,
- &ddb_stv0367_config[(input->nr & 1)], i2c);
- if (!dvb->fe) {
- dev_err(dev, "No stv0367 found!\n");
- return -ENODEV;
- }
- dvb->fe->sec_priv = input;
- dvb->i2c_gate_ctrl = dvb->fe->ops.i2c_gate_ctrl;
- dvb->fe->ops.i2c_gate_ctrl = locked_gate_ctrl;
- return 0;
- }
- static int tuner_tda18212_ping(struct ddb_input *input, unsigned short adr)
- {
- struct i2c_adapter *adapter = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- u8 tda_id[2];
- u8 subaddr = 0x00;
- dev_dbg(dev, "stv0367-tda18212 tuner ping\n");
- if (dvb->fe->ops.i2c_gate_ctrl)
- dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 1);
- if (i2c_read_regs(adapter, adr, subaddr, tda_id, sizeof(tda_id)) < 0)
- dev_dbg(dev, "tda18212 ping 1 fail\n");
- if (i2c_read_regs(adapter, adr, subaddr, tda_id, sizeof(tda_id)) < 0)
- dev_warn(dev, "tda18212 ping failed, expect problems\n");
- if (dvb->fe->ops.i2c_gate_ctrl)
- dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 0);
- return 0;
- }
- static int demod_attach_cxd28xx(struct ddb_input *input, int par, int osc24)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- struct cxd2841er_config cfg;
- /* the cxd2841er driver expects 8bit/shifted I2C addresses */
- cfg.i2c_addr = ((input->nr & 1) ? 0x6d : 0x6c) << 1;
- cfg.xtal = osc24 ? SONY_XTAL_24000 : SONY_XTAL_20500;
- cfg.flags = CXD2841ER_AUTO_IFHZ | CXD2841ER_EARLY_TUNE |
- CXD2841ER_NO_WAIT_LOCK | CXD2841ER_NO_AGCNEG |
- CXD2841ER_TSBITS;
- if (!par)
- cfg.flags |= CXD2841ER_TS_SERIAL;
- /* attach frontend */
- dvb->fe = dvb_attach(cxd2841er_attach_t_c, &cfg, i2c);
- if (!dvb->fe) {
- dev_err(dev, "No cxd2837/38/43/54 found!\n");
- return -ENODEV;
- }
- dvb->fe->sec_priv = input;
- dvb->i2c_gate_ctrl = dvb->fe->ops.i2c_gate_ctrl;
- dvb->fe->ops.i2c_gate_ctrl = locked_gate_ctrl;
- return 0;
- }
- static int tuner_attach_tda18212(struct ddb_input *input, u32 porttype)
- {
- struct i2c_adapter *adapter = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- struct i2c_client *client;
- struct tda18212_config config = {
- .fe = dvb->fe,
- .if_dvbt_6 = 3550,
- .if_dvbt_7 = 3700,
- .if_dvbt_8 = 4150,
- .if_dvbt2_6 = 3250,
- .if_dvbt2_7 = 4000,
- .if_dvbt2_8 = 4000,
- .if_dvbc = 5000,
- };
- u8 addr = (input->nr & 1) ? 0x63 : 0x60;
- /* due to a hardware quirk with the I2C gate on the stv0367+tda18212
- * combo, the tda18212 must be probed by reading it's id _twice_ when
- * cold started, or it very likely will fail.
- */
- if (porttype == DDB_TUNER_DVBCT_ST)
- tuner_tda18212_ping(input, addr);
- /* perform tuner probe/init/attach */
- client = dvb_module_probe("tda18212", NULL, adapter, addr, &config);
- if (!client)
- goto err;
- dvb->i2c_client[0] = client;
- return 0;
- err:
- dev_err(dev, "TDA18212 tuner not found. Device is not fully operational.\n");
- return -ENODEV;
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- static struct stv090x_config stv0900 = {
- .device = STV0900,
- .demod_mode = STV090x_DUAL,
- .clk_mode = STV090x_CLK_EXT,
- .xtal = 27000000,
- .address = 0x69,
- .ts1_mode = STV090x_TSMODE_SERIAL_PUNCTURED,
- .ts2_mode = STV090x_TSMODE_SERIAL_PUNCTURED,
- .ts1_tei = 1,
- .ts2_tei = 1,
- .repeater_level = STV090x_RPTLEVEL_16,
- .adc1_range = STV090x_ADC_1Vpp,
- .adc2_range = STV090x_ADC_1Vpp,
- .diseqc_envelope_mode = true,
- };
- static struct stv090x_config stv0900_aa = {
- .device = STV0900,
- .demod_mode = STV090x_DUAL,
- .clk_mode = STV090x_CLK_EXT,
- .xtal = 27000000,
- .address = 0x68,
- .ts1_mode = STV090x_TSMODE_SERIAL_PUNCTURED,
- .ts2_mode = STV090x_TSMODE_SERIAL_PUNCTURED,
- .ts1_tei = 1,
- .ts2_tei = 1,
- .repeater_level = STV090x_RPTLEVEL_16,
- .adc1_range = STV090x_ADC_1Vpp,
- .adc2_range = STV090x_ADC_1Vpp,
- .diseqc_envelope_mode = true,
- };
- static struct stv6110x_config stv6110a = {
- .addr = 0x60,
- .refclk = 27000000,
- .clk_div = 1,
- };
- static struct stv6110x_config stv6110b = {
- .addr = 0x63,
- .refclk = 27000000,
- .clk_div = 1,
- };
- static int demod_attach_stv0900(struct ddb_input *input, int type)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct stv090x_config *feconf = type ? &stv0900_aa : &stv0900;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- dvb->fe = dvb_attach(stv090x_attach, feconf, i2c,
- (input->nr & 1) ? STV090x_DEMODULATOR_1
- : STV090x_DEMODULATOR_0);
- if (!dvb->fe) {
- dev_err(dev, "No STV0900 found!\n");
- return -ENODEV;
- }
- if (!dvb_attach(lnbh24_attach, dvb->fe, i2c, 0,
- 0, (input->nr & 1) ?
- (0x09 - type) : (0x0b - type))) {
- dev_err(dev, "No LNBH24 found!\n");
- dvb_frontend_detach(dvb->fe);
- return -ENODEV;
- }
- return 0;
- }
- static int tuner_attach_stv6110(struct ddb_input *input, int type)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- struct stv090x_config *feconf = type ? &stv0900_aa : &stv0900;
- struct stv6110x_config *tunerconf = (input->nr & 1) ?
- &stv6110b : &stv6110a;
- const struct stv6110x_devctl *ctl;
- ctl = dvb_attach(stv6110x_attach, dvb->fe, tunerconf, i2c);
- if (!ctl) {
- dev_err(dev, "No STV6110X found!\n");
- return -ENODEV;
- }
- dev_info(dev, "attach tuner input %d adr %02x\n",
- input->nr, tunerconf->addr);
- feconf->tuner_init = ctl->tuner_init;
- feconf->tuner_sleep = ctl->tuner_sleep;
- feconf->tuner_set_mode = ctl->tuner_set_mode;
- feconf->tuner_set_frequency = ctl->tuner_set_frequency;
- feconf->tuner_get_frequency = ctl->tuner_get_frequency;
- feconf->tuner_set_bandwidth = ctl->tuner_set_bandwidth;
- feconf->tuner_get_bandwidth = ctl->tuner_get_bandwidth;
- feconf->tuner_set_bbgain = ctl->tuner_set_bbgain;
- feconf->tuner_get_bbgain = ctl->tuner_get_bbgain;
- feconf->tuner_set_refclk = ctl->tuner_set_refclk;
- feconf->tuner_get_status = ctl->tuner_get_status;
- return 0;
- }
- static const struct stv0910_cfg stv0910_p = {
- .adr = 0x68,
- .parallel = 1,
- .rptlvl = 4,
- .clk = 30000000,
- };
- static const struct lnbh25_config lnbh25_cfg = {
- .i2c_address = 0x0c << 1,
- .data2_config = LNBH25_TEN
- };
- static int demod_attach_stv0910(struct ddb_input *input, int type)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- struct stv0910_cfg cfg = stv0910_p;
- struct lnbh25_config lnbcfg = lnbh25_cfg;
- if (stv0910_single)
- cfg.single = 1;
- if (type)
- cfg.parallel = 2;
- dvb->fe = dvb_attach(stv0910_attach, i2c, &cfg, (input->nr & 1));
- if (!dvb->fe) {
- cfg.adr = 0x6c;
- dvb->fe = dvb_attach(stv0910_attach, i2c,
- &cfg, (input->nr & 1));
- }
- if (!dvb->fe) {
- dev_err(dev, "No STV0910 found!\n");
- return -ENODEV;
- }
- /* attach lnbh25 - leftshift by one as the lnbh25 driver expects 8bit
- * i2c addresses
- */
- lnbcfg.i2c_address = (((input->nr & 1) ? 0x0d : 0x0c) << 1);
- if (!dvb_attach(lnbh25_attach, dvb->fe, &lnbcfg, i2c)) {
- lnbcfg.i2c_address = (((input->nr & 1) ? 0x09 : 0x08) << 1);
- if (!dvb_attach(lnbh25_attach, dvb->fe, &lnbcfg, i2c)) {
- dev_err(dev, "No LNBH25 found!\n");
- dvb_frontend_detach(dvb->fe);
- return -ENODEV;
- }
- }
- return 0;
- }
- static int tuner_attach_stv6111(struct ddb_input *input, int type)
- {
- struct i2c_adapter *i2c = &input->port->i2c->adap;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- struct dvb_frontend *fe;
- u8 adr = (type ? 0 : 4) + ((input->nr & 1) ? 0x63 : 0x60);
- fe = dvb_attach(stv6111_attach, dvb->fe, i2c, adr);
- if (!fe) {
- fe = dvb_attach(stv6111_attach, dvb->fe, i2c, adr & ~4);
- if (!fe) {
- dev_err(dev, "No STV6111 found at 0x%02x!\n", adr);
- return -ENODEV;
- }
- }
- return 0;
- }
- static int demod_attach_dummy(struct ddb_input *input)
- {
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct device *dev = input->port->dev->dev;
- dvb->fe = dvb_attach(dvb_dummy_fe_qam_attach);
- if (!dvb->fe) {
- dev_err(dev, "QAM dummy attach failed!\n");
- return -ENODEV;
- }
- return 0;
- }
- static int start_feed(struct dvb_demux_feed *dvbdmxfeed)
- {
- struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
- struct ddb_input *input = dvbdmx->priv;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- if (!dvb->users)
- ddb_input_start_all(input);
- return ++dvb->users;
- }
- static int stop_feed(struct dvb_demux_feed *dvbdmxfeed)
- {
- struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
- struct ddb_input *input = dvbdmx->priv;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- if (--dvb->users)
- return dvb->users;
- ddb_input_stop_all(input);
- return 0;
- }
- static void dvb_input_detach(struct ddb_input *input)
- {
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct dvb_demux *dvbdemux = &dvb->demux;
- switch (dvb->attached) {
- case 0x31:
- if (dvb->fe2)
- dvb_unregister_frontend(dvb->fe2);
- if (dvb->fe)
- dvb_unregister_frontend(dvb->fe);
- /* fallthrough */
- case 0x30:
- dvb_module_release(dvb->i2c_client[0]);
- dvb->i2c_client[0] = NULL;
- if (dvb->fe2)
- dvb_frontend_detach(dvb->fe2);
- if (dvb->fe)
- dvb_frontend_detach(dvb->fe);
- dvb->fe = NULL;
- dvb->fe2 = NULL;
- /* fallthrough */
- case 0x20:
- dvb_net_release(&dvb->dvbnet);
- /* fallthrough */
- case 0x12:
- dvbdemux->dmx.remove_frontend(&dvbdemux->dmx,
- &dvb->hw_frontend);
- dvbdemux->dmx.remove_frontend(&dvbdemux->dmx,
- &dvb->mem_frontend);
- /* fallthrough */
- case 0x11:
- dvb_dmxdev_release(&dvb->dmxdev);
- /* fallthrough */
- case 0x10:
- dvb_dmx_release(&dvb->demux);
- /* fallthrough */
- case 0x01:
- break;
- }
- dvb->attached = 0x00;
- }
- static int dvb_register_adapters(struct ddb *dev)
- {
- int i, ret = 0;
- struct ddb_port *port;
- struct dvb_adapter *adap;
- if (adapter_alloc == 3) {
- port = &dev->port[0];
- adap = port->dvb[0].adap;
- ret = dvb_register_adapter(adap, "DDBridge", THIS_MODULE,
- port->dev->dev,
- adapter_nr);
- if (ret < 0)
- return ret;
- port->dvb[0].adap_registered = 1;
- for (i = 0; i < dev->port_num; i++) {
- port = &dev->port[i];
- port->dvb[0].adap = adap;
- port->dvb[1].adap = adap;
- }
- return 0;
- }
- for (i = 0; i < dev->port_num; i++) {
- port = &dev->port[i];
- switch (port->class) {
- case DDB_PORT_TUNER:
- adap = port->dvb[0].adap;
- ret = dvb_register_adapter(adap, "DDBridge",
- THIS_MODULE,
- port->dev->dev,
- adapter_nr);
- if (ret < 0)
- return ret;
- port->dvb[0].adap_registered = 1;
- if (adapter_alloc > 0) {
- port->dvb[1].adap = port->dvb[0].adap;
- break;
- }
- adap = port->dvb[1].adap;
- ret = dvb_register_adapter(adap, "DDBridge",
- THIS_MODULE,
- port->dev->dev,
- adapter_nr);
- if (ret < 0)
- return ret;
- port->dvb[1].adap_registered = 1;
- break;
- case DDB_PORT_CI:
- case DDB_PORT_LOOP:
- adap = port->dvb[0].adap;
- ret = dvb_register_adapter(adap, "DDBridge",
- THIS_MODULE,
- port->dev->dev,
- adapter_nr);
- if (ret < 0)
- return ret;
- port->dvb[0].adap_registered = 1;
- break;
- default:
- if (adapter_alloc < 2)
- break;
- adap = port->dvb[0].adap;
- ret = dvb_register_adapter(adap, "DDBridge",
- THIS_MODULE,
- port->dev->dev,
- adapter_nr);
- if (ret < 0)
- return ret;
- port->dvb[0].adap_registered = 1;
- break;
- }
- }
- return ret;
- }
- static void dvb_unregister_adapters(struct ddb *dev)
- {
- int i;
- struct ddb_port *port;
- struct ddb_dvb *dvb;
- for (i = 0; i < dev->link[0].info->port_num; i++) {
- port = &dev->port[i];
- dvb = &port->dvb[0];
- if (dvb->adap_registered)
- dvb_unregister_adapter(dvb->adap);
- dvb->adap_registered = 0;
- dvb = &port->dvb[1];
- if (dvb->adap_registered)
- dvb_unregister_adapter(dvb->adap);
- dvb->adap_registered = 0;
- }
- }
- static int dvb_input_attach(struct ddb_input *input)
- {
- int ret = 0;
- struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
- struct ddb_port *port = input->port;
- struct dvb_adapter *adap = dvb->adap;
- struct dvb_demux *dvbdemux = &dvb->demux;
- int par = 0, osc24 = 0;
- dvb->attached = 0x01;
- dvbdemux->priv = input;
- dvbdemux->dmx.capabilities = DMX_TS_FILTERING |
- DMX_SECTION_FILTERING | DMX_MEMORY_BASED_FILTERING;
- dvbdemux->start_feed = start_feed;
- dvbdemux->stop_feed = stop_feed;
- dvbdemux->filternum = 256;
- dvbdemux->feednum = 256;
- ret = dvb_dmx_init(dvbdemux);
- if (ret < 0)
- return ret;
- dvb->attached = 0x10;
- dvb->dmxdev.filternum = 256;
- dvb->dmxdev.demux = &dvbdemux->dmx;
- ret = dvb_dmxdev_init(&dvb->dmxdev, adap);
- if (ret < 0)
- goto err_detach;
- dvb->attached = 0x11;
- dvb->mem_frontend.source = DMX_MEMORY_FE;
- dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->mem_frontend);
- dvb->hw_frontend.source = DMX_FRONTEND_0;
- dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->hw_frontend);
- ret = dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, &dvb->hw_frontend);
- if (ret < 0)
- goto err_detach;
- dvb->attached = 0x12;
- ret = dvb_net_init(adap, &dvb->dvbnet, dvb->dmxdev.demux);
- if (ret < 0)
- goto err_detach;
- dvb->attached = 0x20;
- dvb->fe = NULL;
- dvb->fe2 = NULL;
- switch (port->type) {
- case DDB_TUNER_MXL5XX:
- if (ddb_fe_attach_mxl5xx(input) < 0)
- goto err_detach;
- break;
- case DDB_TUNER_DVBS_ST:
- if (demod_attach_stv0900(input, 0) < 0)
- goto err_detach;
- if (tuner_attach_stv6110(input, 0) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBS_ST_AA:
- if (demod_attach_stv0900(input, 1) < 0)
- goto err_detach;
- if (tuner_attach_stv6110(input, 1) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBS_STV0910:
- if (demod_attach_stv0910(input, 0) < 0)
- goto err_detach;
- if (tuner_attach_stv6111(input, 0) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBS_STV0910_PR:
- if (demod_attach_stv0910(input, 1) < 0)
- goto err_detach;
- if (tuner_attach_stv6111(input, 1) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBS_STV0910_P:
- if (demod_attach_stv0910(input, 0) < 0)
- goto err_detach;
- if (tuner_attach_stv6111(input, 1) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBCT_TR:
- if (demod_attach_drxk(input) < 0)
- goto err_detach;
- if (tuner_attach_tda18271(input) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBCT_ST:
- if (demod_attach_stv0367(input) < 0)
- goto err_detach;
- if (tuner_attach_tda18212(input, port->type) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBC2T2I_SONY_P:
- if (input->port->dev->link[input->port->lnr].info->ts_quirks &
- TS_QUIRK_ALT_OSC)
- osc24 = 0;
- else
- osc24 = 1;
- /* fall-through */
- case DDB_TUNER_DVBCT2_SONY_P:
- case DDB_TUNER_DVBC2T2_SONY_P:
- case DDB_TUNER_ISDBT_SONY_P:
- if (input->port->dev->link[input->port->lnr].info->ts_quirks
- & TS_QUIRK_SERIAL)
- par = 0;
- else
- par = 1;
- if (demod_attach_cxd28xx(input, par, osc24) < 0)
- goto err_detach;
- if (tuner_attach_tda18212(input, port->type) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DVBC2T2I_SONY:
- osc24 = 1;
- /* fall-through */
- case DDB_TUNER_DVBCT2_SONY:
- case DDB_TUNER_DVBC2T2_SONY:
- case DDB_TUNER_ISDBT_SONY:
- if (demod_attach_cxd28xx(input, 0, osc24) < 0)
- goto err_detach;
- if (tuner_attach_tda18212(input, port->type) < 0)
- goto err_tuner;
- break;
- case DDB_TUNER_DUMMY:
- if (demod_attach_dummy(input) < 0)
- goto err_detach;
- break;
- case DDB_TUNER_MCI:
- if (ddb_fe_attach_mci(input) < 0)
- goto err_detach;
- break;
- default:
- return 0;
- }
- dvb->attached = 0x30;
- if (dvb->fe) {
- if (dvb_register_frontend(adap, dvb->fe) < 0)
- goto err_detach;
- if (dvb->fe2) {
- if (dvb_register_frontend(adap, dvb->fe2) < 0) {
- dvb_unregister_frontend(dvb->fe);
- goto err_detach;
- }
- dvb->fe2->tuner_priv = dvb->fe->tuner_priv;
- memcpy(&dvb->fe2->ops.tuner_ops,
- &dvb->fe->ops.tuner_ops,
- sizeof(struct dvb_tuner_ops));
- }
- }
- dvb->attached = 0x31;
- return 0;
- err_tuner:
- dev_err(port->dev->dev, "tuner attach failed!\n");
- if (dvb->fe2)
- dvb_frontend_detach(dvb->fe2);
- if (dvb->fe)
- dvb_frontend_detach(dvb->fe);
- err_detach:
- dvb_input_detach(input);
- /* return error from ret if set */
- if (ret < 0)
- return ret;
- return -ENODEV;
- }
- static int port_has_encti(struct ddb_port *port)
- {
- struct device *dev = port->dev->dev;
- u8 val;
- int ret = i2c_read_reg(&port->i2c->adap, 0x20, 0, &val);
- if (!ret)
- dev_info(dev, "[0x20]=0x%02x\n", val);
- return ret ? 0 : 1;
- }
- static int port_has_cxd(struct ddb_port *port, u8 *type)
- {
- u8 val;
- u8 probe[4] = { 0xe0, 0x00, 0x00, 0x00 }, data[4];
- struct i2c_msg msgs[2] = {{ .addr = 0x40, .flags = 0,
- .buf = probe, .len = 4 },
- { .addr = 0x40, .flags = I2C_M_RD,
- .buf = data, .len = 4 } };
- val = i2c_transfer(&port->i2c->adap, msgs, 2);
- if (val != 2)
- return 0;
- if (data[0] == 0x02 && data[1] == 0x2b && data[3] == 0x43)
- *type = 2;
- else
- *type = 1;
- return 1;
- }
- static int port_has_xo2(struct ddb_port *port, u8 *type, u8 *id)
- {
- u8 probe[1] = { 0x00 }, data[4];
- if (i2c_io(&port->i2c->adap, 0x10, probe, 1, data, 4))
- return 0;
- if (data[0] == 'D' && data[1] == 'F') {
- *id = data[2];
- *type = 1;
- return 1;
- }
- if (data[0] == 'C' && data[1] == 'I') {
- *id = data[2];
- *type = 2;
- return 1;
- }
- return 0;
- }
- static int port_has_stv0900(struct ddb_port *port)
- {
- u8 val;
- if (i2c_read_reg16(&port->i2c->adap, 0x69, 0xf100, &val) < 0)
- return 0;
- return 1;
- }
- static int port_has_stv0900_aa(struct ddb_port *port, u8 *id)
- {
- if (i2c_read_reg16(&port->i2c->adap, 0x68, 0xf100, id) < 0)
- return 0;
- return 1;
- }
- static int port_has_drxks(struct ddb_port *port)
- {
- u8 val;
- if (i2c_read(&port->i2c->adap, 0x29, &val) < 0)
- return 0;
- if (i2c_read(&port->i2c->adap, 0x2a, &val) < 0)
- return 0;
- return 1;
- }
- static int port_has_stv0367(struct ddb_port *port)
- {
- u8 val;
- if (i2c_read_reg16(&port->i2c->adap, 0x1e, 0xf000, &val) < 0)
- return 0;
- if (val != 0x60)
- return 0;
- if (i2c_read_reg16(&port->i2c->adap, 0x1f, 0xf000, &val) < 0)
- return 0;
- if (val != 0x60)
- return 0;
- return 1;
- }
- static int init_xo2(struct ddb_port *port)
- {
- struct i2c_adapter *i2c = &port->i2c->adap;
- struct ddb *dev = port->dev;
- u8 val, data[2];
- int res;
- res = i2c_read_regs(i2c, 0x10, 0x04, data, 2);
- if (res < 0)
- return res;
- if (data[0] != 0x01) {
- dev_info(dev->dev, "Port %d: invalid XO2\n", port->nr);
- return -1;
- }
- i2c_read_reg(i2c, 0x10, 0x08, &val);
- if (val != 0) {
- i2c_write_reg(i2c, 0x10, 0x08, 0x00);
- msleep(100);
- }
- /* Enable tuner power, disable pll, reset demods */
- i2c_write_reg(i2c, 0x10, 0x08, 0x04);
- usleep_range(2000, 3000);
- /* Release demod resets */
- i2c_write_reg(i2c, 0x10, 0x08, 0x07);
- /* speed: 0=55,1=75,2=90,3=104 MBit/s */
- i2c_write_reg(i2c, 0x10, 0x09, xo2_speed);
- if (dev->link[port->lnr].info->con_clock) {
- dev_info(dev->dev, "Setting continuous clock for XO2\n");
- i2c_write_reg(i2c, 0x10, 0x0a, 0x03);
- i2c_write_reg(i2c, 0x10, 0x0b, 0x03);
- } else {
- i2c_write_reg(i2c, 0x10, 0x0a, 0x01);
- i2c_write_reg(i2c, 0x10, 0x0b, 0x01);
- }
- usleep_range(2000, 3000);
- /* Start XO2 PLL */
- i2c_write_reg(i2c, 0x10, 0x08, 0x87);
- return 0;
- }
- static int init_xo2_ci(struct ddb_port *port)
- {
- struct i2c_adapter *i2c = &port->i2c->adap;
- struct ddb *dev = port->dev;
- u8 val, data[2];
- int res;
- res = i2c_read_regs(i2c, 0x10, 0x04, data, 2);
- if (res < 0)
- return res;
- if (data[0] > 1) {
- dev_info(dev->dev, "Port %d: invalid XO2 CI %02x\n",
- port->nr, data[0]);
- return -1;
- }
- dev_info(dev->dev, "Port %d: DuoFlex CI %u.%u\n",
- port->nr, data[0], data[1]);
- i2c_read_reg(i2c, 0x10, 0x08, &val);
- if (val != 0) {
- i2c_write_reg(i2c, 0x10, 0x08, 0x00);
- msleep(100);
- }
- /* Enable both CI */
- i2c_write_reg(i2c, 0x10, 0x08, 3);
- usleep_range(2000, 3000);
- /* speed: 0=55,1=75,2=90,3=104 MBit/s */
- i2c_write_reg(i2c, 0x10, 0x09, 1);
- i2c_write_reg(i2c, 0x10, 0x08, 0x83);
- usleep_range(2000, 3000);
- if (dev->link[port->lnr].info->con_clock) {
- dev_info(dev->dev, "Setting continuous clock for DuoFlex CI\n");
- i2c_write_reg(i2c, 0x10, 0x0a, 0x03);
- i2c_write_reg(i2c, 0x10, 0x0b, 0x03);
- } else {
- i2c_write_reg(i2c, 0x10, 0x0a, 0x01);
- i2c_write_reg(i2c, 0x10, 0x0b, 0x01);
- }
- return 0;
- }
- static int port_has_cxd28xx(struct ddb_port *port, u8 *id)
- {
- struct i2c_adapter *i2c = &port->i2c->adap;
- int status;
- status = i2c_write_reg(&port->i2c->adap, 0x6e, 0, 0);
- if (status)
- return 0;
- status = i2c_read_reg(i2c, 0x6e, 0xfd, id);
- if (status)
- return 0;
- return 1;
- }
- static char *xo2names[] = {
- "DUAL DVB-S2", "DUAL DVB-C/T/T2",
- "DUAL DVB-ISDBT", "DUAL DVB-C/C2/T/T2",
- "DUAL ATSC", "DUAL DVB-C/C2/T/T2,ISDB-T",
- "", ""
- };
- static char *xo2types[] = {
- "DVBS_ST", "DVBCT2_SONY",
- "ISDBT_SONY", "DVBC2T2_SONY",
- "ATSC_ST", "DVBC2T2I_SONY"
- };
- static void ddb_port_probe(struct ddb_port *port)
- {
- struct ddb *dev = port->dev;
- u32 l = port->lnr;
- u8 id, type;
- port->name = "NO MODULE";
- port->type_name = "NONE";
- port->class = DDB_PORT_NONE;
- /* Handle missing ports and ports without I2C */
- if (dummy_tuner && !port->nr &&
- dev->link[0].ids.device == 0x0005) {
- port->name = "DUMMY";
- port->class = DDB_PORT_TUNER;
- port->type = DDB_TUNER_DUMMY;
- port->type_name = "DUMMY";
- return;
- }
- if (port->nr == ts_loop) {
- port->name = "TS LOOP";
- port->class = DDB_PORT_LOOP;
- return;
- }
- if (port->nr == 1 && dev->link[l].info->type == DDB_OCTOPUS_CI &&
- dev->link[l].info->i2c_mask == 1) {
- port->name = "NO TAB";
- port->class = DDB_PORT_NONE;
- return;
- }
- if (dev->link[l].info->type == DDB_OCTOPUS_MAX) {
- port->name = "DUAL DVB-S2 MAX";
- port->type_name = "MXL5XX";
- port->class = DDB_PORT_TUNER;
- port->type = DDB_TUNER_MXL5XX;
- if (port->i2c)
- ddbwritel(dev, I2C_SPEED_400,
- port->i2c->regs + I2C_TIMING);
- return;
- }
- if (dev->link[l].info->type == DDB_OCTOPUS_MCI) {
- if (port->nr >= dev->link[l].info->mci)
- return;
- port->name = "DUAL MCI";
- port->type_name = "MCI";
- port->class = DDB_PORT_TUNER;
- port->type = DDB_TUNER_MCI;
- return;
- }
- if (port->nr > 1 && dev->link[l].info->type == DDB_OCTOPUS_CI) {
- port->name = "CI internal";
- port->type_name = "INTERNAL";
- port->class = DDB_PORT_CI;
- port->type = DDB_CI_INTERNAL;
- }
- if (!port->i2c)
- return;
- /* Probe ports with I2C */
- if (port_has_cxd(port, &id)) {
- if (id == 1) {
- port->name = "CI";
- port->type_name = "CXD2099";
- port->class = DDB_PORT_CI;
- port->type = DDB_CI_EXTERNAL_SONY;
- ddbwritel(dev, I2C_SPEED_400,
- port->i2c->regs + I2C_TIMING);
- } else {
- dev_info(dev->dev, "Port %d: Uninitialized DuoFlex\n",
- port->nr);
- return;
- }
- } else if (port_has_xo2(port, &type, &id)) {
- ddbwritel(dev, I2C_SPEED_400, port->i2c->regs + I2C_TIMING);
- /*dev_info(dev->dev, "XO2 ID %02x\n", id);*/
- if (type == 2) {
- port->name = "DuoFlex CI";
- port->class = DDB_PORT_CI;
- port->type = DDB_CI_EXTERNAL_XO2;
- port->type_name = "CI_XO2";
- init_xo2_ci(port);
- return;
- }
- id >>= 2;
- if (id > 5) {
- port->name = "unknown XO2 DuoFlex";
- port->type_name = "UNKNOWN";
- } else {
- port->name = xo2names[id];
- port->class = DDB_PORT_TUNER;
- port->type = DDB_TUNER_XO2 + id;
- port->type_name = xo2types[id];
- init_xo2(port);
- }
- } else if (port_has_cxd28xx(port, &id)) {
- switch (id) {
- case 0xa4:
- port->name = "DUAL DVB-C2T2 CXD2843";
- port->type = DDB_TUNER_DVBC2T2_SONY_P;
- port->type_name = "DVBC2T2_SONY";
- break;
- case 0xb1:
- port->name = "DUAL DVB-CT2 CXD2837";
- port->type = DDB_TUNER_DVBCT2_SONY_P;
- port->type_name = "DVBCT2_SONY";
- break;
- case 0xb0:
- port->name = "DUAL ISDB-T CXD2838";
- port->type = DDB_TUNER_ISDBT_SONY_P;
- port->type_name = "ISDBT_SONY";
- break;
- case 0xc1:
- port->name = "DUAL DVB-C2T2 ISDB-T CXD2854";
- port->type = DDB_TUNER_DVBC2T2I_SONY_P;
- port->type_name = "DVBC2T2I_ISDBT_SONY";
- break;
- default:
- return;
- }
- port->class = DDB_PORT_TUNER;
- ddbwritel(dev, I2C_SPEED_400, port->i2c->regs + I2C_TIMING);
- } else if (port_has_stv0900(port)) {
- port->name = "DUAL DVB-S2";
- port->class = DDB_PORT_TUNER;
- port->type = DDB_TUNER_DVBS_ST;
- port->type_name = "DVBS_ST";
- ddbwritel(dev, I2C_SPEED_100, port->i2c->regs + I2C_TIMING);
- } else if (port_has_stv0900_aa(port, &id)) {
- port->name = "DUAL DVB-S2";
- port->class = DDB_PORT_TUNER;
- if (id == 0x51) {
- if (port->nr == 0 &&
- dev->link[l].info->ts_quirks & TS_QUIRK_REVERSED)
- port->type = DDB_TUNER_DVBS_STV0910_PR;
- else
- port->type = DDB_TUNER_DVBS_STV0910_P;
- port->type_name = "DVBS_ST_0910";
- } else {
- port->type = DDB_TUNER_DVBS_ST_AA;
- port->type_name = "DVBS_ST_AA";
- }
- ddbwritel(dev, I2C_SPEED_100, port->i2c->regs + I2C_TIMING);
- } else if (port_has_drxks(port)) {
- port->name = "DUAL DVB-C/T";
- port->class = DDB_PORT_TUNER;
- port->type = DDB_TUNER_DVBCT_TR;
- port->type_name = "DVBCT_TR";
- ddbwritel(dev, I2C_SPEED_400, port->i2c->regs + I2C_TIMING);
- } else if (port_has_stv0367(port)) {
- port->name = "DUAL DVB-C/T";
- port->class = DDB_PORT_TUNER;
- port->type = DDB_TUNER_DVBCT_ST;
- port->type_name = "DVBCT_ST";
- ddbwritel(dev, I2C_SPEED_100, port->i2c->regs + I2C_TIMING);
- } else if (port_has_encti(port)) {
- port->name = "ENCTI";
- port->class = DDB_PORT_LOOP;
- }
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- static int ddb_port_attach(struct ddb_port *port)
- {
- int ret = 0;
- switch (port->class) {
- case DDB_PORT_TUNER:
- ret = dvb_input_attach(port->input[0]);
- if (ret < 0)
- break;
- ret = dvb_input_attach(port->input[1]);
- if (ret < 0) {
- dvb_input_detach(port->input[0]);
- break;
- }
- port->input[0]->redi = port->input[0];
- port->input[1]->redi = port->input[1];
- break;
- case DDB_PORT_CI:
- ret = ddb_ci_attach(port, ci_bitrate);
- if (ret < 0)
- break;
- /* fall-through */
- case DDB_PORT_LOOP:
- ret = dvb_register_device(port->dvb[0].adap,
- &port->dvb[0].dev,
- &dvbdev_ci, (void *)port->output,
- DVB_DEVICE_SEC, 0);
- break;
- default:
- break;
- }
- if (ret < 0)
- dev_err(port->dev->dev, "port_attach on port %d failed\n",
- port->nr);
- return ret;
- }
- int ddb_ports_attach(struct ddb *dev)
- {
- int i, numports, err_ports = 0, ret = 0;
- struct ddb_port *port;
- if (dev->port_num) {
- ret = dvb_register_adapters(dev);
- if (ret < 0) {
- dev_err(dev->dev, "Registering adapters failed. Check DVB_MAX_ADAPTERS in config.\n");
- return ret;
- }
- }
- numports = dev->port_num;
- for (i = 0; i < dev->port_num; i++) {
- port = &dev->port[i];
- if (port->class != DDB_PORT_NONE) {
- ret = ddb_port_attach(port);
- if (ret)
- err_ports++;
- } else {
- numports--;
- }
- }
- if (err_ports) {
- if (err_ports == numports) {
- dev_err(dev->dev, "All connected ports failed to initialise!\n");
- return -ENODEV;
- }
- dev_warn(dev->dev, "%d of %d connected ports failed to initialise!\n",
- err_ports, numports);
- }
- return 0;
- }
- void ddb_ports_detach(struct ddb *dev)
- {
- int i;
- struct ddb_port *port;
- for (i = 0; i < dev->port_num; i++) {
- port = &dev->port[i];
- switch (port->class) {
- case DDB_PORT_TUNER:
- dvb_input_detach(port->input[1]);
- dvb_input_detach(port->input[0]);
- break;
- case DDB_PORT_CI:
- case DDB_PORT_LOOP:
- ddb_ci_detach(port);
- break;
- }
- }
- dvb_unregister_adapters(dev);
- }
- /* Copy input DMA pointers to output DMA and ACK. */
- static void input_write_output(struct ddb_input *input,
- struct ddb_output *output)
- {
- ddbwritel(output->port->dev,
- input->dma->stat, DMA_BUFFER_ACK(output->dma));
- output->dma->cbuf = (input->dma->stat >> 11) & 0x1f;
- output->dma->coff = (input->dma->stat & 0x7ff) << 7;
- }
- static void output_ack_input(struct ddb_output *output,
- struct ddb_input *input)
- {
- ddbwritel(input->port->dev,
- output->dma->stat, DMA_BUFFER_ACK(input->dma));
- }
- static void input_write_dvb(struct ddb_input *input,
- struct ddb_input *input2)
- {
- struct ddb_dvb *dvb = &input2->port->dvb[input2->nr & 1];
- struct ddb_dma *dma, *dma2;
- struct ddb *dev = input->port->dev;
- int ack = 1;
- dma = input->dma;
- dma2 = input->dma;
- /*
- * if there also is an output connected, do not ACK.
- * input_write_output will ACK.
- */
- if (input->redo) {
- dma2 = input->redo->dma;
- ack = 0;
- }
- while (dma->cbuf != ((dma->stat >> 11) & 0x1f) ||
- (4 & dma->ctrl)) {
- if (4 & dma->ctrl) {
- /* dev_err(dev->dev, "Overflow dma %d\n", dma->nr); */
- ack = 1;
- }
- if (alt_dma)
- dma_sync_single_for_cpu(dev->dev, dma2->pbuf[dma->cbuf],
- dma2->size, DMA_FROM_DEVICE);
- dvb_dmx_swfilter_packets(&dvb->demux,
- dma2->vbuf[dma->cbuf],
- dma2->size / 188);
- dma->cbuf = (dma->cbuf + 1) % dma2->num;
- if (ack)
- ddbwritel(dev, (dma->cbuf << 11),
- DMA_BUFFER_ACK(dma));
- dma->stat = safe_ddbreadl(dev, DMA_BUFFER_CURRENT(dma));
- dma->ctrl = safe_ddbreadl(dev, DMA_BUFFER_CONTROL(dma));
- }
- }
- static void input_work(struct work_struct *work)
- {
- struct ddb_dma *dma = container_of(work, struct ddb_dma, work);
- struct ddb_input *input = (struct ddb_input *)dma->io;
- struct ddb *dev = input->port->dev;
- unsigned long flags;
- spin_lock_irqsave(&dma->lock, flags);
- if (!dma->running) {
- spin_unlock_irqrestore(&dma->lock, flags);
- return;
- }
- dma->stat = ddbreadl(dev, DMA_BUFFER_CURRENT(dma));
- dma->ctrl = ddbreadl(dev, DMA_BUFFER_CONTROL(dma));
- if (input->redi)
- input_write_dvb(input, input->redi);
- if (input->redo)
- input_write_output(input, input->redo);
- wake_up(&dma->wq);
- spin_unlock_irqrestore(&dma->lock, flags);
- }
- static void input_handler(void *data)
- {
- struct ddb_input *input = (struct ddb_input *)data;
- struct ddb_dma *dma = input->dma;
- queue_work(ddb_wq, &dma->work);
- }
- static void output_work(struct work_struct *work)
- {
- struct ddb_dma *dma = container_of(work, struct ddb_dma, work);
- struct ddb_output *output = (struct ddb_output *)dma->io;
- struct ddb *dev = output->port->dev;
- unsigned long flags;
- spin_lock_irqsave(&dma->lock, flags);
- if (!dma->running)
- goto unlock_exit;
- dma->stat = ddbreadl(dev, DMA_BUFFER_CURRENT(dma));
- dma->ctrl = ddbreadl(dev, DMA_BUFFER_CONTROL(dma));
- if (output->redi)
- output_ack_input(output, output->redi);
- wake_up(&dma->wq);
- unlock_exit:
- spin_unlock_irqrestore(&dma->lock, flags);
- }
- static void output_handler(void *data)
- {
- struct ddb_output *output = (struct ddb_output *)data;
- struct ddb_dma *dma = output->dma;
- queue_work(ddb_wq, &dma->work);
- }
- /****************************************************************************/
- /****************************************************************************/
- static const struct ddb_regmap *io_regmap(struct ddb_io *io, int link)
- {
- const struct ddb_info *info;
- if (link)
- info = io->port->dev->link[io->port->lnr].info;
- else
- info = io->port->dev->link[0].info;
- if (!info)
- return NULL;
- return info->regmap;
- }
- static void ddb_dma_init(struct ddb_io *io, int nr, int out)
- {
- struct ddb_dma *dma;
- const struct ddb_regmap *rm = io_regmap(io, 0);
- dma = out ? &io->port->dev->odma[nr] : &io->port->dev->idma[nr];
- io->dma = dma;
- dma->io = io;
- spin_lock_init(&dma->lock);
- init_waitqueue_head(&dma->wq);
- if (out) {
- INIT_WORK(&dma->work, output_work);
- dma->regs = rm->odma->base + rm->odma->size * nr;
- dma->bufregs = rm->odma_buf->base + rm->odma_buf->size * nr;
- dma->num = dma_buf_num;
- dma->size = dma_buf_size * 128 * 47;
- dma->div = 1;
- } else {
- INIT_WORK(&dma->work, input_work);
- dma->regs = rm->idma->base + rm->idma->size * nr;
- dma->bufregs = rm->idma_buf->base + rm->idma_buf->size * nr;
- dma->num = dma_buf_num;
- dma->size = dma_buf_size * 128 * 47;
- dma->div = 1;
- }
- ddbwritel(io->port->dev, 0, DMA_BUFFER_ACK(dma));
- dev_dbg(io->port->dev->dev, "init link %u, io %u, dma %u, dmaregs %08x bufregs %08x\n",
- io->port->lnr, io->nr, nr, dma->regs, dma->bufregs);
- }
- static void ddb_input_init(struct ddb_port *port, int nr, int pnr, int anr)
- {
- struct ddb *dev = port->dev;
- struct ddb_input *input = &dev->input[anr];
- const struct ddb_regmap *rm;
- port->input[pnr] = input;
- input->nr = nr;
- input->port = port;
- rm = io_regmap(input, 1);
- input->regs = DDB_LINK_TAG(port->lnr) |
- (rm->input->base + rm->input->size * nr);
- dev_dbg(dev->dev, "init link %u, input %u, regs %08x\n",
- port->lnr, nr, input->regs);
- if (dev->has_dma) {
- const struct ddb_regmap *rm0 = io_regmap(input, 0);
- u32 base = rm0->irq_base_idma;
- u32 dma_nr = nr;
- if (port->lnr)
- dma_nr += 32 + (port->lnr - 1) * 8;
- dev_dbg(dev->dev, "init link %u, input %u, handler %u\n",
- port->lnr, nr, dma_nr + base);
- ddb_irq_set(dev, 0, dma_nr + base, &input_handler, input);
- ddb_dma_init(input, dma_nr, 0);
- }
- }
- static void ddb_output_init(struct ddb_port *port, int nr)
- {
- struct ddb *dev = port->dev;
- struct ddb_output *output = &dev->output[nr];
- const struct ddb_regmap *rm;
- port->output = output;
- output->nr = nr;
- output->port = port;
- rm = io_regmap(output, 1);
- output->regs = DDB_LINK_TAG(port->lnr) |
- (rm->output->base + rm->output->size * nr);
- dev_dbg(dev->dev, "init link %u, output %u, regs %08x\n",
- port->lnr, nr, output->regs);
- if (dev->has_dma) {
- const struct ddb_regmap *rm0 = io_regmap(output, 0);
- u32 base = rm0->irq_base_odma;
- ddb_irq_set(dev, 0, nr + base, &output_handler, output);
- ddb_dma_init(output, nr, 1);
- }
- }
- static int ddb_port_match_i2c(struct ddb_port *port)
- {
- struct ddb *dev = port->dev;
- u32 i;
- for (i = 0; i < dev->i2c_num; i++) {
- if (dev->i2c[i].link == port->lnr &&
- dev->i2c[i].nr == port->nr) {
- port->i2c = &dev->i2c[i];
- return 1;
- }
- }
- return 0;
- }
- static int ddb_port_match_link_i2c(struct ddb_port *port)
- {
- struct ddb *dev = port->dev;
- u32 i;
- for (i = 0; i < dev->i2c_num; i++) {
- if (dev->i2c[i].link == port->lnr) {
- port->i2c = &dev->i2c[i];
- return 1;
- }
- }
- return 0;
- }
- void ddb_ports_init(struct ddb *dev)
- {
- u32 i, l, p;
- struct ddb_port *port;
- const struct ddb_info *info;
- const struct ddb_regmap *rm;
- for (p = l = 0; l < DDB_MAX_LINK; l++) {
- info = dev->link[l].info;
- if (!info)
- continue;
- rm = info->regmap;
- if (!rm)
- continue;
- for (i = 0; i < info->port_num; i++, p++) {
- port = &dev->port[p];
- port->dev = dev;
- port->nr = i;
- port->lnr = l;
- port->pnr = p;
- port->gap = 0xffffffff;
- port->obr = ci_bitrate;
- mutex_init(&port->i2c_gate_lock);
- if (!ddb_port_match_i2c(port)) {
- if (info->type == DDB_OCTOPUS_MAX)
- ddb_port_match_link_i2c(port);
- }
- ddb_port_probe(port);
- port->dvb[0].adap = &dev->adap[2 * p];
- port->dvb[1].adap = &dev->adap[2 * p + 1];
- if (port->class == DDB_PORT_NONE && i && p &&
- dev->port[p - 1].type == DDB_CI_EXTERNAL_XO2) {
- port->class = DDB_PORT_CI;
- port->type = DDB_CI_EXTERNAL_XO2_B;
- port->name = "DuoFlex CI_B";
- port->i2c = dev->port[p - 1].i2c;
- }
- dev_info(dev->dev, "Port %u: Link %u, Link Port %u (TAB %u): %s\n",
- port->pnr, port->lnr, port->nr, port->nr + 1,
- port->name);
- if (port->class == DDB_PORT_CI &&
- port->type == DDB_CI_EXTERNAL_XO2) {
- ddb_input_init(port, 2 * i, 0, 2 * i);
- ddb_output_init(port, i);
- continue;
- }
- if (port->class == DDB_PORT_CI &&
- port->type == DDB_CI_EXTERNAL_XO2_B) {
- ddb_input_init(port, 2 * i - 1, 0, 2 * i - 1);
- ddb_output_init(port, i);
- continue;
- }
- if (port->class == DDB_PORT_NONE)
- continue;
- switch (dev->link[l].info->type) {
- case DDB_OCTOPUS_CI:
- if (i >= 2) {
- ddb_input_init(port, 2 + i, 0, 2 + i);
- ddb_input_init(port, 4 + i, 1, 4 + i);
- ddb_output_init(port, i);
- break;
- } /* fallthrough */
- case DDB_OCTOPUS:
- ddb_input_init(port, 2 * i, 0, 2 * i);
- ddb_input_init(port, 2 * i + 1, 1, 2 * i + 1);
- ddb_output_init(port, i);
- break;
- case DDB_OCTOPUS_MAX:
- case DDB_OCTOPUS_MAX_CT:
- case DDB_OCTOPUS_MCI:
- ddb_input_init(port, 2 * i, 0, 2 * p);
- ddb_input_init(port, 2 * i + 1, 1, 2 * p + 1);
- break;
- default:
- break;
- }
- }
- }
- dev->port_num = p;
- }
- void ddb_ports_release(struct ddb *dev)
- {
- int i;
- struct ddb_port *port;
- for (i = 0; i < dev->port_num; i++) {
- port = &dev->port[i];
- if (port->input[0] && port->input[0]->dma)
- cancel_work_sync(&port->input[0]->dma->work);
- if (port->input[1] && port->input[1]->dma)
- cancel_work_sync(&port->input[1]->dma->work);
- if (port->output && port->output->dma)
- cancel_work_sync(&port->output->dma->work);
- }
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- #define IRQ_HANDLE(_nr) \
- do { if ((s & (1UL << ((_nr) & 0x1f))) && \
- dev->link[0].irq[_nr].handler) \
- dev->link[0].irq[_nr].handler(dev->link[0].irq[_nr].data); } \
- while (0)
- #define IRQ_HANDLE_NIBBLE(_shift) { \
- if (s & (0x0000000f << ((_shift) & 0x1f))) { \
- IRQ_HANDLE(0 + (_shift)); \
- IRQ_HANDLE(1 + (_shift)); \
- IRQ_HANDLE(2 + (_shift)); \
- IRQ_HANDLE(3 + (_shift)); \
- } \
- }
- #define IRQ_HANDLE_BYTE(_shift) { \
- if (s & (0x000000ff << ((_shift) & 0x1f))) { \
- IRQ_HANDLE(0 + (_shift)); \
- IRQ_HANDLE(1 + (_shift)); \
- IRQ_HANDLE(2 + (_shift)); \
- IRQ_HANDLE(3 + (_shift)); \
- IRQ_HANDLE(4 + (_shift)); \
- IRQ_HANDLE(5 + (_shift)); \
- IRQ_HANDLE(6 + (_shift)); \
- IRQ_HANDLE(7 + (_shift)); \
- } \
- }
- static void irq_handle_msg(struct ddb *dev, u32 s)
- {
- dev->i2c_irq++;
- IRQ_HANDLE_NIBBLE(0);
- }
- static void irq_handle_io(struct ddb *dev, u32 s)
- {
- dev->ts_irq++;
- IRQ_HANDLE_NIBBLE(4);
- IRQ_HANDLE_BYTE(8);
- IRQ_HANDLE_BYTE(16);
- IRQ_HANDLE_BYTE(24);
- }
- irqreturn_t ddb_irq_handler0(int irq, void *dev_id)
- {
- struct ddb *dev = (struct ddb *)dev_id;
- u32 mask = 0x8fffff00;
- u32 s = mask & ddbreadl(dev, INTERRUPT_STATUS);
- if (!s)
- return IRQ_NONE;
- do {
- if (s & 0x80000000)
- return IRQ_NONE;
- ddbwritel(dev, s, INTERRUPT_ACK);
- irq_handle_io(dev, s);
- } while ((s = mask & ddbreadl(dev, INTERRUPT_STATUS)));
- return IRQ_HANDLED;
- }
- irqreturn_t ddb_irq_handler1(int irq, void *dev_id)
- {
- struct ddb *dev = (struct ddb *)dev_id;
- u32 mask = 0x8000000f;
- u32 s = mask & ddbreadl(dev, INTERRUPT_STATUS);
- if (!s)
- return IRQ_NONE;
- do {
- if (s & 0x80000000)
- return IRQ_NONE;
- ddbwritel(dev, s, INTERRUPT_ACK);
- irq_handle_msg(dev, s);
- } while ((s = mask & ddbreadl(dev, INTERRUPT_STATUS)));
- return IRQ_HANDLED;
- }
- irqreturn_t ddb_irq_handler(int irq, void *dev_id)
- {
- struct ddb *dev = (struct ddb *)dev_id;
- u32 s = ddbreadl(dev, INTERRUPT_STATUS);
- int ret = IRQ_HANDLED;
- if (!s)
- return IRQ_NONE;
- do {
- if (s & 0x80000000)
- return IRQ_NONE;
- ddbwritel(dev, s, INTERRUPT_ACK);
- if (s & 0x0000000f)
- irq_handle_msg(dev, s);
- if (s & 0x0fffff00)
- irq_handle_io(dev, s);
- } while ((s = ddbreadl(dev, INTERRUPT_STATUS)));
- return ret;
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- static int reg_wait(struct ddb *dev, u32 reg, u32 bit)
- {
- u32 count = 0;
- while (safe_ddbreadl(dev, reg) & bit) {
- ndelay(10);
- if (++count == 100)
- return -1;
- }
- return 0;
- }
- static int flashio(struct ddb *dev, u32 lnr, u8 *wbuf, u32 wlen, u8 *rbuf,
- u32 rlen)
- {
- u32 data, shift;
- u32 tag = DDB_LINK_TAG(lnr);
- struct ddb_link *link = &dev->link[lnr];
- mutex_lock(&link->flash_mutex);
- if (wlen > 4)
- ddbwritel(dev, 1, tag | SPI_CONTROL);
- while (wlen > 4) {
- /* FIXME: check for big-endian */
- data = swab32(*(u32 *)wbuf);
- wbuf += 4;
- wlen -= 4;
- ddbwritel(dev, data, tag | SPI_DATA);
- if (reg_wait(dev, tag | SPI_CONTROL, 4))
- goto fail;
- }
- if (rlen)
- ddbwritel(dev, 0x0001 | ((wlen << (8 + 3)) & 0x1f00),
- tag | SPI_CONTROL);
- else
- ddbwritel(dev, 0x0003 | ((wlen << (8 + 3)) & 0x1f00),
- tag | SPI_CONTROL);
- data = 0;
- shift = ((4 - wlen) * 8);
- while (wlen) {
- data <<= 8;
- data |= *wbuf;
- wlen--;
- wbuf++;
- }
- if (shift)
- data <<= shift;
- ddbwritel(dev, data, tag | SPI_DATA);
- if (reg_wait(dev, tag | SPI_CONTROL, 4))
- goto fail;
- if (!rlen) {
- ddbwritel(dev, 0, tag | SPI_CONTROL);
- goto exit;
- }
- if (rlen > 4)
- ddbwritel(dev, 1, tag | SPI_CONTROL);
- while (rlen > 4) {
- ddbwritel(dev, 0xffffffff, tag | SPI_DATA);
- if (reg_wait(dev, tag | SPI_CONTROL, 4))
- goto fail;
- data = ddbreadl(dev, tag | SPI_DATA);
- *(u32 *)rbuf = swab32(data);
- rbuf += 4;
- rlen -= 4;
- }
- ddbwritel(dev, 0x0003 | ((rlen << (8 + 3)) & 0x1F00),
- tag | SPI_CONTROL);
- ddbwritel(dev, 0xffffffff, tag | SPI_DATA);
- if (reg_wait(dev, tag | SPI_CONTROL, 4))
- goto fail;
- data = ddbreadl(dev, tag | SPI_DATA);
- ddbwritel(dev, 0, tag | SPI_CONTROL);
- if (rlen < 4)
- data <<= ((4 - rlen) * 8);
- while (rlen > 0) {
- *rbuf = ((data >> 24) & 0xff);
- data <<= 8;
- rbuf++;
- rlen--;
- }
- exit:
- mutex_unlock(&link->flash_mutex);
- return 0;
- fail:
- mutex_unlock(&link->flash_mutex);
- return -1;
- }
- int ddbridge_flashread(struct ddb *dev, u32 link, u8 *buf, u32 addr, u32 len)
- {
- u8 cmd[4] = {0x03, (addr >> 16) & 0xff,
- (addr >> 8) & 0xff, addr & 0xff};
- return flashio(dev, link, cmd, 4, buf, len);
- }
- /*
- * TODO/FIXME: add/implement IOCTLs from upstream driver
- */
- #define DDB_NAME "ddbridge"
- static u32 ddb_num;
- static int ddb_major;
- static DEFINE_MUTEX(ddb_mutex);
- static int ddb_release(struct inode *inode, struct file *file)
- {
- struct ddb *dev = file->private_data;
- dev->ddb_dev_users--;
- return 0;
- }
- static int ddb_open(struct inode *inode, struct file *file)
- {
- struct ddb *dev = ddbs[iminor(inode)];
- if (dev->ddb_dev_users)
- return -EBUSY;
- dev->ddb_dev_users++;
- file->private_data = dev;
- return 0;
- }
- static long ddb_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
- {
- struct ddb *dev = file->private_data;
- dev_warn(dev->dev, "DDB IOCTLs unsupported (cmd: %d, arg: %lu)\n",
- cmd, arg);
- return -ENOTTY;
- }
- static const struct file_operations ddb_fops = {
- .unlocked_ioctl = ddb_ioctl,
- .open = ddb_open,
- .release = ddb_release,
- };
- static char *ddb_devnode(struct device *device, umode_t *mode)
- {
- struct ddb *dev = dev_get_drvdata(device);
- return kasprintf(GFP_KERNEL, "ddbridge/card%d", dev->nr);
- }
- #define __ATTR_MRO(_name, _show) { \
- .attr = { .name = __stringify(_name), .mode = 0444 }, \
- .show = _show, \
- }
- #define __ATTR_MWO(_name, _store) { \
- .attr = { .name = __stringify(_name), .mode = 0222 }, \
- .store = _store, \
- }
- static ssize_t ports_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "%d\n", dev->port_num);
- }
- static ssize_t ts_irq_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "%d\n", dev->ts_irq);
- }
- static ssize_t i2c_irq_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "%d\n", dev->i2c_irq);
- }
- static ssize_t fan_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- u32 val;
- val = ddbreadl(dev, GPIO_OUTPUT) & 1;
- return sprintf(buf, "%d\n", val);
- }
- static ssize_t fan_store(struct device *device, struct device_attribute *d,
- const char *buf, size_t count)
- {
- struct ddb *dev = dev_get_drvdata(device);
- u32 val;
- if (sscanf(buf, "%u\n", &val) != 1)
- return -EINVAL;
- ddbwritel(dev, 1, GPIO_DIRECTION);
- ddbwritel(dev, val & 1, GPIO_OUTPUT);
- return count;
- }
- static ssize_t fanspeed_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- int num = attr->attr.name[8] - 0x30;
- struct ddb_link *link = &dev->link[num];
- u32 spd;
- spd = ddblreadl(link, TEMPMON_FANCONTROL) & 0xff;
- return sprintf(buf, "%u\n", spd * 100);
- }
- static ssize_t temp_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- struct ddb_link *link = &dev->link[0];
- struct i2c_adapter *adap;
- int temp, temp2;
- u8 tmp[2];
- if (!link->info->temp_num)
- return sprintf(buf, "no sensor\n");
- adap = &dev->i2c[link->info->temp_bus].adap;
- if (i2c_read_regs(adap, 0x48, 0, tmp, 2) < 0)
- return sprintf(buf, "read_error\n");
- temp = (tmp[0] << 3) | (tmp[1] >> 5);
- temp *= 125;
- if (link->info->temp_num == 2) {
- if (i2c_read_regs(adap, 0x49, 0, tmp, 2) < 0)
- return sprintf(buf, "read_error\n");
- temp2 = (tmp[0] << 3) | (tmp[1] >> 5);
- temp2 *= 125;
- return sprintf(buf, "%d %d\n", temp, temp2);
- }
- return sprintf(buf, "%d\n", temp);
- }
- static ssize_t ctemp_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- struct i2c_adapter *adap;
- int temp;
- u8 tmp[2];
- int num = attr->attr.name[4] - 0x30;
- adap = &dev->i2c[num].adap;
- if (!adap)
- return 0;
- if (i2c_read_regs(adap, 0x49, 0, tmp, 2) < 0)
- if (i2c_read_regs(adap, 0x4d, 0, tmp, 2) < 0)
- return sprintf(buf, "no sensor\n");
- temp = tmp[0] * 1000;
- return sprintf(buf, "%d\n", temp);
- }
- static ssize_t led_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- int num = attr->attr.name[3] - 0x30;
- return sprintf(buf, "%d\n", dev->leds & (1 << num) ? 1 : 0);
- }
- static void ddb_set_led(struct ddb *dev, int num, int val)
- {
- if (!dev->link[0].info->led_num)
- return;
- switch (dev->port[num].class) {
- case DDB_PORT_TUNER:
- switch (dev->port[num].type) {
- case DDB_TUNER_DVBS_ST:
- i2c_write_reg16(&dev->i2c[num].adap,
- 0x69, 0xf14c, val ? 2 : 0);
- break;
- case DDB_TUNER_DVBCT_ST:
- i2c_write_reg16(&dev->i2c[num].adap,
- 0x1f, 0xf00e, 0);
- i2c_write_reg16(&dev->i2c[num].adap,
- 0x1f, 0xf00f, val ? 1 : 0);
- break;
- case DDB_TUNER_XO2 ... DDB_TUNER_DVBC2T2I_SONY:
- {
- u8 v;
- i2c_read_reg(&dev->i2c[num].adap, 0x10, 0x08, &v);
- v = (v & ~0x10) | (val ? 0x10 : 0);
- i2c_write_reg(&dev->i2c[num].adap, 0x10, 0x08, v);
- break;
- }
- default:
- break;
- }
- break;
- }
- }
- static ssize_t led_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ddb *dev = dev_get_drvdata(device);
- int num = attr->attr.name[3] - 0x30;
- u32 val;
- if (sscanf(buf, "%u\n", &val) != 1)
- return -EINVAL;
- if (val)
- dev->leds |= (1 << num);
- else
- dev->leds &= ~(1 << num);
- ddb_set_led(dev, num, val);
- return count;
- }
- static ssize_t snr_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- char snr[32];
- int num = attr->attr.name[3] - 0x30;
- if (dev->port[num].type >= DDB_TUNER_XO2) {
- if (i2c_read_regs(&dev->i2c[num].adap, 0x10, 0x10, snr, 16) < 0)
- return sprintf(buf, "NO SNR\n");
- snr[16] = 0;
- } else {
- /* serial number at 0x100-0x11f */
- if (i2c_read_regs16(&dev->i2c[num].adap,
- 0x57, 0x100, snr, 32) < 0)
- if (i2c_read_regs16(&dev->i2c[num].adap,
- 0x50, 0x100, snr, 32) < 0)
- return sprintf(buf, "NO SNR\n");
- snr[31] = 0; /* in case it is not terminated on EEPROM */
- }
- return sprintf(buf, "%s\n", snr);
- }
- static ssize_t bsnr_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- char snr[16];
- ddbridge_flashread(dev, 0, snr, 0x10, 15);
- snr[15] = 0; /* in case it is not terminated on EEPROM */
- return sprintf(buf, "%s\n", snr);
- }
- static ssize_t bpsnr_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- unsigned char snr[32];
- if (!dev->i2c_num)
- return 0;
- if (i2c_read_regs16(&dev->i2c[0].adap,
- 0x50, 0x0000, snr, 32) < 0 ||
- snr[0] == 0xff)
- return sprintf(buf, "NO SNR\n");
- snr[31] = 0; /* in case it is not terminated on EEPROM */
- return sprintf(buf, "%s\n", snr);
- }
- static ssize_t redirect_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- return 0;
- }
- static ssize_t redirect_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- unsigned int i, p;
- int res;
- if (sscanf(buf, "%x %x\n", &i, &p) != 2)
- return -EINVAL;
- res = ddb_redirect(i, p);
- if (res < 0)
- return res;
- dev_info(device, "redirect: %02x, %02x\n", i, p);
- return count;
- }
- static ssize_t gap_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- int num = attr->attr.name[3] - 0x30;
- return sprintf(buf, "%d\n", dev->port[num].gap);
- }
- static ssize_t gap_store(struct device *device, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ddb *dev = dev_get_drvdata(device);
- int num = attr->attr.name[3] - 0x30;
- unsigned int val;
- if (sscanf(buf, "%u\n", &val) != 1)
- return -EINVAL;
- if (val > 128)
- return -EINVAL;
- if (val == 128)
- val = 0xffffffff;
- dev->port[num].gap = val;
- return count;
- }
- static ssize_t version_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "%08x %08x\n",
- dev->link[0].ids.hwid, dev->link[0].ids.regmapid);
- }
- static ssize_t hwid_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "0x%08X\n", dev->link[0].ids.hwid);
- }
- static ssize_t regmap_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "0x%08X\n", dev->link[0].ids.regmapid);
- }
- static ssize_t fmode_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- int num = attr->attr.name[5] - 0x30;
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "%u\n", dev->link[num].lnb.fmode);
- }
- static ssize_t devid_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- int num = attr->attr.name[5] - 0x30;
- struct ddb *dev = dev_get_drvdata(device);
- return sprintf(buf, "%08x\n", dev->link[num].ids.devid);
- }
- static ssize_t fmode_store(struct device *device, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ddb *dev = dev_get_drvdata(device);
- int num = attr->attr.name[5] - 0x30;
- unsigned int val;
- if (sscanf(buf, "%u\n", &val) != 1)
- return -EINVAL;
- if (val > 3)
- return -EINVAL;
- ddb_lnb_init_fmode(dev, &dev->link[num], val);
- return count;
- }
- static struct device_attribute ddb_attrs[] = {
- __ATTR_RO(version),
- __ATTR_RO(ports),
- __ATTR_RO(ts_irq),
- __ATTR_RO(i2c_irq),
- __ATTR(gap0, 0664, gap_show, gap_store),
- __ATTR(gap1, 0664, gap_show, gap_store),
- __ATTR(gap2, 0664, gap_show, gap_store),
- __ATTR(gap3, 0664, gap_show, gap_store),
- __ATTR(fmode0, 0664, fmode_show, fmode_store),
- __ATTR(fmode1, 0664, fmode_show, fmode_store),
- __ATTR(fmode2, 0664, fmode_show, fmode_store),
- __ATTR(fmode3, 0664, fmode_show, fmode_store),
- __ATTR_MRO(devid0, devid_show),
- __ATTR_MRO(devid1, devid_show),
- __ATTR_MRO(devid2, devid_show),
- __ATTR_MRO(devid3, devid_show),
- __ATTR_RO(hwid),
- __ATTR_RO(regmap),
- __ATTR(redirect, 0664, redirect_show, redirect_store),
- __ATTR_MRO(snr, bsnr_show),
- __ATTR_RO(bpsnr),
- __ATTR_NULL,
- };
- static struct device_attribute ddb_attrs_temp[] = {
- __ATTR_RO(temp),
- };
- static struct device_attribute ddb_attrs_fan[] = {
- __ATTR(fan, 0664, fan_show, fan_store),
- };
- static struct device_attribute ddb_attrs_snr[] = {
- __ATTR_MRO(snr0, snr_show),
- __ATTR_MRO(snr1, snr_show),
- __ATTR_MRO(snr2, snr_show),
- __ATTR_MRO(snr3, snr_show),
- };
- static struct device_attribute ddb_attrs_ctemp[] = {
- __ATTR_MRO(temp0, ctemp_show),
- __ATTR_MRO(temp1, ctemp_show),
- __ATTR_MRO(temp2, ctemp_show),
- __ATTR_MRO(temp3, ctemp_show),
- };
- static struct device_attribute ddb_attrs_led[] = {
- __ATTR(led0, 0664, led_show, led_store),
- __ATTR(led1, 0664, led_show, led_store),
- __ATTR(led2, 0664, led_show, led_store),
- __ATTR(led3, 0664, led_show, led_store),
- };
- static struct device_attribute ddb_attrs_fanspeed[] = {
- __ATTR_MRO(fanspeed0, fanspeed_show),
- __ATTR_MRO(fanspeed1, fanspeed_show),
- __ATTR_MRO(fanspeed2, fanspeed_show),
- __ATTR_MRO(fanspeed3, fanspeed_show),
- };
- static struct class ddb_class = {
- .name = "ddbridge",
- .owner = THIS_MODULE,
- .devnode = ddb_devnode,
- };
- static int ddb_class_create(void)
- {
- ddb_major = register_chrdev(0, DDB_NAME, &ddb_fops);
- if (ddb_major < 0)
- return ddb_major;
- if (class_register(&ddb_class) < 0)
- return -1;
- return 0;
- }
- static void ddb_class_destroy(void)
- {
- class_unregister(&ddb_class);
- unregister_chrdev(ddb_major, DDB_NAME);
- }
- static void ddb_device_attrs_del(struct ddb *dev)
- {
- int i;
- for (i = 0; i < 4; i++)
- if (dev->link[i].info && dev->link[i].info->tempmon_irq)
- device_remove_file(dev->ddb_dev,
- &ddb_attrs_fanspeed[i]);
- for (i = 0; i < dev->link[0].info->temp_num; i++)
- device_remove_file(dev->ddb_dev, &ddb_attrs_temp[i]);
- for (i = 0; i < dev->link[0].info->fan_num; i++)
- device_remove_file(dev->ddb_dev, &ddb_attrs_fan[i]);
- for (i = 0; i < dev->i2c_num && i < 4; i++) {
- if (dev->link[0].info->led_num)
- device_remove_file(dev->ddb_dev, &ddb_attrs_led[i]);
- device_remove_file(dev->ddb_dev, &ddb_attrs_snr[i]);
- device_remove_file(dev->ddb_dev, &ddb_attrs_ctemp[i]);
- }
- for (i = 0; ddb_attrs[i].attr.name; i++)
- device_remove_file(dev->ddb_dev, &ddb_attrs[i]);
- }
- static int ddb_device_attrs_add(struct ddb *dev)
- {
- int i;
- for (i = 0; ddb_attrs[i].attr.name; i++)
- if (device_create_file(dev->ddb_dev, &ddb_attrs[i]))
- goto fail;
- for (i = 0; i < dev->link[0].info->temp_num; i++)
- if (device_create_file(dev->ddb_dev, &ddb_attrs_temp[i]))
- goto fail;
- for (i = 0; i < dev->link[0].info->fan_num; i++)
- if (device_create_file(dev->ddb_dev, &ddb_attrs_fan[i]))
- goto fail;
- for (i = 0; (i < dev->i2c_num) && (i < 4); i++) {
- if (device_create_file(dev->ddb_dev, &ddb_attrs_snr[i]))
- goto fail;
- if (device_create_file(dev->ddb_dev, &ddb_attrs_ctemp[i]))
- goto fail;
- if (dev->link[0].info->led_num)
- if (device_create_file(dev->ddb_dev,
- &ddb_attrs_led[i]))
- goto fail;
- }
- for (i = 0; i < 4; i++)
- if (dev->link[i].info && dev->link[i].info->tempmon_irq)
- if (device_create_file(dev->ddb_dev,
- &ddb_attrs_fanspeed[i]))
- goto fail;
- return 0;
- fail:
- return -1;
- }
- int ddb_device_create(struct ddb *dev)
- {
- int res = 0;
- if (ddb_num == DDB_MAX_ADAPTER)
- return -ENOMEM;
- mutex_lock(&ddb_mutex);
- dev->nr = ddb_num;
- ddbs[dev->nr] = dev;
- dev->ddb_dev = device_create(&ddb_class, dev->dev,
- MKDEV(ddb_major, dev->nr),
- dev, "ddbridge%d", dev->nr);
- if (IS_ERR(dev->ddb_dev)) {
- res = PTR_ERR(dev->ddb_dev);
- dev_info(dev->dev, "Could not create ddbridge%d\n", dev->nr);
- goto fail;
- }
- res = ddb_device_attrs_add(dev);
- if (res) {
- ddb_device_attrs_del(dev);
- device_destroy(&ddb_class, MKDEV(ddb_major, dev->nr));
- ddbs[dev->nr] = NULL;
- dev->ddb_dev = ERR_PTR(-ENODEV);
- } else {
- ddb_num++;
- }
- fail:
- mutex_unlock(&ddb_mutex);
- return res;
- }
- void ddb_device_destroy(struct ddb *dev)
- {
- if (IS_ERR(dev->ddb_dev))
- return;
- ddb_device_attrs_del(dev);
- device_destroy(&ddb_class, MKDEV(ddb_major, dev->nr));
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- static void tempmon_setfan(struct ddb_link *link)
- {
- u32 temp, temp2, pwm;
- if ((ddblreadl(link, TEMPMON_CONTROL) &
- TEMPMON_CONTROL_OVERTEMP) != 0) {
- dev_info(link->dev->dev, "Over temperature condition\n");
- link->overtemperature_error = 1;
- }
- temp = (ddblreadl(link, TEMPMON_SENSOR0) >> 8) & 0xFF;
- if (temp & 0x80)
- temp = 0;
- temp2 = (ddblreadl(link, TEMPMON_SENSOR1) >> 8) & 0xFF;
- if (temp2 & 0x80)
- temp2 = 0;
- if (temp2 > temp)
- temp = temp2;
- pwm = (ddblreadl(link, TEMPMON_FANCONTROL) >> 8) & 0x0F;
- if (pwm > 10)
- pwm = 10;
- if (temp >= link->temp_tab[pwm]) {
- while (pwm < 10 && temp >= link->temp_tab[pwm + 1])
- pwm += 1;
- } else {
- while (pwm > 1 && temp < link->temp_tab[pwm - 2])
- pwm -= 1;
- }
- ddblwritel(link, (pwm << 8), TEMPMON_FANCONTROL);
- }
- static void temp_handler(void *data)
- {
- struct ddb_link *link = (struct ddb_link *)data;
- spin_lock(&link->temp_lock);
- tempmon_setfan(link);
- spin_unlock(&link->temp_lock);
- }
- static int tempmon_init(struct ddb_link *link, int first_time)
- {
- struct ddb *dev = link->dev;
- int status = 0;
- u32 l = link->nr;
- spin_lock_irq(&link->temp_lock);
- if (first_time) {
- static u8 temperature_table[11] = {
- 30, 35, 40, 45, 50, 55, 60, 65, 70, 75, 80 };
- memcpy(link->temp_tab, temperature_table,
- sizeof(temperature_table));
- }
- ddb_irq_set(dev, l, link->info->tempmon_irq, temp_handler, link);
- ddblwritel(link, (TEMPMON_CONTROL_OVERTEMP | TEMPMON_CONTROL_AUTOSCAN |
- TEMPMON_CONTROL_INTENABLE),
- TEMPMON_CONTROL);
- ddblwritel(link, (3 << 8), TEMPMON_FANCONTROL);
- link->overtemperature_error =
- ((ddblreadl(link, TEMPMON_CONTROL) &
- TEMPMON_CONTROL_OVERTEMP) != 0);
- if (link->overtemperature_error) {
- dev_info(link->dev->dev, "Over temperature condition\n");
- status = -1;
- }
- tempmon_setfan(link);
- spin_unlock_irq(&link->temp_lock);
- return status;
- }
- static int ddb_init_tempmon(struct ddb_link *link)
- {
- const struct ddb_info *info = link->info;
- if (!info->tempmon_irq)
- return 0;
- if (info->type == DDB_OCTOPUS_MAX_CT)
- if (link->ids.regmapid < 0x00010002)
- return 0;
- spin_lock_init(&link->temp_lock);
- dev_dbg(link->dev->dev, "init_tempmon\n");
- return tempmon_init(link, 1);
- }
- /****************************************************************************/
- /****************************************************************************/
- /****************************************************************************/
- static int ddb_init_boards(struct ddb *dev)
- {
- const struct ddb_info *info;
- struct ddb_link *link;
- u32 l;
- for (l = 0; l < DDB_MAX_LINK; l++) {
- link = &dev->link[l];
- info = link->info;
- if (!info)
- continue;
- if (info->board_control) {
- ddbwritel(dev, 0, DDB_LINK_TAG(l) | BOARD_CONTROL);
- msleep(100);
- ddbwritel(dev, info->board_control_2,
- DDB_LINK_TAG(l) | BOARD_CONTROL);
- usleep_range(2000, 3000);
- ddbwritel(dev,
- info->board_control_2 | info->board_control,
- DDB_LINK_TAG(l) | BOARD_CONTROL);
- usleep_range(2000, 3000);
- }
- ddb_init_tempmon(link);
- }
- return 0;
- }
- int ddb_init(struct ddb *dev)
- {
- mutex_init(&dev->link[0].lnb.lock);
- mutex_init(&dev->link[0].flash_mutex);
- if (no_init) {
- ddb_device_create(dev);
- return 0;
- }
- ddb_init_boards(dev);
- if (ddb_i2c_init(dev) < 0)
- goto fail1;
- ddb_ports_init(dev);
- if (ddb_buffers_alloc(dev) < 0) {
- dev_info(dev->dev, "Could not allocate buffer memory\n");
- goto fail2;
- }
- if (ddb_ports_attach(dev) < 0)
- goto fail3;
- ddb_device_create(dev);
- if (dev->link[0].info->fan_num) {
- ddbwritel(dev, 1, GPIO_DIRECTION);
- ddbwritel(dev, 1, GPIO_OUTPUT);
- }
- return 0;
- fail3:
- dev_err(dev->dev, "fail3\n");
- ddb_ports_detach(dev);
- ddb_buffers_free(dev);
- fail2:
- dev_err(dev->dev, "fail2\n");
- ddb_ports_release(dev);
- ddb_i2c_release(dev);
- fail1:
- dev_err(dev->dev, "fail1\n");
- return -1;
- }
- void ddb_unmap(struct ddb *dev)
- {
- if (dev->regs)
- iounmap(dev->regs);
- vfree(dev);
- }
- int ddb_exit_ddbridge(int stage, int error)
- {
- switch (stage) {
- default:
- case 2:
- destroy_workqueue(ddb_wq);
- /* fall-through */
- case 1:
- ddb_class_destroy();
- break;
- }
- return error;
- }
- int ddb_init_ddbridge(void)
- {
- if (dma_buf_num < 8)
- dma_buf_num = 8;
- if (dma_buf_num > 32)
- dma_buf_num = 32;
- if (dma_buf_size < 1)
- dma_buf_size = 1;
- if (dma_buf_size > 43)
- dma_buf_size = 43;
- if (ddb_class_create() < 0)
- return -1;
- ddb_wq = alloc_workqueue("ddbridge", 0, 0);
- if (!ddb_wq)
- return ddb_exit_ddbridge(1, -1);
- return 0;
- }
|