| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * core.c - DesignWare USB3 DRD Controller Core file
- *
- * Copyright (C) 2010-2011 Texas Instruments Incorporated - https://www.ti.com
- *
- * Authors: Felipe Balbi <balbi@ti.com>,
- * Sebastian Andrzej Siewior <bigeasy@linutronix.de>
- */
- #include <linux/clk.h>
- #include <linux/version.h>
- #include <linux/module.h>
- #include <linux/kernel.h>
- #include <linux/slab.h>
- #include <linux/spinlock.h>
- #include <linux/platform_device.h>
- #include <linux/pm_runtime.h>
- #include <linux/interrupt.h>
- #include <linux/ioport.h>
- #include <linux/io.h>
- #include <linux/list.h>
- #include <linux/delay.h>
- #include <linux/dma-mapping.h>
- #include <linux/of.h>
- #include <linux/of_graph.h>
- #include <linux/acpi.h>
- #include <linux/pci.h>
- #include <linux/pinctrl/consumer.h>
- #include <linux/pinctrl/devinfo.h>
- #include <linux/reset.h>
- #include <linux/bitfield.h>
- #include <linux/usb/ch9.h>
- #include <linux/usb/gadget.h>
- #include <linux/usb/of.h>
- #include <linux/usb/otg.h>
- #include "core.h"
- #include "gadget.h"
- #include "glue.h"
- #include "io.h"
- #include "debug.h"
- #include "../host/xhci-ext-caps.h"
- #define DWC3_DEFAULT_AUTOSUSPEND_DELAY 5000 /* ms */
- /**
- * dwc3_get_dr_mode - Validates and sets dr_mode
- * @dwc: pointer to our context structure
- */
- static int dwc3_get_dr_mode(struct dwc3 *dwc)
- {
- enum usb_dr_mode mode;
- struct device *dev = dwc->dev;
- unsigned int hw_mode;
- if (dwc->dr_mode == USB_DR_MODE_UNKNOWN)
- dwc->dr_mode = USB_DR_MODE_OTG;
- mode = dwc->dr_mode;
- hw_mode = DWC3_GHWPARAMS0_MODE(dwc->hwparams.hwparams0);
- switch (hw_mode) {
- case DWC3_GHWPARAMS0_MODE_GADGET:
- if (IS_ENABLED(CONFIG_USB_DWC3_HOST)) {
- dev_err(dev,
- "Controller does not support host mode.\n");
- return -EINVAL;
- }
- mode = USB_DR_MODE_PERIPHERAL;
- break;
- case DWC3_GHWPARAMS0_MODE_HOST:
- if (IS_ENABLED(CONFIG_USB_DWC3_GADGET)) {
- dev_err(dev,
- "Controller does not support device mode.\n");
- return -EINVAL;
- }
- mode = USB_DR_MODE_HOST;
- break;
- default:
- if (IS_ENABLED(CONFIG_USB_DWC3_HOST))
- mode = USB_DR_MODE_HOST;
- else if (IS_ENABLED(CONFIG_USB_DWC3_GADGET))
- mode = USB_DR_MODE_PERIPHERAL;
- /*
- * DWC_usb31 and DWC_usb3 v3.30a and higher do not support OTG
- * mode. If the controller supports DRD but the dr_mode is not
- * specified or set to OTG, then set the mode to peripheral.
- */
- if (mode == USB_DR_MODE_OTG && !dwc->edev &&
- (!IS_ENABLED(CONFIG_USB_ROLE_SWITCH) ||
- !device_property_read_bool(dwc->dev, "usb-role-switch")) &&
- !DWC3_VER_IS_PRIOR(DWC3, 330A))
- mode = USB_DR_MODE_PERIPHERAL;
- }
- if (mode != dwc->dr_mode) {
- dev_warn(dev,
- "Configuration mismatch. dr_mode forced to %s\n",
- mode == USB_DR_MODE_HOST ? "host" : "gadget");
- dwc->dr_mode = mode;
- }
- return 0;
- }
- void dwc3_enable_susphy(struct dwc3 *dwc, bool enable)
- {
- u32 reg;
- int i;
- for (i = 0; i < dwc->num_usb3_ports; i++) {
- reg = dwc3_readl(dwc, DWC3_GUSB3PIPECTL(i));
- if (enable && !dwc->dis_u3_susphy_quirk)
- reg |= DWC3_GUSB3PIPECTL_SUSPHY;
- else
- reg &= ~DWC3_GUSB3PIPECTL_SUSPHY;
- dwc3_writel(dwc, DWC3_GUSB3PIPECTL(i), reg);
- }
- for (i = 0; i < dwc->num_usb2_ports; i++) {
- reg = dwc3_readl(dwc, DWC3_GUSB2PHYCFG(i));
- if (enable && !dwc->dis_u2_susphy_quirk)
- reg |= DWC3_GUSB2PHYCFG_SUSPHY;
- else
- reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
- dwc3_writel(dwc, DWC3_GUSB2PHYCFG(i), reg);
- }
- }
- EXPORT_SYMBOL_GPL(dwc3_enable_susphy);
- void dwc3_set_prtcap(struct dwc3 *dwc, u32 mode, bool ignore_susphy)
- {
- unsigned int hw_mode;
- u32 reg;
- reg = dwc3_readl(dwc, DWC3_GCTL);
- /*
- * For DRD controllers, GUSB3PIPECTL.SUSPENDENABLE and
- * GUSB2PHYCFG.SUSPHY should be cleared during mode switching,
- * and they can be set after core initialization.
- */
- hw_mode = DWC3_GHWPARAMS0_MODE(dwc->hwparams.hwparams0);
- if (hw_mode == DWC3_GHWPARAMS0_MODE_DRD && !ignore_susphy) {
- if (DWC3_GCTL_PRTCAP(reg) != mode)
- dwc3_enable_susphy(dwc, false);
- }
- reg &= ~(DWC3_GCTL_PRTCAPDIR(DWC3_GCTL_PRTCAP_OTG));
- reg |= DWC3_GCTL_PRTCAPDIR(mode);
- dwc3_writel(dwc, DWC3_GCTL, reg);
- dwc->current_dr_role = mode;
- trace_dwc3_set_prtcap(dwc, mode);
- }
- EXPORT_SYMBOL_GPL(dwc3_set_prtcap);
- static void __dwc3_set_mode(struct work_struct *work)
- {
- struct dwc3 *dwc = work_to_dwc(work);
- unsigned long flags;
- int ret;
- u32 reg;
- u32 desired_dr_role;
- int i;
- mutex_lock(&dwc->mutex);
- spin_lock_irqsave(&dwc->lock, flags);
- desired_dr_role = dwc->desired_dr_role;
- spin_unlock_irqrestore(&dwc->lock, flags);
- pm_runtime_get_sync(dwc->dev);
- if (dwc->current_dr_role == DWC3_GCTL_PRTCAP_OTG)
- dwc3_otg_update(dwc, 0);
- if (!desired_dr_role)
- goto out;
- if (desired_dr_role == dwc->current_dr_role)
- goto out;
- if (desired_dr_role == DWC3_GCTL_PRTCAP_OTG && dwc->edev)
- goto out;
- switch (dwc->current_dr_role) {
- case DWC3_GCTL_PRTCAP_HOST:
- dwc3_host_exit(dwc);
- break;
- case DWC3_GCTL_PRTCAP_DEVICE:
- dwc3_gadget_exit(dwc);
- dwc3_event_buffers_cleanup(dwc);
- break;
- case DWC3_GCTL_PRTCAP_OTG:
- dwc3_otg_exit(dwc);
- spin_lock_irqsave(&dwc->lock, flags);
- dwc->desired_otg_role = DWC3_OTG_ROLE_IDLE;
- spin_unlock_irqrestore(&dwc->lock, flags);
- dwc3_otg_update(dwc, 1);
- break;
- default:
- break;
- }
- /*
- * When current_dr_role is not set, there's no role switching.
- * Only perform GCTL.CoreSoftReset when there's DRD role switching.
- */
- if (dwc->current_dr_role && ((DWC3_IP_IS(DWC3) ||
- DWC3_VER_IS_PRIOR(DWC31, 190A)) &&
- desired_dr_role != DWC3_GCTL_PRTCAP_OTG)) {
- reg = dwc3_readl(dwc, DWC3_GCTL);
- reg |= DWC3_GCTL_CORESOFTRESET;
- dwc3_writel(dwc, DWC3_GCTL, reg);
- /*
- * Wait for internal clocks to synchronized. DWC_usb31 and
- * DWC_usb32 may need at least 50ms (less for DWC_usb3). To
- * keep it consistent across different IPs, let's wait up to
- * 100ms before clearing GCTL.CORESOFTRESET.
- */
- msleep(100);
- reg = dwc3_readl(dwc, DWC3_GCTL);
- reg &= ~DWC3_GCTL_CORESOFTRESET;
- dwc3_writel(dwc, DWC3_GCTL, reg);
- }
- spin_lock_irqsave(&dwc->lock, flags);
- dwc3_set_prtcap(dwc, desired_dr_role, false);
- spin_unlock_irqrestore(&dwc->lock, flags);
- switch (desired_dr_role) {
- case DWC3_GCTL_PRTCAP_HOST:
- ret = dwc3_host_init(dwc);
- if (ret) {
- dev_err(dwc->dev, "failed to initialize host\n");
- } else {
- if (dwc->usb2_phy)
- otg_set_vbus(dwc->usb2_phy->otg, true);
- for (i = 0; i < dwc->num_usb2_ports; i++)
- phy_set_mode(dwc->usb2_generic_phy[i], PHY_MODE_USB_HOST);
- for (i = 0; i < dwc->num_usb3_ports; i++)
- phy_set_mode(dwc->usb3_generic_phy[i], PHY_MODE_USB_HOST);
- if (dwc->dis_split_quirk) {
- reg = dwc3_readl(dwc, DWC3_GUCTL3);
- reg |= DWC3_GUCTL3_SPLITDISABLE;
- dwc3_writel(dwc, DWC3_GUCTL3, reg);
- }
- }
- break;
- case DWC3_GCTL_PRTCAP_DEVICE:
- dwc3_core_soft_reset(dwc);
- dwc3_event_buffers_setup(dwc);
- if (dwc->usb2_phy)
- otg_set_vbus(dwc->usb2_phy->otg, false);
- phy_set_mode(dwc->usb2_generic_phy[0], PHY_MODE_USB_DEVICE);
- phy_set_mode(dwc->usb3_generic_phy[0], PHY_MODE_USB_DEVICE);
- ret = dwc3_gadget_init(dwc);
- if (ret)
- dev_err(dwc->dev, "failed to initialize peripheral\n");
- break;
- case DWC3_GCTL_PRTCAP_OTG:
- dwc3_otg_init(dwc);
- dwc3_otg_update(dwc, 0);
- break;
- default:
- break;
- }
- out:
- pm_runtime_put_autosuspend(dwc->dev);
- mutex_unlock(&dwc->mutex);
- }
- void dwc3_set_mode(struct dwc3 *dwc, u32 mode)
- {
- unsigned long flags;
- if (dwc->dr_mode != USB_DR_MODE_OTG)
- return;
- spin_lock_irqsave(&dwc->lock, flags);
- dwc->desired_dr_role = mode;
- spin_unlock_irqrestore(&dwc->lock, flags);
- queue_work(system_freezable_wq, &dwc->drd_work);
- }
- u32 dwc3_core_fifo_space(struct dwc3_ep *dep, u8 type)
- {
- struct dwc3 *dwc = dep->dwc;
- u32 reg;
- dwc3_writel(dwc, DWC3_GDBGFIFOSPACE,
- DWC3_GDBGFIFOSPACE_NUM(dep->number) |
- DWC3_GDBGFIFOSPACE_TYPE(type));
- reg = dwc3_readl(dwc, DWC3_GDBGFIFOSPACE);
- return DWC3_GDBGFIFOSPACE_SPACE_AVAILABLE(reg);
- }
- /**
- * dwc3_core_soft_reset - Issues core soft reset and PHY reset
- * @dwc: pointer to our context structure
- */
- int dwc3_core_soft_reset(struct dwc3 *dwc)
- {
- u32 reg;
- int retries = 1000;
- /*
- * We're resetting only the device side because, if we're in host mode,
- * XHCI driver will reset the host block. If dwc3 was configured for
- * host-only mode, then we can return early.
- */
- if (dwc->current_dr_role == DWC3_GCTL_PRTCAP_HOST)
- return 0;
- reg = dwc3_readl(dwc, DWC3_DCTL);
- reg |= DWC3_DCTL_CSFTRST;
- reg &= ~DWC3_DCTL_RUN_STOP;
- dwc3_gadget_dctl_write_safe(dwc, reg);
- /*
- * For DWC_usb31 controller 1.90a and later, the DCTL.CSFRST bit
- * is cleared only after all the clocks are synchronized. This can
- * take a little more than 50ms. Set the polling rate at 20ms
- * for 10 times instead.
- */
- if (DWC3_VER_IS_WITHIN(DWC31, 190A, ANY) || DWC3_IP_IS(DWC32))
- retries = 10;
- do {
- reg = dwc3_readl(dwc, DWC3_DCTL);
- if (!(reg & DWC3_DCTL_CSFTRST))
- goto done;
- if (DWC3_VER_IS_WITHIN(DWC31, 190A, ANY) || DWC3_IP_IS(DWC32))
- msleep(20);
- else
- udelay(1);
- } while (--retries);
- dev_warn(dwc->dev, "DWC3 controller soft reset failed.\n");
- return -ETIMEDOUT;
- done:
- /*
- * For DWC_usb31 controller 1.80a and prior, once DCTL.CSFRST bit
- * is cleared, we must wait at least 50ms before accessing the PHY
- * domain (synchronization delay).
- */
- if (DWC3_VER_IS_WITHIN(DWC31, ANY, 180A))
- msleep(50);
- return 0;
- }
- /*
- * dwc3_frame_length_adjustment - Adjusts frame length if required
- * @dwc3: Pointer to our controller context structure
- */
- static void dwc3_frame_length_adjustment(struct dwc3 *dwc)
- {
- u32 reg;
- u32 dft;
- if (DWC3_VER_IS_PRIOR(DWC3, 250A))
- return;
- if (dwc->fladj == 0)
- return;
- reg = dwc3_readl(dwc, DWC3_GFLADJ);
- dft = reg & DWC3_GFLADJ_30MHZ_MASK;
- if (dft != dwc->fladj) {
- reg &= ~DWC3_GFLADJ_30MHZ_MASK;
- reg |= DWC3_GFLADJ_30MHZ_SDBND_SEL | dwc->fladj;
- dwc3_writel(dwc, DWC3_GFLADJ, reg);
- }
- }
- /**
- * dwc3_ref_clk_period - Reference clock period configuration
- * Default reference clock period depends on hardware
- * configuration. For systems with reference clock that differs
- * from the default, this will set clock period in DWC3_GUCTL
- * register.
- * @dwc: Pointer to our controller context structure
- */
- static void dwc3_ref_clk_period(struct dwc3 *dwc)
- {
- unsigned long period;
- unsigned long fladj;
- unsigned long decr;
- unsigned long rate;
- u32 reg;
- if (dwc->ref_clk) {
- rate = clk_get_rate(dwc->ref_clk);
- if (!rate)
- return;
- period = NSEC_PER_SEC / rate;
- } else if (dwc->ref_clk_per) {
- period = dwc->ref_clk_per;
- rate = NSEC_PER_SEC / period;
- } else {
- return;
- }
- reg = dwc3_readl(dwc, DWC3_GUCTL);
- reg &= ~DWC3_GUCTL_REFCLKPER_MASK;
- reg |= FIELD_PREP(DWC3_GUCTL_REFCLKPER_MASK, period);
- dwc3_writel(dwc, DWC3_GUCTL, reg);
- if (DWC3_VER_IS_PRIOR(DWC3, 250A))
- return;
- /*
- * The calculation below is
- *
- * 125000 * (NSEC_PER_SEC / (rate * period) - 1)
- *
- * but rearranged for fixed-point arithmetic. The division must be
- * 64-bit because 125000 * NSEC_PER_SEC doesn't fit in 32 bits (and
- * neither does rate * period).
- *
- * Note that rate * period ~= NSEC_PER_SECOND, minus the number of
- * nanoseconds of error caused by the truncation which happened during
- * the division when calculating rate or period (whichever one was
- * derived from the other). We first calculate the relative error, then
- * scale it to units of 8 ppm.
- */
- fladj = div64_u64(125000ULL * NSEC_PER_SEC, (u64)rate * period);
- fladj -= 125000;
- /*
- * The documented 240MHz constant is scaled by 2 to get PLS1 as well.
- */
- decr = 480000000 / rate;
- reg = dwc3_readl(dwc, DWC3_GFLADJ);
- reg &= ~DWC3_GFLADJ_REFCLK_FLADJ_MASK
- & ~DWC3_GFLADJ_240MHZDECR
- & ~DWC3_GFLADJ_240MHZDECR_PLS1;
- reg |= FIELD_PREP(DWC3_GFLADJ_REFCLK_FLADJ_MASK, fladj)
- | FIELD_PREP(DWC3_GFLADJ_240MHZDECR, decr >> 1)
- | FIELD_PREP(DWC3_GFLADJ_240MHZDECR_PLS1, decr & 1);
- if (dwc->gfladj_refclk_lpm_sel)
- reg |= DWC3_GFLADJ_REFCLK_LPM_SEL;
- dwc3_writel(dwc, DWC3_GFLADJ, reg);
- }
- /**
- * dwc3_free_one_event_buffer - Frees one event buffer
- * @dwc: Pointer to our controller context structure
- * @evt: Pointer to event buffer to be freed
- */
- static void dwc3_free_one_event_buffer(struct dwc3 *dwc,
- struct dwc3_event_buffer *evt)
- {
- dma_free_coherent(dwc->sysdev, evt->length, evt->buf, evt->dma);
- }
- /**
- * dwc3_alloc_one_event_buffer - Allocates one event buffer structure
- * @dwc: Pointer to our controller context structure
- * @length: size of the event buffer
- *
- * Returns a pointer to the allocated event buffer structure on success
- * otherwise ERR_PTR(errno).
- */
- static struct dwc3_event_buffer *dwc3_alloc_one_event_buffer(struct dwc3 *dwc,
- unsigned int length)
- {
- struct dwc3_event_buffer *evt;
- evt = devm_kzalloc(dwc->dev, sizeof(*evt), GFP_KERNEL);
- if (!evt)
- return ERR_PTR(-ENOMEM);
- evt->dwc = dwc;
- evt->length = length;
- evt->cache = devm_kzalloc(dwc->dev, length, GFP_KERNEL);
- if (!evt->cache)
- return ERR_PTR(-ENOMEM);
- evt->buf = dma_alloc_coherent(dwc->sysdev, length,
- &evt->dma, GFP_KERNEL);
- if (!evt->buf)
- return ERR_PTR(-ENOMEM);
- return evt;
- }
- /**
- * dwc3_free_event_buffers - frees all allocated event buffers
- * @dwc: Pointer to our controller context structure
- */
- static void dwc3_free_event_buffers(struct dwc3 *dwc)
- {
- struct dwc3_event_buffer *evt;
- evt = dwc->ev_buf;
- if (evt)
- dwc3_free_one_event_buffer(dwc, evt);
- }
- /**
- * dwc3_alloc_event_buffers - Allocates @num event buffers of size @length
- * @dwc: pointer to our controller context structure
- * @length: size of event buffer
- *
- * Returns 0 on success otherwise negative errno. In the error case, dwc
- * may contain some buffers allocated but not all which were requested.
- */
- static int dwc3_alloc_event_buffers(struct dwc3 *dwc, unsigned int length)
- {
- struct dwc3_event_buffer *evt;
- unsigned int hw_mode;
- hw_mode = DWC3_GHWPARAMS0_MODE(dwc->hwparams.hwparams0);
- if (hw_mode == DWC3_GHWPARAMS0_MODE_HOST) {
- dwc->ev_buf = NULL;
- return 0;
- }
- evt = dwc3_alloc_one_event_buffer(dwc, length);
- if (IS_ERR(evt)) {
- dev_err(dwc->dev, "can't allocate event buffer\n");
- return PTR_ERR(evt);
- }
- dwc->ev_buf = evt;
- return 0;
- }
- /**
- * dwc3_event_buffers_setup - setup our allocated event buffers
- * @dwc: pointer to our controller context structure
- *
- * Returns 0 on success otherwise negative errno.
- */
- int dwc3_event_buffers_setup(struct dwc3 *dwc)
- {
- struct dwc3_event_buffer *evt;
- u32 reg;
- if (!dwc->ev_buf)
- return 0;
- evt = dwc->ev_buf;
- evt->lpos = 0;
- dwc3_writel(dwc, DWC3_GEVNTADRLO(0),
- lower_32_bits(evt->dma));
- dwc3_writel(dwc, DWC3_GEVNTADRHI(0),
- upper_32_bits(evt->dma));
- dwc3_writel(dwc, DWC3_GEVNTSIZ(0),
- DWC3_GEVNTSIZ_SIZE(evt->length));
- /* Clear any stale event */
- reg = dwc3_readl(dwc, DWC3_GEVNTCOUNT(0));
- dwc3_writel(dwc, DWC3_GEVNTCOUNT(0), reg);
- return 0;
- }
- void dwc3_event_buffers_cleanup(struct dwc3 *dwc)
- {
- struct dwc3_event_buffer *evt;
- u32 reg;
- if (!dwc->ev_buf)
- return;
- /*
- * Exynos platforms may not be able to access event buffer if the
- * controller failed to halt on dwc3_core_exit().
- */
- reg = dwc3_readl(dwc, DWC3_DSTS);
- if (!(reg & DWC3_DSTS_DEVCTRLHLT))
- return;
- evt = dwc->ev_buf;
- evt->lpos = 0;
- dwc3_writel(dwc, DWC3_GEVNTADRLO(0), 0);
- dwc3_writel(dwc, DWC3_GEVNTADRHI(0), 0);
- dwc3_writel(dwc, DWC3_GEVNTSIZ(0), DWC3_GEVNTSIZ_INTMASK
- | DWC3_GEVNTSIZ_SIZE(0));
- /* Clear any stale event */
- reg = dwc3_readl(dwc, DWC3_GEVNTCOUNT(0));
- dwc3_writel(dwc, DWC3_GEVNTCOUNT(0), reg);
- }
- static void dwc3_core_num_eps(struct dwc3 *dwc)
- {
- struct dwc3_hwparams *parms = &dwc->hwparams;
- dwc->num_eps = DWC3_NUM_EPS(parms);
- }
- static void dwc3_cache_hwparams(struct dwc3 *dwc)
- {
- struct dwc3_hwparams *parms = &dwc->hwparams;
- parms->hwparams0 = dwc3_readl(dwc, DWC3_GHWPARAMS0);
- parms->hwparams1 = dwc3_readl(dwc, DWC3_GHWPARAMS1);
- parms->hwparams2 = dwc3_readl(dwc, DWC3_GHWPARAMS2);
- parms->hwparams3 = dwc3_readl(dwc, DWC3_GHWPARAMS3);
- parms->hwparams4 = dwc3_readl(dwc, DWC3_GHWPARAMS4);
- parms->hwparams5 = dwc3_readl(dwc, DWC3_GHWPARAMS5);
- parms->hwparams6 = dwc3_readl(dwc, DWC3_GHWPARAMS6);
- parms->hwparams7 = dwc3_readl(dwc, DWC3_GHWPARAMS7);
- parms->hwparams8 = dwc3_readl(dwc, DWC3_GHWPARAMS8);
- if (DWC3_IP_IS(DWC32))
- parms->hwparams9 = dwc3_readl(dwc, DWC3_GHWPARAMS9);
- }
- static void dwc3_config_soc_bus(struct dwc3 *dwc)
- {
- if (dwc->gsbuscfg0_reqinfo != DWC3_GSBUSCFG0_REQINFO_UNSPECIFIED) {
- u32 reg;
- reg = dwc3_readl(dwc, DWC3_GSBUSCFG0);
- reg &= ~DWC3_GSBUSCFG0_REQINFO(~0);
- reg |= DWC3_GSBUSCFG0_REQINFO(dwc->gsbuscfg0_reqinfo);
- dwc3_writel(dwc, DWC3_GSBUSCFG0, reg);
- }
- }
- static int dwc3_core_ulpi_init(struct dwc3 *dwc)
- {
- int intf;
- int ret = 0;
- intf = DWC3_GHWPARAMS3_HSPHY_IFC(dwc->hwparams.hwparams3);
- if (intf == DWC3_GHWPARAMS3_HSPHY_IFC_ULPI ||
- (intf == DWC3_GHWPARAMS3_HSPHY_IFC_UTMI_ULPI &&
- dwc->hsphy_interface &&
- !strncmp(dwc->hsphy_interface, "ulpi", 4)))
- ret = dwc3_ulpi_init(dwc);
- return ret;
- }
- static int dwc3_ss_phy_setup(struct dwc3 *dwc, int index)
- {
- u32 reg;
- reg = dwc3_readl(dwc, DWC3_GUSB3PIPECTL(index));
- /*
- * Make sure UX_EXIT_PX is cleared as that causes issues with some
- * PHYs. Also, this bit is not supposed to be used in normal operation.
- */
- reg &= ~DWC3_GUSB3PIPECTL_UX_EXIT_PX;
- /* Ensure the GUSB3PIPECTL.SUSPENDENABLE is cleared prior to phy init. */
- reg &= ~DWC3_GUSB3PIPECTL_SUSPHY;
- if (dwc->u2ss_inp3_quirk)
- reg |= DWC3_GUSB3PIPECTL_U2SSINP3OK;
- if (dwc->dis_rxdet_inp3_quirk)
- reg |= DWC3_GUSB3PIPECTL_DISRXDETINP3;
- if (dwc->req_p1p2p3_quirk)
- reg |= DWC3_GUSB3PIPECTL_REQP1P2P3;
- if (dwc->del_p1p2p3_quirk)
- reg |= DWC3_GUSB3PIPECTL_DEP1P2P3_EN;
- if (dwc->del_phy_power_chg_quirk)
- reg |= DWC3_GUSB3PIPECTL_DEPOCHANGE;
- if (dwc->lfps_filter_quirk)
- reg |= DWC3_GUSB3PIPECTL_LFPSFILT;
- if (dwc->rx_detect_poll_quirk)
- reg |= DWC3_GUSB3PIPECTL_RX_DETOPOLL;
- if (dwc->tx_de_emphasis_quirk)
- reg |= DWC3_GUSB3PIPECTL_TX_DEEPH(dwc->tx_de_emphasis);
- if (dwc->dis_del_phy_power_chg_quirk)
- reg &= ~DWC3_GUSB3PIPECTL_DEPOCHANGE;
- dwc3_writel(dwc, DWC3_GUSB3PIPECTL(index), reg);
- return 0;
- }
- static int dwc3_hs_phy_setup(struct dwc3 *dwc, int index)
- {
- u32 reg;
- reg = dwc3_readl(dwc, DWC3_GUSB2PHYCFG(index));
- /* Select the HS PHY interface */
- switch (DWC3_GHWPARAMS3_HSPHY_IFC(dwc->hwparams.hwparams3)) {
- case DWC3_GHWPARAMS3_HSPHY_IFC_UTMI_ULPI:
- if (dwc->hsphy_interface &&
- !strncmp(dwc->hsphy_interface, "utmi", 4)) {
- reg &= ~DWC3_GUSB2PHYCFG_ULPI_UTMI;
- break;
- } else if (dwc->hsphy_interface &&
- !strncmp(dwc->hsphy_interface, "ulpi", 4)) {
- reg |= DWC3_GUSB2PHYCFG_ULPI_UTMI;
- dwc3_writel(dwc, DWC3_GUSB2PHYCFG(index), reg);
- } else {
- /* Relying on default value. */
- if (!(reg & DWC3_GUSB2PHYCFG_ULPI_UTMI))
- break;
- }
- fallthrough;
- case DWC3_GHWPARAMS3_HSPHY_IFC_ULPI:
- default:
- break;
- }
- switch (dwc->hsphy_mode) {
- case USBPHY_INTERFACE_MODE_UTMI:
- reg &= ~(DWC3_GUSB2PHYCFG_PHYIF_MASK |
- DWC3_GUSB2PHYCFG_USBTRDTIM_MASK);
- reg |= DWC3_GUSB2PHYCFG_PHYIF(UTMI_PHYIF_8_BIT) |
- DWC3_GUSB2PHYCFG_USBTRDTIM(USBTRDTIM_UTMI_8_BIT);
- break;
- case USBPHY_INTERFACE_MODE_UTMIW:
- reg &= ~(DWC3_GUSB2PHYCFG_PHYIF_MASK |
- DWC3_GUSB2PHYCFG_USBTRDTIM_MASK);
- reg |= DWC3_GUSB2PHYCFG_PHYIF(UTMI_PHYIF_16_BIT) |
- DWC3_GUSB2PHYCFG_USBTRDTIM(USBTRDTIM_UTMI_16_BIT);
- break;
- default:
- break;
- }
- /* Ensure the GUSB2PHYCFG.SUSPHY is cleared prior to phy init. */
- reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
- if (dwc->dis_enblslpm_quirk)
- reg &= ~DWC3_GUSB2PHYCFG_ENBLSLPM;
- else
- reg |= DWC3_GUSB2PHYCFG_ENBLSLPM;
- if (dwc->dis_u2_freeclk_exists_quirk || dwc->gfladj_refclk_lpm_sel)
- reg &= ~DWC3_GUSB2PHYCFG_U2_FREECLK_EXISTS;
- /*
- * Some ULPI USB PHY does not support internal VBUS supply, to drive
- * the CPEN pin requires the configuration of the ULPI DRVVBUSEXTERNAL
- * bit of OTG_CTRL register. Controller configures the USB2 PHY
- * ULPIEXTVBUSDRV bit[17] of the GUSB2PHYCFG register to drive vBus
- * with an external supply.
- */
- if (dwc->ulpi_ext_vbus_drv)
- reg |= DWC3_GUSB2PHYCFG_ULPIEXTVBUSDRV;
- dwc3_writel(dwc, DWC3_GUSB2PHYCFG(index), reg);
- return 0;
- }
- /**
- * dwc3_phy_setup - Configure USB PHY Interface of DWC3 Core
- * @dwc: Pointer to our controller context structure
- *
- * Returns 0 on success. The USB PHY interfaces are configured but not
- * initialized. The PHY interfaces and the PHYs get initialized together with
- * the core in dwc3_core_init.
- */
- static int dwc3_phy_setup(struct dwc3 *dwc)
- {
- int i;
- int ret;
- for (i = 0; i < dwc->num_usb3_ports; i++) {
- ret = dwc3_ss_phy_setup(dwc, i);
- if (ret)
- return ret;
- }
- for (i = 0; i < dwc->num_usb2_ports; i++) {
- ret = dwc3_hs_phy_setup(dwc, i);
- if (ret)
- return ret;
- }
- return 0;
- }
- static int dwc3_phy_init(struct dwc3 *dwc)
- {
- int ret;
- int i;
- int j;
- usb_phy_init(dwc->usb2_phy);
- usb_phy_init(dwc->usb3_phy);
- for (i = 0; i < dwc->num_usb2_ports; i++) {
- ret = phy_init(dwc->usb2_generic_phy[i]);
- if (ret < 0)
- goto err_exit_usb2_phy;
- }
- for (j = 0; j < dwc->num_usb3_ports; j++) {
- ret = phy_init(dwc->usb3_generic_phy[j]);
- if (ret < 0)
- goto err_exit_usb3_phy;
- }
- /*
- * Above DWC_usb3.0 1.94a, it is recommended to set
- * DWC3_GUSB3PIPECTL_SUSPHY and DWC3_GUSB2PHYCFG_SUSPHY to '0' during
- * coreConsultant configuration. So default value will be '0' when the
- * core is reset. Application needs to set it to '1' after the core
- * initialization is completed.
- *
- * Certain phy requires to be in P0 power state during initialization.
- * Make sure GUSB3PIPECTL.SUSPENDENABLE and GUSB2PHYCFG.SUSPHY are clear
- * prior to phy init to maintain in the P0 state.
- *
- * After phy initialization, some phy operations can only be executed
- * while in lower P states. Ensure GUSB3PIPECTL.SUSPENDENABLE and
- * GUSB2PHYCFG.SUSPHY are set soon after initialization to avoid
- * blocking phy ops.
- */
- if (!DWC3_VER_IS_WITHIN(DWC3, ANY, 194A))
- dwc3_enable_susphy(dwc, true);
- return 0;
- err_exit_usb3_phy:
- while (--j >= 0)
- phy_exit(dwc->usb3_generic_phy[j]);
- err_exit_usb2_phy:
- while (--i >= 0)
- phy_exit(dwc->usb2_generic_phy[i]);
- usb_phy_shutdown(dwc->usb3_phy);
- usb_phy_shutdown(dwc->usb2_phy);
- return ret;
- }
- static void dwc3_phy_exit(struct dwc3 *dwc)
- {
- int i;
- for (i = 0; i < dwc->num_usb3_ports; i++)
- phy_exit(dwc->usb3_generic_phy[i]);
- for (i = 0; i < dwc->num_usb2_ports; i++)
- phy_exit(dwc->usb2_generic_phy[i]);
- usb_phy_shutdown(dwc->usb3_phy);
- usb_phy_shutdown(dwc->usb2_phy);
- }
- static int dwc3_phy_power_on(struct dwc3 *dwc)
- {
- int ret;
- int i;
- int j;
- usb_phy_set_suspend(dwc->usb2_phy, 0);
- usb_phy_set_suspend(dwc->usb3_phy, 0);
- for (i = 0; i < dwc->num_usb2_ports; i++) {
- ret = phy_power_on(dwc->usb2_generic_phy[i]);
- if (ret < 0)
- goto err_power_off_usb2_phy;
- }
- for (j = 0; j < dwc->num_usb3_ports; j++) {
- ret = phy_power_on(dwc->usb3_generic_phy[j]);
- if (ret < 0)
- goto err_power_off_usb3_phy;
- }
- return 0;
- err_power_off_usb3_phy:
- while (--j >= 0)
- phy_power_off(dwc->usb3_generic_phy[j]);
- err_power_off_usb2_phy:
- while (--i >= 0)
- phy_power_off(dwc->usb2_generic_phy[i]);
- usb_phy_set_suspend(dwc->usb3_phy, 1);
- usb_phy_set_suspend(dwc->usb2_phy, 1);
- return ret;
- }
- static void dwc3_phy_power_off(struct dwc3 *dwc)
- {
- int i;
- for (i = 0; i < dwc->num_usb3_ports; i++)
- phy_power_off(dwc->usb3_generic_phy[i]);
- for (i = 0; i < dwc->num_usb2_ports; i++)
- phy_power_off(dwc->usb2_generic_phy[i]);
- usb_phy_set_suspend(dwc->usb3_phy, 1);
- usb_phy_set_suspend(dwc->usb2_phy, 1);
- }
- static int dwc3_clk_enable(struct dwc3 *dwc)
- {
- int ret;
- ret = clk_prepare_enable(dwc->bus_clk);
- if (ret)
- return ret;
- ret = clk_prepare_enable(dwc->ref_clk);
- if (ret)
- goto disable_bus_clk;
- ret = clk_prepare_enable(dwc->susp_clk);
- if (ret)
- goto disable_ref_clk;
- ret = clk_prepare_enable(dwc->utmi_clk);
- if (ret)
- goto disable_susp_clk;
- ret = clk_prepare_enable(dwc->pipe_clk);
- if (ret)
- goto disable_utmi_clk;
- return 0;
- disable_utmi_clk:
- clk_disable_unprepare(dwc->utmi_clk);
- disable_susp_clk:
- clk_disable_unprepare(dwc->susp_clk);
- disable_ref_clk:
- clk_disable_unprepare(dwc->ref_clk);
- disable_bus_clk:
- clk_disable_unprepare(dwc->bus_clk);
- return ret;
- }
- static void dwc3_clk_disable(struct dwc3 *dwc)
- {
- clk_disable_unprepare(dwc->pipe_clk);
- clk_disable_unprepare(dwc->utmi_clk);
- clk_disable_unprepare(dwc->susp_clk);
- clk_disable_unprepare(dwc->ref_clk);
- clk_disable_unprepare(dwc->bus_clk);
- }
- void dwc3_core_exit(struct dwc3 *dwc)
- {
- dwc3_event_buffers_cleanup(dwc);
- dwc3_phy_power_off(dwc);
- dwc3_phy_exit(dwc);
- dwc3_clk_disable(dwc);
- reset_control_assert(dwc->reset);
- }
- EXPORT_SYMBOL_GPL(dwc3_core_exit);
- static bool dwc3_core_is_valid(struct dwc3 *dwc)
- {
- u32 reg;
- reg = dwc3_readl(dwc, DWC3_GSNPSID);
- dwc->ip = DWC3_GSNPS_ID(reg);
- if (dwc->ip == DWC4_IP)
- dwc->ip = DWC32_IP;
- /* This should read as U3 followed by revision number */
- if (DWC3_IP_IS(DWC3)) {
- dwc->revision = reg;
- } else if (DWC3_IP_IS(DWC31) || DWC3_IP_IS(DWC32)) {
- dwc->revision = dwc3_readl(dwc, DWC3_VER_NUMBER);
- dwc->version_type = dwc3_readl(dwc, DWC3_VER_TYPE);
- } else {
- return false;
- }
- return true;
- }
- static void dwc3_core_setup_global_control(struct dwc3 *dwc)
- {
- unsigned int power_opt;
- unsigned int hw_mode;
- u32 reg;
- reg = dwc3_readl(dwc, DWC3_GCTL);
- reg &= ~DWC3_GCTL_SCALEDOWN_MASK;
- hw_mode = DWC3_GHWPARAMS0_MODE(dwc->hwparams.hwparams0);
- power_opt = DWC3_GHWPARAMS1_EN_PWROPT(dwc->hwparams.hwparams1);
- switch (power_opt) {
- case DWC3_GHWPARAMS1_EN_PWROPT_CLK:
- /**
- * WORKAROUND: DWC3 revisions between 2.10a and 2.50a have an
- * issue which would cause xHCI compliance tests to fail.
- *
- * Because of that we cannot enable clock gating on such
- * configurations.
- *
- * Refers to:
- *
- * STAR#9000588375: Clock Gating, SOF Issues when ref_clk-Based
- * SOF/ITP Mode Used
- */
- if ((dwc->dr_mode == USB_DR_MODE_HOST ||
- dwc->dr_mode == USB_DR_MODE_OTG) &&
- DWC3_VER_IS_WITHIN(DWC3, 210A, 250A))
- reg |= DWC3_GCTL_DSBLCLKGTNG | DWC3_GCTL_SOFITPSYNC;
- else
- reg &= ~DWC3_GCTL_DSBLCLKGTNG;
- break;
- case DWC3_GHWPARAMS1_EN_PWROPT_HIB:
- /*
- * REVISIT Enabling this bit so that host-mode hibernation
- * will work. Device-mode hibernation is not yet implemented.
- */
- reg |= DWC3_GCTL_GBLHIBERNATIONEN;
- break;
- default:
- /* nothing */
- break;
- }
- /*
- * This is a workaround for STAR#4846132, which only affects
- * DWC_usb31 version2.00a operating in host mode.
- *
- * There is a problem in DWC_usb31 version 2.00a operating
- * in host mode that would cause a CSR read timeout When CSR
- * read coincides with RAM Clock Gating Entry. By disable
- * Clock Gating, sacrificing power consumption for normal
- * operation.
- */
- if (power_opt != DWC3_GHWPARAMS1_EN_PWROPT_NO &&
- hw_mode != DWC3_GHWPARAMS0_MODE_GADGET && DWC3_VER_IS(DWC31, 200A))
- reg |= DWC3_GCTL_DSBLCLKGTNG;
- /* check if current dwc3 is on simulation board */
- if (dwc->hwparams.hwparams6 & DWC3_GHWPARAMS6_EN_FPGA) {
- dev_info(dwc->dev, "Running with FPGA optimizations\n");
- dwc->is_fpga = true;
- }
- WARN_ONCE(dwc->disable_scramble_quirk && !dwc->is_fpga,
- "disable_scramble cannot be used on non-FPGA builds\n");
- if (dwc->disable_scramble_quirk && dwc->is_fpga)
- reg |= DWC3_GCTL_DISSCRAMBLE;
- else
- reg &= ~DWC3_GCTL_DISSCRAMBLE;
- if (dwc->u2exit_lfps_quirk)
- reg |= DWC3_GCTL_U2EXIT_LFPS;
- /*
- * WORKAROUND: DWC3 revisions <1.90a have a bug
- * where the device can fail to connect at SuperSpeed
- * and falls back to high-speed mode which causes
- * the device to enter a Connect/Disconnect loop
- */
- if (DWC3_VER_IS_PRIOR(DWC3, 190A))
- reg |= DWC3_GCTL_U2RSTECN;
- dwc3_writel(dwc, DWC3_GCTL, reg);
- }
- static int dwc3_core_get_phy(struct dwc3 *dwc);
- static int dwc3_core_ulpi_init(struct dwc3 *dwc);
- /* set global incr burst type configuration registers */
- static void dwc3_set_incr_burst_type(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- /* incrx_mode : for INCR burst type. */
- bool incrx_mode;
- /* incrx_size : for size of INCRX burst. */
- u32 incrx_size;
- u32 *vals;
- u32 cfg;
- int ntype;
- int ret;
- int i;
- cfg = dwc3_readl(dwc, DWC3_GSBUSCFG0);
- /*
- * Handle property "snps,incr-burst-type-adjustment".
- * Get the number of value from this property:
- * result <= 0, means this property is not supported.
- * result = 1, means INCRx burst mode supported.
- * result > 1, means undefined length burst mode supported.
- */
- ntype = device_property_count_u32(dev, "snps,incr-burst-type-adjustment");
- if (ntype <= 0)
- return;
- vals = kcalloc(ntype, sizeof(u32), GFP_KERNEL);
- if (!vals)
- return;
- /* Get INCR burst type, and parse it */
- ret = device_property_read_u32_array(dev,
- "snps,incr-burst-type-adjustment", vals, ntype);
- if (ret) {
- kfree(vals);
- dev_err(dev, "Error to get property\n");
- return;
- }
- incrx_size = *vals;
- if (ntype > 1) {
- /* INCRX (undefined length) burst mode */
- incrx_mode = INCRX_UNDEF_LENGTH_BURST_MODE;
- for (i = 1; i < ntype; i++) {
- if (vals[i] > incrx_size)
- incrx_size = vals[i];
- }
- } else {
- /* INCRX burst mode */
- incrx_mode = INCRX_BURST_MODE;
- }
- kfree(vals);
- /* Enable Undefined Length INCR Burst and Enable INCRx Burst */
- cfg &= ~DWC3_GSBUSCFG0_INCRBRST_MASK;
- if (incrx_mode)
- cfg |= DWC3_GSBUSCFG0_INCRBRSTENA;
- switch (incrx_size) {
- case 256:
- cfg |= DWC3_GSBUSCFG0_INCR256BRSTENA;
- break;
- case 128:
- cfg |= DWC3_GSBUSCFG0_INCR128BRSTENA;
- break;
- case 64:
- cfg |= DWC3_GSBUSCFG0_INCR64BRSTENA;
- break;
- case 32:
- cfg |= DWC3_GSBUSCFG0_INCR32BRSTENA;
- break;
- case 16:
- cfg |= DWC3_GSBUSCFG0_INCR16BRSTENA;
- break;
- case 8:
- cfg |= DWC3_GSBUSCFG0_INCR8BRSTENA;
- break;
- case 4:
- cfg |= DWC3_GSBUSCFG0_INCR4BRSTENA;
- break;
- case 1:
- break;
- default:
- dev_err(dev, "Invalid property\n");
- break;
- }
- dwc3_writel(dwc, DWC3_GSBUSCFG0, cfg);
- }
- static void dwc3_set_power_down_clk_scale(struct dwc3 *dwc)
- {
- u32 scale;
- u32 reg;
- if (!dwc->susp_clk)
- return;
- /*
- * The power down scale field specifies how many suspend_clk
- * periods fit into a 16KHz clock period. When performing
- * the division, round up the remainder.
- *
- * The power down scale value is calculated using the fastest
- * frequency of the suspend_clk. If it isn't fixed (but within
- * the accuracy requirement), the driver may not know the max
- * rate of the suspend_clk, so only update the power down scale
- * if the default is less than the calculated value from
- * clk_get_rate() or if the default is questionably high
- * (3x or more) to be within the requirement.
- */
- scale = DIV_ROUND_UP(clk_get_rate(dwc->susp_clk), 16000);
- reg = dwc3_readl(dwc, DWC3_GCTL);
- if ((reg & DWC3_GCTL_PWRDNSCALE_MASK) < DWC3_GCTL_PWRDNSCALE(scale) ||
- (reg & DWC3_GCTL_PWRDNSCALE_MASK) > DWC3_GCTL_PWRDNSCALE(scale*3)) {
- reg &= ~(DWC3_GCTL_PWRDNSCALE_MASK);
- reg |= DWC3_GCTL_PWRDNSCALE(scale);
- dwc3_writel(dwc, DWC3_GCTL, reg);
- }
- }
- static void dwc3_config_threshold(struct dwc3 *dwc)
- {
- u32 reg;
- u8 rx_thr_num;
- u8 rx_maxburst;
- u8 tx_thr_num;
- u8 tx_maxburst;
- /*
- * Must config both number of packets and max burst settings to enable
- * RX and/or TX threshold.
- */
- if (!DWC3_IP_IS(DWC3) && dwc->dr_mode == USB_DR_MODE_HOST) {
- rx_thr_num = dwc->rx_thr_num_pkt_prd;
- rx_maxburst = dwc->rx_max_burst_prd;
- tx_thr_num = dwc->tx_thr_num_pkt_prd;
- tx_maxburst = dwc->tx_max_burst_prd;
- if (rx_thr_num && rx_maxburst) {
- reg = dwc3_readl(dwc, DWC3_GRXTHRCFG);
- reg |= DWC31_RXTHRNUMPKTSEL_PRD;
- reg &= ~DWC31_RXTHRNUMPKT_PRD(~0);
- reg |= DWC31_RXTHRNUMPKT_PRD(rx_thr_num);
- reg &= ~DWC31_MAXRXBURSTSIZE_PRD(~0);
- reg |= DWC31_MAXRXBURSTSIZE_PRD(rx_maxburst);
- dwc3_writel(dwc, DWC3_GRXTHRCFG, reg);
- }
- if (tx_thr_num && tx_maxburst) {
- reg = dwc3_readl(dwc, DWC3_GTXTHRCFG);
- reg |= DWC31_TXTHRNUMPKTSEL_PRD;
- reg &= ~DWC31_TXTHRNUMPKT_PRD(~0);
- reg |= DWC31_TXTHRNUMPKT_PRD(tx_thr_num);
- reg &= ~DWC31_MAXTXBURSTSIZE_PRD(~0);
- reg |= DWC31_MAXTXBURSTSIZE_PRD(tx_maxburst);
- dwc3_writel(dwc, DWC3_GTXTHRCFG, reg);
- }
- }
- rx_thr_num = dwc->rx_thr_num_pkt;
- rx_maxburst = dwc->rx_max_burst;
- tx_thr_num = dwc->tx_thr_num_pkt;
- tx_maxburst = dwc->tx_max_burst;
- if (DWC3_IP_IS(DWC3)) {
- if (rx_thr_num && rx_maxburst) {
- reg = dwc3_readl(dwc, DWC3_GRXTHRCFG);
- reg |= DWC3_GRXTHRCFG_PKTCNTSEL;
- reg &= ~DWC3_GRXTHRCFG_RXPKTCNT(~0);
- reg |= DWC3_GRXTHRCFG_RXPKTCNT(rx_thr_num);
- reg &= ~DWC3_GRXTHRCFG_MAXRXBURSTSIZE(~0);
- reg |= DWC3_GRXTHRCFG_MAXRXBURSTSIZE(rx_maxburst);
- dwc3_writel(dwc, DWC3_GRXTHRCFG, reg);
- }
- if (tx_thr_num && tx_maxburst) {
- reg = dwc3_readl(dwc, DWC3_GTXTHRCFG);
- reg |= DWC3_GTXTHRCFG_PKTCNTSEL;
- reg &= ~DWC3_GTXTHRCFG_TXPKTCNT(~0);
- reg |= DWC3_GTXTHRCFG_TXPKTCNT(tx_thr_num);
- reg &= ~DWC3_GTXTHRCFG_MAXTXBURSTSIZE(~0);
- reg |= DWC3_GTXTHRCFG_MAXTXBURSTSIZE(tx_maxburst);
- dwc3_writel(dwc, DWC3_GTXTHRCFG, reg);
- }
- } else {
- if (rx_thr_num && rx_maxburst) {
- reg = dwc3_readl(dwc, DWC3_GRXTHRCFG);
- reg |= DWC31_GRXTHRCFG_PKTCNTSEL;
- reg &= ~DWC31_GRXTHRCFG_RXPKTCNT(~0);
- reg |= DWC31_GRXTHRCFG_RXPKTCNT(rx_thr_num);
- reg &= ~DWC31_GRXTHRCFG_MAXRXBURSTSIZE(~0);
- reg |= DWC31_GRXTHRCFG_MAXRXBURSTSIZE(rx_maxburst);
- dwc3_writel(dwc, DWC3_GRXTHRCFG, reg);
- }
- if (tx_thr_num && tx_maxburst) {
- reg = dwc3_readl(dwc, DWC3_GTXTHRCFG);
- reg |= DWC31_GTXTHRCFG_PKTCNTSEL;
- reg &= ~DWC31_GTXTHRCFG_TXPKTCNT(~0);
- reg |= DWC31_GTXTHRCFG_TXPKTCNT(tx_thr_num);
- reg &= ~DWC31_GTXTHRCFG_MAXTXBURSTSIZE(~0);
- reg |= DWC31_GTXTHRCFG_MAXTXBURSTSIZE(tx_maxburst);
- dwc3_writel(dwc, DWC3_GTXTHRCFG, reg);
- }
- }
- }
- /**
- * dwc3_core_init - Low-level initialization of DWC3 Core
- * @dwc: Pointer to our controller context structure
- *
- * Returns 0 on success otherwise negative errno.
- */
- int dwc3_core_init(struct dwc3 *dwc)
- {
- unsigned int hw_mode;
- u32 reg;
- int ret;
- hw_mode = DWC3_GHWPARAMS0_MODE(dwc->hwparams.hwparams0);
- /*
- * Write Linux Version Code to our GUID register so it's easy to figure
- * out which kernel version a bug was found.
- */
- dwc3_writel(dwc, DWC3_GUID, LINUX_VERSION_CODE);
- ret = dwc3_phy_setup(dwc);
- if (ret)
- return ret;
- if (!dwc->ulpi_ready) {
- ret = dwc3_core_ulpi_init(dwc);
- if (ret) {
- if (ret == -ETIMEDOUT) {
- dwc3_core_soft_reset(dwc);
- ret = -EPROBE_DEFER;
- }
- return ret;
- }
- dwc->ulpi_ready = true;
- }
- if (!dwc->phys_ready) {
- ret = dwc3_core_get_phy(dwc);
- if (ret)
- goto err_exit_ulpi;
- dwc->phys_ready = true;
- }
- ret = dwc3_phy_init(dwc);
- if (ret)
- goto err_exit_ulpi;
- ret = dwc3_core_soft_reset(dwc);
- if (ret)
- goto err_exit_phy;
- dwc3_core_setup_global_control(dwc);
- dwc3_core_num_eps(dwc);
- /* Set power down scale of suspend_clk */
- dwc3_set_power_down_clk_scale(dwc);
- /* Adjust Frame Length */
- dwc3_frame_length_adjustment(dwc);
- /* Adjust Reference Clock Period */
- dwc3_ref_clk_period(dwc);
- dwc3_set_incr_burst_type(dwc);
- dwc3_config_soc_bus(dwc);
- ret = dwc3_phy_power_on(dwc);
- if (ret)
- goto err_exit_phy;
- ret = dwc3_event_buffers_setup(dwc);
- if (ret) {
- dev_err(dwc->dev, "failed to setup event buffers\n");
- goto err_power_off_phy;
- }
- /*
- * ENDXFER polling is available on version 3.10a and later of
- * the DWC_usb3 controller. It is NOT available in the
- * DWC_usb31 controller.
- */
- if (DWC3_VER_IS_WITHIN(DWC3, 310A, ANY)) {
- reg = dwc3_readl(dwc, DWC3_GUCTL2);
- reg |= DWC3_GUCTL2_RST_ACTBITLATER;
- dwc3_writel(dwc, DWC3_GUCTL2, reg);
- }
- /*
- * STAR 9001285599: This issue affects DWC_usb3 version 3.20a
- * only. If the PM TIMER ECM is enabled through GUCTL2[19], the
- * link compliance test (TD7.21) may fail. If the ECN is not
- * enabled (GUCTL2[19] = 0), the controller will use the old timer
- * value (5us), which is still acceptable for the link compliance
- * test. Therefore, do not enable PM TIMER ECM in 3.20a by
- * setting GUCTL2[19] by default; instead, use GUCTL2[19] = 0.
- */
- if (DWC3_VER_IS(DWC3, 320A)) {
- reg = dwc3_readl(dwc, DWC3_GUCTL2);
- reg &= ~DWC3_GUCTL2_LC_TIMER;
- dwc3_writel(dwc, DWC3_GUCTL2, reg);
- }
- /*
- * When configured in HOST mode, after issuing U3/L2 exit controller
- * fails to send proper CRC checksum in CRC5 field. Because of this
- * behaviour Transaction Error is generated, resulting in reset and
- * re-enumeration of usb device attached. All the termsel, xcvrsel,
- * opmode becomes 0 during end of resume. Enabling bit 10 of GUCTL1
- * will correct this problem. This option is to support certain
- * legacy ULPI PHYs.
- */
- if (dwc->resume_hs_terminations) {
- reg = dwc3_readl(dwc, DWC3_GUCTL1);
- reg |= DWC3_GUCTL1_RESUME_OPMODE_HS_HOST;
- dwc3_writel(dwc, DWC3_GUCTL1, reg);
- }
- if (!DWC3_VER_IS_PRIOR(DWC3, 250A)) {
- reg = dwc3_readl(dwc, DWC3_GUCTL1);
- /*
- * Enable hardware control of sending remote wakeup
- * in HS when the device is in the L1 state.
- */
- if (!DWC3_VER_IS_PRIOR(DWC3, 290A))
- reg |= DWC3_GUCTL1_DEV_L1_EXIT_BY_HW;
- /*
- * Decouple USB 2.0 L1 & L2 events which will allow for
- * gadget driver to only receive U3/L2 suspend & wakeup
- * events and prevent the more frequent L1 LPM transitions
- * from interrupting the driver.
- */
- if (!DWC3_VER_IS_PRIOR(DWC3, 300A))
- reg |= DWC3_GUCTL1_DEV_DECOUPLE_L1L2_EVT;
- if (dwc->dis_tx_ipgap_linecheck_quirk)
- reg |= DWC3_GUCTL1_TX_IPGAP_LINECHECK_DIS;
- if (dwc->parkmode_disable_ss_quirk)
- reg |= DWC3_GUCTL1_PARKMODE_DISABLE_SS;
- if (dwc->parkmode_disable_hs_quirk)
- reg |= DWC3_GUCTL1_PARKMODE_DISABLE_HS;
- if (DWC3_VER_IS_WITHIN(DWC3, 290A, ANY)) {
- if (dwc->maximum_speed == USB_SPEED_FULL ||
- dwc->maximum_speed == USB_SPEED_HIGH)
- reg |= DWC3_GUCTL1_DEV_FORCE_20_CLK_FOR_30_CLK;
- else
- reg &= ~DWC3_GUCTL1_DEV_FORCE_20_CLK_FOR_30_CLK;
- }
- dwc3_writel(dwc, DWC3_GUCTL1, reg);
- }
- dwc3_config_threshold(dwc);
- if (hw_mode != DWC3_GHWPARAMS0_MODE_GADGET &&
- (DWC3_IP_IS(DWC31)) &&
- dwc->maximum_speed == USB_SPEED_SUPER) {
- int i;
- for (i = 0; i < dwc->num_usb3_ports; i++) {
- reg = dwc3_readl(dwc, DWC3_LLUCTL(i));
- reg |= DWC3_LLUCTL_FORCE_GEN1;
- dwc3_writel(dwc, DWC3_LLUCTL(i), reg);
- }
- }
- /*
- * STAR 9001346572: This issue affects DWC_usb31 versions 1.80a and
- * prior. When an active endpoint not currently cached in the host
- * controller is chosen to be cached to the same index as an endpoint
- * receiving NAKs, the endpoint receiving NAKs enters continuous
- * retry mode. This prevents it from being evicted from the host
- * controller cache, blocking the new endpoint from being cached and
- * serviced.
- *
- * To resolve this, for controller versions 1.70a and 1.80a, set the
- * GUCTL3 bit[16] (USB2.0 Internal Retry Disable) to 1. This bit
- * disables the USB2.0 internal retry feature. The GUCTL3[16] register
- * function is available only from version 1.70a.
- */
- if (DWC3_VER_IS_WITHIN(DWC31, 170A, 180A)) {
- reg = dwc3_readl(dwc, DWC3_GUCTL3);
- reg |= DWC3_GUCTL3_USB20_RETRY_DISABLE;
- dwc3_writel(dwc, DWC3_GUCTL3, reg);
- }
- return 0;
- err_power_off_phy:
- dwc3_phy_power_off(dwc);
- err_exit_phy:
- dwc3_phy_exit(dwc);
- err_exit_ulpi:
- dwc3_ulpi_exit(dwc);
- return ret;
- }
- EXPORT_SYMBOL_GPL(dwc3_core_init);
- static int dwc3_core_get_phy(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- struct device_node *node = dev->of_node;
- char phy_name[9];
- int ret;
- u8 i;
- if (node) {
- dwc->usb2_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 0);
- dwc->usb3_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 1);
- } else {
- dwc->usb2_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2);
- dwc->usb3_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3);
- }
- if (IS_ERR(dwc->usb2_phy)) {
- ret = PTR_ERR(dwc->usb2_phy);
- if (ret == -ENXIO || ret == -ENODEV)
- dwc->usb2_phy = NULL;
- else
- return dev_err_probe(dev, ret, "no usb2 phy configured\n");
- }
- if (IS_ERR(dwc->usb3_phy)) {
- ret = PTR_ERR(dwc->usb3_phy);
- if (ret == -ENXIO || ret == -ENODEV)
- dwc->usb3_phy = NULL;
- else
- return dev_err_probe(dev, ret, "no usb3 phy configured\n");
- }
- for (i = 0; i < dwc->num_usb2_ports; i++) {
- if (dwc->num_usb2_ports == 1)
- snprintf(phy_name, sizeof(phy_name), "usb2-phy");
- else
- snprintf(phy_name, sizeof(phy_name), "usb2-%u", i);
- dwc->usb2_generic_phy[i] = devm_phy_get(dev, phy_name);
- if (IS_ERR(dwc->usb2_generic_phy[i])) {
- ret = PTR_ERR(dwc->usb2_generic_phy[i]);
- if (ret == -ENOSYS || ret == -ENODEV)
- dwc->usb2_generic_phy[i] = NULL;
- else
- return dev_err_probe(dev, ret, "failed to lookup phy %s\n",
- phy_name);
- }
- }
- for (i = 0; i < dwc->num_usb3_ports; i++) {
- if (dwc->num_usb3_ports == 1)
- snprintf(phy_name, sizeof(phy_name), "usb3-phy");
- else
- snprintf(phy_name, sizeof(phy_name), "usb3-%u", i);
- dwc->usb3_generic_phy[i] = devm_phy_get(dev, phy_name);
- if (IS_ERR(dwc->usb3_generic_phy[i])) {
- ret = PTR_ERR(dwc->usb3_generic_phy[i]);
- if (ret == -ENOSYS || ret == -ENODEV)
- dwc->usb3_generic_phy[i] = NULL;
- else
- return dev_err_probe(dev, ret, "failed to lookup phy %s\n",
- phy_name);
- }
- }
- return 0;
- }
- static int dwc3_core_init_mode(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- int ret;
- int i;
- switch (dwc->dr_mode) {
- case USB_DR_MODE_PERIPHERAL:
- dwc3_set_prtcap(dwc, DWC3_GCTL_PRTCAP_DEVICE, false);
- if (dwc->usb2_phy)
- otg_set_vbus(dwc->usb2_phy->otg, false);
- phy_set_mode(dwc->usb2_generic_phy[0], PHY_MODE_USB_DEVICE);
- phy_set_mode(dwc->usb3_generic_phy[0], PHY_MODE_USB_DEVICE);
- ret = dwc3_gadget_init(dwc);
- if (ret)
- return dev_err_probe(dev, ret, "failed to initialize gadget\n");
- break;
- case USB_DR_MODE_HOST:
- dwc3_set_prtcap(dwc, DWC3_GCTL_PRTCAP_HOST, false);
- if (dwc->usb2_phy)
- otg_set_vbus(dwc->usb2_phy->otg, true);
- for (i = 0; i < dwc->num_usb2_ports; i++)
- phy_set_mode(dwc->usb2_generic_phy[i], PHY_MODE_USB_HOST);
- for (i = 0; i < dwc->num_usb3_ports; i++)
- phy_set_mode(dwc->usb3_generic_phy[i], PHY_MODE_USB_HOST);
- ret = dwc3_host_init(dwc);
- if (ret)
- return dev_err_probe(dev, ret, "failed to initialize host\n");
- break;
- case USB_DR_MODE_OTG:
- INIT_WORK(&dwc->drd_work, __dwc3_set_mode);
- ret = dwc3_drd_init(dwc);
- if (ret)
- return dev_err_probe(dev, ret, "failed to initialize dual-role\n");
- break;
- default:
- dev_err(dev, "Unsupported mode of operation %d\n", dwc->dr_mode);
- return -EINVAL;
- }
- return 0;
- }
- static void dwc3_core_exit_mode(struct dwc3 *dwc)
- {
- switch (dwc->dr_mode) {
- case USB_DR_MODE_PERIPHERAL:
- dwc3_gadget_exit(dwc);
- break;
- case USB_DR_MODE_HOST:
- dwc3_host_exit(dwc);
- break;
- case USB_DR_MODE_OTG:
- dwc3_drd_exit(dwc);
- break;
- default:
- /* do nothing */
- break;
- }
- /* de-assert DRVVBUS for HOST and OTG mode */
- dwc3_set_prtcap(dwc, DWC3_GCTL_PRTCAP_DEVICE, true);
- }
- static void dwc3_get_software_properties(struct dwc3 *dwc,
- const struct dwc3_properties *properties)
- {
- struct device *tmpdev;
- u16 gsbuscfg0_reqinfo;
- int ret;
- dwc->gsbuscfg0_reqinfo = DWC3_GSBUSCFG0_REQINFO_UNSPECIFIED;
- if (properties->gsbuscfg0_reqinfo !=
- DWC3_GSBUSCFG0_REQINFO_UNSPECIFIED) {
- dwc->gsbuscfg0_reqinfo = properties->gsbuscfg0_reqinfo;
- return;
- }
- /*
- * Iterate over all parent nodes for finding swnode properties
- * and non-DT (non-ABI) properties.
- */
- for (tmpdev = dwc->dev; tmpdev; tmpdev = tmpdev->parent) {
- ret = device_property_read_u16(tmpdev,
- "snps,gsbuscfg0-reqinfo",
- &gsbuscfg0_reqinfo);
- if (!ret)
- dwc->gsbuscfg0_reqinfo = gsbuscfg0_reqinfo;
- }
- }
- static void dwc3_get_properties(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- u8 lpm_nyet_threshold;
- u8 tx_de_emphasis;
- u8 hird_threshold;
- u8 rx_thr_num_pkt = 0;
- u8 rx_max_burst = 0;
- u8 tx_thr_num_pkt = 0;
- u8 tx_max_burst = 0;
- u8 rx_thr_num_pkt_prd = 0;
- u8 rx_max_burst_prd = 0;
- u8 tx_thr_num_pkt_prd = 0;
- u8 tx_max_burst_prd = 0;
- u8 tx_fifo_resize_max_num;
- u16 num_hc_interrupters;
- /* default to highest possible threshold */
- lpm_nyet_threshold = 0xf;
- /* default to -3.5dB de-emphasis */
- tx_de_emphasis = 1;
- /*
- * default to assert utmi_sleep_n and use maximum allowed HIRD
- * threshold value of 0b1100
- */
- hird_threshold = 12;
- /*
- * default to a TXFIFO size large enough to fit 6 max packets. This
- * allows for systems with larger bus latencies to have some headroom
- * for endpoints that have a large bMaxBurst value.
- */
- tx_fifo_resize_max_num = 6;
- /* default to a single XHCI interrupter */
- num_hc_interrupters = 1;
- dwc->maximum_speed = usb_get_maximum_speed(dev);
- dwc->max_ssp_rate = usb_get_maximum_ssp_rate(dev);
- dwc->dr_mode = usb_get_dr_mode(dev);
- dwc->hsphy_mode = of_usb_get_phy_mode(dev->of_node);
- dwc->sysdev_is_parent = device_property_read_bool(dev,
- "linux,sysdev_is_parent");
- if (dwc->sysdev_is_parent)
- dwc->sysdev = dwc->dev->parent;
- else
- dwc->sysdev = dwc->dev;
- dwc->sys_wakeup = device_may_wakeup(dwc->sysdev);
- dwc->has_lpm_erratum = device_property_read_bool(dev,
- "snps,has-lpm-erratum");
- device_property_read_u8(dev, "snps,lpm-nyet-threshold",
- &lpm_nyet_threshold);
- dwc->is_utmi_l1_suspend = device_property_read_bool(dev,
- "snps,is-utmi-l1-suspend");
- device_property_read_u8(dev, "snps,hird-threshold",
- &hird_threshold);
- dwc->dis_start_transfer_quirk = device_property_read_bool(dev,
- "snps,dis-start-transfer-quirk");
- dwc->usb3_lpm_capable = device_property_read_bool(dev,
- "snps,usb3_lpm_capable");
- dwc->usb2_lpm_disable = device_property_read_bool(dev,
- "snps,usb2-lpm-disable");
- dwc->usb2_gadget_lpm_disable = device_property_read_bool(dev,
- "snps,usb2-gadget-lpm-disable");
- device_property_read_u8(dev, "snps,rx-thr-num-pkt",
- &rx_thr_num_pkt);
- device_property_read_u8(dev, "snps,rx-max-burst",
- &rx_max_burst);
- device_property_read_u8(dev, "snps,tx-thr-num-pkt",
- &tx_thr_num_pkt);
- device_property_read_u8(dev, "snps,tx-max-burst",
- &tx_max_burst);
- device_property_read_u8(dev, "snps,rx-thr-num-pkt-prd",
- &rx_thr_num_pkt_prd);
- device_property_read_u8(dev, "snps,rx-max-burst-prd",
- &rx_max_burst_prd);
- device_property_read_u8(dev, "snps,tx-thr-num-pkt-prd",
- &tx_thr_num_pkt_prd);
- device_property_read_u8(dev, "snps,tx-max-burst-prd",
- &tx_max_burst_prd);
- device_property_read_u16(dev, "num-hc-interrupters",
- &num_hc_interrupters);
- /* DWC3 core allowed to have a max of 8 interrupters */
- if (num_hc_interrupters > 8)
- num_hc_interrupters = 8;
- dwc->do_fifo_resize = device_property_read_bool(dev,
- "tx-fifo-resize");
- if (dwc->do_fifo_resize)
- device_property_read_u8(dev, "tx-fifo-max-num",
- &tx_fifo_resize_max_num);
- dwc->disable_scramble_quirk = device_property_read_bool(dev,
- "snps,disable_scramble_quirk");
- dwc->u2exit_lfps_quirk = device_property_read_bool(dev,
- "snps,u2exit_lfps_quirk");
- dwc->u2ss_inp3_quirk = device_property_read_bool(dev,
- "snps,u2ss_inp3_quirk");
- dwc->req_p1p2p3_quirk = device_property_read_bool(dev,
- "snps,req_p1p2p3_quirk");
- dwc->del_p1p2p3_quirk = device_property_read_bool(dev,
- "snps,del_p1p2p3_quirk");
- dwc->del_phy_power_chg_quirk = device_property_read_bool(dev,
- "snps,del_phy_power_chg_quirk");
- dwc->lfps_filter_quirk = device_property_read_bool(dev,
- "snps,lfps_filter_quirk");
- dwc->rx_detect_poll_quirk = device_property_read_bool(dev,
- "snps,rx_detect_poll_quirk");
- dwc->dis_u3_susphy_quirk = device_property_read_bool(dev,
- "snps,dis_u3_susphy_quirk");
- dwc->dis_u2_susphy_quirk = device_property_read_bool(dev,
- "snps,dis_u2_susphy_quirk");
- dwc->dis_enblslpm_quirk = device_property_read_bool(dev,
- "snps,dis_enblslpm_quirk");
- dwc->dis_u1_entry_quirk = device_property_read_bool(dev,
- "snps,dis-u1-entry-quirk");
- dwc->dis_u2_entry_quirk = device_property_read_bool(dev,
- "snps,dis-u2-entry-quirk");
- dwc->dis_rxdet_inp3_quirk = device_property_read_bool(dev,
- "snps,dis_rxdet_inp3_quirk");
- dwc->dis_u2_freeclk_exists_quirk = device_property_read_bool(dev,
- "snps,dis-u2-freeclk-exists-quirk");
- dwc->dis_del_phy_power_chg_quirk = device_property_read_bool(dev,
- "snps,dis-del-phy-power-chg-quirk");
- dwc->dis_tx_ipgap_linecheck_quirk = device_property_read_bool(dev,
- "snps,dis-tx-ipgap-linecheck-quirk");
- dwc->resume_hs_terminations = device_property_read_bool(dev,
- "snps,resume-hs-terminations");
- dwc->ulpi_ext_vbus_drv = device_property_read_bool(dev,
- "snps,ulpi-ext-vbus-drv");
- dwc->parkmode_disable_ss_quirk = device_property_read_bool(dev,
- "snps,parkmode-disable-ss-quirk");
- dwc->parkmode_disable_hs_quirk = device_property_read_bool(dev,
- "snps,parkmode-disable-hs-quirk");
- dwc->gfladj_refclk_lpm_sel = device_property_read_bool(dev,
- "snps,gfladj-refclk-lpm-sel-quirk");
- dwc->tx_de_emphasis_quirk = device_property_read_bool(dev,
- "snps,tx_de_emphasis_quirk");
- device_property_read_u8(dev, "snps,tx_de_emphasis",
- &tx_de_emphasis);
- device_property_read_string(dev, "snps,hsphy_interface",
- &dwc->hsphy_interface);
- device_property_read_u32(dev, "snps,quirk-frame-length-adjustment",
- &dwc->fladj);
- device_property_read_u32(dev, "snps,ref-clock-period-ns",
- &dwc->ref_clk_per);
- dwc->dis_metastability_quirk = device_property_read_bool(dev,
- "snps,dis_metastability_quirk");
- dwc->dis_split_quirk = device_property_read_bool(dev,
- "snps,dis-split-quirk");
- dwc->lpm_nyet_threshold = lpm_nyet_threshold;
- dwc->tx_de_emphasis = tx_de_emphasis;
- dwc->hird_threshold = hird_threshold;
- dwc->rx_thr_num_pkt = rx_thr_num_pkt;
- dwc->rx_max_burst = rx_max_burst;
- dwc->tx_thr_num_pkt = tx_thr_num_pkt;
- dwc->tx_max_burst = tx_max_burst;
- dwc->rx_thr_num_pkt_prd = rx_thr_num_pkt_prd;
- dwc->rx_max_burst_prd = rx_max_burst_prd;
- dwc->tx_thr_num_pkt_prd = tx_thr_num_pkt_prd;
- dwc->tx_max_burst_prd = tx_max_burst_prd;
- dwc->tx_fifo_resize_max_num = tx_fifo_resize_max_num;
- dwc->num_hc_interrupters = num_hc_interrupters;
- }
- /* check whether the core supports IMOD */
- bool dwc3_has_imod(struct dwc3 *dwc)
- {
- return DWC3_VER_IS_WITHIN(DWC3, 300A, ANY) ||
- DWC3_VER_IS_WITHIN(DWC31, 120A, ANY) ||
- DWC3_IP_IS(DWC32);
- }
- static void dwc3_check_params(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- unsigned int hwparam_gen =
- DWC3_GHWPARAMS3_SSPHY_IFC(dwc->hwparams.hwparams3);
- /*
- * Enable IMOD for all supporting controllers.
- *
- * Particularly, DWC_usb3 v3.00a must enable this feature for
- * the following reason:
- *
- * Workaround for STAR 9000961433 which affects only version
- * 3.00a of the DWC_usb3 core. This prevents the controller
- * interrupt from being masked while handling events. IMOD
- * allows us to work around this issue. Enable it for the
- * affected version.
- */
- if (dwc3_has_imod((dwc)))
- dwc->imod_interval = 1;
- /* Check the maximum_speed parameter */
- switch (dwc->maximum_speed) {
- case USB_SPEED_FULL:
- case USB_SPEED_HIGH:
- break;
- case USB_SPEED_SUPER:
- if (hwparam_gen == DWC3_GHWPARAMS3_SSPHY_IFC_DIS)
- dev_warn(dev, "UDC doesn't support Gen 1\n");
- break;
- case USB_SPEED_SUPER_PLUS:
- if ((DWC3_IP_IS(DWC32) &&
- hwparam_gen == DWC3_GHWPARAMS3_SSPHY_IFC_DIS) ||
- (!DWC3_IP_IS(DWC32) &&
- hwparam_gen != DWC3_GHWPARAMS3_SSPHY_IFC_GEN2))
- dev_warn(dev, "UDC doesn't support SSP\n");
- break;
- default:
- dev_err(dev, "invalid maximum_speed parameter %d\n",
- dwc->maximum_speed);
- fallthrough;
- case USB_SPEED_UNKNOWN:
- switch (hwparam_gen) {
- case DWC3_GHWPARAMS3_SSPHY_IFC_GEN2:
- dwc->maximum_speed = USB_SPEED_SUPER_PLUS;
- break;
- case DWC3_GHWPARAMS3_SSPHY_IFC_GEN1:
- if (DWC3_IP_IS(DWC32))
- dwc->maximum_speed = USB_SPEED_SUPER_PLUS;
- else
- dwc->maximum_speed = USB_SPEED_SUPER;
- break;
- case DWC3_GHWPARAMS3_SSPHY_IFC_DIS:
- dwc->maximum_speed = USB_SPEED_HIGH;
- break;
- default:
- dwc->maximum_speed = USB_SPEED_SUPER;
- break;
- }
- break;
- }
- /*
- * Currently the controller does not have visibility into the HW
- * parameter to determine the maximum number of lanes the HW supports.
- * If the number of lanes is not specified in the device property, then
- * set the default to support dual-lane for DWC_usb32 and single-lane
- * for DWC_usb31 for super-speed-plus.
- */
- if (dwc->maximum_speed == USB_SPEED_SUPER_PLUS) {
- switch (dwc->max_ssp_rate) {
- case USB_SSP_GEN_2x1:
- if (hwparam_gen == DWC3_GHWPARAMS3_SSPHY_IFC_GEN1)
- dev_warn(dev, "UDC only supports Gen 1\n");
- break;
- case USB_SSP_GEN_1x2:
- case USB_SSP_GEN_2x2:
- if (DWC3_IP_IS(DWC31))
- dev_warn(dev, "UDC only supports single lane\n");
- break;
- case USB_SSP_GEN_UNKNOWN:
- default:
- switch (hwparam_gen) {
- case DWC3_GHWPARAMS3_SSPHY_IFC_GEN2:
- if (DWC3_IP_IS(DWC32))
- dwc->max_ssp_rate = USB_SSP_GEN_2x2;
- else
- dwc->max_ssp_rate = USB_SSP_GEN_2x1;
- break;
- case DWC3_GHWPARAMS3_SSPHY_IFC_GEN1:
- if (DWC3_IP_IS(DWC32))
- dwc->max_ssp_rate = USB_SSP_GEN_1x2;
- break;
- }
- break;
- }
- }
- }
- static struct extcon_dev *dwc3_get_extcon(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- struct device_node *np_phy;
- struct extcon_dev *edev = NULL;
- const char *name;
- if (device_property_present(dev, "extcon"))
- return extcon_get_edev_by_phandle(dev, 0);
- /*
- * Device tree platforms should get extcon via phandle.
- * On ACPI platforms, we get the name from a device property.
- * This device property is for kernel internal use only and
- * is expected to be set by the glue code.
- */
- if (device_property_read_string(dev, "linux,extcon-name", &name) == 0)
- return extcon_get_extcon_dev(name);
- /*
- * Check explicitly if "usb-role-switch" is used since
- * extcon_find_edev_by_node() can not be used to check the absence of
- * an extcon device. In the absence of an device it will always return
- * EPROBE_DEFER.
- */
- if (IS_ENABLED(CONFIG_USB_ROLE_SWITCH) &&
- device_property_read_bool(dev, "usb-role-switch"))
- return NULL;
- /*
- * Try to get an extcon device from the USB PHY controller's "port"
- * node. Check if it has the "port" node first, to avoid printing the
- * error message from underlying code, as it's a valid case: extcon
- * device (and "port" node) may be missing in case of "usb-role-switch"
- * or OTG mode.
- */
- np_phy = of_parse_phandle(dev->of_node, "phys", 0);
- if (of_graph_is_present(np_phy)) {
- struct device_node *np_conn;
- np_conn = of_graph_get_remote_node(np_phy, -1, -1);
- if (np_conn)
- edev = extcon_find_edev_by_node(np_conn);
- of_node_put(np_conn);
- }
- of_node_put(np_phy);
- return edev;
- }
- static int dwc3_get_clocks(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- if (!dev->of_node)
- return 0;
- /*
- * Clocks are optional, but new DT platforms should support all clocks
- * as required by the DT-binding.
- * Some devices have different clock names in legacy device trees,
- * check for them to retain backwards compatibility.
- */
- dwc->bus_clk = devm_clk_get_optional(dev, "bus_early");
- if (IS_ERR(dwc->bus_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->bus_clk),
- "could not get bus clock\n");
- }
- if (dwc->bus_clk == NULL) {
- dwc->bus_clk = devm_clk_get_optional(dev, "bus_clk");
- if (IS_ERR(dwc->bus_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->bus_clk),
- "could not get bus clock\n");
- }
- }
- dwc->ref_clk = devm_clk_get_optional(dev, "ref");
- if (IS_ERR(dwc->ref_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->ref_clk),
- "could not get ref clock\n");
- }
- if (dwc->ref_clk == NULL) {
- dwc->ref_clk = devm_clk_get_optional(dev, "ref_clk");
- if (IS_ERR(dwc->ref_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->ref_clk),
- "could not get ref clock\n");
- }
- }
- dwc->susp_clk = devm_clk_get_optional(dev, "suspend");
- if (IS_ERR(dwc->susp_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->susp_clk),
- "could not get suspend clock\n");
- }
- if (dwc->susp_clk == NULL) {
- dwc->susp_clk = devm_clk_get_optional(dev, "suspend_clk");
- if (IS_ERR(dwc->susp_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->susp_clk),
- "could not get suspend clock\n");
- }
- }
- /* specific to Rockchip RK3588 */
- dwc->utmi_clk = devm_clk_get_optional(dev, "utmi");
- if (IS_ERR(dwc->utmi_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->utmi_clk),
- "could not get utmi clock\n");
- }
- /* specific to Rockchip RK3588 */
- dwc->pipe_clk = devm_clk_get_optional(dev, "pipe");
- if (IS_ERR(dwc->pipe_clk)) {
- return dev_err_probe(dev, PTR_ERR(dwc->pipe_clk),
- "could not get pipe clock\n");
- }
- return 0;
- }
- static int dwc3_get_num_ports(struct dwc3 *dwc)
- {
- void __iomem *base;
- u8 major_revision;
- u32 offset;
- u32 val;
- /*
- * Remap xHCI address space to access XHCI ext cap regs since it is
- * needed to get information on number of ports present.
- */
- base = ioremap(dwc->xhci_resources[0].start,
- resource_size(&dwc->xhci_resources[0]));
- if (!base)
- return -ENOMEM;
- offset = 0;
- do {
- offset = xhci_find_next_ext_cap(base, offset,
- XHCI_EXT_CAPS_PROTOCOL);
- if (!offset)
- break;
- val = readl(base + offset);
- major_revision = XHCI_EXT_PORT_MAJOR(val);
- val = readl(base + offset + 0x08);
- if (major_revision == 0x03) {
- dwc->num_usb3_ports += XHCI_EXT_PORT_COUNT(val);
- } else if (major_revision <= 0x02) {
- dwc->num_usb2_ports += XHCI_EXT_PORT_COUNT(val);
- } else {
- dev_warn(dwc->dev, "unrecognized port major revision %d\n",
- major_revision);
- }
- } while (1);
- dev_dbg(dwc->dev, "hs-ports: %u ss-ports: %u\n",
- dwc->num_usb2_ports, dwc->num_usb3_ports);
- iounmap(base);
- if (dwc->num_usb2_ports > DWC3_USB2_MAX_PORTS ||
- dwc->num_usb3_ports > DWC3_USB3_MAX_PORTS)
- return -EINVAL;
- return 0;
- }
- static void dwc3_vbus_draw_work(struct work_struct *work)
- {
- struct dwc3 *dwc = container_of(work, struct dwc3, vbus_draw_work);
- union power_supply_propval val = {0};
- int ret;
- val.intval = 1000 * (dwc->current_limit);
- ret = power_supply_set_property(dwc->usb_psy, POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT, &val);
- if (ret < 0)
- dev_dbg(dwc->dev, "Error (%d) setting vbus draw (%d mA)\n",
- ret, dwc->current_limit);
- }
- static struct power_supply *dwc3_get_usb_power_supply(struct dwc3 *dwc)
- {
- struct power_supply *usb_psy;
- const char *usb_psy_name;
- int ret;
- ret = device_property_read_string(dwc->dev, "usb-psy-name", &usb_psy_name);
- if (ret < 0)
- return NULL;
- usb_psy = power_supply_get_by_name(usb_psy_name);
- if (!usb_psy)
- return ERR_PTR(-EPROBE_DEFER);
- INIT_WORK(&dwc->vbus_draw_work, dwc3_vbus_draw_work);
- return usb_psy;
- }
- int dwc3_core_probe(const struct dwc3_probe_data *data)
- {
- struct dwc3 *dwc = data->dwc;
- struct device *dev = dwc->dev;
- struct resource dwc_res;
- unsigned int hw_mode;
- void __iomem *regs;
- struct resource *res = data->res;
- int ret;
- dwc->xhci_resources[0].start = res->start;
- dwc->xhci_resources[0].end = dwc->xhci_resources[0].start +
- DWC3_XHCI_REGS_END;
- dwc->xhci_resources[0].flags = res->flags;
- dwc->xhci_resources[0].name = res->name;
- /*
- * Request memory region but exclude xHCI regs,
- * since it will be requested by the xhci-plat driver.
- */
- dwc_res = *res;
- dwc_res.start += DWC3_GLOBALS_REGS_START;
- if (dev->of_node) {
- struct device_node *parent = of_get_parent(dev->of_node);
- if (of_device_is_compatible(parent, "realtek,rtd-dwc3")) {
- dwc_res.start -= DWC3_GLOBALS_REGS_START;
- dwc_res.start += DWC3_RTK_RTD_GLOBALS_REGS_START;
- }
- of_node_put(parent);
- }
- regs = devm_ioremap_resource(dev, &dwc_res);
- if (IS_ERR(regs))
- return PTR_ERR(regs);
- dwc->regs = regs;
- dwc->regs_size = resource_size(&dwc_res);
- dwc3_get_properties(dwc);
- dwc3_get_software_properties(dwc, &data->properties);
- dwc->usb_psy = dwc3_get_usb_power_supply(dwc);
- if (IS_ERR(dwc->usb_psy))
- return dev_err_probe(dev, PTR_ERR(dwc->usb_psy), "couldn't get usb power supply\n");
- if (!data->ignore_clocks_and_resets) {
- dwc->reset = devm_reset_control_array_get_optional_shared(dev);
- if (IS_ERR(dwc->reset)) {
- ret = PTR_ERR(dwc->reset);
- goto err_put_psy;
- }
- ret = dwc3_get_clocks(dwc);
- if (ret)
- goto err_put_psy;
- }
- ret = reset_control_deassert(dwc->reset);
- if (ret)
- goto err_put_psy;
- ret = dwc3_clk_enable(dwc);
- if (ret)
- goto err_assert_reset;
- if (!dwc3_core_is_valid(dwc)) {
- dev_err(dwc->dev, "this is not a DesignWare USB3 DRD Core\n");
- ret = -ENODEV;
- goto err_disable_clks;
- }
- dev_set_drvdata(dev, dwc);
- dwc3_cache_hwparams(dwc);
- if (!dev_is_pci(dwc->sysdev) &&
- DWC3_GHWPARAMS0_AWIDTH(dwc->hwparams.hwparams0) == 64) {
- ret = dma_set_mask_and_coherent(dwc->sysdev, DMA_BIT_MASK(64));
- if (ret)
- goto err_disable_clks;
- }
- /*
- * Currently only DWC3 controllers that are host-only capable
- * can have more than one port.
- */
- hw_mode = DWC3_GHWPARAMS0_MODE(dwc->hwparams.hwparams0);
- if (hw_mode == DWC3_GHWPARAMS0_MODE_HOST) {
- ret = dwc3_get_num_ports(dwc);
- if (ret)
- goto err_disable_clks;
- } else {
- dwc->num_usb2_ports = 1;
- dwc->num_usb3_ports = 1;
- }
- spin_lock_init(&dwc->lock);
- mutex_init(&dwc->mutex);
- pm_runtime_get_noresume(dev);
- pm_runtime_set_active(dev);
- pm_runtime_use_autosuspend(dev);
- pm_runtime_set_autosuspend_delay(dev, DWC3_DEFAULT_AUTOSUSPEND_DELAY);
- pm_runtime_enable(dev);
- pm_runtime_forbid(dev);
- ret = dwc3_alloc_event_buffers(dwc, DWC3_EVENT_BUFFERS_SIZE);
- if (ret) {
- dev_err(dwc->dev, "failed to allocate event buffers\n");
- ret = -ENOMEM;
- goto err_allow_rpm;
- }
- dwc->edev = dwc3_get_extcon(dwc);
- if (IS_ERR(dwc->edev)) {
- ret = dev_err_probe(dwc->dev, PTR_ERR(dwc->edev), "failed to get extcon\n");
- goto err_free_event_buffers;
- }
- ret = dwc3_get_dr_mode(dwc);
- if (ret)
- goto err_free_event_buffers;
- ret = dwc3_core_init(dwc);
- if (ret) {
- dev_err_probe(dev, ret, "failed to initialize core\n");
- goto err_free_event_buffers;
- }
- dwc3_check_params(dwc);
- dwc3_debugfs_init(dwc);
- if (!data->skip_core_init_mode) {
- ret = dwc3_core_init_mode(dwc);
- if (ret)
- goto err_exit_debugfs;
- }
- pm_runtime_put(dev);
- dma_set_max_seg_size(dev, UINT_MAX);
- return 0;
- err_exit_debugfs:
- dwc3_debugfs_exit(dwc);
- dwc3_event_buffers_cleanup(dwc);
- dwc3_phy_power_off(dwc);
- dwc3_phy_exit(dwc);
- dwc3_ulpi_exit(dwc);
- err_free_event_buffers:
- dwc3_free_event_buffers(dwc);
- err_allow_rpm:
- pm_runtime_allow(dev);
- pm_runtime_disable(dev);
- pm_runtime_dont_use_autosuspend(dev);
- pm_runtime_set_suspended(dev);
- pm_runtime_put_noidle(dev);
- err_disable_clks:
- dwc3_clk_disable(dwc);
- err_assert_reset:
- reset_control_assert(dwc->reset);
- err_put_psy:
- if (dwc->usb_psy)
- power_supply_put(dwc->usb_psy);
- return ret;
- }
- EXPORT_SYMBOL_GPL(dwc3_core_probe);
- static int dwc3_probe(struct platform_device *pdev)
- {
- struct dwc3_probe_data probe_data = {};
- struct resource *res;
- struct dwc3 *dwc;
- res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- if (!res) {
- dev_err(&pdev->dev, "missing memory resource\n");
- return -ENODEV;
- }
- dwc = devm_kzalloc(&pdev->dev, sizeof(*dwc), GFP_KERNEL);
- if (!dwc)
- return -ENOMEM;
- dwc->dev = &pdev->dev;
- dwc->glue_ops = NULL;
- probe_data.dwc = dwc;
- probe_data.res = res;
- probe_data.properties = DWC3_DEFAULT_PROPERTIES;
- return dwc3_core_probe(&probe_data);
- }
- void dwc3_core_remove(struct dwc3 *dwc)
- {
- pm_runtime_get_sync(dwc->dev);
- dwc3_core_exit_mode(dwc);
- dwc3_debugfs_exit(dwc);
- dwc3_core_exit(dwc);
- dwc3_ulpi_exit(dwc);
- pm_runtime_allow(dwc->dev);
- pm_runtime_disable(dwc->dev);
- pm_runtime_dont_use_autosuspend(dwc->dev);
- pm_runtime_put_noidle(dwc->dev);
- /*
- * HACK: Clear the driver data, which is currently accessed by parent
- * glue drivers, before allowing the parent to suspend.
- */
- dev_set_drvdata(dwc->dev, NULL);
- pm_runtime_set_suspended(dwc->dev);
- dwc3_free_event_buffers(dwc);
- if (dwc->usb_psy) {
- cancel_work_sync(&dwc->vbus_draw_work);
- power_supply_put(dwc->usb_psy);
- }
- }
- EXPORT_SYMBOL_GPL(dwc3_core_remove);
- static void dwc3_remove(struct platform_device *pdev)
- {
- dwc3_core_remove(platform_get_drvdata(pdev));
- }
- #ifdef CONFIG_PM
- static int dwc3_core_init_for_resume(struct dwc3 *dwc)
- {
- int ret;
- ret = reset_control_deassert(dwc->reset);
- if (ret)
- return ret;
- ret = dwc3_clk_enable(dwc);
- if (ret)
- goto assert_reset;
- ret = dwc3_core_init(dwc);
- if (ret)
- goto disable_clks;
- return 0;
- disable_clks:
- dwc3_clk_disable(dwc);
- assert_reset:
- reset_control_assert(dwc->reset);
- return ret;
- }
- static int dwc3_suspend_common(struct dwc3 *dwc, pm_message_t msg)
- {
- u32 reg;
- int i;
- int ret;
- if (!pm_runtime_suspended(dwc->dev) && !PMSG_IS_AUTO(msg)) {
- dwc->susphy_state = (dwc3_readl(dwc, DWC3_GUSB2PHYCFG(0)) &
- DWC3_GUSB2PHYCFG_SUSPHY) ||
- (dwc3_readl(dwc, DWC3_GUSB3PIPECTL(0)) &
- DWC3_GUSB3PIPECTL_SUSPHY);
- /*
- * TI AM62 platform requires SUSPHY to be
- * enabled for system suspend to work.
- */
- if (!dwc->susphy_state)
- dwc3_enable_susphy(dwc, true);
- }
- switch (dwc->current_dr_role) {
- case DWC3_GCTL_PRTCAP_DEVICE:
- if (pm_runtime_suspended(dwc->dev))
- break;
- ret = dwc3_gadget_suspend(dwc);
- if (ret)
- return ret;
- synchronize_irq(dwc->irq_gadget);
- dwc3_core_exit(dwc);
- break;
- case DWC3_GCTL_PRTCAP_HOST:
- if (!PMSG_IS_AUTO(msg) && !device_may_wakeup(dwc->dev)) {
- dwc3_core_exit(dwc);
- break;
- }
- /* Let controller to suspend HSPHY before PHY driver suspends */
- if (dwc->dis_u2_susphy_quirk ||
- dwc->dis_enblslpm_quirk) {
- for (i = 0; i < dwc->num_usb2_ports; i++) {
- reg = dwc3_readl(dwc, DWC3_GUSB2PHYCFG(i));
- reg |= DWC3_GUSB2PHYCFG_ENBLSLPM |
- DWC3_GUSB2PHYCFG_SUSPHY;
- dwc3_writel(dwc, DWC3_GUSB2PHYCFG(i), reg);
- }
- /* Give some time for USB2 PHY to suspend */
- usleep_range(5000, 6000);
- }
- for (i = 0; i < dwc->num_usb2_ports; i++)
- phy_pm_runtime_put_sync(dwc->usb2_generic_phy[i]);
- for (i = 0; i < dwc->num_usb3_ports; i++)
- phy_pm_runtime_put_sync(dwc->usb3_generic_phy[i]);
- break;
- case DWC3_GCTL_PRTCAP_OTG:
- /* do nothing during runtime_suspend */
- if (PMSG_IS_AUTO(msg))
- break;
- if (dwc->current_otg_role == DWC3_OTG_ROLE_DEVICE) {
- ret = dwc3_gadget_suspend(dwc);
- if (ret)
- return ret;
- synchronize_irq(dwc->irq_gadget);
- }
- dwc3_otg_exit(dwc);
- dwc3_core_exit(dwc);
- break;
- default:
- /* do nothing */
- break;
- }
- return 0;
- }
- static int dwc3_resume_common(struct dwc3 *dwc, pm_message_t msg)
- {
- int ret;
- u32 reg;
- int i;
- switch (dwc->current_dr_role) {
- case DWC3_GCTL_PRTCAP_DEVICE:
- ret = dwc3_core_init_for_resume(dwc);
- if (ret)
- return ret;
- dwc3_set_prtcap(dwc, DWC3_GCTL_PRTCAP_DEVICE, true);
- dwc3_gadget_resume(dwc);
- break;
- case DWC3_GCTL_PRTCAP_HOST:
- if (!PMSG_IS_AUTO(msg) && !device_may_wakeup(dwc->dev)) {
- ret = dwc3_core_init_for_resume(dwc);
- if (ret)
- return ret;
- dwc3_set_prtcap(dwc, DWC3_GCTL_PRTCAP_HOST, true);
- break;
- }
- /* Restore GUSB2PHYCFG bits that were modified in suspend */
- for (i = 0; i < dwc->num_usb2_ports; i++) {
- reg = dwc3_readl(dwc, DWC3_GUSB2PHYCFG(i));
- if (dwc->dis_u2_susphy_quirk)
- reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
- if (dwc->dis_enblslpm_quirk)
- reg &= ~DWC3_GUSB2PHYCFG_ENBLSLPM;
- dwc3_writel(dwc, DWC3_GUSB2PHYCFG(i), reg);
- }
- for (i = 0; i < dwc->num_usb2_ports; i++)
- phy_pm_runtime_get_sync(dwc->usb2_generic_phy[i]);
- for (i = 0; i < dwc->num_usb3_ports; i++)
- phy_pm_runtime_get_sync(dwc->usb3_generic_phy[i]);
- break;
- case DWC3_GCTL_PRTCAP_OTG:
- /* nothing to do on runtime_resume */
- if (PMSG_IS_AUTO(msg))
- break;
- ret = dwc3_core_init_for_resume(dwc);
- if (ret)
- return ret;
- dwc3_set_prtcap(dwc, dwc->current_dr_role, true);
- dwc3_otg_init(dwc);
- if (dwc->current_otg_role == DWC3_OTG_ROLE_HOST) {
- dwc3_otg_host_init(dwc);
- } else if (dwc->current_otg_role == DWC3_OTG_ROLE_DEVICE) {
- dwc3_gadget_resume(dwc);
- }
- break;
- default:
- /* do nothing */
- break;
- }
- if (!PMSG_IS_AUTO(msg)) {
- /* restore SUSPHY state to that before system suspend. */
- dwc3_enable_susphy(dwc, dwc->susphy_state);
- }
- return 0;
- }
- static int dwc3_runtime_checks(struct dwc3 *dwc)
- {
- switch (dwc->current_dr_role) {
- case DWC3_GCTL_PRTCAP_DEVICE:
- if (dwc->connected)
- return -EBUSY;
- break;
- case DWC3_GCTL_PRTCAP_HOST:
- default:
- /* do nothing */
- break;
- }
- return 0;
- }
- int dwc3_runtime_suspend(struct dwc3 *dwc)
- {
- int ret;
- if (dwc3_runtime_checks(dwc))
- return -EBUSY;
- ret = dwc3_suspend_common(dwc, PMSG_AUTO_SUSPEND);
- if (ret)
- return ret;
- return 0;
- }
- EXPORT_SYMBOL_GPL(dwc3_runtime_suspend);
- int dwc3_runtime_resume(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- int ret;
- ret = dwc3_resume_common(dwc, PMSG_AUTO_RESUME);
- if (ret)
- return ret;
- switch (dwc->current_dr_role) {
- case DWC3_GCTL_PRTCAP_DEVICE:
- if (dwc->pending_events) {
- pm_runtime_put(dev);
- dwc->pending_events = false;
- enable_irq(dwc->irq_gadget);
- }
- break;
- case DWC3_GCTL_PRTCAP_HOST:
- default:
- /* do nothing */
- break;
- }
- pm_runtime_mark_last_busy(dev);
- return 0;
- }
- EXPORT_SYMBOL_GPL(dwc3_runtime_resume);
- int dwc3_runtime_idle(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- switch (dwc->current_dr_role) {
- case DWC3_GCTL_PRTCAP_DEVICE:
- if (dwc3_runtime_checks(dwc))
- return -EBUSY;
- break;
- case DWC3_GCTL_PRTCAP_HOST:
- default:
- /* do nothing */
- break;
- }
- pm_runtime_autosuspend(dev);
- return 0;
- }
- EXPORT_SYMBOL_GPL(dwc3_runtime_idle);
- static int dwc3_plat_runtime_suspend(struct device *dev)
- {
- return dwc3_runtime_suspend(dev_get_drvdata(dev));
- }
- static int dwc3_plat_runtime_resume(struct device *dev)
- {
- return dwc3_runtime_resume(dev_get_drvdata(dev));
- }
- static int dwc3_plat_runtime_idle(struct device *dev)
- {
- return dwc3_runtime_idle(dev_get_drvdata(dev));
- }
- #endif /* CONFIG_PM */
- #ifdef CONFIG_PM_SLEEP
- int dwc3_pm_suspend(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- int ret;
- ret = dwc3_suspend_common(dwc, PMSG_SUSPEND);
- if (ret)
- return ret;
- pinctrl_pm_select_sleep_state(dev);
- return 0;
- }
- EXPORT_SYMBOL_GPL(dwc3_pm_suspend);
- int dwc3_pm_resume(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- int ret = 0;
- pinctrl_pm_select_default_state(dev);
- pm_runtime_disable(dev);
- ret = pm_runtime_set_active(dev);
- if (ret)
- goto out;
- ret = dwc3_resume_common(dwc, PMSG_RESUME);
- if (ret)
- pm_runtime_set_suspended(dev);
- out:
- pm_runtime_enable(dev);
- return ret;
- }
- EXPORT_SYMBOL_GPL(dwc3_pm_resume);
- void dwc3_pm_complete(struct dwc3 *dwc)
- {
- u32 reg;
- if (dwc->current_dr_role == DWC3_GCTL_PRTCAP_HOST &&
- dwc->dis_split_quirk) {
- reg = dwc3_readl(dwc, DWC3_GUCTL3);
- reg |= DWC3_GUCTL3_SPLITDISABLE;
- dwc3_writel(dwc, DWC3_GUCTL3, reg);
- }
- }
- EXPORT_SYMBOL_GPL(dwc3_pm_complete);
- int dwc3_pm_prepare(struct dwc3 *dwc)
- {
- struct device *dev = dwc->dev;
- /*
- * Indicate to the PM core that it may safely leave the device in
- * runtime suspend if runtime-suspended already in device mode.
- */
- if (dwc->current_dr_role == DWC3_GCTL_PRTCAP_DEVICE &&
- pm_runtime_suspended(dev) &&
- !dev_pinctrl(dev))
- return 1;
- return 0;
- }
- EXPORT_SYMBOL_GPL(dwc3_pm_prepare);
- static int dwc3_plat_suspend(struct device *dev)
- {
- return dwc3_pm_suspend(dev_get_drvdata(dev));
- }
- static int dwc3_plat_resume(struct device *dev)
- {
- return dwc3_pm_resume(dev_get_drvdata(dev));
- }
- static void dwc3_plat_complete(struct device *dev)
- {
- dwc3_pm_complete(dev_get_drvdata(dev));
- }
- static int dwc3_plat_prepare(struct device *dev)
- {
- return dwc3_pm_prepare(dev_get_drvdata(dev));
- }
- #else
- #define dwc3_plat_complete NULL
- #define dwc3_plat_prepare NULL
- #endif /* CONFIG_PM_SLEEP */
- static const struct dev_pm_ops dwc3_dev_pm_ops = {
- SET_SYSTEM_SLEEP_PM_OPS(dwc3_plat_suspend, dwc3_plat_resume)
- .complete = dwc3_plat_complete,
- .prepare = dwc3_plat_prepare,
- /*
- * Runtime suspend halts the controller on disconnection. It relies on
- * platforms with custom connection notification to start the controller
- * again.
- */
- SET_RUNTIME_PM_OPS(dwc3_plat_runtime_suspend, dwc3_plat_runtime_resume,
- dwc3_plat_runtime_idle)
- };
- #ifdef CONFIG_OF
- static const struct of_device_id of_dwc3_match[] = {
- {
- .compatible = "snps,dwc3"
- },
- {
- .compatible = "synopsys,dwc3"
- },
- { },
- };
- MODULE_DEVICE_TABLE(of, of_dwc3_match);
- #endif
- #ifdef CONFIG_ACPI
- #define ACPI_ID_INTEL_BSW "808622B7"
- static const struct acpi_device_id dwc3_acpi_match[] = {
- { ACPI_ID_INTEL_BSW, 0 },
- { },
- };
- MODULE_DEVICE_TABLE(acpi, dwc3_acpi_match);
- #endif
- static struct platform_driver dwc3_driver = {
- .probe = dwc3_probe,
- .remove = dwc3_remove,
- .driver = {
- .name = "dwc3",
- .of_match_table = of_match_ptr(of_dwc3_match),
- .acpi_match_table = ACPI_PTR(dwc3_acpi_match),
- .pm = &dwc3_dev_pm_ops,
- },
- };
- module_platform_driver(dwc3_driver);
- MODULE_ALIAS("platform:dwc3");
- MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
- MODULE_LICENSE("GPL v2");
- MODULE_DESCRIPTION("DesignWare USB3 DRD Controller Driver");
|