123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (c) 2015-2021, The Linux Foundation. All rights reserved.
- * Copyright (c) 2021-2024 Qualcomm Innovation Center, Inc. All rights reserved.
- */
- #include <linux/module.h>
- #include <linux/soc/qcom/qmi.h>
- #include "bus.h"
- #include "debug.h"
- #include "main.h"
- #include "qmi.h"
- #include "genl.h"
- #define WLFW_SERVICE_INS_ID_V01 1
- #define WLFW_CLIENT_ID 0x4b4e454c
- #define BDF_FILE_NAME_PREFIX "bdwlan"
- #define ELF_BDF_FILE_NAME "bdwlan.elf"
- #define ELF_BDF_FILE_NAME_GF "bdwlang.elf"
- #define ELF_BDF_FILE_NAME_PREFIX "bdwlan.e"
- #define ELF_BDF_FILE_NAME_GF_PREFIX "bdwlang.e"
- #define BIN_BDF_FILE_NAME "bdwlan.bin"
- #define BIN_BDF_FILE_NAME_GF "bdwlang.bin"
- #define BIN_BDF_FILE_NAME_PREFIX "bdwlan.b"
- #define BIN_BDF_FILE_NAME_GF_PREFIX "bdwlang.b"
- #define REGDB_FILE_NAME "regdb.bin"
- #define HDS_FILE_NAME "hds.bin"
- #define CHIP_ID_GF_MASK 0x10
- #define QDSS_TRACE_CONFIG_FILE "qdss_trace_config"
- /*
- * Download QDSS config file based on build type. Add build type string to
- * file name. Download "qdss_trace_config_debug_v<n>.cfg" for debug build
- * and "qdss_trace_config_perf_v<n>.cfg" for perf build.
- */
- #ifdef CONFIG_CNSS2_DEBUG
- #define QDSS_FILE_BUILD_STR "debug_"
- #else
- #define QDSS_FILE_BUILD_STR "perf_"
- #endif
- #define HW_V1_NUMBER "v1"
- #define HW_V2_NUMBER "v2"
- #define CE_MSI_NAME "CE"
- #define QMI_WLFW_TIMEOUT_MS (plat_priv->ctrl_params.qmi_timeout)
- #define QMI_WLFW_TIMEOUT_JF msecs_to_jiffies(QMI_WLFW_TIMEOUT_MS)
- #define COEX_TIMEOUT QMI_WLFW_TIMEOUT_JF
- #define IMS_TIMEOUT QMI_WLFW_TIMEOUT_JF
- #define QMI_WLFW_MAX_RECV_BUF_SIZE SZ_8K
- #define IMSPRIVATE_SERVICE_MAX_MSG_LEN SZ_8K
- #define DMS_QMI_MAX_MSG_LEN SZ_256
- #define MAX_SHADOW_REG_RESERVED 2
- #define MAX_NUM_SHADOW_REG_V3 (QMI_WLFW_MAX_NUM_SHADOW_REG_V3_USAGE_V01 - \
- MAX_SHADOW_REG_RESERVED)
- #define QMI_WLFW_MAC_READY_TIMEOUT_MS 50
- #define QMI_WLFW_MAC_READY_MAX_RETRY 200
- // these error values are not defined in <linux/soc/qcom/qmi.h> and fw is sending as error response
- #define QMI_ERR_HARDWARE_RESTRICTED_V01 0x0053
- #define QMI_ERR_ENOMEM_V01 0x0002
- enum nm_modem_bit {
- SLEEP_CLOCK_SELECT_INTERNAL_BIT = BIT(1),
- HOST_CSTATE_BIT = BIT(2),
- };
- #ifdef CONFIG_CNSS2_DEBUG
- static bool ignore_qmi_failure;
- #define CNSS_QMI_ASSERT() CNSS_ASSERT(ignore_qmi_failure)
- void cnss_ignore_qmi_failure(bool ignore)
- {
- ignore_qmi_failure = ignore;
- }
- #else
- #define CNSS_QMI_ASSERT() do { } while (0)
- void cnss_ignore_qmi_failure(bool ignore) { }
- #endif
- static char *cnss_qmi_mode_to_str(enum cnss_driver_mode mode)
- {
- switch (mode) {
- case CNSS_MISSION:
- return "MISSION";
- case CNSS_FTM:
- return "FTM";
- case CNSS_EPPING:
- return "EPPING";
- case CNSS_WALTEST:
- return "WALTEST";
- case CNSS_OFF:
- return "OFF";
- case CNSS_CCPM:
- return "CCPM";
- case CNSS_QVIT:
- return "QVIT";
- case CNSS_CALIBRATION:
- return "CALIBRATION";
- default:
- return "UNKNOWN";
- }
- }
- static int qmi_send_wait(struct qmi_handle *qmi, void *req, void *rsp,
- struct qmi_elem_info *req_ei,
- struct qmi_elem_info *rsp_ei,
- int req_id, size_t req_len,
- unsigned long timeout)
- {
- struct qmi_txn txn;
- int ret;
- char *err_msg;
- struct qmi_response_type_v01 *resp = rsp;
- ret = qmi_txn_init(qmi, &txn, rsp_ei, rsp);
- if (ret < 0) {
- err_msg = "Qmi fail: fail to init txn,";
- goto out;
- }
- ret = qmi_send_request(qmi, NULL, &txn, req_id,
- req_len, req_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- err_msg = "Qmi fail: fail to send req,";
- goto out;
- }
- ret = qmi_txn_wait(&txn, timeout);
- if (ret < 0) {
- err_msg = "Qmi fail: wait timeout,";
- goto out;
- } else if (resp->result != QMI_RESULT_SUCCESS_V01) {
- err_msg = "Qmi fail: request rejected,";
- cnss_pr_err("Qmi fail: respons with error:%d\n",
- resp->error);
- ret = -resp->result;
- goto out;
- }
- cnss_pr_dbg("req %x success\n", req_id);
- return 0;
- out:
- cnss_pr_err("%s req %x, ret %d\n", err_msg, req_id, ret);
- return ret;
- }
- static int cnss_wlfw_ind_register_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_ind_register_req_msg_v01 *req;
- struct wlfw_ind_register_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- cnss_pr_dbg("Sending indication register message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->client_id_valid = 1;
- req->client_id = WLFW_CLIENT_ID;
- req->request_mem_enable_valid = 1;
- req->request_mem_enable = 1;
- req->fw_mem_ready_enable_valid = 1;
- req->fw_mem_ready_enable = 1;
- /* fw_ready indication is replaced by fw_init_done in HST/HSP */
- req->fw_init_done_enable_valid = 1;
- req->fw_init_done_enable = 1;
- req->pin_connect_result_enable_valid = 1;
- req->pin_connect_result_enable = 1;
- req->cal_done_enable_valid = 1;
- req->cal_done_enable = 1;
- req->qdss_trace_req_mem_enable_valid = 1;
- req->qdss_trace_req_mem_enable = 1;
- req->qdss_trace_save_enable_valid = 1;
- req->qdss_trace_save_enable = 1;
- req->qdss_trace_free_enable_valid = 1;
- req->qdss_trace_free_enable = 1;
- req->respond_get_info_enable_valid = 1;
- req->respond_get_info_enable = 1;
- req->wfc_call_twt_config_enable_valid = 1;
- req->wfc_call_twt_config_enable = 1;
- req->async_data_enable_valid = 1;
- req->async_data_enable = 1;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_ind_register_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for indication register request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_IND_REGISTER_REQ_V01,
- WLFW_IND_REGISTER_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_ind_register_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send indication register request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of indication register request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Indication register request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- if (resp->fw_status_valid) {
- if (resp->fw_status & QMI_WLFW_ALREADY_REGISTERED_V01) {
- ret = -EALREADY;
- goto qmi_registered;
- }
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- qmi_registered:
- kfree(req);
- kfree(resp);
- return ret;
- }
- static void cnss_wlfw_host_cap_parse_mlo(struct cnss_plat_data *plat_priv,
- struct wlfw_host_cap_req_msg_v01 *req)
- {
- if (plat_priv->device_id == KIWI_DEVICE_ID ||
- plat_priv->device_id == MANGO_DEVICE_ID ||
- plat_priv->device_id == PEACH_DEVICE_ID) {
- req->mlo_capable_valid = 1;
- req->mlo_capable = 1;
- req->mlo_chip_id_valid = 1;
- req->mlo_chip_id = 0;
- req->mlo_group_id_valid = 1;
- req->mlo_group_id = 0;
- req->max_mlo_peer_valid = 1;
- /* Max peer number generally won't change for the same device
- * but needs to be synced with host driver.
- */
- req->max_mlo_peer = 32;
- req->mlo_num_chips_valid = 1;
- req->mlo_num_chips = 1;
- req->mlo_chip_info_valid = 1;
- req->mlo_chip_info[0].chip_id = 0;
- req->mlo_chip_info[0].num_local_links = 2;
- req->mlo_chip_info[0].hw_link_id[0] = 0;
- req->mlo_chip_info[0].hw_link_id[1] = 1;
- req->mlo_chip_info[0].valid_mlo_link_id[0] = 1;
- req->mlo_chip_info[0].valid_mlo_link_id[1] = 1;
- }
- }
- static int cnss_wlfw_host_cap_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_host_cap_req_msg_v01 *req;
- struct wlfw_host_cap_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- u64 iova_start = 0, iova_size = 0,
- iova_ipa_start = 0, iova_ipa_size = 0;
- u64 feature_list = 0;
- cnss_pr_dbg("Sending host capability message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->num_clients_valid = 1;
- req->num_clients = 1;
- cnss_pr_dbg("Number of clients is %d\n", req->num_clients);
- req->wake_msi = cnss_bus_get_wake_irq(plat_priv);
- if (req->wake_msi) {
- cnss_pr_dbg("WAKE MSI base data is %d\n", req->wake_msi);
- req->wake_msi_valid = 1;
- }
- req->bdf_support_valid = 1;
- req->bdf_support = 1;
- req->m3_support_valid = 1;
- req->m3_support = 1;
- req->m3_cache_support_valid = 1;
- req->m3_cache_support = 1;
- req->cal_done_valid = 1;
- req->cal_done = plat_priv->cal_done;
- cnss_pr_dbg("Calibration done is %d\n", plat_priv->cal_done);
- if (plat_priv->sleep_clk) {
- req->nm_modem_valid = 1;
- /* Notify firmware about the sleep clock selection,
- * nm_modem_bit[1] is used for this purpose.
- */
- req->nm_modem |= SLEEP_CLOCK_SELECT_INTERNAL_BIT;
- }
- if (plat_priv->supported_link_speed) {
- req->pcie_link_info_valid = 1;
- req->pcie_link_info.pci_link_speed =
- plat_priv->supported_link_speed;
- cnss_pr_dbg("Supported link speed in Host Cap %d\n",
- plat_priv->supported_link_speed);
- }
- if (cnss_bus_is_smmu_s1_enabled(plat_priv) &&
- !cnss_bus_get_iova(plat_priv, &iova_start, &iova_size) &&
- !cnss_bus_get_iova_ipa(plat_priv, &iova_ipa_start,
- &iova_ipa_size)) {
- req->ddr_range_valid = 1;
- req->ddr_range[0].start = iova_start;
- req->ddr_range[0].size = iova_size + iova_ipa_size;
- cnss_pr_dbg("Sending iova starting 0x%llx with size 0x%llx\n",
- req->ddr_range[0].start, req->ddr_range[0].size);
- }
- req->host_build_type_valid = 1;
- req->host_build_type = cnss_get_host_build_type();
- cnss_wlfw_host_cap_parse_mlo(plat_priv, req);
- ret = cnss_get_feature_list(plat_priv, &feature_list);
- if (!ret) {
- req->feature_list_valid = 1;
- req->feature_list = feature_list;
- cnss_pr_dbg("Sending feature list 0x%llx\n",
- req->feature_list);
- }
- if (cnss_get_platform_name(plat_priv, req->platform_name,
- QMI_WLFW_MAX_PLATFORM_NAME_LEN_V01))
- req->platform_name_valid = 1;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_host_cap_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for host capability request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_HOST_CAP_REQ_V01,
- WLFW_HOST_CAP_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_host_cap_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send host capability request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of host capability request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Host capability request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_respond_mem_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_respond_mem_req_msg_v01 *req;
- struct wlfw_respond_mem_resp_msg_v01 *resp;
- struct qmi_txn txn;
- struct cnss_fw_mem *fw_mem = plat_priv->fw_mem;
- int ret = 0, i;
- cnss_pr_dbg("Sending respond memory message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- if (plat_priv->fw_mem_seg_len > QMI_WLFW_MAX_NUM_MEM_SEG_V01) {
- cnss_pr_err("Invalid seg len %u\n", plat_priv->fw_mem_seg_len);
- ret = -EINVAL;
- goto out;
- }
- req->mem_seg_len = plat_priv->fw_mem_seg_len;
- for (i = 0; i < req->mem_seg_len; i++) {
- if (!fw_mem[i].pa || !fw_mem[i].size) {
- if (fw_mem[i].type == 0) {
- cnss_pr_err("Invalid memory for FW type, segment = %d\n",
- i);
- ret = -EINVAL;
- goto out;
- }
- cnss_pr_err("Memory for FW is not available for type: %u\n",
- fw_mem[i].type);
- ret = -ENOMEM;
- goto out;
- }
- cnss_pr_dbg("Memory for FW, va: 0x%pK, pa: %pa, size: 0x%zx, type: %u\n",
- fw_mem[i].va, &fw_mem[i].pa,
- fw_mem[i].size, fw_mem[i].type);
- req->mem_seg[i].addr = fw_mem[i].pa;
- req->mem_seg[i].size = fw_mem[i].size;
- req->mem_seg[i].type = fw_mem[i].type;
- }
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_respond_mem_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for respond memory request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_RESPOND_MEM_REQ_V01,
- WLFW_RESPOND_MEM_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_respond_mem_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send respond memory request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of respond memory request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Respond memory request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_tgt_cap_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_cap_req_msg_v01 *req;
- struct wlfw_cap_resp_msg_v01 *resp;
- struct qmi_txn txn;
- char *fw_build_timestamp;
- int ret = 0, i;
- cnss_pr_dbg("Sending target capability message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_cap_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for target capability request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_CAP_REQ_V01,
- WLFW_CAP_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_cap_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send respond target capability request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of target capability request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Target capability request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- if (resp->chip_info_valid) {
- plat_priv->chip_info.chip_id = resp->chip_info.chip_id;
- plat_priv->chip_info.chip_family = resp->chip_info.chip_family;
- }
- if (resp->board_info_valid)
- plat_priv->board_info.board_id = resp->board_info.board_id;
- else
- plat_priv->board_info.board_id = 0xFF;
- if (resp->soc_info_valid)
- plat_priv->soc_info.soc_id = resp->soc_info.soc_id;
- if (resp->fw_version_info_valid) {
- plat_priv->fw_version_info.fw_version =
- resp->fw_version_info.fw_version;
- fw_build_timestamp = resp->fw_version_info.fw_build_timestamp;
- fw_build_timestamp[QMI_WLFW_MAX_TIMESTAMP_LEN] = '\0';
- strlcpy(plat_priv->fw_version_info.fw_build_timestamp,
- resp->fw_version_info.fw_build_timestamp,
- QMI_WLFW_MAX_TIMESTAMP_LEN + 1);
- }
- if (resp->fw_build_id_valid) {
- resp->fw_build_id[QMI_WLFW_MAX_BUILD_ID_LEN] = '\0';
- strlcpy(plat_priv->fw_build_id, resp->fw_build_id,
- QMI_WLFW_MAX_BUILD_ID_LEN + 1);
- }
- /* FW will send aop retention volatage for qca6490 */
- if (resp->voltage_mv_valid) {
- plat_priv->cpr_info.voltage = resp->voltage_mv;
- cnss_pr_dbg("Voltage for CPR: %dmV\n",
- plat_priv->cpr_info.voltage);
- cnss_update_cpr_info(plat_priv);
- }
- if (resp->time_freq_hz_valid) {
- plat_priv->device_freq_hz = resp->time_freq_hz;
- cnss_pr_dbg("Device frequency is %d HZ\n",
- plat_priv->device_freq_hz);
- }
- if (resp->otp_version_valid)
- plat_priv->otp_version = resp->otp_version;
- if (resp->dev_mem_info_valid) {
- for (i = 0; i < QMI_WLFW_MAX_DEV_MEM_NUM_V01; i++) {
- plat_priv->dev_mem_info[i].start =
- resp->dev_mem_info[i].start;
- plat_priv->dev_mem_info[i].size =
- resp->dev_mem_info[i].size;
- cnss_pr_buf("Device memory info[%d]: start = 0x%llx, size = 0x%llx\n",
- i, plat_priv->dev_mem_info[i].start,
- plat_priv->dev_mem_info[i].size);
- }
- }
- if (resp->fw_caps_valid) {
- plat_priv->fw_pcie_gen_switch =
- !!(resp->fw_caps & QMI_WLFW_HOST_PCIE_GEN_SWITCH_V01);
- plat_priv->fw_aux_uc_support =
- !!(resp->fw_caps & QMI_WLFW_AUX_UC_SUPPORT_V01);
- cnss_pr_dbg("FW aux uc support capability: %d\n",
- plat_priv->fw_aux_uc_support);
- plat_priv->fw_caps = resp->fw_caps;
- }
- if (resp->hang_data_length_valid &&
- resp->hang_data_length &&
- resp->hang_data_length <= WLFW_MAX_HANG_EVENT_DATA_SIZE)
- plat_priv->hang_event_data_len = resp->hang_data_length;
- else
- plat_priv->hang_event_data_len = 0;
- if (resp->hang_data_addr_offset_valid)
- plat_priv->hang_data_addr_offset = resp->hang_data_addr_offset;
- else
- plat_priv->hang_data_addr_offset = 0;
- if (resp->hwid_bitmap_valid)
- plat_priv->hwid_bitmap = resp->hwid_bitmap;
- if (resp->ol_cpr_cfg_valid)
- cnss_aop_ol_cpr_cfg_setup(plat_priv, &resp->ol_cpr_cfg);
- /* Disable WLAN PDC in AOP firmware for boards which support on chip PMIC
- * so AOP will ignore SW_CTRL changes and do not update regulator votes.
- **/
- for (i = 0; i < plat_priv->on_chip_pmic_devices_count; i++) {
- if (plat_priv->board_info.board_id ==
- plat_priv->on_chip_pmic_board_ids[i]) {
- cnss_pr_dbg("Disabling WLAN PDC for board_id: %02x\n",
- plat_priv->board_info.board_id);
- ret = cnss_aop_send_msg(plat_priv,
- "{class: wlan_pdc, ss: rf, res: pdc, enable: 0}");
- if (ret < 0)
- cnss_pr_dbg("Failed to Send AOP Msg");
- break;
- }
- }
- if (resp->serial_id_valid) {
- plat_priv->serial_id = resp->serial_id;
- cnss_pr_info("serial id 0x%x 0x%x\n",
- resp->serial_id.serial_id_msb,
- resp->serial_id.serial_id_lsb);
- }
- cnss_pr_dbg("Target capability: chip_id: 0x%x, chip_family: 0x%x, board_id: 0x%x, soc_id: 0x%x, otp_version: 0x%x\n",
- plat_priv->chip_info.chip_id,
- plat_priv->chip_info.chip_family,
- plat_priv->board_info.board_id, plat_priv->soc_info.soc_id,
- plat_priv->otp_version);
- cnss_pr_dbg("fw_version: 0x%x, fw_build_timestamp: %s, fw_build_id: %s, hwid_bitmap:0x%x\n",
- plat_priv->fw_version_info.fw_version,
- plat_priv->fw_version_info.fw_build_timestamp,
- plat_priv->fw_build_id,
- plat_priv->hwid_bitmap);
- cnss_pr_dbg("Hang event params, Length: 0x%x, Offset Address: 0x%x\n",
- plat_priv->hang_event_data_len,
- plat_priv->hang_data_addr_offset);
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- static char *cnss_bdf_type_to_str(enum cnss_bdf_type bdf_type)
- {
- switch (bdf_type) {
- case CNSS_BDF_BIN:
- case CNSS_BDF_ELF:
- return "BDF";
- case CNSS_BDF_REGDB:
- return "REGDB";
- case CNSS_BDF_HDS:
- return "HDS";
- default:
- return "UNKNOWN";
- }
- }
- static int cnss_get_bdf_file_name(struct cnss_plat_data *plat_priv,
- u32 bdf_type, char *filename,
- u32 filename_len)
- {
- char filename_tmp[MAX_FIRMWARE_NAME_LEN];
- int ret = 0;
- switch (bdf_type) {
- case CNSS_BDF_ELF:
- /* Board ID will be equal or less than 0xFF in GF mask case */
- if (plat_priv->board_info.board_id == 0xFF) {
- if (plat_priv->chip_info.chip_id & CHIP_ID_GF_MASK)
- snprintf(filename_tmp, filename_len,
- ELF_BDF_FILE_NAME_GF);
- else
- snprintf(filename_tmp, filename_len,
- ELF_BDF_FILE_NAME);
- } else if (plat_priv->board_info.board_id < 0xFF) {
- if (plat_priv->chip_info.chip_id & CHIP_ID_GF_MASK)
- snprintf(filename_tmp, filename_len,
- ELF_BDF_FILE_NAME_GF_PREFIX "%02x",
- plat_priv->board_info.board_id);
- else
- snprintf(filename_tmp, filename_len,
- ELF_BDF_FILE_NAME_PREFIX "%02x",
- plat_priv->board_info.board_id);
- } else {
- snprintf(filename_tmp, filename_len,
- BDF_FILE_NAME_PREFIX "%02x.e%02x",
- plat_priv->board_info.board_id >> 8 & 0xFF,
- plat_priv->board_info.board_id & 0xFF);
- }
- break;
- case CNSS_BDF_BIN:
- if (plat_priv->board_info.board_id == 0xFF) {
- if (plat_priv->chip_info.chip_id & CHIP_ID_GF_MASK)
- snprintf(filename_tmp, filename_len,
- BIN_BDF_FILE_NAME_GF);
- else
- snprintf(filename_tmp, filename_len,
- BIN_BDF_FILE_NAME);
- } else if (plat_priv->board_info.board_id < 0xFF) {
- if (plat_priv->chip_info.chip_id & CHIP_ID_GF_MASK)
- snprintf(filename_tmp, filename_len,
- BIN_BDF_FILE_NAME_GF_PREFIX "%02x",
- plat_priv->board_info.board_id);
- else
- snprintf(filename_tmp, filename_len,
- BIN_BDF_FILE_NAME_PREFIX "%02x",
- plat_priv->board_info.board_id);
- } else {
- snprintf(filename_tmp, filename_len,
- BDF_FILE_NAME_PREFIX "%02x.b%02x",
- plat_priv->board_info.board_id >> 8 & 0xFF,
- plat_priv->board_info.board_id & 0xFF);
- }
- break;
- case CNSS_BDF_REGDB:
- snprintf(filename_tmp, filename_len, REGDB_FILE_NAME);
- break;
- case CNSS_BDF_HDS:
- snprintf(filename_tmp, filename_len, HDS_FILE_NAME);
- break;
- default:
- cnss_pr_err("Invalid BDF type: %d\n",
- plat_priv->ctrl_params.bdf_type);
- ret = -EINVAL;
- break;
- }
- if (!ret)
- cnss_bus_add_fw_prefix_name(plat_priv, filename, filename_tmp);
- return ret;
- }
- int cnss_wlfw_bdf_dnld_send_sync(struct cnss_plat_data *plat_priv,
- u32 bdf_type)
- {
- struct wlfw_bdf_download_req_msg_v01 *req;
- struct wlfw_bdf_download_resp_msg_v01 *resp;
- struct qmi_txn txn;
- char filename[MAX_FIRMWARE_NAME_LEN];
- const struct firmware *fw_entry = NULL;
- const u8 *temp;
- unsigned int remaining;
- int ret = 0;
- cnss_pr_dbg("Sending QMI_WLFW_BDF_DOWNLOAD_REQ_V01 message for bdf_type: %d (%s), state: 0x%lx\n",
- bdf_type, cnss_bdf_type_to_str(bdf_type), plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- ret = cnss_get_bdf_file_name(plat_priv, bdf_type,
- filename, sizeof(filename));
- if (ret)
- goto err_req_fw;
- cnss_pr_dbg("Invoke firmware_request_nowarn for %s\n", filename);
- if (bdf_type == CNSS_BDF_REGDB)
- ret = cnss_request_firmware_direct(plat_priv, &fw_entry,
- filename);
- else
- ret = firmware_request_nowarn(&fw_entry, filename,
- &plat_priv->plat_dev->dev);
- if (ret) {
- cnss_pr_err("Failed to load %s: %s, ret: %d\n",
- cnss_bdf_type_to_str(bdf_type), filename, ret);
- goto err_req_fw;
- }
- temp = fw_entry->data;
- remaining = fw_entry->size;
- cnss_pr_dbg("Downloading %s: %s, size: %u\n",
- cnss_bdf_type_to_str(bdf_type), filename, remaining);
- while (remaining) {
- req->valid = 1;
- req->file_id_valid = 1;
- req->file_id = plat_priv->board_info.board_id;
- req->total_size_valid = 1;
- req->total_size = remaining;
- req->seg_id_valid = 1;
- req->data_valid = 1;
- req->end_valid = 1;
- req->bdf_type_valid = 1;
- req->bdf_type = bdf_type;
- if (remaining > QMI_WLFW_MAX_DATA_SIZE_V01) {
- req->data_len = QMI_WLFW_MAX_DATA_SIZE_V01;
- } else {
- req->data_len = remaining;
- req->end = 1;
- }
- memcpy(req->data, temp, req->data_len);
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_bdf_download_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for QMI_WLFW_BDF_DOWNLOAD_REQ_V01 request for %s, error: %d\n",
- cnss_bdf_type_to_str(bdf_type), ret);
- goto err_send;
- }
- ret = qmi_send_request
- (&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_BDF_DOWNLOAD_REQ_V01,
- WLFW_BDF_DOWNLOAD_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_bdf_download_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send QMI_WLFW_BDF_DOWNLOAD_REQ_V01 request for %s, error: %d\n",
- cnss_bdf_type_to_str(bdf_type), ret);
- goto err_send;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Timeout while waiting for FW response for QMI_WLFW_BDF_DOWNLOAD_REQ_V01 request for %s, err: %d\n",
- cnss_bdf_type_to_str(bdf_type), ret);
- goto err_send;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("FW response for QMI_WLFW_BDF_DOWNLOAD_REQ_V01 request for %s failed, result: %d, err: %d\n",
- cnss_bdf_type_to_str(bdf_type), resp->resp.result,
- resp->resp.error);
- ret = -resp->resp.result;
- goto err_send;
- }
- remaining -= req->data_len;
- temp += req->data_len;
- req->seg_id++;
- }
- release_firmware(fw_entry);
- if (resp->host_bdf_data_valid) {
- /* QCA6490 enable S3E regulator for IPA configuration only */
- if (!(resp->host_bdf_data & QMI_WLFW_HW_XPA_V01))
- cnss_enable_int_pow_amp_vreg(plat_priv);
- plat_priv->cbc_file_download =
- resp->host_bdf_data & QMI_WLFW_CBC_FILE_DOWNLOAD_V01;
- cnss_pr_info("Host BDF config: HW_XPA: %d CalDB: %d\n",
- resp->host_bdf_data & QMI_WLFW_HW_XPA_V01,
- plat_priv->cbc_file_download);
- }
- kfree(req);
- kfree(resp);
- return 0;
- err_send:
- release_firmware(fw_entry);
- err_req_fw:
- if (!(bdf_type == CNSS_BDF_REGDB ||
- test_bit(CNSS_IN_REBOOT, &plat_priv->driver_state) ||
- ret == -EAGAIN))
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_tme_patch_dnld_send_sync(struct cnss_plat_data *plat_priv,
- enum wlfw_tme_lite_file_type_v01 file)
- {
- struct wlfw_tme_lite_info_req_msg_v01 *req;
- struct wlfw_tme_lite_info_resp_msg_v01 *resp;
- struct qmi_txn txn;
- struct cnss_fw_mem *tme_lite_mem = &plat_priv->tme_lite_mem;
- int ret = 0;
- cnss_pr_dbg("Sending TME patch information message, state: 0x%lx\n",
- plat_priv->driver_state);
- if (plat_priv->device_id != PEACH_DEVICE_ID)
- return 0;
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- if (!tme_lite_mem->pa || !tme_lite_mem->size) {
- cnss_pr_err("Memory for TME patch is not available\n");
- ret = -ENOMEM;
- goto out;
- }
- cnss_pr_dbg("TME-L patch memory, va: 0x%pK, pa: %pa, size: 0x%zx\n",
- tme_lite_mem->va, &tme_lite_mem->pa, tme_lite_mem->size);
- req->tme_file = file;
- req->addr = plat_priv->tme_lite_mem.pa;
- req->size = plat_priv->tme_lite_mem.size;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_tme_lite_info_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for TME patch information request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_TME_LITE_INFO_REQ_V01,
- WLFW_TME_LITE_INFO_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_tme_lite_info_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send TME patch information request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of TME patch information request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("TME patch information request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_tme_opt_file_dnld_send_sync(struct cnss_plat_data *plat_priv,
- enum wlfw_tme_lite_file_type_v01 file)
- {
- struct wlfw_tme_lite_info_req_msg_v01 *req;
- struct wlfw_tme_lite_info_resp_msg_v01 *resp;
- struct qmi_txn txn;
- struct cnss_fw_mem *tme_opt_file_mem = NULL;
- char *file_name = NULL;
- int ret = 0;
- if (plat_priv->device_id != PEACH_DEVICE_ID)
- return 0;
- cnss_pr_dbg("Sending TME opt file information message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- if (file == WLFW_TME_LITE_OEM_FUSE_FILE_V01) {
- tme_opt_file_mem = &plat_priv->tme_opt_file_mem[0];
- file_name = TME_OEM_FUSE_FILE_NAME;
- } else if (file == WLFW_TME_LITE_RPR_FILE_V01) {
- tme_opt_file_mem = &plat_priv->tme_opt_file_mem[1];
- file_name = TME_RPR_FILE_NAME;
- } else if (file == WLFW_TME_LITE_DPR_FILE_V01) {
- tme_opt_file_mem = &plat_priv->tme_opt_file_mem[2];
- file_name = TME_DPR_FILE_NAME;
- }
- if (!tme_opt_file_mem || !tme_opt_file_mem->pa ||
- !tme_opt_file_mem->size) {
- cnss_pr_err("Memory for TME opt file is not available\n");
- ret = -ENOMEM;
- goto out;
- }
- cnss_pr_dbg("TME opt file %s memory, va: 0x%pK, pa: %pa, size: 0x%zx\n",
- file_name, tme_opt_file_mem->va, &tme_opt_file_mem->pa, tme_opt_file_mem->size);
- req->tme_file = file;
- req->addr = tme_opt_file_mem->pa;
- req->size = tme_opt_file_mem->size;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_tme_lite_info_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for TME opt file information request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_TME_LITE_INFO_REQ_V01,
- WLFW_TME_LITE_INFO_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_tme_lite_info_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send TME opt file information request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of TME opt file information request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- ret = -resp->resp.result;
- if (resp->resp.error == QMI_ERR_HARDWARE_RESTRICTED_V01) {
- cnss_pr_err("TME Power On failed\n");
- goto out;
- } else if (resp->resp.error == QMI_ERR_ENOMEM_V01) {
- cnss_pr_err("malloc SRAM failed\n");
- goto out;
- }
- cnss_pr_err("TME opt file information request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_m3_dnld_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_m3_info_req_msg_v01 *req;
- struct wlfw_m3_info_resp_msg_v01 *resp;
- struct qmi_txn txn;
- struct cnss_fw_mem *m3_mem = &plat_priv->m3_mem;
- int ret = 0;
- cnss_pr_dbg("Sending M3 information message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- if (!m3_mem->pa || !m3_mem->size) {
- cnss_pr_err("Memory for M3 is not available\n");
- ret = -ENOMEM;
- goto out;
- }
- cnss_pr_dbg("M3 memory, va: 0x%pK, pa: %pa, size: 0x%zx\n",
- m3_mem->va, &m3_mem->pa, m3_mem->size);
- req->addr = plat_priv->m3_mem.pa;
- req->size = plat_priv->m3_mem.size;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_m3_info_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for M3 information request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_M3_INFO_REQ_V01,
- WLFW_M3_INFO_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_m3_info_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send M3 information request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of M3 information request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("M3 information request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_aux_dnld_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_aux_uc_info_req_msg_v01 *req;
- struct wlfw_aux_uc_info_resp_msg_v01 *resp;
- struct qmi_txn txn;
- struct cnss_fw_mem *aux_mem = &plat_priv->aux_mem;
- int ret = 0;
- cnss_pr_dbg("Sending QMI_WLFW_AUX_UC_INFO_REQ_V01 message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- if (!aux_mem->pa || !aux_mem->size) {
- cnss_pr_err("Memory for AUX is not available\n");
- ret = -ENOMEM;
- goto out;
- }
- cnss_pr_dbg("AUX memory, va: 0x%pK, pa: %pa, size: 0x%zx\n",
- aux_mem->va, &aux_mem->pa, aux_mem->size);
- req->addr = plat_priv->aux_mem.pa;
- req->size = plat_priv->aux_mem.size;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_aux_uc_info_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for QMI_WLFW_AUX_UC_INFO_REQ_V01 request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_AUX_UC_INFO_REQ_V01,
- WLFW_AUX_UC_INFO_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_aux_uc_info_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send QMI_WLFW_AUX_UC_INFO_REQ_V01 request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of QMI_WLFW_AUX_UC_INFO_REQ_V01 request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("QMI_WLFW_AUX_UC_INFO_REQ_V01 request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_wlan_mac_req_send_sync(struct cnss_plat_data *plat_priv,
- u8 *mac, u32 mac_len)
- {
- struct wlfw_mac_addr_req_msg_v01 req;
- struct wlfw_mac_addr_resp_msg_v01 resp = {0};
- struct qmi_txn txn;
- int ret;
- if (!plat_priv || !mac || mac_len != QMI_WLFW_MAC_ADDR_SIZE_V01)
- return -EINVAL;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_mac_addr_resp_msg_v01_ei, &resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for mac req, err: %d\n",
- ret);
- ret = -EIO;
- goto out;
- }
- cnss_pr_dbg("Sending WLAN mac req [%pM], state: 0x%lx\n",
- mac, plat_priv->driver_state);
- memcpy(req.mac_addr, mac, mac_len);
- req.mac_addr_valid = 1;
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_MAC_ADDR_REQ_V01,
- WLFW_MAC_ADDR_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_mac_addr_req_msg_v01_ei, &req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send mac req, err: %d\n", ret);
- ret = -EIO;
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for resp of mac req, err: %d\n",
- ret);
- ret = -EIO;
- goto out;
- }
- if (resp.resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("WLAN mac req failed, result: %d, err: %d\n",
- resp.resp.result);
- ret = -resp.resp.result;
- }
- out:
- return ret;
- }
- int cnss_wlfw_qdss_data_send_sync(struct cnss_plat_data *plat_priv, char *file_name,
- u32 total_size)
- {
- int ret = 0;
- struct wlfw_qdss_trace_data_req_msg_v01 *req;
- struct wlfw_qdss_trace_data_resp_msg_v01 *resp;
- unsigned char *p_qdss_trace_data_temp, *p_qdss_trace_data = NULL;
- unsigned int remaining;
- struct qmi_txn txn;
- cnss_pr_dbg("%s\n", __func__);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- p_qdss_trace_data = kzalloc(total_size, GFP_KERNEL);
- if (!p_qdss_trace_data) {
- ret = ENOMEM;
- goto end;
- }
- remaining = total_size;
- p_qdss_trace_data_temp = p_qdss_trace_data;
- while (remaining && resp->end == 0) {
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_qdss_trace_data_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Fail to init txn for QDSS trace resp %d\n",
- ret);
- goto fail;
- }
- ret = qmi_send_request
- (&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_QDSS_TRACE_DATA_REQ_V01,
- WLFW_QDSS_TRACE_DATA_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_qdss_trace_data_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Fail to send QDSS trace data req %d\n",
- ret);
- goto fail;
- }
- ret = qmi_txn_wait(&txn, plat_priv->ctrl_params.qmi_timeout);
- if (ret < 0) {
- cnss_pr_err("QDSS trace resp wait failed with rc %d\n",
- ret);
- goto fail;
- } else if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("QMI QDSS trace request rejected, result:%d error:%d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto fail;
- } else {
- ret = 0;
- }
- cnss_pr_dbg("%s: response total size %d data len %d",
- __func__, resp->total_size, resp->data_len);
- if ((resp->total_size_valid == 1 &&
- resp->total_size == total_size) &&
- (resp->seg_id_valid == 1 && resp->seg_id == req->seg_id) &&
- (resp->data_valid == 1 &&
- resp->data_len <= QMI_WLFW_MAX_DATA_SIZE_V01) &&
- resp->data_len <= remaining) {
- memcpy(p_qdss_trace_data_temp,
- resp->data, resp->data_len);
- } else {
- cnss_pr_err("%s: Unmatched qdss trace data, Expect total_size %u, seg_id %u, Recv total_size_valid %u, total_size %u, seg_id_valid %u, seg_id %u, data_len_valid %u, data_len %u",
- __func__,
- total_size, req->seg_id,
- resp->total_size_valid,
- resp->total_size,
- resp->seg_id_valid,
- resp->seg_id,
- resp->data_valid,
- resp->data_len);
- ret = -1;
- goto fail;
- }
- remaining -= resp->data_len;
- p_qdss_trace_data_temp += resp->data_len;
- req->seg_id++;
- }
- if (remaining == 0 && (resp->end_valid && resp->end)) {
- ret = cnss_genl_send_msg(p_qdss_trace_data,
- CNSS_GENL_MSG_TYPE_QDSS, file_name,
- total_size);
- if (ret < 0) {
- cnss_pr_err("Fail to save QDSS trace data: %d\n",
- ret);
- ret = -1;
- goto fail;
- }
- } else {
- cnss_pr_err("%s: QDSS trace file corrupted: remaining %u, end_valid %u, end %u",
- __func__,
- remaining, resp->end_valid, resp->end);
- ret = -1;
- goto fail;
- }
- fail:
- kfree(p_qdss_trace_data);
- end:
- kfree(req);
- kfree(resp);
- return ret;
- }
- static void cnss_get_qdss_cfg_filename(struct cnss_plat_data *plat_priv,
- char *filename, u32 filename_len,
- bool fallback_file)
- {
- char filename_tmp[MAX_FIRMWARE_NAME_LEN];
- char *build_str = QDSS_FILE_BUILD_STR;
- if (fallback_file)
- build_str = "";
- if (plat_priv->device_version.major_version == FW_V2_NUMBER)
- snprintf(filename_tmp, filename_len, QDSS_TRACE_CONFIG_FILE
- "_%s%s.cfg", build_str, HW_V2_NUMBER);
- else
- snprintf(filename_tmp, filename_len, QDSS_TRACE_CONFIG_FILE
- "_%s%s.cfg", build_str, HW_V1_NUMBER);
- cnss_bus_add_fw_prefix_name(plat_priv, filename, filename_tmp);
- }
- int cnss_wlfw_qdss_dnld_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_qdss_trace_config_download_req_msg_v01 *req;
- struct wlfw_qdss_trace_config_download_resp_msg_v01 *resp;
- struct qmi_txn txn;
- const struct firmware *fw_entry = NULL;
- const u8 *temp;
- char qdss_cfg_filename[MAX_FIRMWARE_NAME_LEN];
- unsigned int remaining;
- int ret = 0;
- cnss_pr_dbg("Sending QDSS config download message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- cnss_get_qdss_cfg_filename(plat_priv, qdss_cfg_filename,
- sizeof(qdss_cfg_filename), false);
- cnss_pr_dbg("Invoke firmware_request_nowarn for %s\n",
- qdss_cfg_filename);
- ret = cnss_request_firmware_direct(plat_priv, &fw_entry,
- qdss_cfg_filename);
- if (ret) {
- cnss_pr_dbg("Unable to load %s ret %d, try default file\n",
- qdss_cfg_filename, ret);
- cnss_get_qdss_cfg_filename(plat_priv, qdss_cfg_filename,
- sizeof(qdss_cfg_filename),
- true);
- cnss_pr_dbg("Invoke firmware_request_nowarn for %s\n",
- qdss_cfg_filename);
- ret = cnss_request_firmware_direct(plat_priv, &fw_entry,
- qdss_cfg_filename);
- if (ret) {
- cnss_pr_err("Unable to load %s ret %d\n",
- qdss_cfg_filename, ret);
- goto err_req_fw;
- }
- }
- temp = fw_entry->data;
- remaining = fw_entry->size;
- cnss_pr_dbg("Downloading QDSS: %s, size: %u\n",
- qdss_cfg_filename, remaining);
- while (remaining) {
- req->total_size_valid = 1;
- req->total_size = remaining;
- req->seg_id_valid = 1;
- req->data_valid = 1;
- req->end_valid = 1;
- if (remaining > QMI_WLFW_MAX_DATA_SIZE_V01) {
- req->data_len = QMI_WLFW_MAX_DATA_SIZE_V01;
- } else {
- req->data_len = remaining;
- req->end = 1;
- }
- memcpy(req->data, temp, req->data_len);
- ret = qmi_txn_init
- (&plat_priv->qmi_wlfw, &txn,
- wlfw_qdss_trace_config_download_resp_msg_v01_ei,
- resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for QDSS download request, err: %d\n",
- ret);
- goto err_send;
- }
- ret = qmi_send_request
- (&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_QDSS_TRACE_CONFIG_DOWNLOAD_REQ_V01,
- WLFW_QDSS_TRACE_CONFIG_DOWNLOAD_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_qdss_trace_config_download_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send respond QDSS download request, err: %d\n",
- ret);
- goto err_send;
- }
- ret = qmi_txn_wait(&txn, plat_priv->ctrl_params.qmi_timeout);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of QDSS download request, err: %d\n",
- ret);
- goto err_send;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("QDSS download request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto err_send;
- }
- remaining -= req->data_len;
- temp += req->data_len;
- req->seg_id++;
- }
- release_firmware(fw_entry);
- kfree(req);
- kfree(resp);
- return 0;
- err_send:
- release_firmware(fw_entry);
- err_req_fw:
- kfree(req);
- kfree(resp);
- return ret;
- }
- static int wlfw_send_qdss_trace_mode_req
- (struct cnss_plat_data *plat_priv,
- enum wlfw_qdss_trace_mode_enum_v01 mode,
- unsigned long long option)
- {
- int rc = 0;
- int tmp = 0;
- struct wlfw_qdss_trace_mode_req_msg_v01 *req;
- struct wlfw_qdss_trace_mode_resp_msg_v01 *resp;
- struct qmi_txn txn;
- if (!plat_priv)
- return -ENODEV;
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->mode_valid = 1;
- req->mode = mode;
- req->option_valid = 1;
- req->option = option;
- tmp = plat_priv->hw_trc_override;
- req->hw_trc_disable_override_valid = 1;
- req->hw_trc_disable_override =
- (tmp > QMI_PARAM_DISABLE_V01 ? QMI_PARAM_DISABLE_V01 :
- (tmp < 0 ? QMI_PARAM_INVALID_V01 : tmp));
- cnss_pr_dbg("%s: mode %u, option %llu, hw_trc_disable_override: %u",
- __func__, mode, option, req->hw_trc_disable_override);
- rc = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_qdss_trace_mode_resp_msg_v01_ei, resp);
- if (rc < 0) {
- cnss_pr_err("Fail to init txn for QDSS Mode resp %d\n",
- rc);
- goto out;
- }
- rc = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_QDSS_TRACE_MODE_REQ_V01,
- WLFW_QDSS_TRACE_MODE_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_qdss_trace_mode_req_msg_v01_ei, req);
- if (rc < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Fail to send QDSS Mode req %d\n", rc);
- goto out;
- }
- rc = qmi_txn_wait(&txn, plat_priv->ctrl_params.qmi_timeout);
- if (rc < 0) {
- cnss_pr_err("QDSS Mode resp wait failed with rc %d\n",
- rc);
- goto out;
- } else if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("QMI QDSS Mode request rejected, result:%d error:%d\n",
- resp->resp.result, resp->resp.error);
- rc = -resp->resp.result;
- goto out;
- }
- kfree(resp);
- kfree(req);
- return rc;
- out:
- kfree(resp);
- kfree(req);
- CNSS_QMI_ASSERT();
- return rc;
- }
- int wlfw_qdss_trace_start(struct cnss_plat_data *plat_priv)
- {
- return wlfw_send_qdss_trace_mode_req(plat_priv,
- QMI_WLFW_QDSS_TRACE_ON_V01, 0);
- }
- int wlfw_qdss_trace_stop(struct cnss_plat_data *plat_priv, unsigned long long option)
- {
- return wlfw_send_qdss_trace_mode_req(plat_priv, QMI_WLFW_QDSS_TRACE_OFF_V01,
- option);
- }
- int cnss_wlfw_wlan_mode_send_sync(struct cnss_plat_data *plat_priv,
- enum cnss_driver_mode mode)
- {
- struct wlfw_wlan_mode_req_msg_v01 *req;
- struct wlfw_wlan_mode_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending mode message, mode: %s(%d), state: 0x%lx\n",
- cnss_qmi_mode_to_str(mode), mode, plat_priv->driver_state);
- if (mode == CNSS_OFF &&
- test_bit(CNSS_DRIVER_RECOVERY, &plat_priv->driver_state)) {
- cnss_pr_dbg("Recovery is in progress, ignore mode off request\n");
- return 0;
- }
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->mode = (enum wlfw_driver_mode_enum_v01)mode;
- req->hw_debug_valid = 1;
- req->hw_debug = 0;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_wlan_mode_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for mode request, mode: %s(%d), err: %d\n",
- cnss_qmi_mode_to_str(mode), mode, ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_WLAN_MODE_REQ_V01,
- WLFW_WLAN_MODE_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_wlan_mode_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send mode request, mode: %s(%d), err: %d\n",
- cnss_qmi_mode_to_str(mode), mode, ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of mode request, mode: %s(%d), err: %d\n",
- cnss_qmi_mode_to_str(mode), mode, ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Mode request failed, mode: %s(%d), result: %d, err: %d\n",
- cnss_qmi_mode_to_str(mode), mode, resp->resp.result,
- resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- if (mode == CNSS_OFF) {
- cnss_pr_dbg("WLFW service is disconnected while sending mode off request\n");
- ret = 0;
- } else {
- CNSS_QMI_ASSERT();
- }
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_wlan_cfg_send_sync(struct cnss_plat_data *plat_priv,
- struct cnss_wlan_enable_cfg *config,
- const char *host_version)
- {
- struct wlfw_wlan_cfg_req_msg_v01 *req;
- struct wlfw_wlan_cfg_resp_msg_v01 *resp;
- struct qmi_txn txn;
- u32 i, ce_id, num_vectors, user_base_data, base_vector;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending WLAN config message, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->host_version_valid = 1;
- strlcpy(req->host_version, host_version,
- QMI_WLFW_MAX_STR_LEN_V01 + 1);
- req->tgt_cfg_valid = 1;
- if (config->num_ce_tgt_cfg > QMI_WLFW_MAX_NUM_CE_V01)
- req->tgt_cfg_len = QMI_WLFW_MAX_NUM_CE_V01;
- else
- req->tgt_cfg_len = config->num_ce_tgt_cfg;
- for (i = 0; i < req->tgt_cfg_len; i++) {
- req->tgt_cfg[i].pipe_num = config->ce_tgt_cfg[i].pipe_num;
- req->tgt_cfg[i].pipe_dir = config->ce_tgt_cfg[i].pipe_dir;
- req->tgt_cfg[i].nentries = config->ce_tgt_cfg[i].nentries;
- req->tgt_cfg[i].nbytes_max = config->ce_tgt_cfg[i].nbytes_max;
- req->tgt_cfg[i].flags = config->ce_tgt_cfg[i].flags;
- }
- req->svc_cfg_valid = 1;
- if (config->num_ce_svc_pipe_cfg > QMI_WLFW_MAX_NUM_SVC_V01)
- req->svc_cfg_len = QMI_WLFW_MAX_NUM_SVC_V01;
- else
- req->svc_cfg_len = config->num_ce_svc_pipe_cfg;
- for (i = 0; i < req->svc_cfg_len; i++) {
- req->svc_cfg[i].service_id = config->ce_svc_cfg[i].service_id;
- req->svc_cfg[i].pipe_dir = config->ce_svc_cfg[i].pipe_dir;
- req->svc_cfg[i].pipe_num = config->ce_svc_cfg[i].pipe_num;
- }
- if (plat_priv->device_id != KIWI_DEVICE_ID &&
- plat_priv->device_id != MANGO_DEVICE_ID &&
- plat_priv->device_id != PEACH_DEVICE_ID) {
- if (plat_priv->device_id == QCN7605_DEVICE_ID &&
- config->num_shadow_reg_cfg) {
- req->shadow_reg_valid = 1;
- if (config->num_shadow_reg_cfg >
- QMI_WLFW_MAX_NUM_SHADOW_REG_V01)
- req->shadow_reg_len =
- QMI_WLFW_MAX_NUM_SHADOW_REG_V01;
- else
- req->shadow_reg_len =
- config->num_shadow_reg_cfg;
- memcpy(req->shadow_reg, config->shadow_reg_cfg,
- sizeof(struct wlfw_shadow_reg_cfg_s_v01) *
- req->shadow_reg_len);
- } else {
- req->shadow_reg_v2_valid = 1;
- if (config->num_shadow_reg_v2_cfg >
- QMI_WLFW_MAX_NUM_SHADOW_REG_V2_V01)
- req->shadow_reg_v2_len =
- QMI_WLFW_MAX_NUM_SHADOW_REG_V2_V01;
- else
- req->shadow_reg_v2_len =
- config->num_shadow_reg_v2_cfg;
- memcpy(req->shadow_reg_v2, config->shadow_reg_v2_cfg,
- sizeof(struct wlfw_shadow_reg_v2_cfg_s_v01) *
- req->shadow_reg_v2_len);
- }
- } else {
- req->shadow_reg_v3_valid = 1;
- if (config->num_shadow_reg_v3_cfg >
- MAX_NUM_SHADOW_REG_V3)
- req->shadow_reg_v3_len = MAX_NUM_SHADOW_REG_V3;
- else
- req->shadow_reg_v3_len = config->num_shadow_reg_v3_cfg;
- plat_priv->num_shadow_regs_v3 = req->shadow_reg_v3_len;
- cnss_pr_dbg("Shadow reg v3 len: %d\n",
- plat_priv->num_shadow_regs_v3);
- memcpy(req->shadow_reg_v3, config->shadow_reg_v3_cfg,
- sizeof(struct wlfw_shadow_reg_v3_cfg_s_v01) *
- req->shadow_reg_v3_len);
- }
- if (config->rri_over_ddr_cfg_valid) {
- req->rri_over_ddr_cfg_valid = 1;
- req->rri_over_ddr_cfg.base_addr_low =
- config->rri_over_ddr_cfg.base_addr_low;
- req->rri_over_ddr_cfg.base_addr_high =
- config->rri_over_ddr_cfg.base_addr_high;
- }
- if (config->send_msi_ce) {
- ret = cnss_bus_get_msi_assignment(plat_priv,
- CE_MSI_NAME,
- &num_vectors,
- &user_base_data,
- &base_vector);
- if (!ret) {
- req->msi_cfg_valid = 1;
- req->msi_cfg_len = QMI_WLFW_MAX_NUM_CE_V01;
- for (ce_id = 0; ce_id < QMI_WLFW_MAX_NUM_CE_V01;
- ce_id++) {
- req->msi_cfg[ce_id].ce_id = ce_id;
- req->msi_cfg[ce_id].msi_vector =
- (ce_id % num_vectors) + base_vector;
- }
- }
- }
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_wlan_cfg_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for WLAN config request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_WLAN_CFG_REQ_V01,
- WLFW_WLAN_CFG_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_wlan_cfg_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send WLAN config request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of WLAN config request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("WLAN config request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_athdiag_read_send_sync(struct cnss_plat_data *plat_priv,
- u32 offset, u32 mem_type,
- u32 data_len, u8 *data)
- {
- struct wlfw_athdiag_read_req_msg_v01 *req;
- struct wlfw_athdiag_read_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- if (!data || data_len == 0 || data_len > QMI_WLFW_MAX_DATA_SIZE_V01) {
- cnss_pr_err("Invalid parameters for athdiag read: data %pK, data_len %u\n",
- data, data_len);
- return -EINVAL;
- }
- cnss_pr_dbg("athdiag read: state 0x%lx, offset %x, mem_type %x, data_len %u\n",
- plat_priv->driver_state, offset, mem_type, data_len);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->offset = offset;
- req->mem_type = mem_type;
- req->data_len = data_len;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_athdiag_read_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for athdiag read request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_ATHDIAG_READ_REQ_V01,
- WLFW_ATHDIAG_READ_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_athdiag_read_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send athdiag read request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of athdiag read request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Athdiag read request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- if (!resp->data_valid || resp->data_len != data_len) {
- cnss_pr_err("athdiag read data is invalid, data_valid = %u, data_len = %u\n",
- resp->data_valid, resp->data_len);
- ret = -EINVAL;
- goto out;
- }
- memcpy(data, resp->data, resp->data_len);
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_athdiag_write_send_sync(struct cnss_plat_data *plat_priv,
- u32 offset, u32 mem_type,
- u32 data_len, u8 *data)
- {
- struct wlfw_athdiag_write_req_msg_v01 *req;
- struct wlfw_athdiag_write_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- if (!data || data_len == 0 || data_len > QMI_WLFW_MAX_DATA_SIZE_V01) {
- cnss_pr_err("Invalid parameters for athdiag write: data %pK, data_len %u\n",
- data, data_len);
- return -EINVAL;
- }
- cnss_pr_dbg("athdiag write: state 0x%lx, offset %x, mem_type %x, data_len %u, data %pK\n",
- plat_priv->driver_state, offset, mem_type, data_len, data);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->offset = offset;
- req->mem_type = mem_type;
- req->data_len = data_len;
- memcpy(req->data, data, data_len);
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_athdiag_write_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for athdiag write request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_ATHDIAG_WRITE_REQ_V01,
- WLFW_ATHDIAG_WRITE_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_athdiag_write_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send athdiag write request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of athdiag write request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Athdiag write request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_ini_send_sync(struct cnss_plat_data *plat_priv,
- u8 fw_log_mode)
- {
- struct wlfw_ini_req_msg_v01 *req;
- struct wlfw_ini_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending ini sync request, state: 0x%lx, fw_log_mode: %d\n",
- plat_priv->driver_state, fw_log_mode);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->enablefwlog_valid = 1;
- req->enablefwlog = fw_log_mode;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_ini_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for ini request, fw_log_mode: %d, err: %d\n",
- fw_log_mode, ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_INI_REQ_V01,
- WLFW_INI_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_ini_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send ini request, fw_log_mode: %d, err: %d\n",
- fw_log_mode, ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of ini request, fw_log_mode: %d, err: %d\n",
- fw_log_mode, ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Ini request failed, fw_log_mode: %d, result: %d, err: %d\n",
- fw_log_mode, resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_send_pcie_gen_speed_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_pcie_gen_switch_req_msg_v01 req;
- struct wlfw_pcie_gen_switch_resp_msg_v01 resp = {0};
- struct qmi_txn txn;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- if (plat_priv->pcie_gen_speed == QMI_PCIE_GEN_SPEED_INVALID_V01 ||
- !plat_priv->fw_pcie_gen_switch) {
- cnss_pr_dbg("PCIE Gen speed not setup\n");
- return 0;
- }
- cnss_pr_dbg("Sending PCIE Gen speed: %d state: 0x%lx\n",
- plat_priv->pcie_gen_speed, plat_priv->driver_state);
- req.pcie_speed = (enum wlfw_pcie_gen_speed_v01)
- plat_priv->pcie_gen_speed;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_pcie_gen_switch_resp_msg_v01_ei, &resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for PCIE speed switch err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_PCIE_GEN_SWITCH_REQ_V01,
- WLFW_PCIE_GEN_SWITCH_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_pcie_gen_switch_req_msg_v01_ei, &req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send PCIE speed switch, err: %d\n", ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for PCIE Gen switch resp, err: %d\n",
- ret);
- goto out;
- }
- if (resp.resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("PCIE Gen Switch req failed, Speed: %d, result: %d, err: %d\n",
- plat_priv->pcie_gen_speed, resp.resp.result,
- resp.resp.error);
- ret = -resp.resp.result;
- }
- out:
- /* Reset PCIE Gen speed after one time use */
- plat_priv->pcie_gen_speed = QMI_PCIE_GEN_SPEED_INVALID_V01;
- return ret;
- }
- int cnss_wlfw_antenna_switch_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_antenna_switch_req_msg_v01 *req;
- struct wlfw_antenna_switch_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending antenna switch sync request, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_antenna_switch_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for antenna switch request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_ANTENNA_SWITCH_REQ_V01,
- WLFW_ANTENNA_SWITCH_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_antenna_switch_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send antenna switch request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of antenna switch request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_dbg("Antenna switch request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- if (resp->antenna_valid)
- plat_priv->antenna = resp->antenna;
- cnss_pr_dbg("Antenna valid: %u, antenna 0x%llx\n",
- resp->antenna_valid, resp->antenna);
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_antenna_grant_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_antenna_grant_req_msg_v01 *req;
- struct wlfw_antenna_grant_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending antenna grant sync request, state: 0x%lx, grant 0x%llx\n",
- plat_priv->driver_state, plat_priv->grant);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->grant_valid = 1;
- req->grant = plat_priv->grant;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_antenna_grant_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for antenna grant request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_ANTENNA_GRANT_REQ_V01,
- WLFW_ANTENNA_GRANT_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_antenna_grant_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send antenna grant request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of antenna grant request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Antenna grant request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_qdss_trace_mem_info_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_qdss_trace_mem_info_req_msg_v01 *req;
- struct wlfw_qdss_trace_mem_info_resp_msg_v01 *resp;
- struct qmi_txn txn;
- struct cnss_fw_mem *qdss_mem = plat_priv->qdss_mem;
- int ret = 0;
- int i;
- cnss_pr_dbg("Sending QDSS trace mem info, state: 0x%lx\n",
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- if (plat_priv->qdss_mem_seg_len > QMI_WLFW_MAX_NUM_MEM_SEG_V01) {
- cnss_pr_err("Invalid seg len %u\n", plat_priv->qdss_mem_seg_len);
- ret = -EINVAL;
- goto out;
- }
- req->mem_seg_len = plat_priv->qdss_mem_seg_len;
- for (i = 0; i < req->mem_seg_len; i++) {
- cnss_pr_dbg("Memory for FW, va: 0x%pK, pa: %pa, size: 0x%zx, type: %u\n",
- qdss_mem[i].va, &qdss_mem[i].pa,
- qdss_mem[i].size, qdss_mem[i].type);
- req->mem_seg[i].addr = qdss_mem[i].pa;
- req->mem_seg[i].size = qdss_mem[i].size;
- req->mem_seg[i].type = qdss_mem[i].type;
- }
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_qdss_trace_mem_info_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Fail to initialize txn for QDSS trace mem request: err %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_QDSS_TRACE_MEM_INFO_REQ_V01,
- WLFW_QDSS_TRACE_MEM_INFO_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_qdss_trace_mem_info_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Fail to send QDSS trace mem info request: err %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Fail to wait for response of QDSS trace mem info request, err %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("QDSS trace mem info request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_send_host_wfc_call_status(struct cnss_plat_data *plat_priv,
- struct cnss_wfc_cfg cfg)
- {
- struct wlfw_wfc_call_status_req_msg_v01 *req;
- struct wlfw_wfc_call_status_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!test_bit(CNSS_FW_READY, &plat_priv->driver_state)) {
- cnss_pr_err("Drop host WFC indication as FW not initialized\n");
- return -EINVAL;
- }
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->wfc_call_active_valid = 1;
- req->wfc_call_active = cfg.mode;
- cnss_pr_dbg("CNSS->FW: WFC_CALL_REQ: state: 0x%lx\n",
- plat_priv->driver_state);
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_wfc_call_status_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("CNSS->FW: WFC_CALL_REQ: QMI Txn Init: Err %d\n",
- ret);
- goto out;
- }
- cnss_pr_dbg("Send WFC Mode: %d\n", cfg.mode);
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_WFC_CALL_STATUS_REQ_V01,
- WLFW_WFC_CALL_STATUS_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_wfc_call_status_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("CNSS->FW: WFC_CALL_REQ: QMI Send Err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("FW->CNSS: WFC_CALL_RSP: QMI Wait Err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("FW->CNSS: WFC_CALL_RSP: Result: %d Err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -EINVAL;
- goto out;
- }
- ret = 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- static int cnss_wlfw_wfc_call_status_send_sync
- (struct cnss_plat_data *plat_priv,
- const struct ims_private_service_wfc_call_status_ind_msg_v01 *ind_msg)
- {
- struct wlfw_wfc_call_status_req_msg_v01 *req;
- struct wlfw_wfc_call_status_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!test_bit(CNSS_FW_READY, &plat_priv->driver_state)) {
- cnss_pr_err("Drop IMS WFC indication as FW not initialized\n");
- return -EINVAL;
- }
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- /**
- * WFC Call r1 design has CNSS as pass thru using opaque hex buffer.
- * But in r2 update QMI structure is expanded and as an effect qmi
- * decoded structures have padding. Thus we cannot use buffer design.
- * For backward compatibility for r1 design copy only wfc_call_active
- * value in hex buffer.
- */
- req->wfc_call_status_len = sizeof(ind_msg->wfc_call_active);
- req->wfc_call_status[0] = ind_msg->wfc_call_active;
- /* wfc_call_active is mandatory in IMS indication */
- req->wfc_call_active_valid = 1;
- req->wfc_call_active = ind_msg->wfc_call_active;
- req->all_wfc_calls_held_valid = ind_msg->all_wfc_calls_held_valid;
- req->all_wfc_calls_held = ind_msg->all_wfc_calls_held;
- req->is_wfc_emergency_valid = ind_msg->is_wfc_emergency_valid;
- req->is_wfc_emergency = ind_msg->is_wfc_emergency;
- req->twt_ims_start_valid = ind_msg->twt_ims_start_valid;
- req->twt_ims_start = ind_msg->twt_ims_start;
- req->twt_ims_int_valid = ind_msg->twt_ims_int_valid;
- req->twt_ims_int = ind_msg->twt_ims_int;
- req->media_quality_valid = ind_msg->media_quality_valid;
- req->media_quality =
- (enum wlfw_wfc_media_quality_v01)ind_msg->media_quality;
- cnss_pr_dbg("CNSS->FW: WFC_CALL_REQ: state: 0x%lx\n",
- plat_priv->driver_state);
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_wfc_call_status_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("CNSS->FW: WFC_CALL_REQ: QMI Txn Init: Err %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_WFC_CALL_STATUS_REQ_V01,
- WLFW_WFC_CALL_STATUS_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_wfc_call_status_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("CNSS->FW: WFC_CALL_REQ: QMI Send Err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("FW->CNSS: WFC_CALL_RSP: QMI Wait Err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("FW->CNSS: WFC_CALL_RSP: Result: %d Err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- ret = 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_dynamic_feature_mask_send_sync(struct cnss_plat_data *plat_priv)
- {
- struct wlfw_dynamic_feature_mask_req_msg_v01 *req;
- struct wlfw_dynamic_feature_mask_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- cnss_pr_dbg("Sending dynamic feature mask 0x%llx, state: 0x%lx\n",
- plat_priv->dynamic_feature,
- plat_priv->driver_state);
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->mask_valid = 1;
- req->mask = plat_priv->dynamic_feature;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_dynamic_feature_mask_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Fail to initialize txn for dynamic feature mask request: err %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request
- (&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_DYNAMIC_FEATURE_MASK_REQ_V01,
- WLFW_DYNAMIC_FEATURE_MASK_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_dynamic_feature_mask_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Fail to send dynamic feature mask request: err %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Fail to wait for response of dynamic feature mask request, err %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Dynamic feature mask request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_wlfw_get_info_send_sync(struct cnss_plat_data *plat_priv, int type,
- void *cmd, int cmd_len)
- {
- struct wlfw_get_info_req_msg_v01 *req;
- struct wlfw_get_info_resp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- cnss_pr_buf("Sending get info message, type: %d, cmd length: %d, state: 0x%lx\n",
- type, cmd_len, plat_priv->driver_state);
- if (cmd_len > QMI_WLFW_MAX_DATA_SIZE_V01)
- return -EINVAL;
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->type = type;
- req->data_len = cmd_len;
- memcpy(req->data, cmd, req->data_len);
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_get_info_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for get info request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_GET_INFO_REQ_V01,
- WLFW_GET_INFO_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_get_info_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send get info request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of get info request, err: %d\n",
- ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Get info request failed, result: %d, err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(req);
- kfree(resp);
- return 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- unsigned int cnss_get_qmi_timeout(struct cnss_plat_data *plat_priv)
- {
- return QMI_WLFW_TIMEOUT_MS;
- }
- static void cnss_wlfw_request_mem_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn, const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_request_mem_ind_msg_v01 *ind_msg = data;
- int i;
- cnss_pr_dbg("Received QMI WLFW request memory indication\n");
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- if (ind_msg->mem_seg_len > QMI_WLFW_MAX_NUM_MEM_SEG_V01) {
- cnss_pr_err("Invalid seg len %u\n", ind_msg->mem_seg_len);
- return;
- }
- plat_priv->fw_mem_seg_len = ind_msg->mem_seg_len;
- for (i = 0; i < plat_priv->fw_mem_seg_len; i++) {
- cnss_pr_dbg("FW requests for memory, size: 0x%x, type: %u\n",
- ind_msg->mem_seg[i].size, ind_msg->mem_seg[i].type);
- plat_priv->fw_mem[i].type = ind_msg->mem_seg[i].type;
- plat_priv->fw_mem[i].size = ind_msg->mem_seg[i].size;
- if (!plat_priv->fw_mem[i].va &&
- plat_priv->fw_mem[i].type == CNSS_MEM_TYPE_DDR)
- plat_priv->fw_mem[i].attrs |=
- DMA_ATTR_FORCE_CONTIGUOUS;
- if (plat_priv->fw_mem[i].type == CNSS_MEM_CAL_V01)
- plat_priv->cal_mem = &plat_priv->fw_mem[i];
- }
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_REQUEST_MEM,
- 0, NULL);
- }
- static void cnss_wlfw_fw_mem_ready_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn, const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- cnss_pr_dbg("Received QMI WLFW FW memory ready indication\n");
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_FW_MEM_READY,
- 0, NULL);
- }
- /**
- * cnss_wlfw_fw_ready_ind_cb: FW ready indication handler (Helium arch)
- *
- * This event is not required for HST/ HSP as FW calibration done is
- * provided in QMI_WLFW_CAL_DONE_IND_V01
- */
- static void cnss_wlfw_fw_ready_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn, const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- struct cnss_cal_info *cal_info;
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- if (plat_priv->device_id == QCA6390_DEVICE_ID ||
- plat_priv->device_id == QCA6490_DEVICE_ID) {
- cnss_pr_dbg("Ignore FW Ready Indication for HST/HSP");
- return;
- }
- cnss_pr_dbg("Received QMI WLFW FW ready indication.\n");
- cal_info = kzalloc(sizeof(*cal_info), GFP_KERNEL);
- if (!cal_info)
- return;
- cal_info->cal_status = CNSS_CAL_DONE;
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_COLD_BOOT_CAL_DONE,
- 0, cal_info);
- }
- static void cnss_wlfw_fw_init_done_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn, const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- cnss_pr_dbg("Received QMI WLFW FW initialization done indication\n");
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_FW_READY, 0, NULL);
- }
- static void cnss_wlfw_pin_result_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn, const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_pin_connect_result_ind_msg_v01 *ind_msg = data;
- cnss_pr_dbg("Received QMI WLFW pin connect result indication\n");
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- if (ind_msg->pwr_pin_result_valid)
- plat_priv->pin_result.fw_pwr_pin_result =
- ind_msg->pwr_pin_result;
- if (ind_msg->phy_io_pin_result_valid)
- plat_priv->pin_result.fw_phy_io_pin_result =
- ind_msg->phy_io_pin_result;
- if (ind_msg->rf_pin_result_valid)
- plat_priv->pin_result.fw_rf_pin_result = ind_msg->rf_pin_result;
- cnss_pr_dbg("Pin connect Result: pwr_pin: 0x%x phy_io_pin: 0x%x rf_io_pin: 0x%x\n",
- ind_msg->pwr_pin_result, ind_msg->phy_io_pin_result,
- ind_msg->rf_pin_result);
- }
- int cnss_wlfw_cal_report_req_send_sync(struct cnss_plat_data *plat_priv,
- u32 cal_file_download_size)
- {
- struct wlfw_cal_report_req_msg_v01 req = {0};
- struct wlfw_cal_report_resp_msg_v01 resp = {0};
- struct qmi_txn txn;
- int ret = 0;
- cnss_pr_dbg("Sending cal file report request. File size: %d, state: 0x%lx\n",
- cal_file_download_size, plat_priv->driver_state);
- req.cal_file_download_size_valid = 1;
- req.cal_file_download_size = cal_file_download_size;
- ret = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
- wlfw_cal_report_resp_msg_v01_ei, &resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for Cal Report request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
- QMI_WLFW_CAL_REPORT_REQ_V01,
- WLFW_CAL_REPORT_REQ_MSG_V01_MAX_MSG_LEN,
- wlfw_cal_report_req_msg_v01_ei, &req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send Cal Report request, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for response of Cal Report request, err: %d\n",
- ret);
- goto out;
- }
- if (resp.resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Cal Report request failed, result: %d, err: %d\n",
- resp.resp.result, resp.resp.error);
- ret = -resp.resp.result;
- goto out;
- }
- out:
- return ret;
- }
- static void cnss_wlfw_cal_done_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn, const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_cal_done_ind_msg_v01 *ind = data;
- struct cnss_cal_info *cal_info;
- cnss_pr_dbg("Received Cal done indication. File size: %d\n",
- ind->cal_file_upload_size);
- cnss_pr_info("Calibration took %d ms\n",
- jiffies_to_msecs(jiffies - plat_priv->cal_time));
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- if (ind->cal_file_upload_size_valid)
- plat_priv->cal_file_size = ind->cal_file_upload_size;
- cal_info = kzalloc(sizeof(*cal_info), GFP_KERNEL);
- if (!cal_info)
- return;
- cal_info->cal_status = CNSS_CAL_DONE;
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_COLD_BOOT_CAL_DONE,
- 0, cal_info);
- }
- static void cnss_wlfw_qdss_trace_req_mem_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn,
- const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_qdss_trace_req_mem_ind_msg_v01 *ind_msg = data;
- int i;
- cnss_pr_dbg("Received QMI WLFW QDSS trace request mem indication\n");
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- if (plat_priv->qdss_mem_seg_len) {
- cnss_pr_err("Ignore double allocation for QDSS trace, current len %u\n",
- plat_priv->qdss_mem_seg_len);
- return;
- }
- if (ind_msg->mem_seg_len > QMI_WLFW_MAX_NUM_MEM_SEG_V01) {
- cnss_pr_err("Invalid seg len %u\n", ind_msg->mem_seg_len);
- return;
- }
- plat_priv->qdss_mem_seg_len = ind_msg->mem_seg_len;
- for (i = 0; i < plat_priv->qdss_mem_seg_len; i++) {
- cnss_pr_dbg("QDSS requests for memory, size: 0x%x, type: %u\n",
- ind_msg->mem_seg[i].size, ind_msg->mem_seg[i].type);
- plat_priv->qdss_mem[i].type = ind_msg->mem_seg[i].type;
- plat_priv->qdss_mem[i].size = ind_msg->mem_seg[i].size;
- }
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_QDSS_TRACE_REQ_MEM,
- 0, NULL);
- }
- /**
- * cnss_wlfw_fw_mem_file_save_ind_cb: Save given FW mem to filesystem
- *
- * QDSS_TRACE_SAVE_IND feature is overloaded to provide any host allocated
- * fw memory segment for dumping to file system. Only one type of mem can be
- * saved per indication and is provided in mem seg index 0.
- *
- * Return: None
- */
- static void cnss_wlfw_fw_mem_file_save_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn,
- const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_qdss_trace_save_ind_msg_v01 *ind_msg = data;
- struct cnss_qmi_event_fw_mem_file_save_data *event_data;
- int i = 0;
- if (!txn || !data) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- cnss_pr_dbg_buf("QMI fw_mem_file_save: source: %d mem_seg: %d type: %u len: %u\n",
- ind_msg->source, ind_msg->mem_seg_valid,
- ind_msg->mem_seg[0].type, ind_msg->mem_seg_len);
- event_data = kzalloc(sizeof(*event_data), GFP_KERNEL);
- if (!event_data)
- return;
- event_data->mem_type = ind_msg->mem_seg[0].type;
- event_data->mem_seg_len = ind_msg->mem_seg_len;
- event_data->total_size = ind_msg->total_size;
- if (ind_msg->mem_seg_valid) {
- if (ind_msg->mem_seg_len > QMI_WLFW_MAX_STR_LEN_V01) {
- cnss_pr_err("Invalid seg len indication\n");
- goto free_event_data;
- }
- for (i = 0; i < ind_msg->mem_seg_len; i++) {
- event_data->mem_seg[i].addr = ind_msg->mem_seg[i].addr;
- event_data->mem_seg[i].size = ind_msg->mem_seg[i].size;
- if (event_data->mem_type != ind_msg->mem_seg[i].type) {
- cnss_pr_err("FW Mem file save ind cannot have multiple mem types\n");
- goto free_event_data;
- }
- cnss_pr_dbg_buf("seg-%d: addr 0x%llx size 0x%x\n",
- i, ind_msg->mem_seg[i].addr,
- ind_msg->mem_seg[i].size);
- }
- }
- if (ind_msg->file_name_valid)
- strlcpy(event_data->file_name, ind_msg->file_name,
- QMI_WLFW_MAX_STR_LEN_V01 + 1);
- if (ind_msg->source == 1) {
- if (!ind_msg->file_name_valid)
- strlcpy(event_data->file_name, "qdss_trace_wcss_etb",
- QMI_WLFW_MAX_STR_LEN_V01 + 1);
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_QDSS_TRACE_REQ_DATA,
- 0, event_data);
- } else {
- if (event_data->mem_type == QMI_WLFW_MEM_QDSS_V01) {
- if (!ind_msg->file_name_valid)
- strlcpy(event_data->file_name, "qdss_trace_ddr",
- QMI_WLFW_MAX_STR_LEN_V01 + 1);
- } else {
- if (!ind_msg->file_name_valid)
- strlcpy(event_data->file_name, "fw_mem_dump",
- QMI_WLFW_MAX_STR_LEN_V01 + 1);
- }
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_FW_MEM_FILE_SAVE,
- 0, event_data);
- }
- return;
- free_event_data:
- kfree(event_data);
- }
- static void cnss_wlfw_qdss_trace_free_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn,
- const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_QDSS_TRACE_FREE,
- 0, NULL);
- }
- static void cnss_wlfw_respond_get_info_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn,
- const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_respond_get_info_ind_msg_v01 *ind_msg = data;
- cnss_pr_buf("Received QMI WLFW respond get info indication\n");
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- cnss_pr_buf("Extract message with event length: %d, type: %d, is last: %d, seq no: %d\n",
- ind_msg->data_len, ind_msg->type,
- ind_msg->is_last, ind_msg->seq_no);
- if (plat_priv->get_info_cb_ctx && plat_priv->get_info_cb)
- plat_priv->get_info_cb(plat_priv->get_info_cb_ctx,
- (void *)ind_msg->data,
- ind_msg->data_len);
- }
- static void cnss_wlfw_driver_async_data_ind_cb(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn,
- const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_driver_async_data_ind_msg_v01 *ind_msg = data;
- cnss_pr_buf("Received QMI WLFW driver async data indication\n");
- if (!txn) {
- cnss_pr_err("Spurious indication\n");
- return;
- }
- cnss_pr_buf("Extract message with event length: %d, type: %d\n",
- ind_msg->data_len, ind_msg->type);
- if (plat_priv->get_driver_async_data_ctx &&
- plat_priv->get_driver_async_data_cb)
- plat_priv->get_driver_async_data_cb(
- plat_priv->get_driver_async_data_ctx, ind_msg->type,
- (void *)ind_msg->data, ind_msg->data_len);
- }
- static int cnss_ims_wfc_call_twt_cfg_send_sync
- (struct cnss_plat_data *plat_priv,
- const struct wlfw_wfc_call_twt_config_ind_msg_v01 *ind_msg)
- {
- struct ims_private_service_wfc_call_twt_config_req_msg_v01 *req;
- struct ims_private_service_wfc_call_twt_config_rsp_msg_v01 *resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!test_bit(CNSS_IMS_CONNECTED, &plat_priv->driver_state)) {
- cnss_pr_err("Drop FW WFC indication as IMS QMI not connected\n");
- return -EINVAL;
- }
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->twt_sta_start_valid = ind_msg->twt_sta_start_valid;
- req->twt_sta_start = ind_msg->twt_sta_start;
- req->twt_sta_int_valid = ind_msg->twt_sta_int_valid;
- req->twt_sta_int = ind_msg->twt_sta_int;
- req->twt_sta_upo_valid = ind_msg->twt_sta_upo_valid;
- req->twt_sta_upo = ind_msg->twt_sta_upo;
- req->twt_sta_sp_valid = ind_msg->twt_sta_sp_valid;
- req->twt_sta_sp = ind_msg->twt_sta_sp;
- req->twt_sta_dl_valid = req->twt_sta_dl_valid;
- req->twt_sta_dl = req->twt_sta_dl;
- req->twt_sta_config_changed_valid =
- ind_msg->twt_sta_config_changed_valid;
- req->twt_sta_config_changed = ind_msg->twt_sta_config_changed;
- cnss_pr_dbg("CNSS->IMS: TWT_CFG_REQ: state: 0x%lx\n",
- plat_priv->driver_state);
- ret =
- qmi_txn_init(&plat_priv->ims_qmi, &txn,
- ims_private_service_wfc_call_twt_config_rsp_msg_v01_ei,
- resp);
- if (ret < 0) {
- cnss_pr_err("CNSS->IMS: TWT_CFG_REQ: QMI Txn Init Err: %d\n",
- ret);
- goto out;
- }
- ret =
- qmi_send_request(&plat_priv->ims_qmi, NULL, &txn,
- QMI_IMS_PRIVATE_SERVICE_WFC_CALL_TWT_CONFIG_REQ_V01,
- IMS_PRIVATE_SERVICE_WFC_CALL_TWT_CONFIG_REQ_MSG_V01_MAX_MSG_LEN,
- ims_private_service_wfc_call_twt_config_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("CNSS->IMS: TWT_CFG_REQ: QMI Send Err: %d\n", ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("IMS->CNSS: TWT_CFG_RSP: QMI Wait Err: %d\n", ret);
- goto out;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("IMS->CNSS: TWT_CFG_RSP: Result: %d Err: %d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- ret = 0;
- out:
- kfree(req);
- kfree(resp);
- return ret;
- }
- int cnss_process_twt_cfg_ind_event(struct cnss_plat_data *plat_priv,
- void *data)
- {
- int ret;
- struct wlfw_wfc_call_twt_config_ind_msg_v01 *ind_msg = data;
- ret = cnss_ims_wfc_call_twt_cfg_send_sync(plat_priv, ind_msg);
- kfree(data);
- return ret;
- }
- static void cnss_wlfw_process_twt_cfg_ind(struct qmi_handle *qmi_wlfw,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn,
- const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- const struct wlfw_wfc_call_twt_config_ind_msg_v01 *ind_msg = data;
- struct wlfw_wfc_call_twt_config_ind_msg_v01 *event_data;
- if (!txn) {
- cnss_pr_err("FW->CNSS: TWT_CFG_IND: Spurious indication\n");
- return;
- }
- if (!ind_msg) {
- cnss_pr_err("FW->CNSS: TWT_CFG_IND: Invalid indication\n");
- return;
- }
- cnss_pr_dbg("FW->CNSS: TWT_CFG_IND: %x %llx, %x %x, %x %x, %x %x, %x %x, %x %x\n",
- ind_msg->twt_sta_start_valid, ind_msg->twt_sta_start,
- ind_msg->twt_sta_int_valid, ind_msg->twt_sta_int,
- ind_msg->twt_sta_upo_valid, ind_msg->twt_sta_upo,
- ind_msg->twt_sta_sp_valid, ind_msg->twt_sta_sp,
- ind_msg->twt_sta_dl_valid, ind_msg->twt_sta_dl,
- ind_msg->twt_sta_config_changed_valid,
- ind_msg->twt_sta_config_changed);
- event_data = kmemdup(ind_msg, sizeof(*event_data), GFP_KERNEL);
- if (!event_data)
- return;
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_WLFW_TWT_CFG_IND, 0,
- event_data);
- }
- static struct qmi_msg_handler qmi_wlfw_msg_handlers[] = {
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_REQUEST_MEM_IND_V01,
- .ei = wlfw_request_mem_ind_msg_v01_ei,
- .decoded_size = sizeof(struct wlfw_request_mem_ind_msg_v01),
- .fn = cnss_wlfw_request_mem_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_FW_MEM_READY_IND_V01,
- .ei = wlfw_fw_mem_ready_ind_msg_v01_ei,
- .decoded_size = sizeof(struct wlfw_fw_mem_ready_ind_msg_v01),
- .fn = cnss_wlfw_fw_mem_ready_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_FW_READY_IND_V01,
- .ei = wlfw_fw_ready_ind_msg_v01_ei,
- .decoded_size = sizeof(struct wlfw_fw_ready_ind_msg_v01),
- .fn = cnss_wlfw_fw_ready_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_FW_INIT_DONE_IND_V01,
- .ei = wlfw_fw_init_done_ind_msg_v01_ei,
- .decoded_size = sizeof(struct wlfw_fw_init_done_ind_msg_v01),
- .fn = cnss_wlfw_fw_init_done_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_PIN_CONNECT_RESULT_IND_V01,
- .ei = wlfw_pin_connect_result_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct wlfw_pin_connect_result_ind_msg_v01),
- .fn = cnss_wlfw_pin_result_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_CAL_DONE_IND_V01,
- .ei = wlfw_cal_done_ind_msg_v01_ei,
- .decoded_size = sizeof(struct wlfw_cal_done_ind_msg_v01),
- .fn = cnss_wlfw_cal_done_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_QDSS_TRACE_REQ_MEM_IND_V01,
- .ei = wlfw_qdss_trace_req_mem_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct wlfw_qdss_trace_req_mem_ind_msg_v01),
- .fn = cnss_wlfw_qdss_trace_req_mem_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_QDSS_TRACE_SAVE_IND_V01,
- .ei = wlfw_qdss_trace_save_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct wlfw_qdss_trace_save_ind_msg_v01),
- .fn = cnss_wlfw_fw_mem_file_save_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_QDSS_TRACE_FREE_IND_V01,
- .ei = wlfw_qdss_trace_free_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct wlfw_qdss_trace_free_ind_msg_v01),
- .fn = cnss_wlfw_qdss_trace_free_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_RESPOND_GET_INFO_IND_V01,
- .ei = wlfw_respond_get_info_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct wlfw_respond_get_info_ind_msg_v01),
- .fn = cnss_wlfw_respond_get_info_ind_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_WFC_CALL_TWT_CONFIG_IND_V01,
- .ei = wlfw_wfc_call_twt_config_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct wlfw_wfc_call_twt_config_ind_msg_v01),
- .fn = cnss_wlfw_process_twt_cfg_ind
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_WLFW_DRIVER_ASYNC_DATA_IND_V01,
- .ei = wlfw_driver_async_data_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct wlfw_driver_async_data_ind_msg_v01),
- .fn = cnss_wlfw_driver_async_data_ind_cb
- },
- {}
- };
- static int cnss_wlfw_connect_to_server(struct cnss_plat_data *plat_priv,
- void *data)
- {
- struct cnss_qmi_event_server_arrive_data *event_data = data;
- struct qmi_handle *qmi_wlfw = &plat_priv->qmi_wlfw;
- struct sockaddr_qrtr sq = { 0 };
- int ret = 0;
- if (!event_data)
- return -EINVAL;
- sq.sq_family = AF_QIPCRTR;
- sq.sq_node = event_data->node;
- sq.sq_port = event_data->port;
- ret = kernel_connect(qmi_wlfw->sock, (struct sockaddr *)&sq,
- sizeof(sq), 0);
- if (ret < 0) {
- cnss_pr_err("Failed to connect to QMI WLFW remote service port\n");
- goto out;
- }
- set_bit(CNSS_QMI_WLFW_CONNECTED, &plat_priv->driver_state);
- cnss_pr_info("QMI WLFW service connected, state: 0x%lx\n",
- plat_priv->driver_state);
- kfree(data);
- return 0;
- out:
- CNSS_QMI_ASSERT();
- kfree(data);
- return ret;
- }
- int cnss_wlfw_server_arrive(struct cnss_plat_data *plat_priv, void *data)
- {
- int ret = 0;
- if (!plat_priv)
- return -ENODEV;
- if (test_bit(CNSS_QMI_WLFW_CONNECTED, &plat_priv->driver_state)) {
- cnss_pr_err("Unexpected WLFW server arrive\n");
- CNSS_ASSERT(0);
- return -EINVAL;
- }
- cnss_ignore_qmi_failure(false);
- ret = cnss_wlfw_connect_to_server(plat_priv, data);
- if (ret < 0)
- goto out;
- ret = cnss_wlfw_ind_register_send_sync(plat_priv);
- if (ret < 0) {
- if (ret == -EALREADY)
- ret = 0;
- goto out;
- }
- ret = cnss_wlfw_host_cap_send_sync(plat_priv);
- if (ret < 0)
- goto out;
- return 0;
- out:
- return ret;
- }
- int cnss_wlfw_server_exit(struct cnss_plat_data *plat_priv)
- {
- int ret;
- if (!plat_priv)
- return -ENODEV;
- clear_bit(CNSS_QMI_WLFW_CONNECTED, &plat_priv->driver_state);
- cnss_pr_info("QMI WLFW service disconnected, state: 0x%lx\n",
- plat_priv->driver_state);
- cnss_qmi_deinit(plat_priv);
- clear_bit(CNSS_QMI_DEL_SERVER, &plat_priv->driver_state);
- ret = cnss_qmi_init(plat_priv);
- if (ret < 0) {
- cnss_pr_err("QMI WLFW service registraton failed, ret\n", ret);
- CNSS_ASSERT(0);
- }
- return 0;
- }
- static int wlfw_new_server(struct qmi_handle *qmi_wlfw,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- struct cnss_qmi_event_server_arrive_data *event_data;
- if (plat_priv && test_bit(CNSS_QMI_DEL_SERVER, &plat_priv->driver_state)) {
- cnss_pr_info("WLFW server delete in progress, Ignore server arrive, state: 0x%lx\n",
- plat_priv->driver_state);
- return 0;
- }
- cnss_pr_dbg("WLFW server arriving: node %u port %u\n",
- service->node, service->port);
- event_data = kzalloc(sizeof(*event_data), GFP_KERNEL);
- if (!event_data)
- return -ENOMEM;
- event_data->node = service->node;
- event_data->port = service->port;
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_SERVER_ARRIVE,
- 0, event_data);
- return 0;
- }
- static void wlfw_del_server(struct qmi_handle *qmi_wlfw,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_wlfw, struct cnss_plat_data, qmi_wlfw);
- if (plat_priv && test_bit(CNSS_QMI_DEL_SERVER, &plat_priv->driver_state)) {
- cnss_pr_info("WLFW server delete in progress, Ignore server delete, state: 0x%lx\n",
- plat_priv->driver_state);
- return;
- }
- cnss_pr_dbg("WLFW server exiting\n");
- if (plat_priv) {
- cnss_ignore_qmi_failure(true);
- set_bit(CNSS_QMI_DEL_SERVER, &plat_priv->driver_state);
- }
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_SERVER_EXIT,
- 0, NULL);
- }
- static struct qmi_ops qmi_wlfw_ops = {
- .new_server = wlfw_new_server,
- .del_server = wlfw_del_server,
- };
- static int cnss_qmi_add_lookup(struct cnss_plat_data *plat_priv)
- {
- unsigned int id = WLFW_SERVICE_INS_ID_V01;
- /* In order to support dual wlan card attach case,
- * need separate qmi service instance id for each dev
- */
- if (cnss_is_dual_wlan_enabled() && plat_priv->qrtr_node_id != 0 &&
- plat_priv->wlfw_service_instance_id != 0)
- id = plat_priv->wlfw_service_instance_id;
- return qmi_add_lookup(&plat_priv->qmi_wlfw, WLFW_SERVICE_ID_V01,
- WLFW_SERVICE_VERS_V01, id);
- }
- int cnss_qmi_init(struct cnss_plat_data *plat_priv)
- {
- int ret = 0;
- cnss_get_qrtr_info(plat_priv);
- ret = qmi_handle_init(&plat_priv->qmi_wlfw,
- QMI_WLFW_MAX_RECV_BUF_SIZE,
- &qmi_wlfw_ops, qmi_wlfw_msg_handlers);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize WLFW QMI handle, err: %d\n",
- ret);
- goto out;
- }
- ret = cnss_qmi_add_lookup(plat_priv);
- if (ret < 0)
- cnss_pr_err("Failed to add WLFW QMI lookup, err: %d\n", ret);
- out:
- return ret;
- }
- void cnss_qmi_deinit(struct cnss_plat_data *plat_priv)
- {
- qmi_handle_release(&plat_priv->qmi_wlfw);
- }
- int cnss_qmi_get_dms_mac(struct cnss_plat_data *plat_priv)
- {
- struct dms_get_mac_address_req_msg_v01 req;
- struct dms_get_mac_address_resp_msg_v01 resp;
- struct qmi_txn txn;
- int ret = 0;
- if (!test_bit(CNSS_QMI_DMS_CONNECTED, &plat_priv->driver_state)) {
- cnss_pr_err("DMS QMI connection not established\n");
- return -EINVAL;
- }
- cnss_pr_dbg("Requesting DMS MAC address");
- memset(&resp, 0, sizeof(resp));
- ret = qmi_txn_init(&plat_priv->qmi_dms, &txn,
- dms_get_mac_address_resp_msg_v01_ei, &resp);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize txn for dms, err: %d\n",
- ret);
- goto out;
- }
- req.device = DMS_DEVICE_MAC_WLAN_V01;
- ret = qmi_send_request(&plat_priv->qmi_dms, NULL, &txn,
- QMI_DMS_GET_MAC_ADDRESS_REQ_V01,
- DMS_GET_MAC_ADDRESS_REQ_MSG_V01_MAX_MSG_LEN,
- dms_get_mac_address_req_msg_v01_ei, &req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Failed to send QMI_DMS_GET_MAC_ADDRESS_REQ_V01, err: %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, QMI_WLFW_TIMEOUT_JF);
- if (ret < 0) {
- cnss_pr_err("Failed to wait for QMI_DMS_GET_MAC_ADDRESS_RESP_V01, err: %d\n",
- ret);
- goto out;
- }
- if (resp.resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("QMI_DMS_GET_MAC_ADDRESS_REQ_V01 failed, result: %d, err: %d\n",
- resp.resp.result, resp.resp.error);
- ret = -resp.resp.result;
- goto out;
- }
- if (!resp.mac_address_valid ||
- resp.mac_address_len != QMI_WLFW_MAC_ADDR_SIZE_V01) {
- cnss_pr_err("Invalid MAC address received from DMS\n");
- plat_priv->dms.mac_valid = false;
- goto out;
- }
- plat_priv->dms.mac_valid = true;
- memcpy(plat_priv->dms.mac, resp.mac_address, QMI_WLFW_MAC_ADDR_SIZE_V01);
- cnss_pr_info("Received DMS MAC: [%pM]\n", plat_priv->dms.mac);
- out:
- return ret;
- }
- static int cnss_dms_connect_to_server(struct cnss_plat_data *plat_priv,
- unsigned int node, unsigned int port)
- {
- struct qmi_handle *qmi_dms = &plat_priv->qmi_dms;
- struct sockaddr_qrtr sq = {0};
- int ret = 0;
- sq.sq_family = AF_QIPCRTR;
- sq.sq_node = node;
- sq.sq_port = port;
- ret = kernel_connect(qmi_dms->sock, (struct sockaddr *)&sq,
- sizeof(sq), 0);
- if (ret < 0) {
- cnss_pr_err("Failed to connect to QMI DMS remote service Node: %d Port: %d\n",
- node, port);
- goto out;
- }
- set_bit(CNSS_QMI_DMS_CONNECTED, &plat_priv->driver_state);
- cnss_pr_info("QMI DMS service connected, state: 0x%lx\n",
- plat_priv->driver_state);
- out:
- return ret;
- }
- static int dms_new_server(struct qmi_handle *qmi_dms,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_dms, struct cnss_plat_data, qmi_dms);
- if (!service)
- return -EINVAL;
- return cnss_dms_connect_to_server(plat_priv, service->node,
- service->port);
- }
- static void cnss_dms_server_exit_work(struct work_struct *work)
- {
- int ret;
- struct cnss_plat_data *plat_priv = cnss_get_plat_priv(NULL);
- cnss_dms_deinit(plat_priv);
- cnss_pr_info("QMI DMS Server Exit");
- clear_bit(CNSS_DMS_DEL_SERVER, &plat_priv->driver_state);
- ret = cnss_dms_init(plat_priv);
- if (ret < 0)
- cnss_pr_err("QMI DMS service registraton failed, ret\n", ret);
- }
- static DECLARE_WORK(cnss_dms_del_work, cnss_dms_server_exit_work);
- static void dms_del_server(struct qmi_handle *qmi_dms,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi_dms, struct cnss_plat_data, qmi_dms);
- if (!plat_priv)
- return;
- if (test_bit(CNSS_DMS_DEL_SERVER, &plat_priv->driver_state)) {
- cnss_pr_info("DMS server delete or cnss remove in progress, Ignore server delete: 0x%lx\n",
- plat_priv->driver_state);
- return;
- }
- set_bit(CNSS_DMS_DEL_SERVER, &plat_priv->driver_state);
- clear_bit(CNSS_QMI_DMS_CONNECTED, &plat_priv->driver_state);
- cnss_pr_info("QMI DMS service disconnected, state: 0x%lx\n",
- plat_priv->driver_state);
- schedule_work(&cnss_dms_del_work);
- }
- void cnss_cancel_dms_work(void)
- {
- cancel_work_sync(&cnss_dms_del_work);
- }
- static struct qmi_ops qmi_dms_ops = {
- .new_server = dms_new_server,
- .del_server = dms_del_server,
- };
- int cnss_dms_init(struct cnss_plat_data *plat_priv)
- {
- int ret = 0;
- ret = qmi_handle_init(&plat_priv->qmi_dms, DMS_QMI_MAX_MSG_LEN,
- &qmi_dms_ops, NULL);
- if (ret < 0) {
- cnss_pr_err("Failed to initialize DMS handle, err: %d\n", ret);
- goto out;
- }
- ret = qmi_add_lookup(&plat_priv->qmi_dms, DMS_SERVICE_ID_V01,
- DMS_SERVICE_VERS_V01, 0);
- if (ret < 0)
- cnss_pr_err("Failed to add DMS lookup, err: %d\n", ret);
- out:
- return ret;
- }
- void cnss_dms_deinit(struct cnss_plat_data *plat_priv)
- {
- set_bit(CNSS_DMS_DEL_SERVER, &plat_priv->driver_state);
- qmi_handle_release(&plat_priv->qmi_dms);
- }
- int coex_antenna_switch_to_wlan_send_sync_msg(struct cnss_plat_data *plat_priv)
- {
- int ret;
- struct coex_antenna_switch_to_wlan_req_msg_v01 *req;
- struct coex_antenna_switch_to_wlan_resp_msg_v01 *resp;
- struct qmi_txn txn;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending coex antenna switch_to_wlan\n");
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->antenna = plat_priv->antenna;
- ret = qmi_txn_init(&plat_priv->coex_qmi, &txn,
- coex_antenna_switch_to_wlan_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Fail to init txn for coex antenna switch_to_wlan resp %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request
- (&plat_priv->coex_qmi, NULL, &txn,
- QMI_COEX_SWITCH_ANTENNA_TO_WLAN_REQ_V01,
- COEX_ANTENNA_SWITCH_TO_WLAN_REQ_MSG_V01_MAX_MSG_LEN,
- coex_antenna_switch_to_wlan_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Fail to send coex antenna switch_to_wlan req %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, COEX_TIMEOUT);
- if (ret < 0) {
- cnss_pr_err("Coex antenna switch_to_wlan resp wait failed with ret %d\n",
- ret);
- goto out;
- } else if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Coex antenna switch_to_wlan request rejected, result:%d error:%d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- if (resp->grant_valid)
- plat_priv->grant = resp->grant;
- cnss_pr_dbg("Coex antenna grant: 0x%llx\n", resp->grant);
- kfree(resp);
- kfree(req);
- return 0;
- out:
- kfree(resp);
- kfree(req);
- return ret;
- }
- int coex_antenna_switch_to_mdm_send_sync_msg(struct cnss_plat_data *plat_priv)
- {
- int ret;
- struct coex_antenna_switch_to_mdm_req_msg_v01 *req;
- struct coex_antenna_switch_to_mdm_resp_msg_v01 *resp;
- struct qmi_txn txn;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending coex antenna switch_to_mdm\n");
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- resp = kzalloc(sizeof(*resp), GFP_KERNEL);
- if (!resp) {
- kfree(req);
- return -ENOMEM;
- }
- req->antenna = plat_priv->antenna;
- ret = qmi_txn_init(&plat_priv->coex_qmi, &txn,
- coex_antenna_switch_to_mdm_resp_msg_v01_ei, resp);
- if (ret < 0) {
- cnss_pr_err("Fail to init txn for coex antenna switch_to_mdm resp %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request
- (&plat_priv->coex_qmi, NULL, &txn,
- QMI_COEX_SWITCH_ANTENNA_TO_MDM_REQ_V01,
- COEX_ANTENNA_SWITCH_TO_MDM_REQ_MSG_V01_MAX_MSG_LEN,
- coex_antenna_switch_to_mdm_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(&txn);
- cnss_pr_err("Fail to send coex antenna switch_to_mdm req %d\n",
- ret);
- goto out;
- }
- ret = qmi_txn_wait(&txn, COEX_TIMEOUT);
- if (ret < 0) {
- cnss_pr_err("Coex antenna switch_to_mdm resp wait failed with ret %d\n",
- ret);
- goto out;
- } else if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("Coex antenna switch_to_mdm request rejected, result:%d error:%d\n",
- resp->resp.result, resp->resp.error);
- ret = -resp->resp.result;
- goto out;
- }
- kfree(resp);
- kfree(req);
- return 0;
- out:
- kfree(resp);
- kfree(req);
- return ret;
- }
- int cnss_send_subsys_restart_level_msg(struct cnss_plat_data *plat_priv)
- {
- int ret;
- struct wlfw_subsys_restart_level_req_msg_v01 req;
- struct wlfw_subsys_restart_level_resp_msg_v01 resp;
- u8 pcss_enabled;
- if (!plat_priv)
- return -ENODEV;
- if (!test_bit(CNSS_FW_READY, &plat_priv->driver_state)) {
- cnss_pr_dbg("Can't send pcss cmd before fw ready\n");
- return 0;
- }
- pcss_enabled = plat_priv->recovery_pcss_enabled;
- cnss_pr_dbg("Sending pcss recovery status: %d\n", pcss_enabled);
- req.restart_level_type_valid = 1;
- req.restart_level_type = pcss_enabled;
- ret = qmi_send_wait(&plat_priv->qmi_wlfw, &req, &resp,
- wlfw_subsys_restart_level_req_msg_v01_ei,
- wlfw_subsys_restart_level_resp_msg_v01_ei,
- QMI_WLFW_SUBSYS_RESTART_LEVEL_REQ_V01,
- WLFW_SUBSYS_RESTART_LEVEL_REQ_MSG_V01_MAX_MSG_LEN,
- QMI_WLFW_TIMEOUT_JF);
- if (ret < 0)
- cnss_pr_err("pcss recovery setting failed with ret %d\n", ret);
- return ret;
- }
- static int coex_new_server(struct qmi_handle *qmi,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi, struct cnss_plat_data, coex_qmi);
- struct sockaddr_qrtr sq = { 0 };
- int ret = 0;
- cnss_pr_dbg("COEX server arrive: node %u port %u\n",
- service->node, service->port);
- sq.sq_family = AF_QIPCRTR;
- sq.sq_node = service->node;
- sq.sq_port = service->port;
- ret = kernel_connect(qmi->sock, (struct sockaddr *)&sq, sizeof(sq), 0);
- if (ret < 0) {
- cnss_pr_err("Fail to connect to remote service port\n");
- return ret;
- }
- set_bit(CNSS_COEX_CONNECTED, &plat_priv->driver_state);
- cnss_pr_dbg("COEX Server Connected: 0x%lx\n",
- plat_priv->driver_state);
- return 0;
- }
- static void coex_del_server(struct qmi_handle *qmi,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi, struct cnss_plat_data, coex_qmi);
- cnss_pr_dbg("COEX server exit\n");
- clear_bit(CNSS_COEX_CONNECTED, &plat_priv->driver_state);
- }
- static struct qmi_ops coex_qmi_ops = {
- .new_server = coex_new_server,
- .del_server = coex_del_server,
- };
- int cnss_register_coex_service(struct cnss_plat_data *plat_priv)
- { int ret;
- ret = qmi_handle_init(&plat_priv->coex_qmi,
- COEX_SERVICE_MAX_MSG_LEN,
- &coex_qmi_ops, NULL);
- if (ret < 0)
- return ret;
- ret = qmi_add_lookup(&plat_priv->coex_qmi, COEX_SERVICE_ID_V01,
- COEX_SERVICE_VERS_V01, 0);
- return ret;
- }
- void cnss_unregister_coex_service(struct cnss_plat_data *plat_priv)
- {
- qmi_handle_release(&plat_priv->coex_qmi);
- }
- /* IMS Service */
- static int ims_subscribe_for_indication_send_async(struct cnss_plat_data *plat_priv)
- {
- int ret;
- struct ims_private_service_subscribe_for_indications_req_msg_v01 *req;
- struct qmi_txn *txn;
- if (!plat_priv)
- return -ENODEV;
- cnss_pr_dbg("Sending ASYNC ims subscribe for indication\n");
- req = kzalloc(sizeof(*req), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
- req->wfc_call_status_valid = 1;
- req->wfc_call_status = 1;
- txn = &plat_priv->txn;
- ret = qmi_txn_init(&plat_priv->ims_qmi, txn, NULL, NULL);
- if (ret < 0) {
- cnss_pr_err("Fail to init txn for ims subscribe for indication resp %d\n",
- ret);
- goto out;
- }
- ret = qmi_send_request
- (&plat_priv->ims_qmi, NULL, txn,
- QMI_IMS_PRIVATE_SERVICE_SUBSCRIBE_FOR_INDICATIONS_REQ_V01,
- IMS_PRIVATE_SERVICE_SUBSCRIBE_FOR_INDICATIONS_REQ_MSG_V01_MAX_MSG_LEN,
- ims_private_service_subscribe_ind_req_msg_v01_ei, req);
- if (ret < 0) {
- qmi_txn_cancel(txn);
- cnss_pr_err("Fail to send ims subscribe for indication req %d\n",
- ret);
- goto out;
- }
- kfree(req);
- return 0;
- out:
- kfree(req);
- return ret;
- }
- static void ims_subscribe_for_indication_resp_cb(struct qmi_handle *qmi,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn,
- const void *data)
- {
- const
- struct ims_private_service_subscribe_for_indications_rsp_msg_v01 *resp =
- data;
- cnss_pr_dbg("Received IMS subscribe indication response\n");
- if (!txn) {
- cnss_pr_err("spurious response\n");
- return;
- }
- if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
- cnss_pr_err("IMS subscribe for indication request rejected, result:%d error:%d\n",
- resp->resp.result, resp->resp.error);
- txn->result = -resp->resp.result;
- }
- }
- int cnss_process_wfc_call_ind_event(struct cnss_plat_data *plat_priv,
- void *data)
- {
- int ret;
- struct ims_private_service_wfc_call_status_ind_msg_v01 *ind_msg = data;
- ret = cnss_wlfw_wfc_call_status_send_sync(plat_priv, ind_msg);
- kfree(data);
- return ret;
- }
- static void
- cnss_ims_process_wfc_call_ind_cb(struct qmi_handle *ims_qmi,
- struct sockaddr_qrtr *sq,
- struct qmi_txn *txn, const void *data)
- {
- struct cnss_plat_data *plat_priv =
- container_of(ims_qmi, struct cnss_plat_data, ims_qmi);
- const
- struct ims_private_service_wfc_call_status_ind_msg_v01 *ind_msg = data;
- struct ims_private_service_wfc_call_status_ind_msg_v01 *event_data;
- if (!txn) {
- cnss_pr_err("IMS->CNSS: WFC_CALL_IND: Spurious indication\n");
- return;
- }
- if (!ind_msg) {
- cnss_pr_err("IMS->CNSS: WFC_CALL_IND: Invalid indication\n");
- return;
- }
- cnss_pr_dbg("IMS->CNSS: WFC_CALL_IND: %x, %x %x, %x %x, %x %llx, %x %x, %x %x\n",
- ind_msg->wfc_call_active, ind_msg->all_wfc_calls_held_valid,
- ind_msg->all_wfc_calls_held,
- ind_msg->is_wfc_emergency_valid, ind_msg->is_wfc_emergency,
- ind_msg->twt_ims_start_valid, ind_msg->twt_ims_start,
- ind_msg->twt_ims_int_valid, ind_msg->twt_ims_int,
- ind_msg->media_quality_valid, ind_msg->media_quality);
- event_data = kmemdup(ind_msg, sizeof(*event_data), GFP_KERNEL);
- if (!event_data)
- return;
- cnss_driver_event_post(plat_priv, CNSS_DRIVER_EVENT_IMS_WFC_CALL_IND,
- 0, event_data);
- }
- static struct qmi_msg_handler qmi_ims_msg_handlers[] = {
- {
- .type = QMI_RESPONSE,
- .msg_id =
- QMI_IMS_PRIVATE_SERVICE_SUBSCRIBE_FOR_INDICATIONS_REQ_V01,
- .ei =
- ims_private_service_subscribe_ind_rsp_msg_v01_ei,
- .decoded_size = sizeof(struct
- ims_private_service_subscribe_for_indications_rsp_msg_v01),
- .fn = ims_subscribe_for_indication_resp_cb
- },
- {
- .type = QMI_INDICATION,
- .msg_id = QMI_IMS_PRIVATE_SERVICE_WFC_CALL_STATUS_IND_V01,
- .ei = ims_private_service_wfc_call_status_ind_msg_v01_ei,
- .decoded_size =
- sizeof(struct ims_private_service_wfc_call_status_ind_msg_v01),
- .fn = cnss_ims_process_wfc_call_ind_cb
- },
- {}
- };
- static int ims_new_server(struct qmi_handle *qmi,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi, struct cnss_plat_data, ims_qmi);
- struct sockaddr_qrtr sq = { 0 };
- int ret = 0;
- cnss_pr_dbg("IMS server arrive: node %u port %u\n",
- service->node, service->port);
- sq.sq_family = AF_QIPCRTR;
- sq.sq_node = service->node;
- sq.sq_port = service->port;
- ret = kernel_connect(qmi->sock, (struct sockaddr *)&sq, sizeof(sq), 0);
- if (ret < 0) {
- cnss_pr_err("Fail to connect to remote service port\n");
- return ret;
- }
- set_bit(CNSS_IMS_CONNECTED, &plat_priv->driver_state);
- cnss_pr_dbg("IMS Server Connected: 0x%lx\n",
- plat_priv->driver_state);
- ret = ims_subscribe_for_indication_send_async(plat_priv);
- return ret;
- }
- static void ims_del_server(struct qmi_handle *qmi,
- struct qmi_service *service)
- {
- struct cnss_plat_data *plat_priv =
- container_of(qmi, struct cnss_plat_data, ims_qmi);
- cnss_pr_dbg("IMS server exit\n");
- clear_bit(CNSS_IMS_CONNECTED, &plat_priv->driver_state);
- }
- static struct qmi_ops ims_qmi_ops = {
- .new_server = ims_new_server,
- .del_server = ims_del_server,
- };
- int cnss_register_ims_service(struct cnss_plat_data *plat_priv)
- { int ret;
- ret = qmi_handle_init(&plat_priv->ims_qmi,
- IMSPRIVATE_SERVICE_MAX_MSG_LEN,
- &ims_qmi_ops, qmi_ims_msg_handlers);
- if (ret < 0)
- return ret;
- ret = qmi_add_lookup(&plat_priv->ims_qmi, IMSPRIVATE_SERVICE_ID_V01,
- IMSPRIVATE_SERVICE_VERS_V01, 0);
- return ret;
- }
- void cnss_unregister_ims_service(struct cnss_plat_data *plat_priv)
- {
- qmi_handle_release(&plat_priv->ims_qmi);
- }
|