123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (c) 2014-2019, The Linux Foundation. All rights reserved.
- */
- /*
- * WWAN Transport Network Driver.
- */
- #include <linux/completion.h>
- #include <linux/errno.h>
- #include <linux/if_arp.h>
- #include <linux/interrupt.h>
- #include <linux/init.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/netdevice.h>
- #include <linux/of_device.h>
- #include <linux/string.h>
- #include <linux/skbuff.h>
- #include <linux/version.h>
- #include <linux/workqueue.h>
- #include <linux/debugfs.h>
- #include <net/pkt_sched.h>
- #include <soc/qcom/subsystem_restart.h>
- #include <soc/qcom/subsystem_notif.h>
- #include "ipa_qmi_service.h"
- #include <linux/rmnet_ipa_fd_ioctl.h>
- #include <linux/ipa.h>
- #include <uapi/linux/msm_rmnet.h>
- #include <net/rmnet_config.h>
- #include "ipa_mhi_proxy.h"
- #include "ipa_trace.h"
- #include "ipa_odl.h"
- #define OUTSTANDING_HIGH_DEFAULT 256
- #define OUTSTANDING_HIGH_CTL_DEFAULT (OUTSTANDING_HIGH_DEFAULT + 32)
- #define OUTSTANDING_LOW_DEFAULT 128
- #define WWAN_METADATA_SHFT 24
- #define WWAN_METADATA_MASK 0xFF000000
- #define WWAN_DATA_LEN 9216
- #define HEADROOM_FOR_QMAP 8 /* for mux header */
- #define TAILROOM 0 /* for padding by mux layer */
- #define MAX_NUM_OF_MUX_CHANNEL 15 /* max mux channels */
- #define UL_FILTER_RULE_HANDLE_START 69
- #define IPA_WWAN_DEV_NAME "rmnet_ipa%d"
- #define IPA_UPSTEAM_WLAN_IFACE_NAME "wlan0"
- #define IPA_UPSTEAM_WLAN1_IFACE_NAME "wlan1"
- #define IPA_WWAN_RX_SOFTIRQ_THRESH 16
- #define INVALID_MUX_ID 0xFF
- #define IPA_QUOTA_REACH_ALERT_MAX_SIZE 64
- #define IPA_QUOTA_REACH_IF_NAME_MAX_SIZE 64
- #define IPA_UEVENT_NUM_EVNP 4 /* number of event pointers */
- #define IPA_NETDEV() \
- ((rmnet_ipa3_ctx && rmnet_ipa3_ctx->wwan_priv) ? \
- rmnet_ipa3_ctx->wwan_priv->net : NULL)
- #define IPA_WWAN_CONS_DESC_FIFO_SZ 256
- static void rmnet_ipa_free_msg(void *buff, u32 len, u32 type);
- static void rmnet_ipa_get_stats_and_update(void);
- static int ipa3_wwan_add_ul_flt_rule_to_ipa(void);
- static int ipa3_wwan_del_ul_flt_rule_to_ipa(void);
- static void ipa3_wwan_msg_free_cb(void*, u32, u32);
- static int ipa3_rmnet_poll(struct napi_struct *napi, int budget);
- static void ipa3_wake_tx_queue(struct work_struct *work);
- static DECLARE_WORK(ipa3_tx_wakequeue_work, ipa3_wake_tx_queue);
- static void tethering_stats_poll_queue(struct work_struct *work);
- static DECLARE_DELAYED_WORK(ipa_tether_stats_poll_wakequeue_work,
- tethering_stats_poll_queue);
- static int rmnet_ipa_send_coalesce_notification(uint8_t qmap_id, bool enable,
- bool tcp, bool udp);
- enum ipa3_wwan_device_status {
- WWAN_DEVICE_INACTIVE = 0,
- WWAN_DEVICE_ACTIVE = 1
- };
- struct ipa3_rmnet_plat_drv_res {
- bool ipa_rmnet_ssr;
- bool ipa_advertise_sg_support;
- bool ipa_napi_enable;
- u32 wan_rx_desc_size;
- };
- /**
- * struct ipa3_wwan_private - WWAN private data
- * @net: network interface struct implemented by this driver
- * @stats: iface statistics
- * @outstanding_pkts: number of packets sent to IPA without TX complete ACKed
- * @ch_id: channel id
- * @lock: spinlock for mutual exclusion
- * @device_status: holds device status
- *
- * WWAN private - holds all relevant info about WWAN driver
- */
- struct ipa3_wwan_private {
- struct net_device *net;
- struct net_device_stats stats;
- atomic_t outstanding_pkts;
- uint32_t ch_id;
- spinlock_t lock;
- struct completion resource_granted_completion;
- enum ipa3_wwan_device_status device_status;
- struct napi_struct napi;
- };
- struct rmnet_ipa_debugfs {
- struct dentry *dent;
- struct dentry *dfile_outstanding_high;
- struct dentry *dfile_outstanding_high_ctl;
- struct dentry *dfile_outstanding_low;
- };
- struct rmnet_ipa3_context {
- struct ipa3_wwan_private *wwan_priv;
- struct ipa_sys_connect_params apps_to_ipa_ep_cfg;
- struct ipa_sys_connect_params ipa_to_apps_ep_cfg;
- u32 qmap_hdr_hdl;
- u32 dflt_v4_wan_rt_hdl;
- u32 dflt_v6_wan_rt_hdl;
- struct ipa3_rmnet_mux_val mux_channel[MAX_NUM_OF_MUX_CHANNEL];
- int num_q6_rules;
- int old_num_q6_rules;
- int rmnet_index;
- bool egress_set;
- bool a7_ul_flt_set;
- atomic_t is_initialized;
- atomic_t is_ssr;
- void *lcl_mdm_subsys_notify_handle;
- void *rmt_mdm_subsys_notify_handle;
- u32 apps_to_ipa3_hdl;
- u32 ipa3_to_apps_hdl;
- struct mutex pipe_handle_guard;
- struct mutex add_mux_channel_lock;
- u32 pm_hdl;
- u32 q6_pm_hdl;
- u32 q6_teth_pm_hdl;
- struct mutex per_client_stats_guard;
- struct ipa_tether_device_info
- tether_device
- [IPACM_MAX_CLIENT_DEVICE_TYPES];
- u32 outstanding_high;
- u32 outstanding_high_ctl;
- u32 outstanding_low;
- struct rmnet_ipa_debugfs dbgfs;
- bool dl_csum_offload_enabled;
- atomic_t ap_suspend;
- bool ipa_config_is_apq;
- bool ipa_mhi_aggr_formet_set;
- };
- static struct rmnet_ipa3_context *rmnet_ipa3_ctx;
- static struct ipa3_rmnet_plat_drv_res ipa3_rmnet_res;
- /**
- * ipa3_setup_a7_qmap_hdr() - Setup default a7 qmap hdr
- *
- * Return codes:
- * 0: success
- * -ENOMEM: failed to allocate memory
- * -EPERM: failed to add the tables
- */
- static int ipa3_setup_a7_qmap_hdr(void)
- {
- struct ipa_ioc_add_hdr *hdr;
- struct ipa_hdr_add *hdr_entry;
- u32 pyld_sz;
- int ret;
- /* install the basic exception header */
- pyld_sz = sizeof(struct ipa_ioc_add_hdr) + 1 *
- sizeof(struct ipa_hdr_add);
- hdr = kzalloc(pyld_sz, GFP_KERNEL);
- if (!hdr)
- return -ENOMEM;
- hdr->num_hdrs = 1;
- hdr->commit = 1;
- hdr_entry = &hdr->hdr[0];
- strlcpy(hdr_entry->name, IPA_A7_QMAP_HDR_NAME,
- IPA_RESOURCE_NAME_MAX);
- if (ipa3_ctx->ipa_hw_type >= IPA_HW_v4_5 &&
- rmnet_ipa3_ctx->dl_csum_offload_enabled) {
- hdr_entry->hdr_len = IPA_DL_CHECKSUM_LENGTH; /* 8 bytes */
- /* new DL QMAP header format */
- hdr_entry->hdr[0] = 0x40;
- hdr_entry->hdr[1] = 0;
- hdr_entry->hdr[2] = 0;
- hdr_entry->hdr[3] = 0;
- hdr_entry->hdr[4] = 0x4;
- /*
- * Need to set csum required/valid bit on which will be replaced
- * by HW if checksum is incorrect after validation
- */
- hdr_entry->hdr[5] = 0x80;
- hdr_entry->hdr[6] = 0;
- hdr_entry->hdr[7] = 0;
- } else
- hdr_entry->hdr_len = IPA_QMAP_HEADER_LENGTH; /* 4 bytes */
- if (ipa3_add_hdr(hdr)) {
- IPAWANERR("fail to add IPA_A7_QMAP hdr\n");
- ret = -EPERM;
- goto bail;
- }
- if (hdr_entry->status) {
- IPAWANERR("fail to add IPA_A7_QMAP hdr\n");
- ret = -EPERM;
- goto bail;
- }
- rmnet_ipa3_ctx->qmap_hdr_hdl = hdr_entry->hdr_hdl;
- ret = 0;
- bail:
- kfree(hdr);
- return ret;
- }
- static void ipa3_del_a7_qmap_hdr(void)
- {
- struct ipa_ioc_del_hdr *del_hdr;
- struct ipa_hdr_del *hdl_entry;
- u32 pyld_sz;
- int ret;
- pyld_sz = sizeof(struct ipa_ioc_del_hdr) + 1 *
- sizeof(struct ipa_hdr_del);
- del_hdr = kzalloc(pyld_sz, GFP_KERNEL);
- if (!del_hdr) {
- IPAWANERR("fail to alloc exception hdr_del\n");
- return;
- }
- del_hdr->commit = 1;
- del_hdr->num_hdls = 1;
- hdl_entry = &del_hdr->hdl[0];
- hdl_entry->hdl = rmnet_ipa3_ctx->qmap_hdr_hdl;
- ret = ipa3_del_hdr(del_hdr);
- if (ret || hdl_entry->status)
- IPAWANERR("ipa3_del_hdr failed\n");
- else
- IPAWANDBG("hdrs deletion done\n");
- rmnet_ipa3_ctx->qmap_hdr_hdl = 0;
- kfree(del_hdr);
- }
- static void ipa3_del_qmap_hdr(uint32_t hdr_hdl)
- {
- struct ipa_ioc_del_hdr *del_hdr;
- struct ipa_hdr_del *hdl_entry;
- u32 pyld_sz;
- int ret;
- if (hdr_hdl == 0) {
- IPAWANERR("Invalid hdr_hdl provided\n");
- return;
- }
- pyld_sz = sizeof(struct ipa_ioc_del_hdr) + 1 *
- sizeof(struct ipa_hdr_del);
- del_hdr = kzalloc(pyld_sz, GFP_KERNEL);
- if (!del_hdr) {
- IPAWANERR("fail to alloc exception hdr_del\n");
- return;
- }
- del_hdr->commit = 1;
- del_hdr->num_hdls = 1;
- hdl_entry = &del_hdr->hdl[0];
- hdl_entry->hdl = hdr_hdl;
- ret = ipa3_del_hdr(del_hdr);
- if (ret || hdl_entry->status)
- IPAWANERR("ipa3_del_hdr failed\n");
- else
- IPAWANDBG("header deletion done\n");
- rmnet_ipa3_ctx->qmap_hdr_hdl = 0;
- kfree(del_hdr);
- }
- static void ipa3_del_mux_qmap_hdrs(void)
- {
- int index;
- for (index = 0; index < rmnet_ipa3_ctx->rmnet_index; index++) {
- ipa3_del_qmap_hdr(rmnet_ipa3_ctx->mux_channel[index].hdr_hdl);
- rmnet_ipa3_ctx->mux_channel[index].hdr_hdl = 0;
- }
- }
- static int ipa3_add_qmap_hdr(uint32_t mux_id, uint32_t *hdr_hdl)
- {
- struct ipa_ioc_add_hdr *hdr;
- struct ipa_hdr_add *hdr_entry;
- char hdr_name[IPA_RESOURCE_NAME_MAX];
- u32 pyld_sz;
- int ret;
- pyld_sz = sizeof(struct ipa_ioc_add_hdr) + 1 *
- sizeof(struct ipa_hdr_add);
- hdr = kzalloc(pyld_sz, GFP_KERNEL);
- if (!hdr)
- return -ENOMEM;
- hdr->num_hdrs = 1;
- hdr->commit = 1;
- hdr_entry = &hdr->hdr[0];
- snprintf(hdr_name, IPA_RESOURCE_NAME_MAX, "%s%d",
- A2_MUX_HDR_NAME_V4_PREF,
- mux_id);
- strlcpy(hdr_entry->name, hdr_name,
- IPA_RESOURCE_NAME_MAX);
- if (rmnet_ipa3_ctx->dl_csum_offload_enabled) {
- if (rmnet_ipa3_ctx->ipa_config_is_apq ||
- ipa3_ctx->ipa_hw_type >= IPA_HW_v4_5) {
- hdr_entry->hdr_len =
- IPA_DL_CHECKSUM_LENGTH; /* 8 bytes */
- /* new DL QMAP header format */
- hdr_entry->hdr[0] = 0x40;
- hdr_entry->hdr[1] = (uint8_t) mux_id;
- hdr_entry->hdr[2] = 0;
- hdr_entry->hdr[3] = 0;
- hdr_entry->hdr[4] = 0x4;
- /*
- * Need to set csum required/valid bit on
- * which will be replaced by HW if checksum
- * is incorrect after validation
- */
- hdr_entry->hdr[5] = 0x80;
- hdr_entry->hdr[6] = 0;
- hdr_entry->hdr[7] = 0;
- } else {
- hdr_entry->hdr_len =
- IPA_QMAP_HEADER_LENGTH; /* 4 bytes */
- hdr_entry->hdr[1] = (uint8_t) mux_id;
- }
- } else {
- hdr_entry->hdr_len = IPA_QMAP_HEADER_LENGTH; /* 4 bytes */
- hdr_entry->hdr[1] = (uint8_t) mux_id;
- }
- IPAWANDBG("header (%s) with mux-id: (%d)\n",
- hdr_name,
- hdr_entry->hdr[1]);
- if (ipa3_add_hdr(hdr)) {
- IPAWANERR("fail to add IPA_QMAP hdr\n");
- ret = -EPERM;
- goto bail;
- }
- if (hdr_entry->status) {
- IPAWANERR("fail to add IPA_QMAP hdr\n");
- ret = -EPERM;
- goto bail;
- }
- ret = 0;
- *hdr_hdl = hdr_entry->hdr_hdl;
- bail:
- kfree(hdr);
- return ret;
- }
- /**
- * ipa3_setup_dflt_wan_rt_tables() - Setup default wan routing tables
- *
- * Return codes:
- * 0: success
- * -ENOMEM: failed to allocate memory
- * -EPERM: failed to add the tables
- */
- static int ipa3_setup_dflt_wan_rt_tables(void)
- {
- struct ipa_ioc_add_rt_rule *rt_rule;
- struct ipa_rt_rule_add *rt_rule_entry;
- rt_rule =
- kzalloc(sizeof(struct ipa_ioc_add_rt_rule) + 1 *
- sizeof(struct ipa_rt_rule_add), GFP_KERNEL);
- if (!rt_rule)
- return -ENOMEM;
- /* setup a default v4 route to point to Apps */
- rt_rule->num_rules = 1;
- rt_rule->commit = 1;
- rt_rule->ip = IPA_IP_v4;
- strlcpy(rt_rule->rt_tbl_name, IPA_DFLT_WAN_RT_TBL_NAME,
- IPA_RESOURCE_NAME_MAX);
- rt_rule_entry = &rt_rule->rules[0];
- rt_rule_entry->at_rear = 1;
- rt_rule_entry->rule.dst = IPA_CLIENT_APPS_WAN_CONS;
- rt_rule_entry->rule.hdr_hdl = rmnet_ipa3_ctx->qmap_hdr_hdl;
- if (ipa3_add_rt_rule(rt_rule)) {
- IPAWANERR("fail to add dflt_wan v4 rule\n");
- kfree(rt_rule);
- return -EPERM;
- }
- IPAWANDBG("dflt v4 rt rule hdl=%x\n", rt_rule_entry->rt_rule_hdl);
- rmnet_ipa3_ctx->dflt_v4_wan_rt_hdl = rt_rule_entry->rt_rule_hdl;
- /* setup a default v6 route to point to A5 */
- rt_rule->ip = IPA_IP_v6;
- if (ipa3_add_rt_rule(rt_rule)) {
- IPAWANERR("fail to add dflt_wan v6 rule\n");
- kfree(rt_rule);
- return -EPERM;
- }
- IPAWANDBG("dflt v6 rt rule hdl=%x\n", rt_rule_entry->rt_rule_hdl);
- rmnet_ipa3_ctx->dflt_v6_wan_rt_hdl = rt_rule_entry->rt_rule_hdl;
- kfree(rt_rule);
- return 0;
- }
- static void ipa3_del_dflt_wan_rt_tables(void)
- {
- struct ipa_ioc_del_rt_rule *rt_rule;
- struct ipa_rt_rule_del *rt_rule_entry;
- int len;
- len = sizeof(struct ipa_ioc_del_rt_rule) + 1 *
- sizeof(struct ipa_rt_rule_del);
- rt_rule = kzalloc(len, GFP_KERNEL);
- if (!rt_rule)
- return;
- memset(rt_rule, 0, len);
- rt_rule->commit = 1;
- rt_rule->num_hdls = 1;
- rt_rule->ip = IPA_IP_v4;
- rt_rule_entry = &rt_rule->hdl[0];
- rt_rule_entry->status = -1;
- rt_rule_entry->hdl = rmnet_ipa3_ctx->dflt_v4_wan_rt_hdl;
- IPAWANERR("Deleting Route hdl:(0x%x) with ip type: %d\n",
- rt_rule_entry->hdl, IPA_IP_v4);
- if (ipa3_del_rt_rule(rt_rule) ||
- (rt_rule_entry->status)) {
- IPAWANERR("Routing rule deletion failed\n");
- }
- rt_rule->ip = IPA_IP_v6;
- rt_rule_entry->hdl = rmnet_ipa3_ctx->dflt_v6_wan_rt_hdl;
- IPAWANERR("Deleting Route hdl:(0x%x) with ip type: %d\n",
- rt_rule_entry->hdl, IPA_IP_v6);
- if (ipa3_del_rt_rule(rt_rule) ||
- (rt_rule_entry->status)) {
- IPAWANERR("Routing rule deletion failed\n");
- }
- kfree(rt_rule);
- }
- static void ipa3_copy_qmi_flt_rule_ex(
- struct ipa_ioc_ext_intf_prop *q6_ul_flt_rule_ptr,
- void *flt_spec_ptr_void)
- {
- int j;
- struct ipa_filter_spec_ex_type_v01 *flt_spec_ptr;
- struct ipa_ipfltr_range_eq_16 *q6_ul_filter_nat_ptr;
- struct ipa_ipfltr_range_eq_16_type_v01 *filter_spec_nat_ptr;
- /*
- * pure_ack and tos has the same size and type and we will treat tos
- * field as pure_ack in ipa4.5 version
- */
- flt_spec_ptr = (struct ipa_filter_spec_ex_type_v01 *) flt_spec_ptr_void;
- q6_ul_flt_rule_ptr->ip = flt_spec_ptr->ip_type;
- q6_ul_flt_rule_ptr->action = flt_spec_ptr->filter_action;
- if (flt_spec_ptr->is_routing_table_index_valid == true)
- q6_ul_flt_rule_ptr->rt_tbl_idx =
- flt_spec_ptr->route_table_index;
- if (flt_spec_ptr->is_mux_id_valid == true)
- q6_ul_flt_rule_ptr->mux_id =
- flt_spec_ptr->mux_id;
- q6_ul_flt_rule_ptr->rule_id =
- flt_spec_ptr->rule_id;
- q6_ul_flt_rule_ptr->is_rule_hashable =
- flt_spec_ptr->is_rule_hashable;
- q6_ul_flt_rule_ptr->eq_attrib.rule_eq_bitmap =
- flt_spec_ptr->filter_rule.rule_eq_bitmap;
- q6_ul_flt_rule_ptr->eq_attrib.tos_eq_present =
- flt_spec_ptr->filter_rule.tos_eq_present;
- q6_ul_flt_rule_ptr->eq_attrib.tos_eq =
- flt_spec_ptr->filter_rule.tos_eq;
- q6_ul_flt_rule_ptr->eq_attrib.protocol_eq_present =
- flt_spec_ptr->filter_rule.protocol_eq_present;
- q6_ul_flt_rule_ptr->eq_attrib.protocol_eq =
- flt_spec_ptr->filter_rule.protocol_eq;
- q6_ul_flt_rule_ptr->eq_attrib.num_ihl_offset_range_16 =
- flt_spec_ptr->filter_rule.num_ihl_offset_range_16;
- for (j = 0;
- j < q6_ul_flt_rule_ptr->eq_attrib.num_ihl_offset_range_16;
- j++) {
- q6_ul_filter_nat_ptr =
- &q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_range_16[j];
- filter_spec_nat_ptr =
- &flt_spec_ptr->filter_rule.ihl_offset_range_16[j];
- q6_ul_filter_nat_ptr->offset =
- filter_spec_nat_ptr->offset;
- q6_ul_filter_nat_ptr->range_low =
- filter_spec_nat_ptr->range_low;
- q6_ul_filter_nat_ptr->range_high =
- filter_spec_nat_ptr->range_high;
- }
- q6_ul_flt_rule_ptr->eq_attrib.num_offset_meq_32 =
- flt_spec_ptr->filter_rule.num_offset_meq_32;
- for (j = 0;
- j < q6_ul_flt_rule_ptr->eq_attrib.num_offset_meq_32;
- j++) {
- q6_ul_flt_rule_ptr->eq_attrib.offset_meq_32[j].offset =
- flt_spec_ptr->filter_rule.offset_meq_32[j].offset;
- q6_ul_flt_rule_ptr->eq_attrib.offset_meq_32[j].mask =
- flt_spec_ptr->filter_rule.offset_meq_32[j].mask;
- q6_ul_flt_rule_ptr->eq_attrib.offset_meq_32[j].value =
- flt_spec_ptr->filter_rule.offset_meq_32[j].value;
- }
- q6_ul_flt_rule_ptr->eq_attrib.tc_eq_present =
- flt_spec_ptr->filter_rule.tc_eq_present;
- q6_ul_flt_rule_ptr->eq_attrib.tc_eq =
- flt_spec_ptr->filter_rule.tc_eq;
- q6_ul_flt_rule_ptr->eq_attrib.fl_eq_present =
- flt_spec_ptr->filter_rule.flow_eq_present;
- q6_ul_flt_rule_ptr->eq_attrib.fl_eq =
- flt_spec_ptr->filter_rule.flow_eq;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_eq_16_present =
- flt_spec_ptr->filter_rule.ihl_offset_eq_16_present;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_eq_16.offset =
- flt_spec_ptr->filter_rule.ihl_offset_eq_16.offset;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_eq_16.value =
- flt_spec_ptr->filter_rule.ihl_offset_eq_16.value;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_eq_32_present =
- flt_spec_ptr->filter_rule.ihl_offset_eq_32_present;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_eq_32.offset =
- flt_spec_ptr->filter_rule.ihl_offset_eq_32.offset;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_eq_32.value =
- flt_spec_ptr->filter_rule.ihl_offset_eq_32.value;
- q6_ul_flt_rule_ptr->eq_attrib.num_ihl_offset_meq_32 =
- flt_spec_ptr->filter_rule.num_ihl_offset_meq_32;
- for (j = 0;
- j < q6_ul_flt_rule_ptr->eq_attrib.num_ihl_offset_meq_32;
- j++) {
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_meq_32[j].offset =
- flt_spec_ptr->filter_rule.ihl_offset_meq_32[j].offset;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_meq_32[j].mask =
- flt_spec_ptr->filter_rule.ihl_offset_meq_32[j].mask;
- q6_ul_flt_rule_ptr->eq_attrib.ihl_offset_meq_32[j].value =
- flt_spec_ptr->filter_rule.ihl_offset_meq_32[j].value;
- }
- q6_ul_flt_rule_ptr->eq_attrib.num_offset_meq_128 =
- flt_spec_ptr->filter_rule.num_offset_meq_128;
- for (j = 0;
- j < q6_ul_flt_rule_ptr->eq_attrib.num_offset_meq_128;
- j++) {
- q6_ul_flt_rule_ptr->eq_attrib.offset_meq_128[j].offset =
- flt_spec_ptr->filter_rule.offset_meq_128[j].offset;
- memcpy(q6_ul_flt_rule_ptr->eq_attrib.offset_meq_128[j].mask,
- flt_spec_ptr->filter_rule.offset_meq_128[j].mask, 16);
- memcpy(q6_ul_flt_rule_ptr->eq_attrib.offset_meq_128[j].value,
- flt_spec_ptr->filter_rule.offset_meq_128[j].value, 16);
- }
- q6_ul_flt_rule_ptr->eq_attrib.metadata_meq32_present =
- flt_spec_ptr->filter_rule.metadata_meq32_present;
- q6_ul_flt_rule_ptr->eq_attrib.metadata_meq32.offset =
- flt_spec_ptr->filter_rule.metadata_meq32.offset;
- q6_ul_flt_rule_ptr->eq_attrib.metadata_meq32.mask =
- flt_spec_ptr->filter_rule.metadata_meq32.mask;
- q6_ul_flt_rule_ptr->eq_attrib.metadata_meq32.value =
- flt_spec_ptr->filter_rule.metadata_meq32.value;
- q6_ul_flt_rule_ptr->eq_attrib.ipv4_frag_eq_present =
- flt_spec_ptr->filter_rule.ipv4_frag_eq_present;
- }
- int ipa3_copy_ul_filter_rule_to_ipa(struct ipa_install_fltr_rule_req_msg_v01
- *rule_req)
- {
- int i;
- /* prevent multi-threads accessing rmnet_ipa3_ctx->num_q6_rules */
- mutex_lock(&rmnet_ipa3_ctx->add_mux_channel_lock);
- if (rule_req->filter_spec_ex_list_valid == true &&
- rule_req->filter_spec_ex2_list_valid == false) {
- rmnet_ipa3_ctx->num_q6_rules =
- rule_req->filter_spec_ex_list_len;
- IPAWANDBG("Received (%d) install_flt_req_ex_list\n",
- rmnet_ipa3_ctx->num_q6_rules);
- } else if (rule_req->filter_spec_ex2_list_valid == true &&
- rule_req->filter_spec_ex_list_valid == false) {
- rmnet_ipa3_ctx->num_q6_rules =
- rule_req->filter_spec_ex2_list_len;
- IPAWANDBG("Received (%d) install_flt_req_ex2_list\n",
- rmnet_ipa3_ctx->num_q6_rules);
- } else {
- rmnet_ipa3_ctx->num_q6_rules = 0;
- if (rule_req->filter_spec_ex2_list_valid == true)
- IPAWANERR(
- "both ex and ex2 flt rules are set to valid\n");
- else
- IPAWANERR("got no UL rules from modem\n");
- mutex_unlock(
- &rmnet_ipa3_ctx->add_mux_channel_lock);
- return -EINVAL;
- }
- /* copy UL filter rules from Modem*/
- for (i = 0; i < rmnet_ipa3_ctx->num_q6_rules; i++) {
- /* check if rules overside the cache*/
- if (i == MAX_NUM_Q6_RULE) {
- IPAWANERR("Reaching (%d) max cache ",
- MAX_NUM_Q6_RULE);
- IPAWANERR(" however total (%d)\n",
- rmnet_ipa3_ctx->num_q6_rules);
- goto failure;
- }
- if (rule_req->filter_spec_ex_list_valid == true)
- ipa3_copy_qmi_flt_rule_ex(
- &ipa3_qmi_ctx->q6_ul_filter_rule[i],
- &rule_req->filter_spec_ex_list[i]);
- else if (rule_req->filter_spec_ex2_list_valid == true)
- ipa3_copy_qmi_flt_rule_ex(
- &ipa3_qmi_ctx->q6_ul_filter_rule[i],
- &rule_req->filter_spec_ex2_list[i]);
- }
- if (rule_req->xlat_filter_indices_list_valid) {
- if (rule_req->xlat_filter_indices_list_len >
- rmnet_ipa3_ctx->num_q6_rules) {
- IPAWANERR("Number of xlat indices is not valid: %d\n",
- rule_req->xlat_filter_indices_list_len);
- goto failure;
- }
- IPAWANDBG("Receive %d XLAT indices: ",
- rule_req->xlat_filter_indices_list_len);
- for (i = 0; i < rule_req->xlat_filter_indices_list_len; i++)
- IPAWANDBG("%d ", rule_req->xlat_filter_indices_list[i]);
- IPAWANDBG("\n");
- for (i = 0; i < rule_req->xlat_filter_indices_list_len; i++) {
- if (rule_req->xlat_filter_indices_list[i]
- >= rmnet_ipa3_ctx->num_q6_rules) {
- IPAWANERR("Xlat rule idx is wrong: %d\n",
- rule_req->xlat_filter_indices_list[i]);
- goto failure;
- } else {
- ipa3_qmi_ctx->q6_ul_filter_rule
- [rule_req->xlat_filter_indices_list[i]]
- .is_xlat_rule = 1;
- IPAWANDBG("Rule %d is xlat rule\n",
- rule_req->xlat_filter_indices_list[i]);
- }
- }
- }
- goto success;
- failure:
- rmnet_ipa3_ctx->num_q6_rules = 0;
- memset(ipa3_qmi_ctx->q6_ul_filter_rule, 0,
- sizeof(ipa3_qmi_ctx->q6_ul_filter_rule));
- mutex_unlock(
- &rmnet_ipa3_ctx->add_mux_channel_lock);
- return -EINVAL;
- success:
- mutex_unlock(
- &rmnet_ipa3_ctx->add_mux_channel_lock);
- return 0;
- }
- static int ipa3_wwan_add_ul_flt_rule_to_ipa(void)
- {
- u32 pyld_sz;
- int i, retval = 0;
- struct ipa_ioc_add_flt_rule *param;
- struct ipa_flt_rule_add flt_rule_entry;
- struct ipa_fltr_installed_notif_req_msg_v01 *req;
- pyld_sz = sizeof(struct ipa_ioc_add_flt_rule) +
- sizeof(struct ipa_flt_rule_add);
- param = kzalloc(pyld_sz, GFP_KERNEL);
- if (!param)
- return -ENOMEM;
- req = kzalloc(sizeof(struct ipa_fltr_installed_notif_req_msg_v01),
- GFP_KERNEL);
- if (!req) {
- kfree(param);
- return -ENOMEM;
- }
- param->commit = 1;
- param->ep = IPA_CLIENT_APPS_WAN_PROD;
- param->global = false;
- param->num_rules = (uint8_t)1;
- memset(req, 0, sizeof(struct ipa_fltr_installed_notif_req_msg_v01));
- for (i = 0; i < rmnet_ipa3_ctx->num_q6_rules; i++) {
- param->ip = ipa3_qmi_ctx->q6_ul_filter_rule[i].ip;
- memset(&flt_rule_entry, 0, sizeof(struct ipa_flt_rule_add));
- flt_rule_entry.at_rear = true;
- flt_rule_entry.rule.action =
- ipa3_qmi_ctx->q6_ul_filter_rule[i].action;
- flt_rule_entry.rule.rt_tbl_idx
- = ipa3_qmi_ctx->q6_ul_filter_rule[i].rt_tbl_idx;
- flt_rule_entry.rule.retain_hdr = true;
- flt_rule_entry.rule.hashable =
- ipa3_qmi_ctx->q6_ul_filter_rule[i].is_rule_hashable;
- flt_rule_entry.rule.rule_id =
- ipa3_qmi_ctx->q6_ul_filter_rule[i].rule_id;
- /* debug rt-hdl*/
- IPAWANDBG("install-IPA index(%d),rt-tbl:(%d)\n",
- i, flt_rule_entry.rule.rt_tbl_idx);
- flt_rule_entry.rule.eq_attrib_type = true;
- memcpy(&(flt_rule_entry.rule.eq_attrib),
- &ipa3_qmi_ctx->q6_ul_filter_rule[i].eq_attrib,
- sizeof(struct ipa_ipfltri_rule_eq));
- memcpy(&(param->rules[0]), &flt_rule_entry,
- sizeof(struct ipa_flt_rule_add));
- if (ipa3_add_flt_rule((struct ipa_ioc_add_flt_rule *)param)) {
- retval = -EFAULT;
- IPAWANERR("add A7 UL filter rule(%d) failed\n", i);
- } else {
- /* store the rule handler */
- ipa3_qmi_ctx->q6_ul_filter_rule_hdl[i] =
- param->rules[0].flt_rule_hdl;
- }
- }
- /* send ipa_fltr_installed_notif_req_msg_v01 to Q6*/
- req->source_pipe_index =
- ipa3_get_ep_mapping(IPA_CLIENT_APPS_WAN_PROD);
- if (req->source_pipe_index == IPA_EP_NOT_ALLOCATED) {
- IPAWANERR("ep mapping failed\n");
- retval = -EFAULT;
- }
- req->install_status = QMI_RESULT_SUCCESS_V01;
- req->rule_id_valid = 1;
- req->rule_id_len = rmnet_ipa3_ctx->num_q6_rules;
- for (i = 0; i < rmnet_ipa3_ctx->num_q6_rules; i++) {
- req->rule_id[i] =
- ipa3_qmi_ctx->q6_ul_filter_rule[i].rule_id;
- }
- if (ipa3_qmi_filter_notify_send(req)) {
- IPAWANDBG("add filter rule index on A7-RX failed\n");
- retval = -EFAULT;
- }
- rmnet_ipa3_ctx->old_num_q6_rules = rmnet_ipa3_ctx->num_q6_rules;
- IPAWANDBG("add (%d) filter rule index on A7-RX\n",
- rmnet_ipa3_ctx->old_num_q6_rules);
- kfree(param);
- kfree(req);
- return retval;
- }
- static int ipa3_wwan_del_ul_flt_rule_to_ipa(void)
- {
- u32 pyld_sz;
- int i, retval = 0;
- struct ipa_ioc_del_flt_rule *param;
- struct ipa_flt_rule_del flt_rule_entry;
- pyld_sz = sizeof(struct ipa_ioc_del_flt_rule) +
- sizeof(struct ipa_flt_rule_del);
- param = kzalloc(pyld_sz, GFP_KERNEL);
- if (!param)
- return -ENOMEM;
- param->commit = 1;
- param->num_hdls = (uint8_t) 1;
- for (i = 0; i < rmnet_ipa3_ctx->old_num_q6_rules; i++) {
- param->ip = ipa3_qmi_ctx->q6_ul_filter_rule[i].ip;
- memset(&flt_rule_entry, 0, sizeof(struct ipa_flt_rule_del));
- flt_rule_entry.hdl = ipa3_qmi_ctx->q6_ul_filter_rule_hdl[i];
- /* debug rt-hdl*/
- IPAWANDBG("delete-IPA rule index(%d)\n", i);
- memcpy(&(param->hdl[0]), &flt_rule_entry,
- sizeof(struct ipa_flt_rule_del));
- if (ipa3_del_flt_rule((struct ipa_ioc_del_flt_rule *)param)) {
- IPAWANERR("del A7 UL filter rule(%d) failed\n", i);
- kfree(param);
- return -EFAULT;
- }
- }
- /* set UL filter-rule add-indication */
- rmnet_ipa3_ctx->a7_ul_flt_set = false;
- rmnet_ipa3_ctx->old_num_q6_rules = 0;
- kfree(param);
- return retval;
- }
- static int ipa3_find_mux_channel_index(uint32_t mux_id)
- {
- int i;
- for (i = 0; i < MAX_NUM_OF_MUX_CHANNEL; i++) {
- if (mux_id == rmnet_ipa3_ctx->mux_channel[i].mux_id)
- return i;
- }
- return MAX_NUM_OF_MUX_CHANNEL;
- }
- static int find_vchannel_name_index(const char *vchannel_name)
- {
- int i;
- for (i = 0; i < rmnet_ipa3_ctx->rmnet_index; i++) {
- if (strcmp(rmnet_ipa3_ctx->mux_channel[i].vchannel_name,
- vchannel_name) == 0)
- return i;
- }
- return MAX_NUM_OF_MUX_CHANNEL;
- }
- static enum ipa_upstream_type find_upstream_type(const char *upstreamIface)
- {
- int i;
- for (i = 0; i < MAX_NUM_OF_MUX_CHANNEL; i++) {
- if (strcmp(rmnet_ipa3_ctx->mux_channel[i].vchannel_name,
- upstreamIface) == 0)
- return IPA_UPSTEAM_MODEM;
- }
- if ((strcmp(IPA_UPSTEAM_WLAN_IFACE_NAME, upstreamIface) == 0) ||
- (strcmp(IPA_UPSTEAM_WLAN1_IFACE_NAME, upstreamIface) == 0))
- return IPA_UPSTEAM_WLAN;
- else
- return MAX_NUM_OF_MUX_CHANNEL;
- }
- static int ipa3_wwan_register_to_ipa(int index)
- {
- struct ipa_tx_intf tx_properties = {0};
- struct ipa_ioc_tx_intf_prop tx_ioc_properties[2] = { {0}, {0} };
- struct ipa_ioc_tx_intf_prop *tx_ipv4_property;
- struct ipa_ioc_tx_intf_prop *tx_ipv6_property;
- struct ipa_rx_intf rx_properties = {0};
- struct ipa_ioc_rx_intf_prop rx_ioc_properties[2] = { {0}, {0} };
- struct ipa_ioc_rx_intf_prop *rx_ipv4_property;
- struct ipa_ioc_rx_intf_prop *rx_ipv6_property;
- struct ipa_ext_intf ext_properties = {0};
- struct ipa_ioc_ext_intf_prop *ext_ioc_properties;
- u32 pyld_sz;
- int ret = 0, i;
- IPAWANDBG("index(%d) device[%s]:\n", index,
- rmnet_ipa3_ctx->mux_channel[index].vchannel_name);
- if (!rmnet_ipa3_ctx->mux_channel[index].mux_hdr_set) {
- ret = ipa3_add_qmap_hdr(
- rmnet_ipa3_ctx->mux_channel[index].mux_id,
- &rmnet_ipa3_ctx->mux_channel[index].hdr_hdl);
- if (ret) {
- IPAWANERR("ipa_add_mux_hdr failed (%d)\n", index);
- return ret;
- }
- rmnet_ipa3_ctx->mux_channel[index].mux_hdr_set = true;
- }
- tx_properties.prop = tx_ioc_properties;
- tx_ipv4_property = &tx_properties.prop[0];
- tx_ipv4_property->ip = IPA_IP_v4;
- if (rmnet_ipa3_ctx->ipa_config_is_apq)
- tx_ipv4_property->dst_pipe = IPA_CLIENT_MHI_PRIME_TETH_CONS;
- else
- tx_ipv4_property->dst_pipe = IPA_CLIENT_APPS_WAN_CONS;
- snprintf(tx_ipv4_property->hdr_name, IPA_RESOURCE_NAME_MAX, "%s%d",
- A2_MUX_HDR_NAME_V4_PREF,
- rmnet_ipa3_ctx->mux_channel[index].mux_id);
- tx_ipv6_property = &tx_properties.prop[1];
- tx_ipv6_property->ip = IPA_IP_v6;
- if (rmnet_ipa3_ctx->ipa_config_is_apq)
- tx_ipv6_property->dst_pipe = IPA_CLIENT_MHI_PRIME_TETH_CONS;
- else
- tx_ipv6_property->dst_pipe = IPA_CLIENT_APPS_WAN_CONS;
- /* no need use A2_MUX_HDR_NAME_V6_PREF, same header */
- snprintf(tx_ipv6_property->hdr_name, IPA_RESOURCE_NAME_MAX, "%s%d",
- A2_MUX_HDR_NAME_V4_PREF,
- rmnet_ipa3_ctx->mux_channel[index].mux_id);
- tx_properties.num_props = 2;
- rx_properties.prop = rx_ioc_properties;
- rx_ipv4_property = &rx_properties.prop[0];
- rx_ipv4_property->ip = IPA_IP_v4;
- rx_ipv4_property->attrib.attrib_mask |= IPA_FLT_META_DATA;
- rx_ipv4_property->attrib.meta_data =
- rmnet_ipa3_ctx->mux_channel[index].mux_id << WWAN_METADATA_SHFT;
- rx_ipv4_property->attrib.meta_data_mask = WWAN_METADATA_MASK;
- if (rmnet_ipa3_ctx->ipa_config_is_apq)
- rx_ipv4_property->src_pipe = IPA_CLIENT_MHI_PRIME_TETH_PROD;
- else
- rx_ipv4_property->src_pipe = IPA_CLIENT_APPS_WAN_PROD;
- rx_ipv6_property = &rx_properties.prop[1];
- rx_ipv6_property->ip = IPA_IP_v6;
- rx_ipv6_property->attrib.attrib_mask |= IPA_FLT_META_DATA;
- rx_ipv6_property->attrib.meta_data =
- rmnet_ipa3_ctx->mux_channel[index].mux_id << WWAN_METADATA_SHFT;
- rx_ipv6_property->attrib.meta_data_mask = WWAN_METADATA_MASK;
- if (rmnet_ipa3_ctx->ipa_config_is_apq)
- rx_ipv6_property->src_pipe = IPA_CLIENT_MHI_PRIME_TETH_PROD;
- else
- rx_ipv6_property->src_pipe = IPA_CLIENT_APPS_WAN_PROD;
- rx_properties.num_props = 2;
- if (rmnet_ipa3_ctx->ipa_config_is_apq) {
- /* provide mux-id to ipacm in apq platform*/
- pyld_sz = sizeof(struct ipa_ioc_ext_intf_prop);
- ext_ioc_properties = kmalloc(pyld_sz, GFP_KERNEL);
- if (!ext_ioc_properties)
- return -ENOMEM;
- ext_properties.prop = ext_ioc_properties;
- ext_properties.num_props = 1;
- ext_properties.prop[0].mux_id =
- rmnet_ipa3_ctx->mux_channel[index].mux_id;
- ext_properties.prop[0].ip = IPA_IP_MAX;
- IPAWANDBG("ip: %d mux:%d\n",
- ext_properties.prop[0].ip,
- ext_properties.prop[0].mux_id);
- ret = ipa3_register_intf_ext(
- rmnet_ipa3_ctx->mux_channel[index].vchannel_name,
- &tx_properties,
- &rx_properties,
- &ext_properties);
- if (ret) {
- IPAWANERR("[%d]ipa3_register_intf failed %d\n",
- index,
- ret);
- goto fail;
- }
- goto end;
- }
- /* non apq case */
- pyld_sz = rmnet_ipa3_ctx->num_q6_rules *
- sizeof(struct ipa_ioc_ext_intf_prop);
- ext_ioc_properties = kmalloc(pyld_sz, GFP_KERNEL);
- if (!ext_ioc_properties)
- return -ENOMEM;
- ext_properties.prop = ext_ioc_properties;
- ext_properties.excp_pipe_valid = true;
- ext_properties.excp_pipe = IPA_CLIENT_APPS_WAN_CONS;
- ext_properties.num_props = rmnet_ipa3_ctx->num_q6_rules;
- for (i = 0; i < rmnet_ipa3_ctx->num_q6_rules; i++) {
- memcpy(&(ext_properties.prop[i]),
- &(ipa3_qmi_ctx->q6_ul_filter_rule[i]),
- sizeof(struct ipa_ioc_ext_intf_prop));
- ext_properties.prop[i].mux_id =
- rmnet_ipa3_ctx->mux_channel[index].mux_id;
- IPAWANDBG("index %d ip: %d rt-tbl:%d\n", i,
- ext_properties.prop[i].ip,
- ext_properties.prop[i].rt_tbl_idx);
- IPAWANDBG("action: %d mux:%d\n",
- ext_properties.prop[i].action,
- ext_properties.prop[i].mux_id);
- }
- ret = ipa3_register_intf_ext(
- rmnet_ipa3_ctx->mux_channel[index].vchannel_name,
- &tx_properties,
- &rx_properties,
- &ext_properties);
- if (ret) {
- IPAWANERR("[%s]:ipa3_register_intf failed %d\n",
- rmnet_ipa3_ctx->mux_channel[index].vchannel_name,
- ret);
- goto fail;
- }
- end:
- rmnet_ipa3_ctx->mux_channel[index].ul_flt_reg = true;
- fail:
- kfree(ext_ioc_properties);
- return ret;
- }
- static void ipa3_cleanup_deregister_intf(void)
- {
- int i;
- int ret;
- int8_t *v_name;
- for (i = 0; i < rmnet_ipa3_ctx->rmnet_index; i++) {
- v_name = rmnet_ipa3_ctx->mux_channel[i].vchannel_name;
- if (rmnet_ipa3_ctx->mux_channel[i].ul_flt_reg) {
- ret = ipa3_deregister_intf(v_name);
- if (ret < 0) {
- IPAWANERR("de-register device %s(%d) failed\n",
- v_name,
- i);
- return;
- }
- IPAWANDBG("de-register device %s(%d) success\n",
- v_name,
- i);
- }
- rmnet_ipa3_ctx->mux_channel[i].ul_flt_reg = false;
- }
- }
- int ipa3_wwan_update_mux_channel_prop(void)
- {
- int ret = 0, i;
- /* install UL filter rules */
- if (rmnet_ipa3_ctx->egress_set) {
- if (!ipa3_qmi_ctx->modem_cfg_emb_pipe_flt) {
- IPAWANDBG("setup UL filter rules\n");
- if (rmnet_ipa3_ctx->a7_ul_flt_set) {
- IPAWANDBG("del previous UL filter rules\n");
- /* delete rule hdlers */
- ret = ipa3_wwan_del_ul_flt_rule_to_ipa();
- if (ret) {
- IPAWANERR("failed to del old rules\n");
- return -EINVAL;
- }
- IPAWANDBG("deleted old UL rules\n");
- }
- ret = ipa3_wwan_add_ul_flt_rule_to_ipa();
- }
- if (ret)
- IPAWANERR("failed to install UL rules\n");
- else
- rmnet_ipa3_ctx->a7_ul_flt_set = true;
- }
- /* update Tx/Rx/Ext property */
- IPAWANDBG("update Tx/Rx/Ext property in IPA\n");
- if (rmnet_ipa3_ctx->rmnet_index == 0) {
- IPAWANDBG("no Tx/Rx/Ext property registered in IPA\n");
- return ret;
- }
- ipa3_cleanup_deregister_intf();
- for (i = 0; i < rmnet_ipa3_ctx->rmnet_index; i++) {
- ret = ipa3_wwan_register_to_ipa(i);
- if (ret < 0) {
- IPAWANERR("failed to re-regist %s, mux %d, index %d\n",
- rmnet_ipa3_ctx->mux_channel[i].vchannel_name,
- rmnet_ipa3_ctx->mux_channel[i].mux_id,
- i);
- return -ENODEV;
- }
- IPAWANERR("dev(%s) has registered to IPA\n",
- rmnet_ipa3_ctx->mux_channel[i].vchannel_name);
- rmnet_ipa3_ctx->mux_channel[i].ul_flt_reg = true;
- }
- return ret;
- }
- #ifdef INIT_COMPLETION
- #define reinit_completion(x) INIT_COMPLETION(*(x))
- #endif /* INIT_COMPLETION */
- static int __ipa_wwan_open(struct net_device *dev)
- {
- struct ipa3_wwan_private *wwan_ptr = netdev_priv(dev);
- IPAWANDBG("[%s] __wwan_open()\n", dev->name);
- if (wwan_ptr->device_status != WWAN_DEVICE_ACTIVE)
- reinit_completion(&wwan_ptr->resource_granted_completion);
- wwan_ptr->device_status = WWAN_DEVICE_ACTIVE;
- if (ipa3_rmnet_res.ipa_napi_enable)
- napi_enable(&(wwan_ptr->napi));
- return 0;
- }
- /**
- * wwan_open() - Opens the wwan network interface. Opens logical
- * channel on A2 MUX driver and starts the network stack queue
- *
- * @dev: network device
- *
- * Return codes:
- * 0: success
- * -ENODEV: Error while opening logical channel on A2 MUX driver
- */
- static int ipa3_wwan_open(struct net_device *dev)
- {
- int rc = 0;
- IPAWANDBG("[%s] wwan_open()\n", dev->name);
- rc = __ipa_wwan_open(dev);
- if (rc == 0)
- netif_start_queue(dev);
- return rc;
- }
- static int __ipa_wwan_close(struct net_device *dev)
- {
- struct ipa3_wwan_private *wwan_ptr = netdev_priv(dev);
- int rc = 0;
- if (wwan_ptr->device_status == WWAN_DEVICE_ACTIVE) {
- wwan_ptr->device_status = WWAN_DEVICE_INACTIVE;
- /* do not close wwan port once up, this causes
- * remote side to hang if tried to open again
- */
- reinit_completion(&wwan_ptr->resource_granted_completion);
- rc = ipa3_deregister_intf(dev->name);
- if (rc) {
- IPAWANERR("[%s]: ipa3_deregister_intf failed %d\n",
- dev->name, rc);
- return rc;
- }
- return rc;
- } else {
- return -EBADF;
- }
- }
- /**
- * ipa3_wwan_stop() - Stops the wwan network interface. Closes
- * logical channel on A2 MUX driver and stops the network stack
- * queue
- *
- * @dev: network device
- *
- * Return codes:
- * 0: success
- * -ENODEV: Error while opening logical channel on A2 MUX driver
- */
- static int ipa3_wwan_stop(struct net_device *dev)
- {
- struct ipa3_wwan_private *wwan_ptr = netdev_priv(dev);
- IPAWANDBG("[%s]\n", dev->name);
- __ipa_wwan_close(dev);
- if (ipa3_rmnet_res.ipa_napi_enable)
- napi_disable(&(wwan_ptr->napi));
- netif_stop_queue(dev);
- return 0;
- }
- static int ipa3_wwan_change_mtu(struct net_device *dev, int new_mtu)
- {
- if (0 > new_mtu || WWAN_DATA_LEN < new_mtu)
- return -EINVAL;
- IPAWANDBG("[%s] MTU change: old=%d new=%d\n",
- dev->name, dev->mtu, new_mtu);
- dev->mtu = new_mtu;
- return 0;
- }
- /**
- * ipa3_wwan_xmit() - Transmits an skb.
- *
- * @skb: skb to be transmitted
- * @dev: network device
- *
- * Return codes:
- * 0: success
- * NETDEV_TX_BUSY: Error while transmitting the skb. Try again
- * later
- * -EFAULT: Error while transmitting the skb
- */
- static int ipa3_wwan_xmit(struct sk_buff *skb, struct net_device *dev)
- {
- int ret = 0;
- bool qmap_check;
- struct ipa3_wwan_private *wwan_ptr = netdev_priv(dev);
- unsigned long flags;
- if (rmnet_ipa3_ctx->ipa_config_is_apq) {
- IPAWANERR_RL("IPA embedded data on APQ platform\n");
- dev_kfree_skb_any(skb);
- dev->stats.tx_dropped++;
- return NETDEV_TX_OK;
- }
- if (skb->protocol != htons(ETH_P_MAP)) {
- IPAWANDBG_LOW
- ("SW filtering out none QMAP packet received from %s",
- current->comm);
- dev_kfree_skb_any(skb);
- dev->stats.tx_dropped++;
- return NETDEV_TX_OK;
- }
- qmap_check = RMNET_MAP_GET_CD_BIT(skb);
- spin_lock_irqsave(&wwan_ptr->lock, flags);
- /* There can be a race between enabling the wake queue and
- * suspend in progress. Check if suspend is pending and
- * return from here itself.
- */
- if (atomic_read(&rmnet_ipa3_ctx->ap_suspend)) {
- netif_stop_queue(dev);
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- return NETDEV_TX_BUSY;
- }
- if (netif_queue_stopped(dev)) {
- if (qmap_check &&
- atomic_read(&wwan_ptr->outstanding_pkts) <
- rmnet_ipa3_ctx->outstanding_high_ctl) {
- IPAWANERR("[%s]Queue stop, send ctrl pkts\n",
- dev->name);
- goto send;
- } else {
- IPAWANERR("[%s]fatal: %s stopped\n", dev->name,
- __func__);
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- return NETDEV_TX_BUSY;
- }
- }
- /* checking High WM hit */
- if (atomic_read(&wwan_ptr->outstanding_pkts) >=
- rmnet_ipa3_ctx->outstanding_high) {
- if (!qmap_check) {
- IPAWANDBG_LOW("pending(%d)/(%d)- stop(%d)\n",
- atomic_read(&wwan_ptr->outstanding_pkts),
- rmnet_ipa3_ctx->outstanding_high,
- netif_queue_stopped(dev));
- IPAWANDBG_LOW("qmap_chk(%d)\n", qmap_check);
- netif_stop_queue(dev);
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- return NETDEV_TX_BUSY;
- }
- }
- send:
- /* IPA_PM checking start */
- /* activate the modem pm for clock scaling */
- ipa_pm_activate(rmnet_ipa3_ctx->q6_pm_hdl);
- ret = ipa_pm_activate(rmnet_ipa3_ctx->pm_hdl);
- if (ret == -EINPROGRESS) {
- netif_stop_queue(dev);
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- return NETDEV_TX_BUSY;
- }
- if (ret) {
- IPAWANERR("[%s] fatal: ipa pm activate failed %d\n",
- dev->name, ret);
- dev_kfree_skb_any(skb);
- dev->stats.tx_dropped++;
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- return NETDEV_TX_OK;
- }
- /* IPA_PM checking end */
- /*
- * both data packets and command will be routed to
- * IPA_CLIENT_Q6_WAN_CONS based on status configuration
- */
- ret = ipa3_tx_dp(IPA_CLIENT_APPS_WAN_PROD, skb, NULL);
- if (ret) {
- if (ret == -EPIPE) {
- IPAWANERR_RL("[%s] fatal: pipe is not valid\n",
- dev->name);
- dev_kfree_skb_any(skb);
- dev->stats.tx_dropped++;
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- return NETDEV_TX_OK;
- }
- ret = NETDEV_TX_BUSY;
- goto out;
- }
- atomic_inc(&wwan_ptr->outstanding_pkts);
- dev->stats.tx_packets++;
- dev->stats.tx_bytes += skb->len;
- ret = NETDEV_TX_OK;
- out:
- if (atomic_read(&wwan_ptr->outstanding_pkts) == 0) {
- ipa_pm_deferred_deactivate(rmnet_ipa3_ctx->pm_hdl);
- ipa_pm_deferred_deactivate(rmnet_ipa3_ctx->q6_pm_hdl);
- }
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- return ret;
- }
- static void ipa3_wwan_tx_timeout(struct net_device *dev)
- {
- struct ipa3_wwan_private *wwan_ptr = netdev_priv(dev);
- if (atomic_read(&wwan_ptr->outstanding_pkts) != 0)
- IPAWANERR("[%s] data stall in UL, %d outstanding\n",
- dev->name, atomic_read(&wwan_ptr->outstanding_pkts));
- }
- /**
- * apps_ipa_tx_complete_notify() - Rx notify
- *
- * @priv: driver context
- * @evt: event type
- * @data: data provided with event
- *
- * Check that the packet is the one we sent and release it
- * This function will be called in defered context in IPA wq.
- */
- static void apps_ipa_tx_complete_notify(void *priv,
- enum ipa_dp_evt_type evt,
- unsigned long data)
- {
- struct sk_buff *skb = (struct sk_buff *)data;
- struct net_device *dev = (struct net_device *)priv;
- struct ipa3_wwan_private *wwan_ptr;
- if (dev != IPA_NETDEV()) {
- IPAWANDBG("Received pre-SSR packet completion\n");
- dev_kfree_skb_any(skb);
- return;
- }
- if (evt != IPA_WRITE_DONE) {
- IPAWANERR("unsupported evt on Tx callback, Drop the packet\n");
- dev_kfree_skb_any(skb);
- dev->stats.tx_dropped++;
- return;
- }
- wwan_ptr = netdev_priv(dev);
- atomic_dec(&wwan_ptr->outstanding_pkts);
- __netif_tx_lock_bh(netdev_get_tx_queue(dev, 0));
- if (!atomic_read(&rmnet_ipa3_ctx->is_ssr) &&
- netif_queue_stopped(wwan_ptr->net) &&
- atomic_read(&wwan_ptr->outstanding_pkts) <
- rmnet_ipa3_ctx->outstanding_low) {
- IPAWANDBG_LOW("Outstanding low (%d) - waking up queue\n",
- rmnet_ipa3_ctx->outstanding_low);
- netif_wake_queue(wwan_ptr->net);
- }
- if (atomic_read(&wwan_ptr->outstanding_pkts) == 0) {
- ipa_pm_deferred_deactivate(rmnet_ipa3_ctx->pm_hdl);
- ipa_pm_deferred_deactivate(rmnet_ipa3_ctx->q6_pm_hdl);
- }
- __netif_tx_unlock_bh(netdev_get_tx_queue(dev, 0));
- dev_kfree_skb_any(skb);
- }
- /**
- * apps_ipa_packet_receive_notify() - Rx notify
- *
- * @priv: driver context
- * @evt: event type
- * @data: data provided with event
- *
- * IPA will pass a packet to the Linux network stack with skb->data
- */
- static void apps_ipa_packet_receive_notify(void *priv,
- enum ipa_dp_evt_type evt,
- unsigned long data)
- {
- struct net_device *dev = (struct net_device *)priv;
- if (evt == IPA_RECEIVE) {
- struct sk_buff *skb = (struct sk_buff *)data;
- int result;
- unsigned int packet_len = skb->len;
- IPAWANDBG_LOW("Rx packet was received");
- skb->dev = IPA_NETDEV();
- skb->protocol = htons(ETH_P_MAP);
- if (ipa3_rmnet_res.ipa_napi_enable) {
- trace_rmnet_ipa_netif_rcv_skb3(dev->stats.rx_packets);
- result = netif_receive_skb(skb);
- } else {
- if (dev->stats.rx_packets % IPA_WWAN_RX_SOFTIRQ_THRESH
- == 0) {
- trace_rmnet_ipa_netifni3(dev->stats.rx_packets);
- result = netif_rx_ni(skb);
- } else {
- trace_rmnet_ipa_netifrx3(dev->stats.rx_packets);
- result = netif_rx(skb);
- }
- }
- if (result) {
- pr_err_ratelimited(DEV_NAME " %s:%d fail on netif_receive_skb\n",
- __func__, __LINE__);
- dev->stats.rx_dropped++;
- }
- dev->stats.rx_packets++;
- dev->stats.rx_bytes += packet_len;
- } else {
- IPAWANERR("Invalid evt %d received in wan_ipa_receive\n", evt);
- }
- }
- /* Send RSC endpoint info to modem using QMI indication message */
- static int ipa_send_rsc_pipe_ind_to_modem(void)
- {
- struct ipa_endp_desc_indication_msg_v01 req;
- struct ipa_ep_id_type_v01 *ep_info;
- memset(&req, 0, sizeof(struct ipa_endp_desc_indication_msg_v01));
- req.ep_info_len = 1;
- req.ep_info_valid = true;
- req.num_eps_valid = true;
- req.num_eps = 1;
- ep_info = &req.ep_info[req.ep_info_len - 1];
- ep_info->ep_id = rmnet_ipa3_ctx->ipa3_to_apps_hdl;
- ep_info->ic_type = DATA_IC_TYPE_AP_V01;
- ep_info->ep_type = DATA_EP_DESC_TYPE_RSC_PROD_V01;
- ep_info->ep_status = DATA_EP_STATUS_CONNECTED_V01;
- return ipa3_qmi_send_rsc_pipe_indication(&req);
- }
- static int handle3_ingress_format(struct net_device *dev,
- struct rmnet_ioctl_extended_s *in)
- {
- int ret = 0;
- struct ipa_sys_connect_params *ipa_wan_ep_cfg;
- int ep_idx;
- IPAWANDBG("Get RMNET_IOCTL_SET_INGRESS_DATA_FORMAT\n");
- ep_idx = ipa3_get_ep_mapping(IPA_CLIENT_APPS_WAN_CONS);
- if (ep_idx == IPA_EP_NOT_ALLOCATED) {
- IPAWANDBG("Embedded datapath not supported\n");
- return -EFAULT;
- }
- ipa_wan_ep_cfg = &rmnet_ipa3_ctx->ipa_to_apps_ep_cfg;
- if ((in->u.data) & RMNET_IOCTL_INGRESS_FORMAT_CHECKSUM) {
- if (ipa3_ctx->ipa_hw_type >= IPA_HW_v4_5)
- ipa_wan_ep_cfg->ipa_ep_cfg.cfg.cs_offload_en =
- IPA_ENABLE_CS_DL_QMAP;
- else
- ipa_wan_ep_cfg->ipa_ep_cfg.cfg.cs_offload_en =
- IPA_ENABLE_CS_OFFLOAD_DL;
- IPAWANDBG("DL chksum set\n");
- }
- if ((in->u.data) & RMNET_IOCTL_INGRESS_FORMAT_AGG_DATA) {
- IPAWANDBG("get AGG size %d count %d\n",
- in->u.ingress_format.agg_size,
- in->u.ingress_format.agg_count);
- ret = ipa_disable_apps_wan_cons_deaggr(
- in->u.ingress_format.agg_size,
- in->u.ingress_format.agg_count);
- if (!ret) {
- ipa_wan_ep_cfg->ipa_ep_cfg.aggr.aggr_byte_limit =
- in->u.ingress_format.agg_size;
- ipa_wan_ep_cfg->ipa_ep_cfg.aggr.aggr_pkt_limit =
- in->u.ingress_format.agg_count;
- }
- }
- if (ipa3_ctx->ipa_hw_type >= IPA_HW_v4_5 &&
- (in->u.data) & RMNET_IOCTL_INGRESS_FORMAT_CHECKSUM) {
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_len = 8;
- rmnet_ipa3_ctx->dl_csum_offload_enabled = true;
- } else {
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_len = 4;
- rmnet_ipa3_ctx->dl_csum_offload_enabled = false;
- }
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_ofst_metadata_valid = 1;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_ofst_metadata = 1;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_ofst_pkt_size_valid = 1;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_ofst_pkt_size = 2;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_total_len_or_pad_valid = true;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_total_len_or_pad = 0;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_payload_len_inc_padding = true;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_total_len_or_pad_offset = 0;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_little_endian = 0;
- ipa_wan_ep_cfg->ipa_ep_cfg.metadata_mask.metadata_mask = 0xFF000000;
- ipa_wan_ep_cfg->client = IPA_CLIENT_APPS_WAN_CONS;
- if (dev->features & NETIF_F_GRO_HW)
- /* Setup coalescing pipes */
- ipa_wan_ep_cfg->client = IPA_CLIENT_APPS_WAN_COAL_CONS;
- ipa_wan_ep_cfg->notify = apps_ipa_packet_receive_notify;
- ipa_wan_ep_cfg->priv = dev;
- if (ipa3_rmnet_res.ipa_napi_enable)
- ipa_wan_ep_cfg->napi_obj = &(rmnet_ipa3_ctx->wwan_priv->napi);
- ipa_wan_ep_cfg->desc_fifo_sz =
- ipa3_rmnet_res.wan_rx_desc_size * IPA_FIFO_ELEMENT_SIZE;
- mutex_lock(&rmnet_ipa3_ctx->pipe_handle_guard);
- if (atomic_read(&rmnet_ipa3_ctx->is_ssr)) {
- IPAWANDBG("In SSR sequence/recovery\n");
- mutex_unlock(&rmnet_ipa3_ctx->pipe_handle_guard);
- return -EFAULT;
- }
- ret = ipa3_setup_sys_pipe(&rmnet_ipa3_ctx->ipa_to_apps_ep_cfg,
- &rmnet_ipa3_ctx->ipa3_to_apps_hdl);
- mutex_unlock(&rmnet_ipa3_ctx->pipe_handle_guard);
- if (ret)
- goto end;
- /* construct default WAN RT tbl for IPACM */
- ret = ipa3_setup_a7_qmap_hdr();
- if (ret)
- goto end;
- ret = ipa3_setup_dflt_wan_rt_tables();
- if (ret)
- ipa3_del_a7_qmap_hdr();
- /* Sending QMI indication message share RSC pipe details*/
- if (dev->features & NETIF_F_GRO_HW)
- ipa_send_rsc_pipe_ind_to_modem();
- end:
- if (ret)
- IPAWANERR("failed to configure ingress\n");
- return ret;
- }
- /**
- * handle3_egress_format() - Egress data format configuration
- *
- * Setup IPA egress system pipe and Configure:
- * header handling, checksum, de-aggregation and fifo size
- *
- * @dev: network device
- * @e: egress configuration
- */
- static int handle3_egress_format(struct net_device *dev,
- struct rmnet_ioctl_extended_s *e)
- {
- int rc;
- struct ipa_sys_connect_params *ipa_wan_ep_cfg;
- int ep_idx;
- IPAWANDBG("get RMNET_IOCTL_SET_EGRESS_DATA_FORMAT %x\n", e->u.data);
- /* in APQ platform, only get QMAP format */
- if (rmnet_ipa3_ctx->ipa_config_is_apq) {
- if ((e->u.data) & RMNET_IOCTL_EGRESS_FORMAT_CHECKSUM) {
- /* QMAPv5 */
- rmnet_ipa3_ctx->dl_csum_offload_enabled = false;
- /* send aggr_info_qmi */
- rc = ipa3_qmi_set_aggr_info(DATA_AGGR_TYPE_QMAP_V01);
- } else {
- /* QMAP */
- rmnet_ipa3_ctx->dl_csum_offload_enabled = false;
- /* send aggr_info_qmi */
- rc = ipa3_qmi_set_aggr_info(DATA_AGGR_TYPE_QMAP_V01);
- }
- rmnet_ipa3_ctx->ipa_mhi_aggr_formet_set = true;
- return rc;
- }
- ep_idx = ipa3_get_ep_mapping(IPA_CLIENT_APPS_WAN_PROD);
- if (ep_idx == IPA_EP_NOT_ALLOCATED) {
- IPAWANDBG("Embedded datapath not supported\n");
- return -EFAULT;
- }
- ipa_wan_ep_cfg = &rmnet_ipa3_ctx->apps_to_ipa_ep_cfg;
- if ((e->u.data) & RMNET_IOCTL_EGRESS_FORMAT_CHECKSUM) {
- IPAWANDBG("UL chksum set\n");
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_len = 8;
- ipa_wan_ep_cfg->ipa_ep_cfg.cfg.cs_offload_en =
- IPA_ENABLE_CS_OFFLOAD_UL;
- ipa_wan_ep_cfg->ipa_ep_cfg.cfg.cs_metadata_hdr_offset = 1;
- } else {
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_len = 4;
- }
- if ((e->u.data) & RMNET_IOCTL_EGRESS_FORMAT_AGGREGATION) {
- IPAWANDBG("WAN UL Aggregation enabled\n");
- ipa_wan_ep_cfg->ipa_ep_cfg.aggr.aggr_en = IPA_ENABLE_DEAGGR;
- ipa_wan_ep_cfg->ipa_ep_cfg.aggr.aggr = IPA_QCMAP;
- ipa_wan_ep_cfg->ipa_ep_cfg.deaggr.packet_offset_valid = false;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_ofst_pkt_size = 2;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_total_len_or_pad_valid =
- true;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_total_len_or_pad =
- IPA_HDR_PAD;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_pad_to_alignment =
- 2;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_payload_len_inc_padding =
- true;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_total_len_or_pad_offset =
- 0;
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr_ext.hdr_little_endian =
- false;
- } else {
- IPAWANDBG("WAN UL Aggregation disabled\n");
- ipa_wan_ep_cfg->ipa_ep_cfg.aggr.aggr_en = IPA_BYPASS_AGGR;
- }
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_ofst_metadata_valid = 1;
- /* modem want offset at 0! */
- ipa_wan_ep_cfg->ipa_ep_cfg.hdr.hdr_ofst_metadata = 0;
- ipa_wan_ep_cfg->ipa_ep_cfg.mode.dst = IPA_CLIENT_APPS_WAN_PROD;
- ipa_wan_ep_cfg->ipa_ep_cfg.mode.mode = IPA_BASIC;
- ipa_wan_ep_cfg->client = IPA_CLIENT_APPS_WAN_PROD;
- ipa_wan_ep_cfg->notify = apps_ipa_tx_complete_notify;
- ipa_wan_ep_cfg->desc_fifo_sz = IPA_SYS_TX_DATA_DESC_FIFO_SZ;
- ipa_wan_ep_cfg->priv = dev;
- mutex_lock(&rmnet_ipa3_ctx->pipe_handle_guard);
- if (atomic_read(&rmnet_ipa3_ctx->is_ssr)) {
- IPAWANDBG("In SSR sequence/recovery\n");
- mutex_unlock(&rmnet_ipa3_ctx->pipe_handle_guard);
- return -EFAULT;
- }
- rc = ipa3_setup_sys_pipe(
- ipa_wan_ep_cfg, &rmnet_ipa3_ctx->apps_to_ipa3_hdl);
- if (rc) {
- IPAWANERR("failed to config egress endpoint\n");
- mutex_unlock(&rmnet_ipa3_ctx->pipe_handle_guard);
- return rc;
- }
- mutex_unlock(&rmnet_ipa3_ctx->pipe_handle_guard);
- if (rmnet_ipa3_ctx->num_q6_rules != 0) {
- /* already got Q6 UL filter rules*/
- if (!ipa3_qmi_ctx->modem_cfg_emb_pipe_flt) {
- /* prevent multi-threads accessing num_q6_rules */
- mutex_lock(&rmnet_ipa3_ctx->add_mux_channel_lock);
- rc = ipa3_wwan_add_ul_flt_rule_to_ipa();
- mutex_unlock(
- &rmnet_ipa3_ctx->add_mux_channel_lock);
- }
- if (rc)
- IPAWANERR("install UL rules failed\n");
- else
- rmnet_ipa3_ctx->a7_ul_flt_set = true;
- } else {
- /* wait Q6 UL filter rules*/
- IPAWANDBG("no UL-rules\n");
- }
- rmnet_ipa3_ctx->egress_set = true;
- return rc;
- }
- /**
- * ipa3_wwan_ioctl() - I/O control for wwan network driver.
- *
- * @dev: network device
- * @ifr: ignored
- * @cmd: cmd to be excecuded. can be one of the following:
- * IPA_WWAN_IOCTL_OPEN - Open the network interface
- * IPA_WWAN_IOCTL_CLOSE - Close the network interface
- *
- * Return codes:
- * 0: success
- * NETDEV_TX_BUSY: Error while transmitting the skb. Try again
- * later
- * -EFAULT: Error while transmitting the skb
- */
- static int ipa3_wwan_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
- {
- int rc = 0;
- int mru = 1000, epid = 1, mux_index, len;
- struct ipa_msg_meta msg_meta;
- struct ipa_wan_msg *wan_msg = NULL;
- struct rmnet_ioctl_extended_s ext_ioctl_data;
- struct rmnet_ioctl_data_s ioctl_data;
- struct ipa3_rmnet_mux_val *mux_channel;
- int rmnet_index;
- uint32_t mux_id;
- int8_t *v_name;
- struct mutex *mux_mutex_ptr;
- int wan_ep;
- bool tcp_en = false, udp_en = false;
- IPAWANDBG("rmnet_ipa got ioctl number 0x%08x", cmd);
- switch (cmd) {
- /* Set Ethernet protocol */
- case RMNET_IOCTL_SET_LLP_ETHERNET:
- break;
- /* Set RAWIP protocol */
- case RMNET_IOCTL_SET_LLP_IP:
- break;
- /* Get link protocol */
- case RMNET_IOCTL_GET_LLP:
- ioctl_data.u.operation_mode = RMNET_MODE_LLP_IP;
- if (copy_to_user(ifr->ifr_ifru.ifru_data, &ioctl_data,
- sizeof(struct rmnet_ioctl_data_s)))
- rc = -EFAULT;
- break;
- /* Set QoS header enabled */
- case RMNET_IOCTL_SET_QOS_ENABLE:
- return -EINVAL;
- /* Set QoS header disabled */
- case RMNET_IOCTL_SET_QOS_DISABLE:
- break;
- /* Get QoS header state */
- case RMNET_IOCTL_GET_QOS:
- ioctl_data.u.operation_mode = RMNET_MODE_NONE;
- if (copy_to_user(ifr->ifr_ifru.ifru_data, &ioctl_data,
- sizeof(struct rmnet_ioctl_data_s)))
- rc = -EFAULT;
- break;
- /* Get operation mode */
- case RMNET_IOCTL_GET_OPMODE:
- ioctl_data.u.operation_mode = RMNET_MODE_LLP_IP;
- if (copy_to_user(ifr->ifr_ifru.ifru_data, &ioctl_data,
- sizeof(struct rmnet_ioctl_data_s)))
- rc = -EFAULT;
- break;
- /* Open transport port */
- case RMNET_IOCTL_OPEN:
- break;
- /* Close transport port */
- case RMNET_IOCTL_CLOSE:
- break;
- /* Flow enable */
- case RMNET_IOCTL_FLOW_ENABLE:
- IPAWANERR("RMNET_IOCTL_FLOW_ENABLE not supported\n");
- rc = -EFAULT;
- break;
- /* Flow disable */
- case RMNET_IOCTL_FLOW_DISABLE:
- IPAWANERR("RMNET_IOCTL_FLOW_DISABLE not supported\n");
- rc = -EFAULT;
- break;
- /* Set flow handle */
- case RMNET_IOCTL_FLOW_SET_HNDL:
- break;
- /* Extended IOCTLs */
- case RMNET_IOCTL_EXTENDED:
- if (!ns_capable(dev_net(dev)->user_ns, CAP_NET_ADMIN))
- return -EPERM;
- IPAWANDBG("get ioctl: RMNET_IOCTL_EXTENDED\n");
- if (copy_from_user(&ext_ioctl_data,
- (u8 *)ifr->ifr_ifru.ifru_data,
- sizeof(struct rmnet_ioctl_extended_s))) {
- IPAWANERR("failed to copy extended ioctl data\n");
- rc = -EFAULT;
- break;
- }
- switch (ext_ioctl_data.extended_ioctl) {
- /* Get features */
- case RMNET_IOCTL_GET_SUPPORTED_FEATURES:
- IPAWANDBG("get RMNET_IOCTL_GET_SUPPORTED_FEATURES\n");
- ext_ioctl_data.u.data =
- (RMNET_IOCTL_FEAT_NOTIFY_MUX_CHANNEL |
- RMNET_IOCTL_FEAT_SET_EGRESS_DATA_FORMAT |
- RMNET_IOCTL_FEAT_SET_INGRESS_DATA_FORMAT);
- if (copy_to_user((u8 *)ifr->ifr_ifru.ifru_data,
- &ext_ioctl_data,
- sizeof(struct rmnet_ioctl_extended_s)))
- rc = -EFAULT;
- break;
- /* Set MRU */
- case RMNET_IOCTL_SET_MRU:
- mru = ext_ioctl_data.u.data;
- IPAWANDBG("get MRU size %d\n",
- ext_ioctl_data.u.data);
- break;
- /* Get MRU */
- case RMNET_IOCTL_GET_MRU:
- ext_ioctl_data.u.data = mru;
- if (copy_to_user((u8 *)ifr->ifr_ifru.ifru_data,
- &ext_ioctl_data,
- sizeof(struct rmnet_ioctl_extended_s)))
- rc = -EFAULT;
- break;
- /* GET SG support */
- case RMNET_IOCTL_GET_SG_SUPPORT:
- ext_ioctl_data.u.data =
- ipa3_rmnet_res.ipa_advertise_sg_support;
- if (copy_to_user((u8 *)ifr->ifr_ifru.ifru_data,
- &ext_ioctl_data,
- sizeof(struct rmnet_ioctl_extended_s)))
- rc = -EFAULT;
- break;
- /* Get endpoint ID */
- case RMNET_IOCTL_GET_EPID:
- IPAWANDBG("get ioctl: RMNET_IOCTL_GET_EPID\n");
- ext_ioctl_data.u.data = epid;
- if (copy_to_user((u8 *)ifr->ifr_ifru.ifru_data,
- &ext_ioctl_data,
- sizeof(struct rmnet_ioctl_extended_s)))
- rc = -EFAULT;
- if (copy_from_user(&ext_ioctl_data,
- (u8 *)ifr->ifr_ifru.ifru_data,
- sizeof(struct rmnet_ioctl_extended_s))) {
- IPAWANERR("copy extended ioctl data failed\n");
- rc = -EFAULT;
- break;
- }
- IPAWANDBG("RMNET_IOCTL_GET_EPID return %d\n",
- ext_ioctl_data.u.data);
- break;
- /* Endpoint pair */
- case RMNET_IOCTL_GET_EP_PAIR:
- IPAWANDBG("get ioctl: RMNET_IOCTL_GET_EP_PAIR\n");
- wan_ep = ipa3_get_ep_mapping(IPA_CLIENT_APPS_WAN_CONS);
- if (wan_ep == IPA_EP_NOT_ALLOCATED) {
- IPAWANERR("Embedded datapath not supported\n");
- rc = -EFAULT;
- break;
- }
- ext_ioctl_data.u.ipa_ep_pair.producer_pipe_num =
- wan_ep;
- wan_ep = ipa3_get_ep_mapping(IPA_CLIENT_APPS_WAN_PROD);
- if (wan_ep == IPA_EP_NOT_ALLOCATED) {
- IPAWANERR("Embedded datapath not supported\n");
- rc = -EFAULT;
- break;
- }
- ext_ioctl_data.u.ipa_ep_pair.consumer_pipe_num =
- wan_ep;
- if (copy_to_user((u8 *)ifr->ifr_ifru.ifru_data,
- &ext_ioctl_data,
- sizeof(struct rmnet_ioctl_extended_s)))
- rc = -EFAULT;
- if (copy_from_user(&ext_ioctl_data,
- (u8 *)ifr->ifr_ifru.ifru_data,
- sizeof(struct rmnet_ioctl_extended_s))) {
- IPAWANERR("copy extended ioctl data failed\n");
- rc = -EFAULT;
- break;
- }
- IPAWANDBG("RMNET_IOCTL_GET_EP_PAIR c: %d p: %d\n",
- ext_ioctl_data.u.ipa_ep_pair.consumer_pipe_num,
- ext_ioctl_data.u.ipa_ep_pair.producer_pipe_num);
- break;
- /* Get driver name */
- case RMNET_IOCTL_GET_DRIVER_NAME:
- if (IPA_NETDEV() != NULL) {
- memcpy(&ext_ioctl_data.u.if_name,
- IPA_NETDEV()->name, IFNAMSIZ);
- ext_ioctl_data.u.if_name[IFNAMSIZ - 1] = '\0';
- if (copy_to_user(ifr->ifr_ifru.ifru_data,
- &ext_ioctl_data,
- sizeof(struct rmnet_ioctl_extended_s)))
- rc = -EFAULT;
- } else {
- IPAWANDBG("IPA_NETDEV is NULL\n");
- rc = -EFAULT;
- }
- break;
- /* Add MUX ID */
- case RMNET_IOCTL_ADD_MUX_CHANNEL:
- mux_id = ext_ioctl_data.u.rmnet_mux_val.mux_id;
- mux_index = ipa3_find_mux_channel_index(
- ext_ioctl_data.u.rmnet_mux_val.mux_id);
- if (mux_index < MAX_NUM_OF_MUX_CHANNEL) {
- IPAWANDBG("already setup mux(%d)\n", mux_id);
- return rc;
- }
- mutex_lock(&rmnet_ipa3_ctx->add_mux_channel_lock);
- if (rmnet_ipa3_ctx->rmnet_index
- >= MAX_NUM_OF_MUX_CHANNEL) {
- IPAWANERR("Exceed mux_channel limit(%d)\n",
- rmnet_ipa3_ctx->rmnet_index);
- mutex_unlock(
- &rmnet_ipa3_ctx->add_mux_channel_lock);
- return -EFAULT;
- }
- ext_ioctl_data.u.rmnet_mux_val.vchannel_name
- [IFNAMSIZ-1] = '\0';
- IPAWANDBG("ADD_MUX_CHANNEL(%d, name: %s)\n",
- ext_ioctl_data.u.rmnet_mux_val.mux_id,
- ext_ioctl_data.u.rmnet_mux_val.vchannel_name);
- /* cache the mux name and id */
- mux_channel = rmnet_ipa3_ctx->mux_channel;
- rmnet_index = rmnet_ipa3_ctx->rmnet_index;
- mux_channel[rmnet_index].mux_id =
- ext_ioctl_data.u.rmnet_mux_val.mux_id;
- memcpy(mux_channel[rmnet_index].vchannel_name,
- ext_ioctl_data.u.rmnet_mux_val.vchannel_name,
- sizeof(mux_channel[rmnet_index]
- .vchannel_name));
- mux_channel[rmnet_index].vchannel_name[
- IFNAMSIZ - 1] = '\0';
- IPAWANDBG("cashe device[%s:%d] in IPA_wan[%d]\n",
- mux_channel[rmnet_index].vchannel_name,
- mux_channel[rmnet_index].mux_id,
- rmnet_index);
- /* check if UL filter rules coming*/
- v_name =
- ext_ioctl_data.u.rmnet_mux_val.vchannel_name;
- if (rmnet_ipa3_ctx->num_q6_rules != 0 ||
- (rmnet_ipa3_ctx->ipa_config_is_apq)) {
- mux_mutex_ptr =
- &rmnet_ipa3_ctx->add_mux_channel_lock;
- IPAWANERR_RL("dev(%s) register to IPA\n",
- v_name);
- rc = ipa3_wwan_register_to_ipa(
- rmnet_ipa3_ctx->rmnet_index);
- if (rc < 0) {
- IPAWANERR("device %s reg IPA failed\n",
- v_name);
- mutex_unlock(mux_mutex_ptr);
- return -ENODEV;
- }
- mux_channel[rmnet_index].mux_channel_set =
- true;
- mux_channel[rmnet_index].ul_flt_reg =
- true;
- } else {
- IPAWANDBG("dev(%s) haven't registered to IPA\n",
- v_name);
- mux_channel[rmnet_index].mux_channel_set =
- true;
- mux_channel[rmnet_index].ul_flt_reg =
- false;
- }
- rmnet_ipa3_ctx->rmnet_index++;
- mutex_unlock(&rmnet_ipa3_ctx->add_mux_channel_lock);
- break;
- case RMNET_IOCTL_SET_EGRESS_DATA_FORMAT:
- rc = handle3_egress_format(dev, &ext_ioctl_data);
- break;
- case RMNET_IOCTL_SET_INGRESS_DATA_FORMAT:/* Set IDF */
- rc = handle3_ingress_format(dev, &ext_ioctl_data);
- break;
- case RMNET_IOCTL_SET_XLAT_DEV_INFO:
- wan_msg = kzalloc(sizeof(struct ipa_wan_msg),
- GFP_KERNEL);
- if (!wan_msg)
- return -ENOMEM;
- ext_ioctl_data.u.if_name[IFNAMSIZ-1] = '\0';
- len = sizeof(wan_msg->upstream_ifname) >
- sizeof(ext_ioctl_data.u.if_name) ?
- sizeof(ext_ioctl_data.u.if_name) :
- sizeof(wan_msg->upstream_ifname);
- strlcpy(wan_msg->upstream_ifname,
- ext_ioctl_data.u.if_name, len);
- wan_msg->upstream_ifname[len-1] = '\0';
- memset(&msg_meta, 0, sizeof(struct ipa_msg_meta));
- msg_meta.msg_type = WAN_XLAT_CONNECT;
- msg_meta.msg_len = sizeof(struct ipa_wan_msg);
- rc = ipa3_send_msg(&msg_meta, wan_msg,
- ipa3_wwan_msg_free_cb);
- if (rc) {
- IPAWANERR("Failed to send XLAT_CONNECT msg\n");
- kfree(wan_msg);
- }
- break;
- /* Get agg count */
- case RMNET_IOCTL_GET_AGGREGATION_COUNT:
- break;
- /* Set agg count */
- case RMNET_IOCTL_SET_AGGREGATION_COUNT:
- break;
- /* Get agg size */
- case RMNET_IOCTL_GET_AGGREGATION_SIZE:
- break;
- /* Set agg size */
- case RMNET_IOCTL_SET_AGGREGATION_SIZE:
- break;
- /* Do flow control */
- case RMNET_IOCTL_FLOW_CONTROL:
- break;
- /* For legacy use */
- case RMNET_IOCTL_GET_DFLT_CONTROL_CHANNEL:
- break;
- /* Get HW/SW map */
- case RMNET_IOCTL_GET_HWSW_MAP:
- break;
- /* Set RX Headroom */
- case RMNET_IOCTL_SET_RX_HEADROOM:
- break;
- /* Set RSC/RSB */
- case RMNET_IOCTL_SET_OFFLOAD:
- if (ext_ioctl_data.u.offload_params.flags
- & RMNET_IOCTL_COALESCING_FORMAT_TCP)
- tcp_en = true;
- if (ext_ioctl_data.u.offload_params.flags
- & RMNET_IOCTL_COALESCING_FORMAT_UDP)
- udp_en = true;
- rc = rmnet_ipa_send_coalesce_notification(
- ext_ioctl_data.u.offload_params.mux_id,
- tcp_en || udp_en, tcp_en, udp_en);
- break;
- default:
- IPAWANERR("[%s] unsupported extended cmd[%d]",
- dev->name,
- ext_ioctl_data.extended_ioctl);
- rc = -EINVAL;
- }
- break;
- default:
- IPAWANERR("[%s] unsupported cmd[%d]",
- dev->name, cmd);
- rc = -EINVAL;
- }
- return rc;
- }
- static const struct net_device_ops ipa3_wwan_ops_ip = {
- .ndo_open = ipa3_wwan_open,
- .ndo_stop = ipa3_wwan_stop,
- .ndo_start_xmit = ipa3_wwan_xmit,
- .ndo_tx_timeout = ipa3_wwan_tx_timeout,
- .ndo_do_ioctl = ipa3_wwan_ioctl,
- .ndo_change_mtu = ipa3_wwan_change_mtu,
- .ndo_set_mac_address = 0,
- .ndo_validate_addr = 0,
- };
- /**
- * wwan_setup() - Setups the wwan network driver.
- *
- * @dev: network device
- *
- * Return codes:
- * None
- */
- static void ipa3_wwan_setup(struct net_device *dev)
- {
- dev->netdev_ops = &ipa3_wwan_ops_ip;
- ether_setup(dev);
- /* set this after calling ether_setup */
- dev->header_ops = 0; /* No header */
- dev->type = ARPHRD_RAWIP;
- dev->hard_header_len = 0;
- dev->mtu = WWAN_DATA_LEN;
- dev->addr_len = 0;
- dev->flags &= ~(IFF_BROADCAST | IFF_MULTICAST);
- dev->needed_headroom = HEADROOM_FOR_QMAP;
- dev->needed_tailroom = TAILROOM;
- dev->watchdog_timeo = 1000;
- }
- /**
- * rmnet_ipa_send_coalesce_notification
- * (uint8_t qmap_id, bool enable, bool tcp, bool udp)
- * send RSC notification
- *
- * This function sends the rsc enable/disable notification
- * fot tcp, udp to user-space module
- */
- static int rmnet_ipa_send_coalesce_notification(uint8_t qmap_id,
- bool enable,
- bool tcp,
- bool udp)
- {
- struct ipa_msg_meta msg_meta;
- struct ipa_coalesce_info *coalesce_info;
- int rc;
- memset(&msg_meta, 0, sizeof(struct ipa_msg_meta));
- coalesce_info = kzalloc(sizeof(*coalesce_info), GFP_KERNEL);
- if (!coalesce_info)
- return -ENOMEM;
- if (enable) {
- coalesce_info->qmap_id = qmap_id;
- coalesce_info->tcp_enable = tcp;
- coalesce_info->udp_enable = udp;
- msg_meta.msg_type = IPA_COALESCE_ENABLE;
- msg_meta.msg_len = sizeof(struct ipa_coalesce_info);
- } else {
- msg_meta.msg_type = IPA_COALESCE_DISABLE;
- msg_meta.msg_len = sizeof(struct ipa_coalesce_info);
- }
- rc = ipa_send_msg(&msg_meta, coalesce_info, ipa3_wwan_msg_free_cb);
- if (rc) {
- IPAWANERR("ipa_send_msg failed: %d\n", rc);
- return -EFAULT;
- }
- IPAWANDBG("qmap-id(%d),enable(%d),tcp(%d),udp(%d)\n",
- qmap_id, enable, tcp, udp);
- return 0;
- }
- int ipa3_wwan_set_modem_state(struct wan_ioctl_notify_wan_state *state)
- {
- if (!state)
- return -EINVAL;
- if (state->up)
- return ipa_pm_activate_sync(rmnet_ipa3_ctx->q6_teth_pm_hdl);
- else
- return ipa_pm_deactivate_sync(rmnet_ipa3_ctx->q6_teth_pm_hdl);
- }
- /**
- * ipa3_q6_register_pm - Register modem clients for PM
- *
- * This function will register 2 client with IPA PM to represent modem
- * in clock scaling calculation:
- * - "EMB MODEM" - this client will be activated with embedded traffic
- - "TETH MODEM" - this client we be activated by IPACM on offload to
- modem.
- */
- static int ipa3_q6_register_pm(void)
- {
- int result;
- struct ipa_pm_register_params pm_reg;
- memset(&pm_reg, 0, sizeof(pm_reg));
- pm_reg.name = "EMB MODEM";
- pm_reg.group = IPA_PM_GROUP_MODEM;
- pm_reg.skip_clk_vote = true;
- result = ipa_pm_register(&pm_reg, &rmnet_ipa3_ctx->q6_pm_hdl);
- if (result) {
- IPAERR("failed to create IPA PM client %d\n", result);
- return result;
- }
- pm_reg.name = "TETH MODEM";
- pm_reg.group = IPA_PM_GROUP_MODEM;
- pm_reg.skip_clk_vote = true;
- result = ipa_pm_register(&pm_reg, &rmnet_ipa3_ctx->q6_teth_pm_hdl);
- if (result) {
- IPAERR("failed to create IPA PM client %d\n", result);
- return result;
- }
- return 0;
- }
- static void ipa3_q6_deregister_pm(void)
- {
- ipa_pm_deactivate_sync(rmnet_ipa3_ctx->q6_pm_hdl);
- ipa_pm_deregister(rmnet_ipa3_ctx->q6_pm_hdl);
- }
- int ipa3_wwan_set_modem_perf_profile(int throughput)
- {
- int ret;
- int tether_bridge_handle = 0;
- IPAWANDBG("throughput: %d\n", throughput);
- /* query rmnet-tethering handle */
- tether_bridge_handle = ipa3_teth_bridge_get_pm_hdl();
- if (tether_bridge_handle > 0) {
- /* only update with valid handle*/
- ret = ipa_pm_set_throughput(tether_bridge_handle,
- throughput);
- }
- /* for TETH MODEM on softap/rndis */
- ret = ipa_pm_set_throughput(rmnet_ipa3_ctx->q6_teth_pm_hdl,
- throughput);
- return ret;
- }
- static void ipa3_wake_tx_queue(struct work_struct *work)
- {
- if (IPA_NETDEV()) {
- __netif_tx_lock_bh(netdev_get_tx_queue(IPA_NETDEV(), 0));
- IPAWANDBG("Waking up the workqueue.\n");
- netif_wake_queue(IPA_NETDEV());
- __netif_tx_unlock_bh(netdev_get_tx_queue(IPA_NETDEV(), 0));
- }
- }
- /**
- * ipa3_pm_resource_granted() - Called upon
- * IPA_PM_RESOURCE_GRANTED event. Wakes up the tx workqueue.
- *
- * @work: work object supplied ny workqueue
- *
- * Return codes:
- * None
- */
- static void ipa3_pm_resource_granted(void *dev)
- {
- IPAWANDBG_LOW("Resource Granted - starting queue\n");
- schedule_work(&ipa3_tx_wakequeue_work);
- }
- /* IPA_PM related functions end*/
- static int ipa3_lcl_mdm_ssr_notifier_cb(struct notifier_block *this,
- unsigned long code,
- void *data);
- static int ipa3_rmt_mdm_ssr_notifier_cb(struct notifier_block *this,
- unsigned long code,
- void *data);
- static struct notifier_block ipa3_lcl_mdm_ssr_notifier = {
- .notifier_call = ipa3_lcl_mdm_ssr_notifier_cb,
- };
- static struct notifier_block ipa3_rmt_mdm_ssr_notifier = {
- .notifier_call = ipa3_rmt_mdm_ssr_notifier_cb,
- };
- static int get_ipa_rmnet_dts_configuration(struct platform_device *pdev,
- struct ipa3_rmnet_plat_drv_res *ipa_rmnet_drv_res)
- {
- int result;
- ipa_rmnet_drv_res->wan_rx_desc_size = IPA_WWAN_CONS_DESC_FIFO_SZ;
- ipa_rmnet_drv_res->ipa_rmnet_ssr =
- of_property_read_bool(pdev->dev.of_node,
- "qcom,rmnet-ipa-ssr");
- pr_info("IPA SSR support = %s\n",
- ipa_rmnet_drv_res->ipa_rmnet_ssr ? "True" : "False");
- ipa_rmnet_drv_res->ipa_advertise_sg_support =
- of_property_read_bool(pdev->dev.of_node,
- "qcom,ipa-advertise-sg-support");
- pr_info("IPA SG support = %s\n",
- ipa_rmnet_drv_res->ipa_advertise_sg_support ? "True" : "False");
- ipa_rmnet_drv_res->ipa_napi_enable =
- of_property_read_bool(pdev->dev.of_node,
- "qcom,ipa-napi-enable");
- pr_info("IPA Napi Enable = %s\n",
- ipa_rmnet_drv_res->ipa_napi_enable ? "True" : "False");
- /* Get IPA WAN RX desc fifo size */
- result = of_property_read_u32(pdev->dev.of_node,
- "qcom,wan-rx-desc-size",
- &ipa_rmnet_drv_res->wan_rx_desc_size);
- if (result)
- pr_info("using default for wan-rx-desc-size = %u\n",
- ipa_rmnet_drv_res->wan_rx_desc_size);
- else
- IPAWANDBG(": found ipa_drv_res->wan-rx-desc-size = %u\n",
- ipa_rmnet_drv_res->wan_rx_desc_size);
- return 0;
- }
- struct ipa3_rmnet_context ipa3_rmnet_ctx;
- static int ipa3_wwan_probe(struct platform_device *pdev);
- struct platform_device *m_pdev;
- static void ipa3_delayed_probe(struct work_struct *work)
- {
- (void)ipa3_wwan_probe(m_pdev);
- }
- static DECLARE_WORK(ipa3_scheduled_probe, ipa3_delayed_probe);
- static void ipa3_ready_cb(void *user_data)
- {
- struct platform_device *pdev = (struct platform_device *)(user_data);
- m_pdev = pdev;
- IPAWANDBG("IPA ready callback has been triggered\n");
- schedule_work(&ipa3_scheduled_probe);
- }
- static void ipa_pm_wwan_pm_cb(void *p, enum ipa_pm_cb_event event)
- {
- struct net_device *dev = (struct net_device *)p;
- struct ipa3_wwan_private *wwan_ptr = netdev_priv(dev);
- IPAWANDBG_LOW("event %d\n", event);
- switch (event) {
- case IPA_PM_CLIENT_ACTIVATED:
- if (wwan_ptr->device_status == WWAN_DEVICE_INACTIVE) {
- complete_all(&wwan_ptr->resource_granted_completion);
- break;
- }
- ipa3_pm_resource_granted(dev);
- break;
- default:
- pr_err("%s: unknown event %d\n", __func__, event);
- break;
- }
- }
- static int ipa3_wwan_register_netdev_pm_client(struct net_device *dev)
- {
- int result;
- struct ipa_pm_register_params pm_reg;
- memset(&pm_reg, 0, sizeof(pm_reg));
- pm_reg.name = IPA_NETDEV()->name;
- pm_reg.user_data = dev;
- pm_reg.callback = ipa_pm_wwan_pm_cb;
- pm_reg.group = IPA_PM_GROUP_APPS;
- result = ipa_pm_register(&pm_reg, &rmnet_ipa3_ctx->pm_hdl);
- if (result) {
- IPAERR("failed to create IPA PM client %d\n", result);
- return result;
- }
- return 0;
- }
- static void ipa3_wwan_deregister_netdev_pm_client(void)
- {
- ipa_pm_deactivate_sync(rmnet_ipa3_ctx->pm_hdl);
- ipa_pm_deregister(rmnet_ipa3_ctx->pm_hdl);
- }
- /**
- * ipa3_wwan_probe() - Initialized the module and registers as a
- * network interface to the network stack
- *
- * Note: In case IPA driver hasn't initialized already, the probe function
- * will return immediately after registering a callback to be invoked when
- * IPA driver initialization is complete.
- *
- * Return codes:
- * 0: success
- * -ENOMEM: No memory available
- * -EFAULT: Internal error
- */
- static int ipa3_wwan_probe(struct platform_device *pdev)
- {
- int ret, i;
- struct net_device *dev;
- int wan_cons_ep;
- pr_info("rmnet_ipa3 started initialization\n");
- if (!ipa3_is_ready()) {
- IPAWANDBG("IPA driver not ready, registering callback\n");
- ret = ipa_register_ipa_ready_cb(ipa3_ready_cb, (void *)pdev);
- /*
- * If we received -EEXIST, IPA has initialized. So we need
- * to continue the probing process.
- */
- if (ret != -EEXIST) {
- if (ret)
- IPAWANERR("IPA CB reg failed - %d\n", ret);
- return ret;
- }
- }
- wan_cons_ep = ipa3_get_ep_mapping(IPA_CLIENT_APPS_WAN_CONS);
- ret = get_ipa_rmnet_dts_configuration(pdev, &ipa3_rmnet_res);
- ipa3_rmnet_ctx.ipa_rmnet_ssr = ipa3_rmnet_res.ipa_rmnet_ssr;
- /* check if booting as mhi-prime */
- rmnet_ipa3_ctx->ipa_config_is_apq
- = ipa3_is_apq();
- ret = ipa3_init_q6_smem();
- if (ret) {
- IPAWANERR("ipa3_init_q6_smem failed\n");
- return ret;
- }
- /* initialize tx/rx endpoint setup */
- memset(&rmnet_ipa3_ctx->apps_to_ipa_ep_cfg, 0,
- sizeof(struct ipa_sys_connect_params));
- memset(&rmnet_ipa3_ctx->ipa_to_apps_ep_cfg, 0,
- sizeof(struct ipa_sys_connect_params));
- /* initialize ex property setup */
- rmnet_ipa3_ctx->num_q6_rules = 0;
- rmnet_ipa3_ctx->old_num_q6_rules = 0;
- rmnet_ipa3_ctx->rmnet_index = 0;
- rmnet_ipa3_ctx->egress_set = false;
- rmnet_ipa3_ctx->a7_ul_flt_set = false;
- rmnet_ipa3_ctx->ipa_mhi_aggr_formet_set = false;
- for (i = 0; i < MAX_NUM_OF_MUX_CHANNEL; i++)
- memset(&rmnet_ipa3_ctx->mux_channel[i], 0,
- sizeof(struct ipa3_rmnet_mux_val));
- /* start A7 QMI service/client */
- if (ipa3_ctx->platform_type == IPA_PLAT_TYPE_MSM ||
- ipa3_ctx->platform_type == IPA_PLAT_TYPE_APQ)
- /* Android platform loads uC */
- ipa3_qmi_service_init(QMI_IPA_PLATFORM_TYPE_MSM_ANDROID_V01);
- else if (ipa3_ctx->ipa_config_is_mhi)
- /* LE MHI platform */
- ipa3_qmi_service_init(QMI_IPA_PLATFORM_TYPE_LE_MHI_V01);
- else
- /* LE platform not loads uC */
- ipa3_qmi_service_init(QMI_IPA_PLATFORM_TYPE_LE_V01);
- if (!atomic_read(&rmnet_ipa3_ctx->is_ssr)) {
- /* Start transport-driver fd ioctl for ipacm for first init */
- ret = ipa3_wan_ioctl_init();
- if (ret)
- goto wan_ioctl_init_err;
- } else {
- /* Enable sending QMI messages after SSR */
- ipa3_wan_ioctl_enable_qmi_messages();
- }
- /* initialize wan-driver netdev */
- dev = alloc_netdev(sizeof(struct ipa3_wwan_private),
- IPA_WWAN_DEV_NAME,
- NET_NAME_UNKNOWN,
- ipa3_wwan_setup);
- if (!dev) {
- IPAWANERR("no memory for netdev\n");
- ret = -ENOMEM;
- goto alloc_netdev_err;
- }
- rmnet_ipa3_ctx->wwan_priv = netdev_priv(dev);
- memset(rmnet_ipa3_ctx->wwan_priv, 0,
- sizeof(*(rmnet_ipa3_ctx->wwan_priv)));
- IPAWANDBG("wwan_ptr (private) = %pK", rmnet_ipa3_ctx->wwan_priv);
- rmnet_ipa3_ctx->wwan_priv->net = dev;
- atomic_set(&rmnet_ipa3_ctx->wwan_priv->outstanding_pkts, 0);
- spin_lock_init(&rmnet_ipa3_ctx->wwan_priv->lock);
- init_completion(
- &rmnet_ipa3_ctx->wwan_priv->resource_granted_completion);
- if (!atomic_read(&rmnet_ipa3_ctx->is_ssr)) {
- /* IPA_PM configuration starts */
- ret = ipa3_q6_register_pm();
- if (ret) {
- IPAWANERR("ipa3_q6_register_pm failed, ret: %d\n",
- ret);
- goto q6_init_err;
- }
- }
- ret = ipa3_wwan_register_netdev_pm_client(dev);
- if (ret) {
- IPAWANERR("fail to create/register pm resources\n");
- goto fail_pm;
- }
- /* Enable SG support in netdevice. */
- if (ipa3_rmnet_res.ipa_advertise_sg_support)
- dev->hw_features |= NETIF_F_SG;
- if (ipa3_rmnet_res.ipa_napi_enable)
- netif_napi_add(dev, &(rmnet_ipa3_ctx->wwan_priv->napi),
- ipa3_rmnet_poll, NAPI_WEIGHT);
- ret = register_netdev(dev);
- if (ret) {
- IPAWANERR("unable to register ipa_netdev %d rc=%d\n",
- 0, ret);
- goto set_perf_err;
- }
- IPAWANDBG("IPA-WWAN devices (%s) initialization ok :>>>>\n", dev->name);
- if (ret) {
- IPAWANERR("default configuration failed rc=%d\n",
- ret);
- goto config_err;
- }
- /* for > IPA 4.5, we set the colaescing feature flag on */
- if (ipa3_ctx->ipa_hw_type >= IPA_HW_v4_5)
- dev->hw_features |= NETIF_F_GRO_HW | NETIF_F_RXCSUM;
- /*
- * for IPA 4.0 offline charge is not needed and we need to prevent
- * power collapse until IPA uC is loaded.
- */
- atomic_set(&rmnet_ipa3_ctx->is_initialized, 1);
- if (!atomic_read(&rmnet_ipa3_ctx->is_ssr) && ipa3_ctx->ipa_hw_type !=
- IPA_HW_v4_0) {
- /* offline charging mode */
- ipa3_proxy_clk_unvote();
- }
- atomic_set(&rmnet_ipa3_ctx->is_ssr, 0);
- atomic_set(&rmnet_ipa3_ctx->ap_suspend, 0);
- ipa3_update_ssr_state(false);
- IPAWANERR("rmnet_ipa completed initialization\n");
- return 0;
- config_err:
- if (ipa3_rmnet_res.ipa_napi_enable)
- netif_napi_del(&(rmnet_ipa3_ctx->wwan_priv->napi));
- unregister_netdev(dev);
- set_perf_err:
- ipa3_wwan_deregister_netdev_pm_client();
- fail_pm:
- if (!atomic_read(&rmnet_ipa3_ctx->is_ssr))
- ipa3_q6_deregister_pm();
- q6_init_err:
- free_netdev(dev);
- rmnet_ipa3_ctx->wwan_priv = NULL;
- alloc_netdev_err:
- ipa3_wan_ioctl_deinit();
- wan_ioctl_init_err:
- ipa3_qmi_service_exit();
- atomic_set(&rmnet_ipa3_ctx->is_ssr, 0);
- return ret;
- }
- static int ipa3_wwan_remove(struct platform_device *pdev)
- {
- int ret;
- IPAWANINFO("rmnet_ipa started deinitialization\n");
- mutex_lock(&rmnet_ipa3_ctx->pipe_handle_guard);
- ret = ipa3_teardown_sys_pipe(rmnet_ipa3_ctx->ipa3_to_apps_hdl);
- if (ret < 0)
- IPAWANERR("Failed to teardown IPA->APPS pipe\n");
- else
- rmnet_ipa3_ctx->ipa3_to_apps_hdl = -1;
- ret = ipa3_teardown_sys_pipe(rmnet_ipa3_ctx->apps_to_ipa3_hdl);
- if (ret < 0)
- IPAWANERR("Failed to teardown APPS->IPA pipe\n");
- else
- rmnet_ipa3_ctx->apps_to_ipa3_hdl = -1;
- if (ipa3_rmnet_res.ipa_napi_enable)
- netif_napi_del(&(rmnet_ipa3_ctx->wwan_priv->napi));
- mutex_unlock(&rmnet_ipa3_ctx->pipe_handle_guard);
- IPAWANINFO("rmnet_ipa unregister_netdev\n");
- unregister_netdev(IPA_NETDEV());
- ipa3_wwan_deregister_netdev_pm_client();
- cancel_work_sync(&ipa3_tx_wakequeue_work);
- cancel_delayed_work(&ipa_tether_stats_poll_wakequeue_work);
- if (IPA_NETDEV())
- free_netdev(IPA_NETDEV());
- rmnet_ipa3_ctx->wwan_priv = NULL;
- /* No need to remove wwan_ioctl during SSR */
- if (!atomic_read(&rmnet_ipa3_ctx->is_ssr))
- ipa3_wan_ioctl_deinit();
- if (ipa3_get_ep_mapping(IPA_CLIENT_APPS_WAN_CONS) !=
- IPA_EP_NOT_ALLOCATED) {
- ipa3_del_dflt_wan_rt_tables();
- ipa3_del_a7_qmap_hdr();
- }
- ipa3_del_mux_qmap_hdrs();
- if (!ipa3_qmi_ctx->modem_cfg_emb_pipe_flt)
- ipa3_wwan_del_ul_flt_rule_to_ipa();
- ipa3_cleanup_deregister_intf();
- /* reset dl_csum_offload_enabled */
- rmnet_ipa3_ctx->dl_csum_offload_enabled = false;
- atomic_set(&rmnet_ipa3_ctx->is_initialized, 0);
- IPAWANINFO("rmnet_ipa completed deinitialization\n");
- return 0;
- }
- /**
- * rmnet_ipa_ap_suspend() - suspend callback for runtime_pm
- * @dev: pointer to device
- *
- * This callback will be invoked by the runtime_pm framework when an AP suspend
- * operation is invoked, usually by pressing a suspend button.
- *
- * Returns -EAGAIN to runtime_pm framework in case there are pending packets
- * in the Tx queue. This will postpone the suspend operation until all the
- * pending packets will be transmitted.
- *
- * In case there are no packets to send, releases the WWAN0_PROD entity.
- * As an outcome, the number of IPA active clients should be decremented
- * until IPA clocks can be gated.
- */
- static int rmnet_ipa_ap_suspend(struct device *dev)
- {
- struct net_device *netdev = IPA_NETDEV();
- struct ipa3_wwan_private *wwan_ptr;
- int ret;
- unsigned long flags;
- IPAWANDBG("Enter...\n");
- if (netdev == NULL) {
- IPAWANERR("netdev is NULL.\n");
- ret = 0;
- goto bail;
- }
- wwan_ptr = netdev_priv(netdev);
- if (wwan_ptr == NULL) {
- IPAWANERR("wwan_ptr is NULL.\n");
- ret = 0;
- goto bail;
- }
- /*
- * Rmnert supend and xmit are executing at the same time, In those
- * scenarios observing the data was processed when IPA clock are off.
- * Added changes to synchronize rmnet supend and xmit.
- */
- atomic_set(&rmnet_ipa3_ctx->ap_suspend, 1);
- spin_lock_irqsave(&wwan_ptr->lock, flags);
- /* Do not allow A7 to suspend in case there are outstanding packets */
- if (atomic_read(&wwan_ptr->outstanding_pkts) != 0) {
- IPAWANDBG("Outstanding packets, postponing AP suspend.\n");
- ret = -EAGAIN;
- atomic_set(&rmnet_ipa3_ctx->ap_suspend, 0);
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- goto bail;
- }
- /* Make sure that there is no Tx operation ongoing */
- netif_stop_queue(netdev);
- spin_unlock_irqrestore(&wwan_ptr->lock, flags);
- IPAWANDBG("De-activating the PM resource.\n");
- ipa_pm_deactivate_sync(rmnet_ipa3_ctx->pm_hdl);
- ret = 0;
- bail:
- IPAWANDBG("Exit with %d\n", ret);
- return ret;
- }
- /**
- * rmnet_ipa_ap_resume() - resume callback for runtime_pm
- * @dev: pointer to device
- *
- * This callback will be invoked by the runtime_pm framework when an AP resume
- * operation is invoked.
- *
- * Enables the network interface queue and returns success to the
- * runtime_pm framework.
- */
- static int rmnet_ipa_ap_resume(struct device *dev)
- {
- struct net_device *netdev = IPA_NETDEV();
- IPAWANDBG("Enter...\n");
- /* Clear the suspend in progress flag. */
- atomic_set(&rmnet_ipa3_ctx->ap_suspend, 0);
- if (netdev)
- netif_wake_queue(netdev);
- IPAWANDBG("Exit\n");
- return 0;
- }
- static void ipa_stop_polling_stats(void)
- {
- cancel_delayed_work(&ipa_tether_stats_poll_wakequeue_work);
- ipa3_rmnet_ctx.polling_interval = 0;
- }
- static const struct of_device_id rmnet_ipa_dt_match[] = {
- {.compatible = "qcom,rmnet-ipa3"},
- {},
- };
- MODULE_DEVICE_TABLE(of, rmnet_ipa_dt_match);
- static const struct dev_pm_ops rmnet_ipa_pm_ops = {
- .suspend_noirq = rmnet_ipa_ap_suspend,
- .resume_noirq = rmnet_ipa_ap_resume,
- };
- static struct platform_driver rmnet_ipa_driver = {
- .driver = {
- .name = "rmnet_ipa3",
- .pm = &rmnet_ipa_pm_ops,
- .of_match_table = rmnet_ipa_dt_match,
- },
- .probe = ipa3_wwan_probe,
- .remove = ipa3_wwan_remove,
- };
- /**
- * rmnet_ipa_send_ssr_notification(bool ssr_done) - send SSR notification
- *
- * This function sends the SSR notification before modem shutdown and
- * after_powerup from SSR framework, to user-space module
- */
- static void rmnet_ipa_send_ssr_notification(bool ssr_done)
- {
- struct ipa_msg_meta msg_meta;
- int rc;
- memset(&msg_meta, 0, sizeof(struct ipa_msg_meta));
- if (ssr_done)
- msg_meta.msg_type = IPA_SSR_AFTER_POWERUP;
- else
- msg_meta.msg_type = IPA_SSR_BEFORE_SHUTDOWN;
- rc = ipa_send_msg(&msg_meta, NULL, NULL);
- if (rc) {
- IPAWANERR("ipa_send_msg failed: %d\n", rc);
- return;
- }
- }
- static int ipa3_lcl_mdm_ssr_notifier_cb(struct notifier_block *this,
- unsigned long code,
- void *data)
- {
- if (!ipa3_rmnet_ctx.ipa_rmnet_ssr)
- return NOTIFY_DONE;
- if (!ipa3_ctx) {
- IPAWANERR_RL("ipa3_ctx was not initialized\n");
- return NOTIFY_DONE;
- }
- if (rmnet_ipa3_ctx->ipa_config_is_apq) {
- IPAWANERR("Local modem SSR event=%lu on APQ platform\n",
- code);
- return NOTIFY_DONE;
- }
- switch (code) {
- case SUBSYS_BEFORE_SHUTDOWN:
- IPAWANINFO("IPA received MPSS BEFORE_SHUTDOWN\n");
- /* send SSR before-shutdown notification to IPACM */
- rmnet_ipa_send_ssr_notification(false);
- atomic_set(&rmnet_ipa3_ctx->is_ssr, 1);
- ipa3_q6_pre_shutdown_cleanup();
- if (IPA_NETDEV())
- netif_stop_queue(IPA_NETDEV());
- ipa3_qmi_stop_workqueues();
- ipa3_wan_ioctl_stop_qmi_messages();
- ipa_stop_polling_stats();
- if (atomic_read(&rmnet_ipa3_ctx->is_initialized))
- platform_driver_unregister(&rmnet_ipa_driver);
- imp_handle_modem_shutdown();
- if (atomic_read(&rmnet_ipa3_ctx->is_ssr) &&
- ipa3_ctx->ipa_hw_type >= IPA_HW_v4_0)
- ipa3_q6_post_shutdown_cleanup();
- ipa3_odl_pipe_cleanup(true);
- IPAWANINFO("IPA BEFORE_SHUTDOWN handling is complete\n");
- break;
- case SUBSYS_AFTER_SHUTDOWN:
- IPAWANINFO("IPA Received MPSS AFTER_SHUTDOWN\n");
- if (atomic_read(&rmnet_ipa3_ctx->is_ssr) &&
- ipa3_ctx->ipa_hw_type < IPA_HW_v4_0)
- ipa3_q6_post_shutdown_cleanup();
- if (ipa3_ctx->ipa_endp_delay_wa)
- ipa3_client_prod_post_shutdown_cleanup();
- IPAWANINFO("IPA AFTER_SHUTDOWN handling is complete\n");
- break;
- case SUBSYS_BEFORE_POWERUP:
- IPAWANINFO("IPA received MPSS BEFORE_POWERUP\n");
- if (atomic_read(&rmnet_ipa3_ctx->is_ssr)) {
- /* clean up cached QMI msg/handlers */
- ipa3_qmi_service_exit();
- ipa3_q6_pre_powerup_cleanup();
- }
- /* hold a proxy vote for the modem. */
- ipa3_proxy_clk_vote();
- ipa3_reset_freeze_vote();
- IPAWANINFO("IPA BEFORE_POWERUP handling is complete\n");
- break;
- case SUBSYS_AFTER_POWERUP:
- IPAWANINFO("IPA received MPSS AFTER_POWERUP\n");
- if (!atomic_read(&rmnet_ipa3_ctx->is_initialized) &&
- atomic_read(&rmnet_ipa3_ctx->is_ssr))
- platform_driver_register(&rmnet_ipa_driver);
- ipa3_odl_pipe_open();
- IPAWANINFO("IPA AFTER_POWERUP handling is complete\n");
- break;
- default:
- IPAWANDBG("Unsupported subsys notification, IPA received: %lu",
- code);
- break;
- }
- IPAWANDBG_LOW("Exit\n");
- return NOTIFY_DONE;
- }
- static int ipa3_rmt_mdm_ssr_notifier_cb(struct notifier_block *this,
- unsigned long code,
- void *data)
- {
- if (!ipa3_rmnet_ctx.ipa_rmnet_ssr) {
- IPAWANERR("SSR event=%lu while not enabled\n", code);
- return NOTIFY_DONE;
- }
- if (!rmnet_ipa3_ctx->ipa_config_is_apq) {
- IPAWANERR("Remote mdm SSR event=%lu on non-APQ platform=%d\n",
- code, ipa3_ctx->platform_type);
- return NOTIFY_DONE;
- }
- switch (code) {
- case SUBSYS_BEFORE_SHUTDOWN:
- IPAWANINFO("IPA received RMT MPSS BEFORE_SHUTDOWN\n");
- break;
- case SUBSYS_AFTER_SHUTDOWN:
- IPAWANINFO("IPA Received RMT MPSS AFTER_SHUTDOWN\n");
- break;
- case SUBSYS_BEFORE_POWERUP:
- IPAWANINFO("IPA received RMT MPSS BEFORE_POWERUP\n");
- break;
- case SUBSYS_AFTER_POWERUP:
- IPAWANINFO("IPA received RMT MPSS AFTER_POWERUP\n");
- break;
- default:
- IPAWANDBG("IPA received RMT MPSS event %lu", code);
- break;
- }
- return NOTIFY_DONE;
- }
- /**
- * rmnet_ipa_free_msg() - Free the msg sent to user space via ipa_send_msg
- * @buff: pointer to buffer containing the message
- * @len: message len
- * @type: message type
- *
- * This function is invoked when ipa_send_msg is complete (Provided as a
- * free function pointer along with the message).
- */
- static void rmnet_ipa_free_msg(void *buff, u32 len, u32 type)
- {
- if (!buff) {
- IPAWANERR("Null buffer\n");
- return;
- }
- if (type != IPA_TETHERING_STATS_UPDATE_STATS &&
- type != IPA_TETHERING_STATS_UPDATE_NETWORK_STATS &&
- type != IPA_PER_CLIENT_STATS_CONNECT_EVENT &&
- type != IPA_PER_CLIENT_STATS_DISCONNECT_EVENT) {
- IPAWANERR("Wrong type given. buff %pK type %d\n",
- buff, type);
- }
- kfree(buff);
- }
- /**
- * rmnet_ipa_get_stats_and_update() - Gets pipe stats from Modem
- *
- * This function queries the IPA Modem driver for the pipe stats
- * via QMI, and updates the user space IPA entity.
- */
- static void rmnet_ipa_get_stats_and_update(void)
- {
- struct ipa_get_data_stats_req_msg_v01 req;
- struct ipa_get_data_stats_resp_msg_v01 *resp;
- struct ipa_msg_meta msg_meta;
- int rc;
- resp = kzalloc(sizeof(struct ipa_get_data_stats_resp_msg_v01),
- GFP_KERNEL);
- if (!resp)
- return;
- memset(&req, 0, sizeof(struct ipa_get_data_stats_req_msg_v01));
- memset(resp, 0, sizeof(struct ipa_get_data_stats_resp_msg_v01));
- req.ipa_stats_type = QMI_IPA_STATS_TYPE_PIPE_V01;
- rc = ipa3_qmi_get_data_stats(&req, resp);
- if (rc) {
- IPAWANERR("ipa3_qmi_get_data_stats failed: %d\n", rc);
- kfree(resp);
- return;
- }
- memset(&msg_meta, 0, sizeof(struct ipa_msg_meta));
- msg_meta.msg_type = IPA_TETHERING_STATS_UPDATE_STATS;
- msg_meta.msg_len = sizeof(struct ipa_get_data_stats_resp_msg_v01);
- rc = ipa_send_msg(&msg_meta, resp, rmnet_ipa_free_msg);
- if (rc) {
- IPAWANERR("ipa_send_msg failed: %d\n", rc);
- kfree(resp);
- return;
- }
- }
- /**
- * tethering_stats_poll_queue() - Stats polling function
- * @work - Work entry
- *
- * This function is scheduled periodically (per the interval) in
- * order to poll the IPA Modem driver for the pipe stats.
- */
- static void tethering_stats_poll_queue(struct work_struct *work)
- {
- rmnet_ipa_get_stats_and_update();
- /* Schedule again only if there's an active polling interval */
- if (ipa3_rmnet_ctx.polling_interval != 0)
- schedule_delayed_work(&ipa_tether_stats_poll_wakequeue_work,
- msecs_to_jiffies(ipa3_rmnet_ctx.polling_interval*1000));
- }
- /**
- * rmnet_ipa_get_network_stats_and_update() - Get network stats from IPA Modem
- *
- * This function retrieves the data usage (used quota) from the IPA Modem driver
- * via QMI, and updates IPA user space entity.
- */
- static void rmnet_ipa_get_network_stats_and_update(void)
- {
- struct ipa_get_apn_data_stats_req_msg_v01 req;
- struct ipa_get_apn_data_stats_resp_msg_v01 *resp;
- struct ipa_msg_meta msg_meta;
- int rc;
- resp = kzalloc(sizeof(struct ipa_get_apn_data_stats_resp_msg_v01),
- GFP_KERNEL);
- if (!resp)
- return;
- memset(&req, 0, sizeof(struct ipa_get_apn_data_stats_req_msg_v01));
- memset(resp, 0, sizeof(struct ipa_get_apn_data_stats_resp_msg_v01));
- req.mux_id_list_valid = true;
- req.mux_id_list_len = 1;
- req.mux_id_list[0] = ipa3_rmnet_ctx.metered_mux_id;
- rc = ipa3_qmi_get_network_stats(&req, resp);
- if (rc) {
- IPAWANERR("ipa3_qmi_get_network_stats failed: %d\n", rc);
- kfree(resp);
- return;
- }
- memset(&msg_meta, 0, sizeof(struct ipa_msg_meta));
- msg_meta.msg_type = IPA_TETHERING_STATS_UPDATE_NETWORK_STATS;
- msg_meta.msg_len = sizeof(struct ipa_get_apn_data_stats_resp_msg_v01);
- rc = ipa_send_msg(&msg_meta, resp, rmnet_ipa_free_msg);
- if (rc) {
- IPAWANERR("ipa_send_msg failed: %d\n", rc);
- kfree(resp);
- return;
- }
- }
- /**
- * rmnet_ipa_send_quota_reach_ind() - send quota_reach notification from
- * IPA Modem
- * This function sends the quota_reach indication from the IPA Modem driver
- * via QMI, to user-space module
- */
- static void rmnet_ipa_send_quota_reach_ind(void)
- {
- struct ipa_msg_meta msg_meta;
- int rc;
- memset(&msg_meta, 0, sizeof(struct ipa_msg_meta));
- msg_meta.msg_type = IPA_QUOTA_REACH;
- rc = ipa_send_msg(&msg_meta, NULL, NULL);
- if (rc) {
- IPAWANERR("ipa_send_msg failed: %d\n", rc);
- return;
- }
- }
- /**
- * rmnet_ipa3_poll_tethering_stats() - Tethering stats polling IOCTL handler
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_POLL_TETHERING_STATS.
- * In case polling interval received is 0, polling will stop
- * (If there's a polling in progress, it will allow it to finish), and then will
- * fetch network stats, and update the IPA user space.
- *
- * Return codes:
- * 0: Success
- */
- int rmnet_ipa3_poll_tethering_stats(struct wan_ioctl_poll_tethering_stats *data)
- {
- ipa3_rmnet_ctx.polling_interval = data->polling_interval_secs;
- cancel_delayed_work_sync(&ipa_tether_stats_poll_wakequeue_work);
- if (ipa3_rmnet_ctx.polling_interval == 0) {
- ipa3_qmi_stop_data_qouta();
- rmnet_ipa_get_network_stats_and_update();
- rmnet_ipa_get_stats_and_update();
- return 0;
- }
- schedule_delayed_work(&ipa_tether_stats_poll_wakequeue_work, 0);
- return 0;
- }
- /**
- * rmnet_ipa_set_data_quota_modem() - Data quota setting IOCTL handler
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_SET_DATA_QUOTA on modem interface.
- * It translates the given interface name to the Modem MUX ID and
- * sends the request of the quota to the IPA Modem driver via QMI.
- *
- * Return codes:
- * 0: Success
- * -EFAULT: Invalid interface name provided
- * other: See ipa_qmi_set_data_quota
- */
- static int rmnet_ipa3_set_data_quota_modem(
- struct wan_ioctl_set_data_quota *data)
- {
- u32 mux_id;
- int index;
- struct ipa_set_data_usage_quota_req_msg_v01 req;
- /* stop quota */
- if (!data->set_quota)
- ipa3_qmi_stop_data_qouta();
- /* prevent string buffer overflows */
- data->interface_name[IFNAMSIZ-1] = '\0';
- index = find_vchannel_name_index(data->interface_name);
- IPAWANERR("iface name %s, quota %lu\n",
- data->interface_name, (unsigned long) data->quota_mbytes);
- if (index == MAX_NUM_OF_MUX_CHANNEL) {
- IPAWANERR("%s is an invalid iface name\n",
- data->interface_name);
- return -ENODEV;
- }
- mux_id = rmnet_ipa3_ctx->mux_channel[index].mux_id;
- ipa3_rmnet_ctx.metered_mux_id = mux_id;
- memset(&req, 0, sizeof(struct ipa_set_data_usage_quota_req_msg_v01));
- req.apn_quota_list_valid = true;
- req.apn_quota_list_len = 1;
- req.apn_quota_list[0].mux_id = mux_id;
- req.apn_quota_list[0].num_Mbytes = data->quota_mbytes;
- return ipa3_qmi_set_data_quota(&req);
- }
- static int rmnet_ipa3_set_data_quota_wifi(struct wan_ioctl_set_data_quota *data)
- {
- struct ipa_set_wifi_quota wifi_quota;
- int rc = 0;
- memset(&wifi_quota, 0, sizeof(struct ipa_set_wifi_quota));
- wifi_quota.set_quota = data->set_quota;
- wifi_quota.quota_bytes = data->quota_mbytes;
- IPAWANERR("iface name %s, quota %lu\n",
- data->interface_name, (unsigned long) data->quota_mbytes);
- rc = ipa3_set_wlan_quota(&wifi_quota);
- /* check if wlan-fw takes this quota-set */
- if (!wifi_quota.set_valid)
- rc = -EFAULT;
- return rc;
- }
- /**
- * rmnet_ipa_set_data_quota() - Data quota setting IOCTL handler
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_SET_DATA_QUOTA.
- * It translates the given interface name to the Modem MUX ID and
- * sends the request of the quota to the IPA Modem driver via QMI.
- *
- * Return codes:
- * 0: Success
- * -EFAULT: Invalid interface name provided
- * other: See ipa_qmi_set_data_quota
- */
- int rmnet_ipa3_set_data_quota(struct wan_ioctl_set_data_quota *data)
- {
- enum ipa_upstream_type upstream_type;
- int rc = 0;
- /* prevent string buffer overflows */
- data->interface_name[IFNAMSIZ-1] = '\0';
- /* get IPA backhaul type */
- upstream_type = find_upstream_type(data->interface_name);
- if (upstream_type == IPA_UPSTEAM_MAX) {
- IPAWANERR("Wrong interface_name name %s\n",
- data->interface_name);
- } else if (upstream_type == IPA_UPSTEAM_WLAN) {
- rc = rmnet_ipa3_set_data_quota_wifi(data);
- if (rc) {
- IPAWANERR("set quota on wifi failed\n");
- return rc;
- }
- } else {
- rc = rmnet_ipa3_set_data_quota_modem(data);
- if (rc) {
- IPAWANERR("set quota on modem failed\n");
- return rc;
- }
- }
- return rc;
- }
- /* rmnet_ipa_set_tether_client_pipe() -
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_SET_DATA_QUOTA.
- * It translates the given interface name to the Modem MUX ID and
- * sends the request of the quota to the IPA Modem driver via QMI.
- *
- * Return codes:
- * 0: Success
- * -EFAULT: Invalid interface name provided
- * other: See ipa_qmi_set_data_quota
- */
- int rmnet_ipa3_set_tether_client_pipe(
- struct wan_ioctl_set_tether_client_pipe *data)
- {
- int number, i;
- /* error checking if ul_src_pipe_len valid or not*/
- if (data->ul_src_pipe_len > QMI_IPA_MAX_PIPES_V01 ||
- data->ul_src_pipe_len < 0) {
- IPAWANERR("UL src pipes %d exceeding max %d\n",
- data->ul_src_pipe_len,
- QMI_IPA_MAX_PIPES_V01);
- return -EFAULT;
- }
- /* error checking if dl_dst_pipe_len valid or not*/
- if (data->dl_dst_pipe_len > QMI_IPA_MAX_PIPES_V01 ||
- data->dl_dst_pipe_len < 0) {
- IPAWANERR("DL dst pipes %d exceeding max %d\n",
- data->dl_dst_pipe_len,
- QMI_IPA_MAX_PIPES_V01);
- return -EFAULT;
- }
- IPAWANDBG("client %d, UL %d, DL %d, reset %d\n",
- data->ipa_client,
- data->ul_src_pipe_len,
- data->dl_dst_pipe_len,
- data->reset_client);
- number = data->ul_src_pipe_len;
- for (i = 0; i < number; i++) {
- IPAWANDBG("UL index-%d pipe %d\n", i,
- data->ul_src_pipe_list[i]);
- if (data->reset_client)
- ipa3_set_client(data->ul_src_pipe_list[i],
- 0, false);
- else
- ipa3_set_client(data->ul_src_pipe_list[i],
- data->ipa_client, true);
- }
- number = data->dl_dst_pipe_len;
- for (i = 0; i < number; i++) {
- IPAWANDBG("DL index-%d pipe %d\n", i,
- data->dl_dst_pipe_list[i]);
- if (data->reset_client)
- ipa3_set_client(data->dl_dst_pipe_list[i],
- 0, false);
- else
- ipa3_set_client(data->dl_dst_pipe_list[i],
- data->ipa_client, false);
- }
- return 0;
- }
- static int rmnet_ipa3_query_tethering_stats_wifi(
- struct wan_ioctl_query_tether_stats *data, bool reset)
- {
- struct ipa_get_wdi_sap_stats *sap_stats;
- int rc;
- sap_stats = kzalloc(sizeof(struct ipa_get_wdi_sap_stats),
- GFP_KERNEL);
- if (!sap_stats)
- return -ENOMEM;
- memset(sap_stats, 0, sizeof(struct ipa_get_wdi_sap_stats));
- sap_stats->reset_stats = reset;
- IPAWANDBG("reset the pipe stats %d\n", sap_stats->reset_stats);
- rc = ipa3_get_wlan_stats(sap_stats);
- if (rc) {
- IPAWANERR_RL("can't get ipa3_get_wlan_stats\n");
- kfree(sap_stats);
- return rc;
- } else if (data == NULL) {
- IPAWANDBG("only reset wlan stats\n");
- kfree(sap_stats);
- return 0;
- }
- if (sap_stats->stats_valid) {
- data->ipv4_tx_packets = sap_stats->ipv4_tx_packets;
- data->ipv4_tx_bytes = sap_stats->ipv4_tx_bytes;
- data->ipv4_rx_packets = sap_stats->ipv4_rx_packets;
- data->ipv4_rx_bytes = sap_stats->ipv4_rx_bytes;
- data->ipv6_tx_packets = sap_stats->ipv6_tx_packets;
- data->ipv6_tx_bytes = sap_stats->ipv6_tx_bytes;
- data->ipv6_rx_packets = sap_stats->ipv6_rx_packets;
- data->ipv6_rx_bytes = sap_stats->ipv6_rx_bytes;
- }
- IPAWANDBG("v4_rx_p(%lu) v6_rx_p(%lu) v4_rx_b(%lu) v6_rx_b(%lu)\n",
- (unsigned long) data->ipv4_rx_packets,
- (unsigned long) data->ipv6_rx_packets,
- (unsigned long) data->ipv4_rx_bytes,
- (unsigned long) data->ipv6_rx_bytes);
- IPAWANDBG("tx_p_v4(%lu)v6(%lu)tx_b_v4(%lu) v6(%lu)\n",
- (unsigned long) data->ipv4_tx_packets,
- (unsigned long) data->ipv6_tx_packets,
- (unsigned long) data->ipv4_tx_bytes,
- (unsigned long) data->ipv6_tx_bytes);
- kfree(sap_stats);
- return rc;
- }
- static int rmnet_ipa3_query_tethering_stats_modem(
- struct wan_ioctl_query_tether_stats *data, bool reset)
- {
- struct ipa_get_data_stats_req_msg_v01 *req;
- struct ipa_get_data_stats_resp_msg_v01 *resp;
- int pipe_len, rc;
- struct ipa_pipe_stats_info_type_v01 *stat_ptr;
- req = kzalloc(sizeof(struct ipa_get_data_stats_req_msg_v01),
- GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(struct ipa_get_data_stats_resp_msg_v01),
- GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- memset(req, 0, sizeof(struct ipa_get_data_stats_req_msg_v01));
- memset(resp, 0, sizeof(struct ipa_get_data_stats_resp_msg_v01));
- req->ipa_stats_type = QMI_IPA_STATS_TYPE_PIPE_V01;
- if (reset) {
- req->reset_stats_valid = true;
- req->reset_stats = true;
- IPAWANDBG("reset the pipe stats\n");
- }
- rc = ipa3_qmi_get_data_stats(req, resp);
- if (rc) {
- IPAWANERR("can't get ipa_qmi_get_data_stats\n");
- kfree(req);
- kfree(resp);
- return rc;
- } else if (data == NULL) {
- IPAWANDBG("only reset modem stats\n");
- kfree(req);
- kfree(resp);
- return 0;
- }
- if (resp->dl_dst_pipe_stats_list_valid) {
- for (pipe_len = 0; pipe_len < resp->dl_dst_pipe_stats_list_len;
- pipe_len++) {
- stat_ptr =
- &resp->dl_dst_pipe_stats_list[pipe_len];
- IPAWANDBG_LOW("Check entry(%d) dl_dst_pipe(%d)\n",
- pipe_len,
- stat_ptr->pipe_index);
- IPAWANDBG_LOW("dl_p_v4(%lu)v6(%lu)\n",
- (unsigned long) stat_ptr->num_ipv4_packets,
- (unsigned long) stat_ptr->num_ipv6_packets
- );
- IPAWANDBG_LOW("dl_b_v4(%lu)v6(%lu)\n",
- (unsigned long) stat_ptr->num_ipv4_bytes,
- (unsigned long) stat_ptr->num_ipv6_bytes);
- if (ipa_get_client_uplink(
- stat_ptr->pipe_index) == false) {
- if (data->ipa_client == ipa_get_client(
- stat_ptr->pipe_index)) {
- /* update the DL stats */
- data->ipv4_rx_packets +=
- stat_ptr->num_ipv4_packets;
- data->ipv6_rx_packets +=
- stat_ptr->num_ipv6_packets;
- data->ipv4_rx_bytes +=
- stat_ptr->num_ipv4_bytes;
- data->ipv6_rx_bytes +=
- stat_ptr->num_ipv6_bytes;
- }
- }
- }
- }
- IPAWANDBG("v4_rx_p(%lu) v6_rx_p(%lu) v4_rx_b(%lu) v6_rx_b(%lu)\n",
- (unsigned long) data->ipv4_rx_packets,
- (unsigned long) data->ipv6_rx_packets,
- (unsigned long) data->ipv4_rx_bytes,
- (unsigned long) data->ipv6_rx_bytes);
- if (resp->ul_src_pipe_stats_list_valid) {
- for (pipe_len = 0; pipe_len < resp->ul_src_pipe_stats_list_len;
- pipe_len++) {
- stat_ptr =
- &resp->ul_src_pipe_stats_list[pipe_len];
- IPAWANDBG_LOW("Check entry(%d) ul_dst_pipe(%d)\n",
- pipe_len,
- stat_ptr->pipe_index);
- IPAWANDBG_LOW("ul_p_v4(%lu)v6(%lu)\n",
- (unsigned long) stat_ptr->num_ipv4_packets,
- (unsigned long) stat_ptr->num_ipv6_packets
- );
- IPAWANDBG_LOW("ul_b_v4(%lu)v6(%lu)\n",
- (unsigned long)stat_ptr->num_ipv4_bytes,
- (unsigned long) stat_ptr->num_ipv6_bytes);
- if (ipa_get_client_uplink(
- stat_ptr->pipe_index) == true) {
- if (data->ipa_client == ipa_get_client(
- stat_ptr->pipe_index)) {
- /* update the DL stats */
- data->ipv4_tx_packets +=
- stat_ptr->num_ipv4_packets;
- data->ipv6_tx_packets +=
- stat_ptr->num_ipv6_packets;
- data->ipv4_tx_bytes +=
- stat_ptr->num_ipv4_bytes;
- data->ipv6_tx_bytes +=
- stat_ptr->num_ipv6_bytes;
- }
- }
- }
- }
- IPAWANDBG("tx_p_v4(%lu)v6(%lu)tx_b_v4(%lu) v6(%lu)\n",
- (unsigned long) data->ipv4_tx_packets,
- (unsigned long) data->ipv6_tx_packets,
- (unsigned long) data->ipv4_tx_bytes,
- (unsigned long) data->ipv6_tx_bytes);
- kfree(req);
- kfree(resp);
- return 0;
- }
- static int rmnet_ipa3_query_tethering_stats_hw(
- struct wan_ioctl_query_tether_stats *data, bool reset)
- {
- int rc = 0, index = 0;
- struct ipa_quota_stats_all *con_stats;
- enum ipa_client_type wlan_client;
- /* qet HW-stats */
- rc = ipa_get_teth_stats();
- if (rc) {
- IPAWANDBG("ipa_get_teth_stats failed %d,\n", rc);
- return rc;
- }
- /* query DL stats */
- IPAWANDBG("reset the pipe stats? (%d)\n", reset);
- con_stats = kzalloc(sizeof(*con_stats), GFP_KERNEL);
- if (!con_stats) {
- IPAWANERR("no memory\n");
- return -ENOMEM;
- }
- if (rmnet_ipa3_ctx->ipa_config_is_apq) {
- rc = ipa_query_teth_stats(IPA_CLIENT_MHI_PRIME_TETH_PROD,
- con_stats, reset);
- if (rc) {
- IPAERR("MHI_PRIME_TETH_PROD query failed %d,\n", rc);
- kfree(con_stats);
- return rc;
- }
- } else {
- rc = ipa_query_teth_stats(IPA_CLIENT_Q6_WAN_PROD,
- con_stats, reset);
- if (rc) {
- IPAERR("IPA_CLIENT_Q6_WAN_PROD query failed %d,\n", rc);
- kfree(con_stats);
- return rc;
- }
- }
- if (ipa3_ctx->ipa_hw_type == IPA_HW_v4_5)
- wlan_client = IPA_CLIENT_WLAN2_CONS;
- else
- wlan_client = IPA_CLIENT_WLAN1_CONS;
- IPAWANDBG("wlan: v4_rx_p-b(%d,%lld) v6_rx_p-b(%d,%lld),client(%d)\n",
- con_stats->client[wlan_client].num_ipv4_pkts,
- con_stats->client[wlan_client].num_ipv4_bytes,
- con_stats->client[wlan_client].num_ipv6_pkts,
- con_stats->client[wlan_client].num_ipv6_bytes,
- wlan_client);
- IPAWANDBG("usb: v4_rx_p(%d) b(%lld) v6_rx_p(%d) b(%lld)\n",
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv4_pkts,
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv4_bytes,
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv6_pkts,
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv6_bytes);
- /* update the DL stats */
- data->ipv4_rx_packets =
- con_stats->client[wlan_client].num_ipv4_pkts +
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv4_pkts;
- data->ipv6_rx_packets =
- con_stats->client[wlan_client].num_ipv6_pkts +
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv6_pkts;
- data->ipv4_rx_bytes =
- con_stats->client[wlan_client].num_ipv4_bytes +
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv4_bytes;
- data->ipv6_rx_bytes =
- con_stats->client[wlan_client].num_ipv6_bytes +
- con_stats->client[IPA_CLIENT_USB_CONS].num_ipv6_bytes;
- IPAWANDBG("v4_rx_p(%lu) v6_rx_p(%lu) v4_rx_b(%lu) v6_rx_b(%lu)\n",
- (unsigned long) data->ipv4_rx_packets,
- (unsigned long) data->ipv6_rx_packets,
- (unsigned long) data->ipv4_rx_bytes,
- (unsigned long) data->ipv6_rx_bytes);
- /* query USB UL stats */
- memset(con_stats, 0, sizeof(struct ipa_quota_stats_all));
- rc = ipa_query_teth_stats(IPA_CLIENT_USB_PROD, con_stats, reset);
- if (rc) {
- IPAERR("IPA_CLIENT_USB_PROD query failed %d\n", rc);
- kfree(con_stats);
- return rc;
- }
- if (rmnet_ipa3_ctx->ipa_config_is_apq)
- index = IPA_CLIENT_MHI_PRIME_TETH_CONS;
- else
- index = IPA_CLIENT_Q6_WAN_CONS;
- IPAWANDBG("usb: v4_tx_p(%d) b(%lld) v6_tx_p(%d) b(%lld)\n",
- con_stats->client[index].num_ipv4_pkts,
- con_stats->client[index].num_ipv4_bytes,
- con_stats->client[index].num_ipv6_pkts,
- con_stats->client[index].num_ipv6_bytes);
- /* update the USB UL stats */
- data->ipv4_tx_packets =
- con_stats->client[index].num_ipv4_pkts;
- data->ipv6_tx_packets =
- con_stats->client[index].num_ipv6_pkts;
- data->ipv4_tx_bytes =
- con_stats->client[index].num_ipv4_bytes;
- data->ipv6_tx_bytes =
- con_stats->client[index].num_ipv6_bytes;
- /* query WLAN UL stats */
- memset(con_stats, 0, sizeof(struct ipa_quota_stats_all));
- if (ipa3_ctx->ipa_hw_type == IPA_HW_v4_5)
- rc = ipa_query_teth_stats(IPA_CLIENT_WLAN2_PROD,
- con_stats, reset);
- else
- rc = ipa_query_teth_stats(IPA_CLIENT_WLAN1_PROD,
- con_stats, reset);
- if (rc) {
- IPAERR("IPA_CLIENT_WLAN_PROD query failed %d\n", rc);
- kfree(con_stats);
- return rc;
- }
- if (rmnet_ipa3_ctx->ipa_config_is_apq)
- index = IPA_CLIENT_MHI_PRIME_TETH_CONS;
- else
- index = IPA_CLIENT_Q6_WAN_CONS;
- IPAWANDBG("wlan1: v4_tx_p(%d) b(%lld) v6_tx_p(%d) b(%lld)\n",
- con_stats->client[index].num_ipv4_pkts,
- con_stats->client[index].num_ipv4_bytes,
- con_stats->client[index].num_ipv6_pkts,
- con_stats->client[index].num_ipv6_bytes);
- /* update the wlan UL stats */
- data->ipv4_tx_packets +=
- con_stats->client[index].num_ipv4_pkts;
- data->ipv6_tx_packets +=
- con_stats->client[index].num_ipv6_pkts;
- data->ipv4_tx_bytes +=
- con_stats->client[index].num_ipv4_bytes;
- data->ipv6_tx_bytes +=
- con_stats->client[index].num_ipv6_bytes;
- IPAWANDBG("v4_tx_p(%lu) v6_tx_p(%lu) v4_tx_b(%lu) v6_tx_b(%lu)\n",
- (unsigned long) data->ipv4_tx_packets,
- (unsigned long) data->ipv6_tx_packets,
- (unsigned long) data->ipv4_tx_bytes,
- (unsigned long) data->ipv6_tx_bytes);
- kfree(con_stats);
- return rc;
- }
- int rmnet_ipa3_query_tethering_stats(struct wan_ioctl_query_tether_stats *data,
- bool reset)
- {
- enum ipa_upstream_type upstream_type;
- int rc = 0;
- /* prevent string buffer overflows */
- data->upstreamIface[IFNAMSIZ-1] = '\0';
- data->tetherIface[IFNAMSIZ-1] = '\0';
- /* get IPA backhaul type */
- upstream_type = find_upstream_type(data->upstreamIface);
- if (upstream_type == IPA_UPSTEAM_MAX) {
- IPAWANERR(" Wrong upstreamIface name %s\n",
- data->upstreamIface);
- } else if (upstream_type == IPA_UPSTEAM_WLAN) {
- IPAWANDBG_LOW(" query wifi-backhaul stats\n");
- rc = rmnet_ipa3_query_tethering_stats_wifi(
- data, false);
- if (rc) {
- IPAWANERR("wlan WAN_IOC_QUERY_TETHER_STATS failed\n");
- return rc;
- }
- } else {
- IPAWANDBG_LOW(" query modem-backhaul stats\n");
- rc = rmnet_ipa3_query_tethering_stats_modem(
- data, false);
- if (rc) {
- IPAWANERR("modem WAN_IOC_QUERY_TETHER_STATS failed\n");
- return rc;
- }
- }
- return rc;
- }
- int rmnet_ipa3_query_tethering_stats_all(
- struct wan_ioctl_query_tether_stats_all *data)
- {
- struct wan_ioctl_query_tether_stats tether_stats;
- enum ipa_upstream_type upstream_type;
- int rc = 0;
- memset(&tether_stats, 0, sizeof(struct wan_ioctl_query_tether_stats));
- /* prevent string buffer overflows */
- data->upstreamIface[IFNAMSIZ-1] = '\0';
- /* get IPA backhaul type */
- upstream_type = find_upstream_type(data->upstreamIface);
- if (upstream_type == IPA_UPSTEAM_MAX) {
- IPAWANERR(" Wrong upstreamIface name %s\n",
- data->upstreamIface);
- } else if (upstream_type == IPA_UPSTEAM_WLAN) {
- IPAWANDBG_LOW(" query wifi-backhaul stats\n");
- rc = rmnet_ipa3_query_tethering_stats_wifi(
- &tether_stats, data->reset_stats);
- if (rc) {
- IPAWANERR_RL(
- "wlan WAN_IOC_QUERY_TETHER_STATS failed\n");
- return rc;
- }
- data->tx_bytes = tether_stats.ipv4_tx_bytes
- + tether_stats.ipv6_tx_bytes;
- data->rx_bytes = tether_stats.ipv4_rx_bytes
- + tether_stats.ipv6_rx_bytes;
- } else {
- IPAWANDBG_LOW(" query modem-backhaul stats\n");
- tether_stats.ipa_client = data->ipa_client;
- if (ipa3_ctx->ipa_hw_type < IPA_HW_v4_0 ||
- !ipa3_ctx->hw_stats.enabled) {
- IPAWANDBG("hw version %d,hw_stats.enabled %d\n",
- ipa3_ctx->ipa_hw_type,
- ipa3_ctx->hw_stats.enabled);
- /* get modem stats from QMI */
- rc = rmnet_ipa3_query_tethering_stats_modem(
- &tether_stats, data->reset_stats);
- if (rc) {
- IPAWANERR("modem QUERY_TETHER_STATS failed\n");
- return rc;
- }
- } else {
- /* get modem stats from IPA-HW counters */
- rc = rmnet_ipa3_query_tethering_stats_hw(
- &tether_stats, data->reset_stats);
- if (rc) {
- IPAWANERR("modem QUERY_TETHER_STATS failed\n");
- return rc;
- }
- }
- data->tx_bytes = tether_stats.ipv4_tx_bytes
- + tether_stats.ipv6_tx_bytes;
- data->rx_bytes = tether_stats.ipv4_rx_bytes
- + tether_stats.ipv6_rx_bytes;
- }
- return rc;
- }
- int rmnet_ipa3_reset_tethering_stats(struct wan_ioctl_reset_tether_stats *data)
- {
- enum ipa_upstream_type upstream_type;
- int rc = 0;
- /* prevent string buffer overflows */
- data->upstreamIface[IFNAMSIZ-1] = '\0';
- /* get IPA backhaul type */
- upstream_type = find_upstream_type(data->upstreamIface);
- if (upstream_type == IPA_UPSTEAM_MAX) {
- IPAWANERR(" Wrong upstreamIface name %s\n",
- data->upstreamIface);
- } else if (upstream_type == IPA_UPSTEAM_WLAN) {
- IPAWANERR(" reset wifi-backhaul stats\n");
- rc = rmnet_ipa3_query_tethering_stats_wifi(
- NULL, true);
- if (rc) {
- IPAWANERR("reset WLAN stats failed\n");
- return rc;
- }
- } else {
- IPAWANERR(" reset modem-backhaul stats\n");
- rc = rmnet_ipa3_query_tethering_stats_modem(
- NULL, true);
- if (rc) {
- IPAWANERR("reset MODEM stats failed\n");
- return rc;
- }
- }
- return rc;
- }
- /**
- * ipa3_broadcast_quota_reach_ind() - Send Netlink broadcast on Quota
- * @mux_id - The MUX ID on which the quota has been reached
- *
- * This function broadcasts a Netlink event using the kobject of the
- * rmnet_ipa interface in order to alert the user space that the quota
- * on the specific interface which matches the mux_id has been reached.
- *
- */
- void ipa3_broadcast_quota_reach_ind(u32 mux_id,
- enum ipa_upstream_type upstream_type)
- {
- char alert_msg[IPA_QUOTA_REACH_ALERT_MAX_SIZE];
- char iface_name_m[IPA_QUOTA_REACH_IF_NAME_MAX_SIZE];
- char iface_name_l[IPA_QUOTA_REACH_IF_NAME_MAX_SIZE];
- char *envp[IPA_UEVENT_NUM_EVNP] = {
- alert_msg, iface_name_l, iface_name_m, NULL};
- int res;
- int index;
- /* check upstream_type*/
- if (upstream_type == IPA_UPSTEAM_MAX) {
- IPAWANERR(" Wrong upstreamIface type %d\n", upstream_type);
- return;
- } else if (upstream_type == IPA_UPSTEAM_MODEM) {
- index = ipa3_find_mux_channel_index(mux_id);
- if (index == MAX_NUM_OF_MUX_CHANNEL) {
- IPAWANERR("%u is an mux ID\n", mux_id);
- return;
- }
- }
- res = snprintf(alert_msg, IPA_QUOTA_REACH_ALERT_MAX_SIZE,
- "ALERT_NAME=%s", "quotaReachedAlert");
- if (res >= IPA_QUOTA_REACH_ALERT_MAX_SIZE) {
- IPAWANERR("message too long (%d)", res);
- return;
- }
- /* posting msg for L-release for CNE */
- if (upstream_type == IPA_UPSTEAM_MODEM) {
- res = snprintf(iface_name_l,
- IPA_QUOTA_REACH_IF_NAME_MAX_SIZE,
- "UPSTREAM=%s",
- rmnet_ipa3_ctx->mux_channel[index].vchannel_name);
- } else {
- res = snprintf(iface_name_l, IPA_QUOTA_REACH_IF_NAME_MAX_SIZE,
- "UPSTREAM=%s", IPA_UPSTEAM_WLAN_IFACE_NAME);
- }
- if (res >= IPA_QUOTA_REACH_IF_NAME_MAX_SIZE) {
- IPAWANERR("message too long (%d)", res);
- return;
- }
- /* posting msg for M-release for CNE */
- if (upstream_type == IPA_UPSTEAM_MODEM) {
- res = snprintf(iface_name_m,
- IPA_QUOTA_REACH_IF_NAME_MAX_SIZE,
- "INTERFACE=%s",
- rmnet_ipa3_ctx->mux_channel[index].vchannel_name);
- } else {
- res = snprintf(iface_name_m,
- IPA_QUOTA_REACH_IF_NAME_MAX_SIZE,
- "INTERFACE=%s",
- IPA_UPSTEAM_WLAN_IFACE_NAME);
- }
- if (res >= IPA_QUOTA_REACH_IF_NAME_MAX_SIZE) {
- IPAWANERR("message too long (%d)", res);
- return;
- }
- IPAWANERR("putting nlmsg: <%s> <%s> <%s>\n",
- alert_msg, iface_name_l, iface_name_m);
- kobject_uevent_env(&(IPA_NETDEV()->dev.kobj),
- KOBJ_CHANGE, envp);
- rmnet_ipa_send_quota_reach_ind();
- }
- /**
- * ipa3_q6_handshake_complete() - Perform operations once Q6 is up
- * @ssr_bootup - Indicates whether this is a cold boot-up or post-SSR.
- *
- * This function is invoked once the handshake between the IPA AP driver
- * and IPA Q6 driver is complete. At this point, it is possible to perform
- * operations which can't be performed until IPA Q6 driver is up.
- *
- */
- void ipa3_q6_handshake_complete(bool ssr_bootup)
- {
- /* It is required to recover the network stats after SSR recovery */
- if (ssr_bootup) {
- /*
- * In case the uC is required to be loaded by the Modem,
- * the proxy vote will be removed only when uC loading is
- * complete and indication is received by the AP. After SSR,
- * uC is already loaded. Therefore, proxy vote can be removed
- * once Modem init is complete.
- */
- ipa3_proxy_clk_unvote();
- /* send SSR power-up notification to IPACM */
- rmnet_ipa_send_ssr_notification(true);
- /*
- * It is required to recover the network stats after
- * SSR recovery
- */
- rmnet_ipa_get_network_stats_and_update();
- }
- imp_handle_modem_ready();
- }
- static inline bool rmnet_ipa3_check_any_client_inited
- (
- enum ipacm_per_client_device_type device_type
- )
- {
- int i = 0;
- struct ipa_tether_device_info *teth_ptr = NULL;
- for (; i < IPA_MAX_NUM_HW_PATH_CLIENTS; i++) {
- teth_ptr = &rmnet_ipa3_ctx->tether_device[device_type];
- if (teth_ptr->lan_client[i].client_idx != -1 &&
- teth_ptr->lan_client[i].inited) {
- IPAWANERR("Found client index: %d which is inited\n",
- i);
- return true;
- }
- }
- return false;
- }
- static inline int rmnet_ipa3_get_lan_client_info
- (
- enum ipacm_per_client_device_type device_type,
- uint8_t mac[]
- )
- {
- int i = 0;
- struct ipa_tether_device_info *teth_ptr = NULL;
- IPAWANDBG("Client MAC %02x:%02x:%02x:%02x:%02x:%02x\n",
- mac[0], mac[1], mac[2],
- mac[3], mac[4], mac[5]);
- for (; i < IPA_MAX_NUM_HW_PATH_CLIENTS; i++) {
- teth_ptr = &rmnet_ipa3_ctx->tether_device[device_type];
- if (memcmp(
- teth_ptr->lan_client[i].mac,
- mac,
- IPA_MAC_ADDR_SIZE) == 0) {
- IPAWANDBG("Matched client index: %d\n", i);
- return i;
- }
- }
- return -EINVAL;
- }
- static inline int rmnet_ipa3_delete_lan_client_info
- (
- enum ipacm_per_client_device_type device_type,
- int lan_clnt_idx
- )
- {
- struct ipa_lan_client *lan_client = NULL;
- int i;
- struct ipa_tether_device_info *teth_ptr = NULL;
- IPAWANDBG("Delete lan client info: %d, %d, %d\n",
- rmnet_ipa3_ctx->tether_device[device_type].num_clients,
- lan_clnt_idx, device_type);
- /* Check if Device type is valid. */
- if (device_type >= IPACM_MAX_CLIENT_DEVICE_TYPES ||
- device_type < 0) {
- IPAWANERR("Invalid Device type: %d\n", device_type);
- return -EINVAL;
- }
- /* Check if the request is to clean up all clients. */
- teth_ptr = &rmnet_ipa3_ctx->tether_device[device_type];
- if (lan_clnt_idx == 0xffffffff) {
- /* Reset the complete device info. */
- memset(teth_ptr, 0,
- sizeof(struct ipa_tether_device_info));
- teth_ptr->ul_src_pipe = -1;
- for (i = 0; i < IPA_MAX_NUM_HW_PATH_CLIENTS; i++)
- teth_ptr->lan_client[i].client_idx = -1;
- } else {
- lan_client = &teth_ptr->lan_client[lan_clnt_idx];
- /* Reset the client info before sending the message. */
- memset(lan_client, 0, sizeof(struct ipa_lan_client));
- lan_client->client_idx = -1;
- /* Decrement the number of clients. */
- rmnet_ipa3_ctx->tether_device[device_type].num_clients--;
- }
- return 0;
- }
- /* rmnet_ipa3_set_lan_client_info() -
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_SET_LAN_CLIENT_INFO.
- * It is used to store LAN client information which
- * is used to fetch the packet stats for a client.
- *
- * Return codes:
- * 0: Success
- * -EINVAL: Invalid args provided
- */
- int rmnet_ipa3_set_lan_client_info(
- struct wan_ioctl_lan_client_info *data)
- {
- struct ipa_lan_client *lan_client = NULL;
- struct ipa_tether_device_info *teth_ptr = NULL;
- IPAWANDBG("Client MAC %02x:%02x:%02x:%02x:%02x:%02x\n",
- data->mac[0], data->mac[1], data->mac[2],
- data->mac[3], data->mac[4], data->mac[5]);
- /* Check if Device type is valid. */
- if (data->device_type >= IPACM_MAX_CLIENT_DEVICE_TYPES ||
- data->device_type < 0) {
- IPAWANERR("Invalid Device type: %d\n", data->device_type);
- return -EINVAL;
- }
- /* Check if Client index is valid. */
- if (data->client_idx >= IPA_MAX_NUM_HW_PATH_CLIENTS ||
- data->client_idx < 0) {
- IPAWANERR("Invalid Client Index: %d\n", data->client_idx);
- return -EINVAL;
- }
- mutex_lock(&rmnet_ipa3_ctx->per_client_stats_guard);
- if (data->client_init) {
- /* check if the client is already inited. */
- if (rmnet_ipa3_ctx->tether_device[data->device_type]
- .lan_client[data->client_idx].inited) {
- IPAWANERR("Client already inited: %d:%d\n",
- data->device_type, data->client_idx);
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -EINVAL;
- }
- }
- teth_ptr = &rmnet_ipa3_ctx->tether_device[data->device_type];
- lan_client = &teth_ptr->lan_client[data->client_idx];
- memcpy(lan_client->mac, data->mac, IPA_MAC_ADDR_SIZE);
- lan_client->client_idx = data->client_idx;
- /* Update the Source pipe. */
- rmnet_ipa3_ctx->tether_device[data->device_type].ul_src_pipe =
- ipa3_get_ep_mapping(data->ul_src_pipe);
- /* Update the header length if not set. */
- if (!rmnet_ipa3_ctx->tether_device[data->device_type].hdr_len)
- rmnet_ipa3_ctx->tether_device[data->device_type].hdr_len =
- data->hdr_len;
- lan_client->inited = true;
- rmnet_ipa3_ctx->tether_device[data->device_type].num_clients++;
- IPAWANDBG("Set the lan client info: %d, %d, %d\n",
- lan_client->client_idx,
- rmnet_ipa3_ctx->tether_device[data->device_type].ul_src_pipe,
- rmnet_ipa3_ctx->tether_device[data->device_type].num_clients);
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return 0;
- }
- /* rmnet_ipa3_delete_lan_client_info() -
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_DELETE_LAN_CLIENT_INFO.
- * It is used to delete LAN client information which
- * is used to fetch the packet stats for a client.
- *
- * Return codes:
- * 0: Success
- * -EINVAL: Invalid args provided
- */
- int rmnet_ipa3_clear_lan_client_info(
- struct wan_ioctl_lan_client_info *data)
- {
- struct ipa_lan_client *lan_client = NULL;
- struct ipa_tether_device_info *teth_ptr = NULL;
- IPAWANDBG("Client MAC %02x:%02x:%02x:%02x:%02x:%02x\n",
- data->mac[0], data->mac[1], data->mac[2],
- data->mac[3], data->mac[4], data->mac[5]);
- /* Check if Device type is valid. */
- if (data->device_type >= IPACM_MAX_CLIENT_DEVICE_TYPES ||
- data->device_type < 0) {
- IPAWANERR("Invalid Device type: %d\n", data->device_type);
- return -EINVAL;
- }
- /* Check if Client index is valid. */
- if (data->client_idx >= IPA_MAX_NUM_HW_PATH_CLIENTS ||
- data->client_idx < 0) {
- IPAWANERR("Invalid Client Index: %d\n", data->client_idx);
- return -EINVAL;
- }
- IPAWANDBG("Client : %d:%d:%d\n",
- data->device_type, data->client_idx,
- rmnet_ipa3_ctx->tether_device[data->device_type].num_clients);
- teth_ptr = &rmnet_ipa3_ctx->tether_device[data->device_type];
- mutex_lock(&rmnet_ipa3_ctx->per_client_stats_guard);
- lan_client = &teth_ptr->lan_client[data->client_idx];
- if (!data->client_init) {
- /* check if the client is already de-inited. */
- if (!lan_client->inited) {
- IPAWANERR("Client already de-inited: %d:%d\n",
- data->device_type, data->client_idx);
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -EINVAL;
- }
- }
- lan_client->inited = false;
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return 0;
- }
- /* rmnet_ipa3_send_lan_client_msg() -
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_SEND_LAN_CLIENT_MSG.
- * It is used to send LAN client information to IPACM.
- *
- * Return codes:
- * 0: Success
- * -EINVAL: Invalid args provided
- */
- int rmnet_ipa3_send_lan_client_msg(
- struct wan_ioctl_send_lan_client_msg *data)
- {
- struct ipa_msg_meta msg_meta;
- int rc;
- struct ipa_lan_client_msg *lan_client;
- /* Notify IPACM to reset the client index. */
- lan_client = kzalloc(sizeof(struct ipa_lan_client_msg),
- GFP_KERNEL);
- if (!lan_client) {
- IPAWANERR("Can't allocate memory for tether_info\n");
- return -ENOMEM;
- }
- if (data->client_event != IPA_PER_CLIENT_STATS_CONNECT_EVENT &&
- data->client_event != IPA_PER_CLIENT_STATS_DISCONNECT_EVENT) {
- IPAWANERR("Wrong event given. Event:- %d\n",
- data->client_event);
- kfree(lan_client);
- return -EINVAL;
- }
- data->lan_client.lanIface[IPA_RESOURCE_NAME_MAX-1] = '\0';
- memset(&msg_meta, 0, sizeof(struct ipa_msg_meta));
- memcpy(lan_client, &data->lan_client,
- sizeof(struct ipa_lan_client_msg));
- msg_meta.msg_type = data->client_event;
- msg_meta.msg_len = sizeof(struct ipa_lan_client_msg);
- rc = ipa_send_msg(&msg_meta, lan_client, rmnet_ipa_free_msg);
- if (rc) {
- IPAWANERR("ipa_send_msg failed: %d\n", rc);
- kfree(lan_client);
- return rc;
- }
- return 0;
- }
- /* rmnet_ipa3_enable_per_client_stats() -
- * @data - IOCTL data
- *
- * This function handles WAN_IOC_ENABLE_PER_CLIENT_STATS.
- * It is used to indicate Q6 to start capturing per client stats.
- *
- * Return codes:
- * 0: Success
- * -EINVAL: Invalid args provided
- */
- int rmnet_ipa3_enable_per_client_stats(
- bool *data)
- {
- struct ipa_enable_per_client_stats_req_msg_v01 *req;
- struct ipa_enable_per_client_stats_resp_msg_v01 *resp;
- int rc;
- req =
- kzalloc(sizeof(struct ipa_enable_per_client_stats_req_msg_v01),
- GFP_KERNEL);
- if (!req) {
- IPAWANERR("Can't allocate memory for stats message\n");
- return -ENOMEM;
- }
- resp =
- kzalloc(sizeof(struct ipa_enable_per_client_stats_resp_msg_v01),
- GFP_KERNEL);
- if (!resp) {
- IPAWANERR("Can't allocate memory for stats message\n");
- kfree(req);
- return -ENOMEM;
- }
- memset(req, 0,
- sizeof(struct ipa_enable_per_client_stats_req_msg_v01));
- memset(resp, 0,
- sizeof(struct ipa_enable_per_client_stats_resp_msg_v01));
- if (*data)
- req->enable_per_client_stats = 1;
- else
- req->enable_per_client_stats = 0;
- rc = ipa3_qmi_enable_per_client_stats(req, resp);
- if (rc) {
- IPAWANERR("can't enable per client stats\n");
- kfree(req);
- kfree(resp);
- return rc;
- }
- kfree(req);
- kfree(resp);
- return 0;
- }
- int rmnet_ipa3_query_per_client_stats(
- struct wan_ioctl_query_per_client_stats *data)
- {
- struct ipa_get_stats_per_client_req_msg_v01 *req;
- struct ipa_get_stats_per_client_resp_msg_v01 *resp;
- int rc, lan_clnt_idx, lan_clnt_idx1, i;
- struct ipa_lan_client *lan_client = NULL;
- struct ipa_tether_device_info *teth_ptr = NULL;
- IPAWANDBG("Client MAC %02x:%02x:%02x:%02x:%02x:%02x\n",
- data->client_info[0].mac[0],
- data->client_info[0].mac[1],
- data->client_info[0].mac[2],
- data->client_info[0].mac[3],
- data->client_info[0].mac[4],
- data->client_info[0].mac[5]);
- /* Check if Device type is valid. */
- if (data->device_type >= IPACM_MAX_CLIENT_DEVICE_TYPES ||
- data->device_type < 0) {
- IPAWANERR("Invalid Device type: %d\n", data->device_type);
- return -EINVAL;
- }
- /* Check if num_clients is valid. */
- if (data->num_clients != IPA_MAX_NUM_HW_PATH_CLIENTS &&
- data->num_clients != 1) {
- IPAWANERR("Invalid number of clients: %d\n", data->num_clients);
- return -EINVAL;
- }
- mutex_lock(&rmnet_ipa3_ctx->per_client_stats_guard);
- /* Check if Source pipe is valid. */
- if (rmnet_ipa3_ctx->tether_device
- [data->device_type].ul_src_pipe == -1) {
- IPAWANERR("Device not initialized: %d\n", data->device_type);
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -EINVAL;
- }
- /* Check if we have clients connected. */
- if (rmnet_ipa3_ctx->tether_device[data->device_type].num_clients == 0) {
- IPAWANERR("No clients connected: %d\n", data->device_type);
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -EINVAL;
- }
- if (data->num_clients == 1) {
- /* Check if the client info is valid.*/
- lan_clnt_idx1 = rmnet_ipa3_get_lan_client_info(
- data->device_type,
- data->client_info[0].mac);
- if (lan_clnt_idx1 < 0) {
- IPAWANERR("Client info not available return.\n");
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -EINVAL;
- }
- teth_ptr = &rmnet_ipa3_ctx->tether_device[data->device_type];
- lan_client = &teth_ptr->lan_client[lan_clnt_idx1];
- /*
- * Check if disconnect flag is set and
- * see if all the clients info are cleared.
- */
- if (data->disconnect_clnt &&
- lan_client->inited) {
- IPAWANERR("Client not inited. Try again.\n");
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -EAGAIN;
- }
- } else {
- /* Max number of clients. */
- /* Check if disconnect flag is set and
- * see if all the clients info are cleared.
- */
- if (data->disconnect_clnt &&
- rmnet_ipa3_check_any_client_inited(data->device_type)) {
- IPAWANERR("CLient not inited. Try again.\n");
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -EAGAIN;
- }
- lan_clnt_idx1 = 0xffffffff;
- }
- req = kzalloc(sizeof(struct ipa_get_stats_per_client_req_msg_v01),
- GFP_KERNEL);
- if (!req) {
- IPAWANERR("Can't allocate memory for stats message\n");
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- return -ENOMEM;
- }
- resp = kzalloc(sizeof(struct ipa_get_stats_per_client_resp_msg_v01),
- GFP_KERNEL);
- if (!resp) {
- IPAWANERR("Can't allocate memory for stats message\n");
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- kfree(req);
- return -ENOMEM;
- }
- memset(req, 0, sizeof(struct ipa_get_stats_per_client_req_msg_v01));
- memset(resp, 0, sizeof(struct ipa_get_stats_per_client_resp_msg_v01));
- IPAWANDBG("Reset stats: %s",
- data->reset_stats?"Yes":"No");
- if (data->reset_stats) {
- req->reset_stats_valid = true;
- req->reset_stats = true;
- IPAWANDBG("fetch and reset the client stats\n");
- }
- req->client_id = lan_clnt_idx1;
- req->src_pipe_id =
- rmnet_ipa3_ctx->tether_device[data->device_type].ul_src_pipe;
- IPAWANDBG("fetch the client stats for %d, %d\n", req->client_id,
- req->src_pipe_id);
- rc = ipa3_qmi_get_per_client_packet_stats(req, resp);
- if (rc) {
- IPAWANERR("can't get per client stats\n");
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- kfree(req);
- kfree(resp);
- return rc;
- }
- if (resp->per_client_stats_list_valid) {
- for (i = 0; i < resp->per_client_stats_list_len
- && i < IPA_MAX_NUM_HW_PATH_CLIENTS; i++) {
- /* Subtract the header bytes from the DL bytes. */
- data->client_info[i].ipv4_rx_bytes =
- (resp->per_client_stats_list[i].num_dl_ipv4_bytes) -
- (teth_ptr->hdr_len *
- resp->per_client_stats_list[i].num_dl_ipv4_pkts);
- /* UL header bytes are subtracted by Q6. */
- data->client_info[i].ipv4_tx_bytes =
- resp->per_client_stats_list[i].num_ul_ipv4_bytes;
- /* Subtract the header bytes from the DL bytes. */
- data->client_info[i].ipv6_rx_bytes =
- (resp->per_client_stats_list[i].num_dl_ipv6_bytes) -
- (teth_ptr->hdr_len *
- resp->per_client_stats_list[i].num_dl_ipv6_pkts);
- /* UL header bytes are subtracted by Q6. */
- data->client_info[i].ipv6_tx_bytes =
- resp->per_client_stats_list[i].num_ul_ipv6_bytes;
- IPAWANDBG("tx_b_v4(%lu)v6(%lu)rx_b_v4(%lu) v6(%lu)\n",
- (unsigned long) data->client_info[i].ipv4_tx_bytes,
- (unsigned long) data->client_info[i].ipv6_tx_bytes,
- (unsigned long) data->client_info[i].ipv4_rx_bytes,
- (unsigned long) data->client_info[i].ipv6_rx_bytes);
- /* Get the lan client index. */
- lan_clnt_idx = resp->per_client_stats_list[i].client_id;
- /* Check if lan_clnt_idx is valid. */
- if (lan_clnt_idx < 0 ||
- lan_clnt_idx >= IPA_MAX_NUM_HW_PATH_CLIENTS) {
- IPAWANERR("Lan client index not valid.\n");
- mutex_unlock(
- &rmnet_ipa3_ctx->per_client_stats_guard);
- kfree(req);
- kfree(resp);
- ipa_assert();
- return -EINVAL;
- }
- memcpy(data->client_info[i].mac,
- teth_ptr->lan_client[lan_clnt_idx].mac,
- IPA_MAC_ADDR_SIZE);
- }
- }
- IPAWANDBG("Disconnect clnt: %s",
- data->disconnect_clnt?"Yes":"No");
- if (data->disconnect_clnt) {
- rmnet_ipa3_delete_lan_client_info(data->device_type,
- lan_clnt_idx1);
- }
- mutex_unlock(&rmnet_ipa3_ctx->per_client_stats_guard);
- kfree(req);
- kfree(resp);
- return 0;
- }
- #ifdef CONFIG_DEBUG_FS
- static void rmnet_ipa_debugfs_init(void)
- {
- const mode_t read_write_mode = 0664;
- struct rmnet_ipa_debugfs *dbgfs = &rmnet_ipa3_ctx->dbgfs;
- dbgfs->dent = debugfs_create_dir("rmnet_ipa", 0);
- if (IS_ERR(dbgfs->dent)) {
- pr_err("fail to create folder in debug_fs\n");
- return;
- }
- dbgfs->dfile_outstanding_high = debugfs_create_u32("outstanding_high",
- read_write_mode, dbgfs->dent,
- &rmnet_ipa3_ctx->outstanding_high);
- if (!dbgfs->dfile_outstanding_high ||
- IS_ERR(dbgfs->dfile_outstanding_high)) {
- pr_err("failed to create file for outstanding_high\n");
- goto fail;
- }
- dbgfs->dfile_outstanding_high_ctl =
- debugfs_create_u32("outstanding_high_ctl",
- read_write_mode, dbgfs->dent,
- &rmnet_ipa3_ctx->outstanding_high_ctl);
- if (!dbgfs->dfile_outstanding_high_ctl ||
- IS_ERR(dbgfs->dfile_outstanding_high_ctl)) {
- pr_err("failed to create file for outstanding_high_ctl\n");
- goto fail;
- }
- dbgfs->dfile_outstanding_low = debugfs_create_u32("outstanding_low",
- read_write_mode, dbgfs->dent,
- &rmnet_ipa3_ctx->outstanding_low);
- if (!dbgfs->dfile_outstanding_low ||
- IS_ERR(dbgfs->dfile_outstanding_low)) {
- pr_err("failed to create file for outstanding_low\n");
- goto fail;
- }
- return;
- fail:
- debugfs_remove_recursive(dbgfs->dent);
- memset(dbgfs, 0, sizeof(struct rmnet_ipa_debugfs));
- }
- static void rmnet_ipa_debugfs_remove(void)
- {
- if (IS_ERR(rmnet_ipa3_ctx->dbgfs.dent))
- return;
- debugfs_remove_recursive(rmnet_ipa3_ctx->dbgfs.dent);
- memset(&rmnet_ipa3_ctx->dbgfs, 0, sizeof(struct rmnet_ipa_debugfs));
- }
- #else /* CONFIG_DEBUG_FS */
- static void rmnet_ipa_debugfs_init(void){}
- static void rmnet_ipa_debugfs_remove(void){}
- #endif /* CONFIG_DEBUG_FS */
- static int __init ipa3_wwan_init(void)
- {
- int i, j;
- struct ipa_tether_device_info *teth_ptr = NULL;
- void *ssr_hdl;
- int rc = 0;
- if (!ipa3_ctx) {
- IPAWANERR_RL("ipa3_ctx was not initialized\n");
- return -EINVAL;
- }
- rmnet_ipa3_ctx = kzalloc(sizeof(*rmnet_ipa3_ctx), GFP_KERNEL);
- if (!rmnet_ipa3_ctx)
- return -ENOMEM;
- atomic_set(&rmnet_ipa3_ctx->is_initialized, 0);
- atomic_set(&rmnet_ipa3_ctx->is_ssr, 0);
- mutex_init(&rmnet_ipa3_ctx->pipe_handle_guard);
- mutex_init(&rmnet_ipa3_ctx->add_mux_channel_lock);
- mutex_init(&rmnet_ipa3_ctx->per_client_stats_guard);
- /* Reset the Lan Stats. */
- for (i = 0; i < IPACM_MAX_CLIENT_DEVICE_TYPES; i++) {
- teth_ptr = &rmnet_ipa3_ctx->tether_device[i];
- teth_ptr->ul_src_pipe = -1;
- for (j = 0; j < IPA_MAX_NUM_HW_PATH_CLIENTS; j++)
- teth_ptr->lan_client[j].client_idx = -1;
- }
- rmnet_ipa3_ctx->ipa3_to_apps_hdl = -1;
- rmnet_ipa3_ctx->apps_to_ipa3_hdl = -1;
- ipa3_qmi_init();
- rmnet_ipa3_ctx->outstanding_high = OUTSTANDING_HIGH_DEFAULT;
- rmnet_ipa3_ctx->outstanding_high_ctl = OUTSTANDING_HIGH_CTL_DEFAULT;
- rmnet_ipa3_ctx->outstanding_low = OUTSTANDING_LOW_DEFAULT;
- rmnet_ipa_debugfs_init();
- /* Register for Local Modem SSR */
- ssr_hdl = subsys_notif_register_notifier(SUBSYS_LOCAL_MODEM,
- &ipa3_lcl_mdm_ssr_notifier);
- if (!IS_ERR(ssr_hdl))
- rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle = ssr_hdl;
- else if (!rmnet_ipa3_ctx->ipa_config_is_apq) {
- rc = PTR_ERR(ssr_hdl);
- goto fail_dbgfs_rm;
- }
- if (rmnet_ipa3_ctx->ipa_config_is_apq) {
- /* Register for Remote Modem SSR */
- ssr_hdl = subsys_notif_register_notifier(SUBSYS_REMOTE_MODEM,
- &ipa3_rmt_mdm_ssr_notifier);
- if (IS_ERR(ssr_hdl)) {
- rc = PTR_ERR(ssr_hdl);
- goto fail_unreg_lcl_mdm_ssr;
- }
- rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle = ssr_hdl;
- }
- rc = platform_driver_register(&rmnet_ipa_driver);
- if (rc)
- goto fail_unreg_rmt_mdm_ssr;
- return 0;
- fail_unreg_rmt_mdm_ssr:
- if (ipa3_ctx->platform_type == IPA_PLAT_TYPE_APQ) {
- subsys_notif_unregister_notifier(
- rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle,
- &ipa3_rmt_mdm_ssr_notifier);
- rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle = NULL;
- }
- fail_unreg_lcl_mdm_ssr:
- if (rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle) {
- subsys_notif_unregister_notifier(
- rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle,
- &ipa3_lcl_mdm_ssr_notifier);
- rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle = NULL;
- }
- fail_dbgfs_rm:
- rmnet_ipa_debugfs_remove();
- return rc;
- }
- static void __exit ipa3_wwan_cleanup(void)
- {
- int ret;
- platform_driver_unregister(&rmnet_ipa_driver);
- if (rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle) {
- ret = subsys_notif_unregister_notifier(
- rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle,
- &ipa3_lcl_mdm_ssr_notifier);
- if (ret)
- IPAWANERR(
- "Failed to unregister subsys %s notifier ret=%d\n",
- SUBSYS_LOCAL_MODEM, ret);
- }
- if (rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle) {
- ret = subsys_notif_unregister_notifier(
- rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle,
- &ipa3_rmt_mdm_ssr_notifier);
- if (ret)
- IPAWANERR(
- "Failed to unregister subsys %s notifier ret=%d\n",
- SUBSYS_REMOTE_MODEM, ret);
- }
- rmnet_ipa_debugfs_remove();
- ipa3_qmi_cleanup();
- mutex_destroy(&rmnet_ipa3_ctx->per_client_stats_guard);
- mutex_destroy(&rmnet_ipa3_ctx->add_mux_channel_lock);
- mutex_destroy(&rmnet_ipa3_ctx->pipe_handle_guard);
- kfree(rmnet_ipa3_ctx);
- rmnet_ipa3_ctx = NULL;
- }
- static void ipa3_wwan_msg_free_cb(void *buff, u32 len, u32 type)
- {
- kfree(buff);
- }
- static int ipa3_rmnet_poll(struct napi_struct *napi, int budget)
- {
- int rcvd_pkts = 0;
- rcvd_pkts = ipa_rx_poll(rmnet_ipa3_ctx->ipa3_to_apps_hdl,
- NAPI_WEIGHT);
- IPAWANDBG_LOW("rcvd packets: %d\n", rcvd_pkts);
- return rcvd_pkts;
- }
- late_initcall(ipa3_wwan_init);
- module_exit(ipa3_wwan_cleanup);
- MODULE_DESCRIPTION("WWAN Network Interface");
- MODULE_LICENSE("GPL v2");
|