ctrl_iface.c 218 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918791979207921792279237924792579267927792879297930793179327933793479357936793779387939794079417942794379447945794679477948794979507951795279537954795579567957795879597960796179627963796479657966796779687969797079717972797379747975797679777978797979807981798279837984798579867987798879897990799179927993799479957996799779987999800080018002800380048005800680078008800980108011801280138014801580168017801880198020802180228023802480258026802780288029803080318032803380348035803680378038803980408041804280438044804580468047804880498050805180528053805480558056805780588059806080618062806380648065806680678068806980708071807280738074807580768077807880798080808180828083808480858086808780888089809080918092809380948095809680978098809981008101810281038104810581068107810881098110811181128113811481158116811781188119812081218122812381248125812681278128812981308131813281338134813581368137813881398140814181428143814481458146814781488149815081518152815381548155815681578158815981608161816281638164816581668167816881698170817181728173817481758176817781788179818081818182818381848185818681878188818981908191819281938194819581968197819881998200820182028203820482058206820782088209821082118212821382148215821682178218821982208221822282238224822582268227822882298230823182328233823482358236823782388239824082418242824382448245824682478248824982508251825282538254825582568257825882598260826182628263826482658266826782688269827082718272827382748275827682778278827982808281828282838284828582868287828882898290829182928293829482958296829782988299830083018302830383048305830683078308830983108311831283138314831583168317831883198320832183228323832483258326832783288329833083318332833383348335833683378338833983408341834283438344834583468347834883498350835183528353835483558356835783588359836083618362836383648365836683678368836983708371837283738374837583768377837883798380838183828383838483858386838783888389839083918392839383948395839683978398839984008401840284038404840584068407840884098410841184128413841484158416841784188419842084218422842384248425842684278428842984308431843284338434843584368437843884398440844184428443844484458446844784488449845084518452845384548455845684578458845984608461846284638464846584668467846884698470847184728473847484758476847784788479848084818482848384848485848684878488848984908491849284938494849584968497849884998500850185028503850485058506850785088509851085118512851385148515851685178518851985208521852285238524852585268527852885298530853185328533853485358536853785388539854085418542854385448545854685478548854985508551855285538554855585568557855885598560856185628563856485658566856785688569857085718572857385748575857685778578857985808581858285838584858585868587858885898590859185928593859485958596859785988599860086018602860386048605860686078608860986108611861286138614861586168617861886198620862186228623862486258626862786288629863086318632863386348635863686378638863986408641864286438644864586468647864886498650865186528653865486558656865786588659866086618662866386648665866686678668866986708671867286738674867586768677867886798680868186828683868486858686868786888689869086918692869386948695869686978698869987008701870287038704870587068707870887098710871187128713871487158716871787188719872087218722872387248725872687278728872987308731873287338734873587368737873887398740874187428743874487458746874787488749875087518752875387548755875687578758875987608761876287638764876587668767876887698770877187728773877487758776877787788779878087818782878387848785878687878788878987908791879287938794879587968797879887998800880188028803880488058806880788088809881088118812881388148815881688178818881988208821882288238824882588268827882888298830883188328833883488358836883788388839884088418842884388448845884688478848884988508851885288538854885588568857885888598860886188628863886488658866886788688869887088718872887388748875887688778878887988808881888288838884888588868887888888898890889188928893889488958896889788988899890089018902890389048905890689078908890989108911891289138914891589168917891889198920892189228923892489258926892789288929893089318932893389348935893689378938893989408941894289438944894589468947894889498950895189528953895489558956895789588959896089618962896389648965896689678968896989708971897289738974897589768977897889798980898189828983898489858986898789888989899089918992899389948995899689978998899990009001900290039004900590069007900890099010901190129013901490159016901790189019902090219022902390249025902690279028902990309031903290339034903590369037903890399040904190429043904490459046904790489049905090519052905390549055905690579058905990609061906290639064906590669067906890699070907190729073907490759076907790789079908090819082908390849085908690879088908990909091909290939094909590969097909890999100910191029103910491059106910791089109911091119112911391149115911691179118911991209121912291239124912591269127912891299130913191329133913491359136913791389139914091419142914391449145914691479148914991509151915291539154915591569157915891599160916191629163916491659166916791689169917091719172917391749175917691779178917991809181
  1. /*
  2. * WPA Supplicant / Control interface (shared code for all backends)
  3. * Copyright (c) 2004-2015, Jouni Malinen <j@w1.fi>
  4. *
  5. * This software may be distributed under the terms of the BSD license.
  6. * See README for more details.
  7. */
  8. #include "utils/includes.h"
  9. #ifdef CONFIG_TESTING_OPTIONS
  10. #include <net/ethernet.h>
  11. #include <netinet/ip.h>
  12. #endif /* CONFIG_TESTING_OPTIONS */
  13. #include "utils/common.h"
  14. #include "utils/eloop.h"
  15. #include "utils/uuid.h"
  16. #include "common/version.h"
  17. #include "common/ieee802_11_defs.h"
  18. #include "common/ieee802_11_common.h"
  19. #include "common/wpa_ctrl.h"
  20. #include "crypto/tls.h"
  21. #include "ap/hostapd.h"
  22. #include "eap_peer/eap.h"
  23. #include "eapol_supp/eapol_supp_sm.h"
  24. #include "rsn_supp/wpa.h"
  25. #include "rsn_supp/preauth.h"
  26. #include "rsn_supp/pmksa_cache.h"
  27. #include "l2_packet/l2_packet.h"
  28. #include "wps/wps.h"
  29. #include "config.h"
  30. #include "wpa_supplicant_i.h"
  31. #include "driver_i.h"
  32. #include "wps_supplicant.h"
  33. #include "ibss_rsn.h"
  34. #include "ap.h"
  35. #include "p2p_supplicant.h"
  36. #include "p2p/p2p.h"
  37. #include "hs20_supplicant.h"
  38. #include "wifi_display.h"
  39. #include "notify.h"
  40. #include "bss.h"
  41. #include "scan.h"
  42. #include "ctrl_iface.h"
  43. #include "interworking.h"
  44. #include "blacklist.h"
  45. #include "autoscan.h"
  46. #include "wnm_sta.h"
  47. #include "offchannel.h"
  48. #include "drivers/driver.h"
  49. #include "mesh.h"
  50. static int wpa_supplicant_global_iface_list(struct wpa_global *global,
  51. char *buf, int len);
  52. static int wpa_supplicant_global_iface_interfaces(struct wpa_global *global,
  53. char *buf, int len);
  54. static int * freq_range_to_channel_list(struct wpa_supplicant *wpa_s,
  55. char *val);
  56. static int set_bssid_filter(struct wpa_supplicant *wpa_s, char *val)
  57. {
  58. char *pos;
  59. u8 addr[ETH_ALEN], *filter = NULL, *n;
  60. size_t count = 0;
  61. pos = val;
  62. while (pos) {
  63. if (*pos == '\0')
  64. break;
  65. if (hwaddr_aton(pos, addr)) {
  66. os_free(filter);
  67. return -1;
  68. }
  69. n = os_realloc_array(filter, count + 1, ETH_ALEN);
  70. if (n == NULL) {
  71. os_free(filter);
  72. return -1;
  73. }
  74. filter = n;
  75. os_memcpy(filter + count * ETH_ALEN, addr, ETH_ALEN);
  76. count++;
  77. pos = os_strchr(pos, ' ');
  78. if (pos)
  79. pos++;
  80. }
  81. wpa_hexdump(MSG_DEBUG, "bssid_filter", filter, count * ETH_ALEN);
  82. os_free(wpa_s->bssid_filter);
  83. wpa_s->bssid_filter = filter;
  84. wpa_s->bssid_filter_count = count;
  85. return 0;
  86. }
  87. static int set_disallow_aps(struct wpa_supplicant *wpa_s, char *val)
  88. {
  89. char *pos;
  90. u8 addr[ETH_ALEN], *bssid = NULL, *n;
  91. struct wpa_ssid_value *ssid = NULL, *ns;
  92. size_t count = 0, ssid_count = 0;
  93. struct wpa_ssid *c;
  94. /*
  95. * disallow_list ::= <ssid_spec> | <bssid_spec> | <disallow_list> | ""
  96. * SSID_SPEC ::= ssid <SSID_HEX>
  97. * BSSID_SPEC ::= bssid <BSSID_HEX>
  98. */
  99. pos = val;
  100. while (pos) {
  101. if (*pos == '\0')
  102. break;
  103. if (os_strncmp(pos, "bssid ", 6) == 0) {
  104. int res;
  105. pos += 6;
  106. res = hwaddr_aton2(pos, addr);
  107. if (res < 0) {
  108. os_free(ssid);
  109. os_free(bssid);
  110. wpa_printf(MSG_DEBUG, "Invalid disallow_aps "
  111. "BSSID value '%s'", pos);
  112. return -1;
  113. }
  114. pos += res;
  115. n = os_realloc_array(bssid, count + 1, ETH_ALEN);
  116. if (n == NULL) {
  117. os_free(ssid);
  118. os_free(bssid);
  119. return -1;
  120. }
  121. bssid = n;
  122. os_memcpy(bssid + count * ETH_ALEN, addr, ETH_ALEN);
  123. count++;
  124. } else if (os_strncmp(pos, "ssid ", 5) == 0) {
  125. char *end;
  126. pos += 5;
  127. end = pos;
  128. while (*end) {
  129. if (*end == '\0' || *end == ' ')
  130. break;
  131. end++;
  132. }
  133. ns = os_realloc_array(ssid, ssid_count + 1,
  134. sizeof(struct wpa_ssid_value));
  135. if (ns == NULL) {
  136. os_free(ssid);
  137. os_free(bssid);
  138. return -1;
  139. }
  140. ssid = ns;
  141. if ((end - pos) & 0x01 ||
  142. end - pos > 2 * SSID_MAX_LEN ||
  143. hexstr2bin(pos, ssid[ssid_count].ssid,
  144. (end - pos) / 2) < 0) {
  145. os_free(ssid);
  146. os_free(bssid);
  147. wpa_printf(MSG_DEBUG, "Invalid disallow_aps "
  148. "SSID value '%s'", pos);
  149. return -1;
  150. }
  151. ssid[ssid_count].ssid_len = (end - pos) / 2;
  152. wpa_hexdump_ascii(MSG_DEBUG, "disallow_aps SSID",
  153. ssid[ssid_count].ssid,
  154. ssid[ssid_count].ssid_len);
  155. ssid_count++;
  156. pos = end;
  157. } else {
  158. wpa_printf(MSG_DEBUG, "Unexpected disallow_aps value "
  159. "'%s'", pos);
  160. os_free(ssid);
  161. os_free(bssid);
  162. return -1;
  163. }
  164. pos = os_strchr(pos, ' ');
  165. if (pos)
  166. pos++;
  167. }
  168. wpa_hexdump(MSG_DEBUG, "disallow_aps_bssid", bssid, count * ETH_ALEN);
  169. os_free(wpa_s->disallow_aps_bssid);
  170. wpa_s->disallow_aps_bssid = bssid;
  171. wpa_s->disallow_aps_bssid_count = count;
  172. wpa_printf(MSG_DEBUG, "disallow_aps_ssid_count %d", (int) ssid_count);
  173. os_free(wpa_s->disallow_aps_ssid);
  174. wpa_s->disallow_aps_ssid = ssid;
  175. wpa_s->disallow_aps_ssid_count = ssid_count;
  176. if (!wpa_s->current_ssid || wpa_s->wpa_state < WPA_AUTHENTICATING)
  177. return 0;
  178. c = wpa_s->current_ssid;
  179. if (c->mode != WPAS_MODE_INFRA && c->mode != WPAS_MODE_IBSS)
  180. return 0;
  181. if (!disallowed_bssid(wpa_s, wpa_s->bssid) &&
  182. !disallowed_ssid(wpa_s, c->ssid, c->ssid_len))
  183. return 0;
  184. wpa_printf(MSG_DEBUG, "Disconnect and try to find another network "
  185. "because current AP was marked disallowed");
  186. #ifdef CONFIG_SME
  187. wpa_s->sme.prev_bssid_set = 0;
  188. #endif /* CONFIG_SME */
  189. wpa_s->reassociate = 1;
  190. wpa_s->own_disconnect_req = 1;
  191. wpa_supplicant_deauthenticate(wpa_s, WLAN_REASON_DEAUTH_LEAVING);
  192. wpa_supplicant_req_scan(wpa_s, 0, 0);
  193. return 0;
  194. }
  195. #ifndef CONFIG_NO_CONFIG_BLOBS
  196. static int wpas_ctrl_set_blob(struct wpa_supplicant *wpa_s, char *pos)
  197. {
  198. char *name = pos;
  199. struct wpa_config_blob *blob;
  200. size_t len;
  201. pos = os_strchr(pos, ' ');
  202. if (pos == NULL)
  203. return -1;
  204. *pos++ = '\0';
  205. len = os_strlen(pos);
  206. if (len & 1)
  207. return -1;
  208. wpa_printf(MSG_DEBUG, "CTRL: Set blob '%s'", name);
  209. blob = os_zalloc(sizeof(*blob));
  210. if (blob == NULL)
  211. return -1;
  212. blob->name = os_strdup(name);
  213. blob->data = os_malloc(len / 2);
  214. if (blob->name == NULL || blob->data == NULL) {
  215. wpa_config_free_blob(blob);
  216. return -1;
  217. }
  218. if (hexstr2bin(pos, blob->data, len / 2) < 0) {
  219. wpa_printf(MSG_DEBUG, "CTRL: Invalid blob hex data");
  220. wpa_config_free_blob(blob);
  221. return -1;
  222. }
  223. blob->len = len / 2;
  224. wpa_config_set_blob(wpa_s->conf, blob);
  225. return 0;
  226. }
  227. #endif /* CONFIG_NO_CONFIG_BLOBS */
  228. static int wpas_ctrl_pno(struct wpa_supplicant *wpa_s, char *cmd)
  229. {
  230. char *params;
  231. char *pos;
  232. int *freqs = NULL;
  233. int ret;
  234. if (atoi(cmd)) {
  235. params = os_strchr(cmd, ' ');
  236. os_free(wpa_s->manual_sched_scan_freqs);
  237. if (params) {
  238. params++;
  239. pos = os_strstr(params, "freq=");
  240. if (pos)
  241. freqs = freq_range_to_channel_list(wpa_s,
  242. pos + 5);
  243. }
  244. wpa_s->manual_sched_scan_freqs = freqs;
  245. ret = wpas_start_pno(wpa_s);
  246. } else {
  247. ret = wpas_stop_pno(wpa_s);
  248. }
  249. return ret;
  250. }
  251. static int wpa_supplicant_ctrl_iface_set(struct wpa_supplicant *wpa_s,
  252. char *cmd)
  253. {
  254. char *value;
  255. int ret = 0;
  256. value = os_strchr(cmd, ' ');
  257. if (value == NULL)
  258. return -1;
  259. *value++ = '\0';
  260. wpa_printf(MSG_DEBUG, "CTRL_IFACE SET '%s'='%s'", cmd, value);
  261. if (os_strcasecmp(cmd, "EAPOL::heldPeriod") == 0) {
  262. eapol_sm_configure(wpa_s->eapol,
  263. atoi(value), -1, -1, -1);
  264. } else if (os_strcasecmp(cmd, "EAPOL::authPeriod") == 0) {
  265. eapol_sm_configure(wpa_s->eapol,
  266. -1, atoi(value), -1, -1);
  267. } else if (os_strcasecmp(cmd, "EAPOL::startPeriod") == 0) {
  268. eapol_sm_configure(wpa_s->eapol,
  269. -1, -1, atoi(value), -1);
  270. } else if (os_strcasecmp(cmd, "EAPOL::maxStart") == 0) {
  271. eapol_sm_configure(wpa_s->eapol,
  272. -1, -1, -1, atoi(value));
  273. } else if (os_strcasecmp(cmd, "dot11RSNAConfigPMKLifetime") == 0) {
  274. if (wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_LIFETIME,
  275. atoi(value)))
  276. ret = -1;
  277. } else if (os_strcasecmp(cmd, "dot11RSNAConfigPMKReauthThreshold") ==
  278. 0) {
  279. if (wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_REAUTH_THRESHOLD,
  280. atoi(value)))
  281. ret = -1;
  282. } else if (os_strcasecmp(cmd, "dot11RSNAConfigSATimeout") == 0) {
  283. if (wpa_sm_set_param(wpa_s->wpa, RSNA_SA_TIMEOUT, atoi(value)))
  284. ret = -1;
  285. } else if (os_strcasecmp(cmd, "wps_fragment_size") == 0) {
  286. wpa_s->wps_fragment_size = atoi(value);
  287. #ifdef CONFIG_WPS_TESTING
  288. } else if (os_strcasecmp(cmd, "wps_version_number") == 0) {
  289. long int val;
  290. val = strtol(value, NULL, 0);
  291. if (val < 0 || val > 0xff) {
  292. ret = -1;
  293. wpa_printf(MSG_DEBUG, "WPS: Invalid "
  294. "wps_version_number %ld", val);
  295. } else {
  296. wps_version_number = val;
  297. wpa_printf(MSG_DEBUG, "WPS: Testing - force WPS "
  298. "version %u.%u",
  299. (wps_version_number & 0xf0) >> 4,
  300. wps_version_number & 0x0f);
  301. }
  302. } else if (os_strcasecmp(cmd, "wps_testing_dummy_cred") == 0) {
  303. wps_testing_dummy_cred = atoi(value);
  304. wpa_printf(MSG_DEBUG, "WPS: Testing - dummy_cred=%d",
  305. wps_testing_dummy_cred);
  306. } else if (os_strcasecmp(cmd, "wps_corrupt_pkhash") == 0) {
  307. wps_corrupt_pkhash = atoi(value);
  308. wpa_printf(MSG_DEBUG, "WPS: Testing - wps_corrupt_pkhash=%d",
  309. wps_corrupt_pkhash);
  310. #endif /* CONFIG_WPS_TESTING */
  311. } else if (os_strcasecmp(cmd, "ampdu") == 0) {
  312. if (wpa_drv_ampdu(wpa_s, atoi(value)) < 0)
  313. ret = -1;
  314. #ifdef CONFIG_TDLS
  315. #ifdef CONFIG_TDLS_TESTING
  316. } else if (os_strcasecmp(cmd, "tdls_testing") == 0) {
  317. extern unsigned int tdls_testing;
  318. tdls_testing = strtol(value, NULL, 0);
  319. wpa_printf(MSG_DEBUG, "TDLS: tdls_testing=0x%x", tdls_testing);
  320. #endif /* CONFIG_TDLS_TESTING */
  321. } else if (os_strcasecmp(cmd, "tdls_disabled") == 0) {
  322. int disabled = atoi(value);
  323. wpa_printf(MSG_DEBUG, "TDLS: tdls_disabled=%d", disabled);
  324. if (disabled) {
  325. if (wpa_drv_tdls_oper(wpa_s, TDLS_DISABLE, NULL) < 0)
  326. ret = -1;
  327. } else if (wpa_drv_tdls_oper(wpa_s, TDLS_ENABLE, NULL) < 0)
  328. ret = -1;
  329. wpa_tdls_enable(wpa_s->wpa, !disabled);
  330. #endif /* CONFIG_TDLS */
  331. } else if (os_strcasecmp(cmd, "pno") == 0) {
  332. ret = wpas_ctrl_pno(wpa_s, value);
  333. } else if (os_strcasecmp(cmd, "radio_disabled") == 0) {
  334. int disabled = atoi(value);
  335. if (wpa_drv_radio_disable(wpa_s, disabled) < 0)
  336. ret = -1;
  337. else if (disabled)
  338. wpa_supplicant_set_state(wpa_s, WPA_INACTIVE);
  339. } else if (os_strcasecmp(cmd, "uapsd") == 0) {
  340. if (os_strcmp(value, "disable") == 0)
  341. wpa_s->set_sta_uapsd = 0;
  342. else {
  343. int be, bk, vi, vo;
  344. char *pos;
  345. /* format: BE,BK,VI,VO;max SP Length */
  346. be = atoi(value);
  347. pos = os_strchr(value, ',');
  348. if (pos == NULL)
  349. return -1;
  350. pos++;
  351. bk = atoi(pos);
  352. pos = os_strchr(pos, ',');
  353. if (pos == NULL)
  354. return -1;
  355. pos++;
  356. vi = atoi(pos);
  357. pos = os_strchr(pos, ',');
  358. if (pos == NULL)
  359. return -1;
  360. pos++;
  361. vo = atoi(pos);
  362. /* ignore max SP Length for now */
  363. wpa_s->set_sta_uapsd = 1;
  364. wpa_s->sta_uapsd = 0;
  365. if (be)
  366. wpa_s->sta_uapsd |= BIT(0);
  367. if (bk)
  368. wpa_s->sta_uapsd |= BIT(1);
  369. if (vi)
  370. wpa_s->sta_uapsd |= BIT(2);
  371. if (vo)
  372. wpa_s->sta_uapsd |= BIT(3);
  373. }
  374. } else if (os_strcasecmp(cmd, "ps") == 0) {
  375. ret = wpa_drv_set_p2p_powersave(wpa_s, atoi(value), -1, -1);
  376. #ifdef CONFIG_WIFI_DISPLAY
  377. } else if (os_strcasecmp(cmd, "wifi_display") == 0) {
  378. int enabled = !!atoi(value);
  379. if (enabled && !wpa_s->global->p2p)
  380. ret = -1;
  381. else
  382. wifi_display_enable(wpa_s->global, enabled);
  383. #endif /* CONFIG_WIFI_DISPLAY */
  384. } else if (os_strcasecmp(cmd, "bssid_filter") == 0) {
  385. ret = set_bssid_filter(wpa_s, value);
  386. } else if (os_strcasecmp(cmd, "disallow_aps") == 0) {
  387. ret = set_disallow_aps(wpa_s, value);
  388. } else if (os_strcasecmp(cmd, "no_keep_alive") == 0) {
  389. wpa_s->no_keep_alive = !!atoi(value);
  390. #ifdef CONFIG_TESTING_OPTIONS
  391. } else if (os_strcasecmp(cmd, "ext_mgmt_frame_handling") == 0) {
  392. wpa_s->ext_mgmt_frame_handling = !!atoi(value);
  393. } else if (os_strcasecmp(cmd, "ext_eapol_frame_io") == 0) {
  394. wpa_s->ext_eapol_frame_io = !!atoi(value);
  395. #ifdef CONFIG_AP
  396. if (wpa_s->ap_iface) {
  397. wpa_s->ap_iface->bss[0]->ext_eapol_frame_io =
  398. wpa_s->ext_eapol_frame_io;
  399. }
  400. #endif /* CONFIG_AP */
  401. } else if (os_strcasecmp(cmd, "extra_roc_dur") == 0) {
  402. wpa_s->extra_roc_dur = atoi(value);
  403. } else if (os_strcasecmp(cmd, "test_failure") == 0) {
  404. wpa_s->test_failure = atoi(value);
  405. #endif /* CONFIG_TESTING_OPTIONS */
  406. #ifndef CONFIG_NO_CONFIG_BLOBS
  407. } else if (os_strcmp(cmd, "blob") == 0) {
  408. ret = wpas_ctrl_set_blob(wpa_s, value);
  409. #endif /* CONFIG_NO_CONFIG_BLOBS */
  410. } else if (os_strcasecmp(cmd, "setband") == 0) {
  411. if (os_strcmp(value, "AUTO") == 0)
  412. wpa_s->setband = WPA_SETBAND_AUTO;
  413. else if (os_strcmp(value, "5G") == 0)
  414. wpa_s->setband = WPA_SETBAND_5G;
  415. else if (os_strcmp(value, "2G") == 0)
  416. wpa_s->setband = WPA_SETBAND_2G;
  417. else
  418. ret = -1;
  419. } else {
  420. value[-1] = '=';
  421. ret = wpa_config_process_global(wpa_s->conf, cmd, -1);
  422. if (ret == 0)
  423. wpa_supplicant_update_config(wpa_s);
  424. }
  425. return ret;
  426. }
  427. static int wpa_supplicant_ctrl_iface_get(struct wpa_supplicant *wpa_s,
  428. char *cmd, char *buf, size_t buflen)
  429. {
  430. int res = -1;
  431. wpa_printf(MSG_DEBUG, "CTRL_IFACE GET '%s'", cmd);
  432. if (os_strcmp(cmd, "version") == 0) {
  433. res = os_snprintf(buf, buflen, "%s", VERSION_STR);
  434. } else if (os_strcasecmp(cmd, "country") == 0) {
  435. if (wpa_s->conf->country[0] && wpa_s->conf->country[1])
  436. res = os_snprintf(buf, buflen, "%c%c",
  437. wpa_s->conf->country[0],
  438. wpa_s->conf->country[1]);
  439. #ifdef CONFIG_WIFI_DISPLAY
  440. } else if (os_strcasecmp(cmd, "wifi_display") == 0) {
  441. int enabled;
  442. if (wpa_s->global->p2p == NULL ||
  443. wpa_s->global->p2p_disabled)
  444. enabled = 0;
  445. else
  446. enabled = wpa_s->global->wifi_display;
  447. res = os_snprintf(buf, buflen, "%d", enabled);
  448. #endif /* CONFIG_WIFI_DISPLAY */
  449. #ifdef CONFIG_TESTING_GET_GTK
  450. } else if (os_strcmp(cmd, "gtk") == 0) {
  451. if (wpa_s->last_gtk_len == 0)
  452. return -1;
  453. res = wpa_snprintf_hex(buf, buflen, wpa_s->last_gtk,
  454. wpa_s->last_gtk_len);
  455. return res;
  456. #endif /* CONFIG_TESTING_GET_GTK */
  457. } else if (os_strcmp(cmd, "tls_library") == 0) {
  458. res = tls_get_library_version(buf, buflen);
  459. } else {
  460. res = wpa_config_get_value(cmd, wpa_s->conf, buf, buflen);
  461. }
  462. if (os_snprintf_error(buflen, res))
  463. return -1;
  464. return res;
  465. }
  466. #ifdef IEEE8021X_EAPOL
  467. static int wpa_supplicant_ctrl_iface_preauth(struct wpa_supplicant *wpa_s,
  468. char *addr)
  469. {
  470. u8 bssid[ETH_ALEN];
  471. struct wpa_ssid *ssid = wpa_s->current_ssid;
  472. if (hwaddr_aton(addr, bssid)) {
  473. wpa_printf(MSG_DEBUG, "CTRL_IFACE PREAUTH: invalid address "
  474. "'%s'", addr);
  475. return -1;
  476. }
  477. wpa_printf(MSG_DEBUG, "CTRL_IFACE PREAUTH " MACSTR, MAC2STR(bssid));
  478. rsn_preauth_deinit(wpa_s->wpa);
  479. if (rsn_preauth_init(wpa_s->wpa, bssid, ssid ? &ssid->eap : NULL))
  480. return -1;
  481. return 0;
  482. }
  483. #endif /* IEEE8021X_EAPOL */
  484. #ifdef CONFIG_PEERKEY
  485. /* MLME-STKSTART.request(peer) */
  486. static int wpa_supplicant_ctrl_iface_stkstart(
  487. struct wpa_supplicant *wpa_s, char *addr)
  488. {
  489. u8 peer[ETH_ALEN];
  490. if (hwaddr_aton(addr, peer)) {
  491. wpa_printf(MSG_DEBUG, "CTRL_IFACE STKSTART: invalid "
  492. "address '%s'", addr);
  493. return -1;
  494. }
  495. wpa_printf(MSG_DEBUG, "CTRL_IFACE STKSTART " MACSTR,
  496. MAC2STR(peer));
  497. return wpa_sm_stkstart(wpa_s->wpa, peer);
  498. }
  499. #endif /* CONFIG_PEERKEY */
  500. #ifdef CONFIG_TDLS
  501. static int wpa_supplicant_ctrl_iface_tdls_discover(
  502. struct wpa_supplicant *wpa_s, char *addr)
  503. {
  504. u8 peer[ETH_ALEN];
  505. int ret;
  506. if (hwaddr_aton(addr, peer)) {
  507. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_DISCOVER: invalid "
  508. "address '%s'", addr);
  509. return -1;
  510. }
  511. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_DISCOVER " MACSTR,
  512. MAC2STR(peer));
  513. if (wpa_tdls_is_external_setup(wpa_s->wpa))
  514. ret = wpa_tdls_send_discovery_request(wpa_s->wpa, peer);
  515. else
  516. ret = wpa_drv_tdls_oper(wpa_s, TDLS_DISCOVERY_REQ, peer);
  517. return ret;
  518. }
  519. static int wpa_supplicant_ctrl_iface_tdls_setup(
  520. struct wpa_supplicant *wpa_s, char *addr)
  521. {
  522. u8 peer[ETH_ALEN];
  523. int ret;
  524. if (hwaddr_aton(addr, peer)) {
  525. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_SETUP: invalid "
  526. "address '%s'", addr);
  527. return -1;
  528. }
  529. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_SETUP " MACSTR,
  530. MAC2STR(peer));
  531. if ((wpa_s->conf->tdls_external_control) &&
  532. wpa_tdls_is_external_setup(wpa_s->wpa))
  533. return wpa_drv_tdls_oper(wpa_s, TDLS_SETUP, peer);
  534. wpa_tdls_remove(wpa_s->wpa, peer);
  535. if (wpa_tdls_is_external_setup(wpa_s->wpa))
  536. ret = wpa_tdls_start(wpa_s->wpa, peer);
  537. else
  538. ret = wpa_drv_tdls_oper(wpa_s, TDLS_SETUP, peer);
  539. return ret;
  540. }
  541. static int wpa_supplicant_ctrl_iface_tdls_teardown(
  542. struct wpa_supplicant *wpa_s, char *addr)
  543. {
  544. u8 peer[ETH_ALEN];
  545. int ret;
  546. if (os_strcmp(addr, "*") == 0) {
  547. /* remove everyone */
  548. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_TEARDOWN *");
  549. wpa_tdls_teardown_peers(wpa_s->wpa);
  550. return 0;
  551. }
  552. if (hwaddr_aton(addr, peer)) {
  553. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_TEARDOWN: invalid "
  554. "address '%s'", addr);
  555. return -1;
  556. }
  557. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_TEARDOWN " MACSTR,
  558. MAC2STR(peer));
  559. if ((wpa_s->conf->tdls_external_control) &&
  560. wpa_tdls_is_external_setup(wpa_s->wpa))
  561. return wpa_drv_tdls_oper(wpa_s, TDLS_TEARDOWN, peer);
  562. if (wpa_tdls_is_external_setup(wpa_s->wpa))
  563. ret = wpa_tdls_teardown_link(
  564. wpa_s->wpa, peer,
  565. WLAN_REASON_TDLS_TEARDOWN_UNSPECIFIED);
  566. else
  567. ret = wpa_drv_tdls_oper(wpa_s, TDLS_TEARDOWN, peer);
  568. return ret;
  569. }
  570. static int ctrl_iface_get_capability_tdls(
  571. struct wpa_supplicant *wpa_s, char *buf, size_t buflen)
  572. {
  573. int ret;
  574. ret = os_snprintf(buf, buflen, "%s\n",
  575. wpa_s->drv_flags & WPA_DRIVER_FLAGS_TDLS_SUPPORT ?
  576. (wpa_s->drv_flags &
  577. WPA_DRIVER_FLAGS_TDLS_EXTERNAL_SETUP ?
  578. "EXTERNAL" : "INTERNAL") : "UNSUPPORTED");
  579. if (os_snprintf_error(buflen, ret))
  580. return -1;
  581. return ret;
  582. }
  583. static int wpa_supplicant_ctrl_iface_tdls_chan_switch(
  584. struct wpa_supplicant *wpa_s, char *cmd)
  585. {
  586. u8 peer[ETH_ALEN];
  587. struct hostapd_freq_params freq_params;
  588. u8 oper_class;
  589. char *pos, *end;
  590. if (!wpa_tdls_is_external_setup(wpa_s->wpa)) {
  591. wpa_printf(MSG_INFO,
  592. "tdls_chanswitch: Only supported with external setup");
  593. return -1;
  594. }
  595. os_memset(&freq_params, 0, sizeof(freq_params));
  596. pos = os_strchr(cmd, ' ');
  597. if (pos == NULL)
  598. return -1;
  599. *pos++ = '\0';
  600. oper_class = strtol(pos, &end, 10);
  601. if (pos == end) {
  602. wpa_printf(MSG_INFO,
  603. "tdls_chanswitch: Invalid op class provided");
  604. return -1;
  605. }
  606. pos = end;
  607. freq_params.freq = atoi(pos);
  608. if (freq_params.freq == 0) {
  609. wpa_printf(MSG_INFO, "tdls_chanswitch: Invalid freq provided");
  610. return -1;
  611. }
  612. #define SET_FREQ_SETTING(str) \
  613. do { \
  614. const char *pos2 = os_strstr(pos, " " #str "="); \
  615. if (pos2) { \
  616. pos2 += sizeof(" " #str "=") - 1; \
  617. freq_params.str = atoi(pos2); \
  618. } \
  619. } while (0)
  620. SET_FREQ_SETTING(center_freq1);
  621. SET_FREQ_SETTING(center_freq2);
  622. SET_FREQ_SETTING(bandwidth);
  623. SET_FREQ_SETTING(sec_channel_offset);
  624. #undef SET_FREQ_SETTING
  625. freq_params.ht_enabled = !!os_strstr(pos, " ht");
  626. freq_params.vht_enabled = !!os_strstr(pos, " vht");
  627. if (hwaddr_aton(cmd, peer)) {
  628. wpa_printf(MSG_DEBUG,
  629. "CTRL_IFACE TDLS_CHAN_SWITCH: Invalid address '%s'",
  630. cmd);
  631. return -1;
  632. }
  633. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_CHAN_SWITCH " MACSTR
  634. " OP CLASS %d FREQ %d CENTER1 %d CENTER2 %d BW %d SEC_OFFSET %d%s%s",
  635. MAC2STR(peer), oper_class, freq_params.freq,
  636. freq_params.center_freq1, freq_params.center_freq2,
  637. freq_params.bandwidth, freq_params.sec_channel_offset,
  638. freq_params.ht_enabled ? " HT" : "",
  639. freq_params.vht_enabled ? " VHT" : "");
  640. return wpa_tdls_enable_chan_switch(wpa_s->wpa, peer, oper_class,
  641. &freq_params);
  642. }
  643. static int wpa_supplicant_ctrl_iface_tdls_cancel_chan_switch(
  644. struct wpa_supplicant *wpa_s, char *cmd)
  645. {
  646. u8 peer[ETH_ALEN];
  647. if (!wpa_tdls_is_external_setup(wpa_s->wpa)) {
  648. wpa_printf(MSG_INFO,
  649. "tdls_chanswitch: Only supported with external setup");
  650. return -1;
  651. }
  652. if (hwaddr_aton(cmd, peer)) {
  653. wpa_printf(MSG_DEBUG,
  654. "CTRL_IFACE TDLS_CANCEL_CHAN_SWITCH: Invalid address '%s'",
  655. cmd);
  656. return -1;
  657. }
  658. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_CANCEL_CHAN_SWITCH " MACSTR,
  659. MAC2STR(peer));
  660. return wpa_tdls_disable_chan_switch(wpa_s->wpa, peer);
  661. }
  662. static int wpa_supplicant_ctrl_iface_tdls_link_status(
  663. struct wpa_supplicant *wpa_s, const char *addr,
  664. char *buf, size_t buflen)
  665. {
  666. u8 peer[ETH_ALEN];
  667. const char *tdls_status;
  668. int ret;
  669. if (hwaddr_aton(addr, peer)) {
  670. wpa_printf(MSG_DEBUG,
  671. "CTRL_IFACE TDLS_LINK_STATUS: Invalid address '%s'",
  672. addr);
  673. return -1;
  674. }
  675. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_LINK_STATUS " MACSTR,
  676. MAC2STR(peer));
  677. tdls_status = wpa_tdls_get_link_status(wpa_s->wpa, peer);
  678. wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_LINK_STATUS: %s", tdls_status);
  679. ret = os_snprintf(buf, buflen, "TDLS link status: %s\n", tdls_status);
  680. if (os_snprintf_error(buflen, ret))
  681. return -1;
  682. return ret;
  683. }
  684. #endif /* CONFIG_TDLS */
  685. static int wmm_ac_ctrl_addts(struct wpa_supplicant *wpa_s, char *cmd)
  686. {
  687. char *token, *context = NULL;
  688. struct wmm_ac_ts_setup_params params = {
  689. .tsid = 0xff,
  690. .direction = 0xff,
  691. };
  692. while ((token = str_token(cmd, " ", &context))) {
  693. if (sscanf(token, "tsid=%i", &params.tsid) == 1 ||
  694. sscanf(token, "up=%i", &params.user_priority) == 1 ||
  695. sscanf(token, "nominal_msdu_size=%i",
  696. &params.nominal_msdu_size) == 1 ||
  697. sscanf(token, "mean_data_rate=%i",
  698. &params.mean_data_rate) == 1 ||
  699. sscanf(token, "min_phy_rate=%i",
  700. &params.minimum_phy_rate) == 1 ||
  701. sscanf(token, "sba=%i",
  702. &params.surplus_bandwidth_allowance) == 1)
  703. continue;
  704. if (os_strcasecmp(token, "downlink") == 0) {
  705. params.direction = WMM_TSPEC_DIRECTION_DOWNLINK;
  706. } else if (os_strcasecmp(token, "uplink") == 0) {
  707. params.direction = WMM_TSPEC_DIRECTION_UPLINK;
  708. } else if (os_strcasecmp(token, "bidi") == 0) {
  709. params.direction = WMM_TSPEC_DIRECTION_BI_DIRECTIONAL;
  710. } else if (os_strcasecmp(token, "fixed_nominal_msdu") == 0) {
  711. params.fixed_nominal_msdu = 1;
  712. } else {
  713. wpa_printf(MSG_DEBUG,
  714. "CTRL: Invalid WMM_AC_ADDTS parameter: '%s'",
  715. token);
  716. return -1;
  717. }
  718. }
  719. return wpas_wmm_ac_addts(wpa_s, &params);
  720. }
  721. static int wmm_ac_ctrl_delts(struct wpa_supplicant *wpa_s, char *cmd)
  722. {
  723. u8 tsid = atoi(cmd);
  724. return wpas_wmm_ac_delts(wpa_s, tsid);
  725. }
  726. #ifdef CONFIG_IEEE80211R
  727. static int wpa_supplicant_ctrl_iface_ft_ds(
  728. struct wpa_supplicant *wpa_s, char *addr)
  729. {
  730. u8 target_ap[ETH_ALEN];
  731. struct wpa_bss *bss;
  732. const u8 *mdie;
  733. if (hwaddr_aton(addr, target_ap)) {
  734. wpa_printf(MSG_DEBUG, "CTRL_IFACE FT_DS: invalid "
  735. "address '%s'", addr);
  736. return -1;
  737. }
  738. wpa_printf(MSG_DEBUG, "CTRL_IFACE FT_DS " MACSTR, MAC2STR(target_ap));
  739. bss = wpa_bss_get_bssid(wpa_s, target_ap);
  740. if (bss)
  741. mdie = wpa_bss_get_ie(bss, WLAN_EID_MOBILITY_DOMAIN);
  742. else
  743. mdie = NULL;
  744. return wpa_ft_start_over_ds(wpa_s->wpa, target_ap, mdie);
  745. }
  746. #endif /* CONFIG_IEEE80211R */
  747. #ifdef CONFIG_WPS
  748. static int wpa_supplicant_ctrl_iface_wps_pbc(struct wpa_supplicant *wpa_s,
  749. char *cmd)
  750. {
  751. u8 bssid[ETH_ALEN], *_bssid = bssid;
  752. #ifdef CONFIG_P2P
  753. u8 p2p_dev_addr[ETH_ALEN];
  754. #endif /* CONFIG_P2P */
  755. #ifdef CONFIG_AP
  756. u8 *_p2p_dev_addr = NULL;
  757. #endif /* CONFIG_AP */
  758. if (cmd == NULL || os_strcmp(cmd, "any") == 0) {
  759. _bssid = NULL;
  760. #ifdef CONFIG_P2P
  761. } else if (os_strncmp(cmd, "p2p_dev_addr=", 13) == 0) {
  762. if (hwaddr_aton(cmd + 13, p2p_dev_addr)) {
  763. wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_PBC: invalid "
  764. "P2P Device Address '%s'",
  765. cmd + 13);
  766. return -1;
  767. }
  768. _p2p_dev_addr = p2p_dev_addr;
  769. #endif /* CONFIG_P2P */
  770. } else if (hwaddr_aton(cmd, bssid)) {
  771. wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_PBC: invalid BSSID '%s'",
  772. cmd);
  773. return -1;
  774. }
  775. #ifdef CONFIG_AP
  776. if (wpa_s->ap_iface)
  777. return wpa_supplicant_ap_wps_pbc(wpa_s, _bssid, _p2p_dev_addr);
  778. #endif /* CONFIG_AP */
  779. return wpas_wps_start_pbc(wpa_s, _bssid, 0);
  780. }
  781. static int wpa_supplicant_ctrl_iface_wps_pin(struct wpa_supplicant *wpa_s,
  782. char *cmd, char *buf,
  783. size_t buflen)
  784. {
  785. u8 bssid[ETH_ALEN], *_bssid = bssid;
  786. char *pin;
  787. int ret;
  788. pin = os_strchr(cmd, ' ');
  789. if (pin)
  790. *pin++ = '\0';
  791. if (os_strcmp(cmd, "any") == 0)
  792. _bssid = NULL;
  793. else if (os_strcmp(cmd, "get") == 0) {
  794. ret = wps_generate_pin();
  795. goto done;
  796. } else if (hwaddr_aton(cmd, bssid)) {
  797. wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_PIN: invalid BSSID '%s'",
  798. cmd);
  799. return -1;
  800. }
  801. #ifdef CONFIG_AP
  802. if (wpa_s->ap_iface) {
  803. int timeout = 0;
  804. char *pos;
  805. if (pin) {
  806. pos = os_strchr(pin, ' ');
  807. if (pos) {
  808. *pos++ = '\0';
  809. timeout = atoi(pos);
  810. }
  811. }
  812. return wpa_supplicant_ap_wps_pin(wpa_s, _bssid, pin,
  813. buf, buflen, timeout);
  814. }
  815. #endif /* CONFIG_AP */
  816. if (pin) {
  817. ret = wpas_wps_start_pin(wpa_s, _bssid, pin, 0,
  818. DEV_PW_DEFAULT);
  819. if (ret < 0)
  820. return -1;
  821. ret = os_snprintf(buf, buflen, "%s", pin);
  822. if (os_snprintf_error(buflen, ret))
  823. return -1;
  824. return ret;
  825. }
  826. ret = wpas_wps_start_pin(wpa_s, _bssid, NULL, 0, DEV_PW_DEFAULT);
  827. if (ret < 0)
  828. return -1;
  829. done:
  830. /* Return the generated PIN */
  831. ret = os_snprintf(buf, buflen, "%08d", ret);
  832. if (os_snprintf_error(buflen, ret))
  833. return -1;
  834. return ret;
  835. }
  836. static int wpa_supplicant_ctrl_iface_wps_check_pin(
  837. struct wpa_supplicant *wpa_s, char *cmd, char *buf, size_t buflen)
  838. {
  839. char pin[9];
  840. size_t len;
  841. char *pos;
  842. int ret;
  843. wpa_hexdump_ascii_key(MSG_DEBUG, "WPS_CHECK_PIN",
  844. (u8 *) cmd, os_strlen(cmd));
  845. for (pos = cmd, len = 0; *pos != '\0'; pos++) {
  846. if (*pos < '0' || *pos > '9')
  847. continue;
  848. pin[len++] = *pos;
  849. if (len == 9) {
  850. wpa_printf(MSG_DEBUG, "WPS: Too long PIN");
  851. return -1;
  852. }
  853. }
  854. if (len != 4 && len != 8) {
  855. wpa_printf(MSG_DEBUG, "WPS: Invalid PIN length %d", (int) len);
  856. return -1;
  857. }
  858. pin[len] = '\0';
  859. if (len == 8) {
  860. unsigned int pin_val;
  861. pin_val = atoi(pin);
  862. if (!wps_pin_valid(pin_val)) {
  863. wpa_printf(MSG_DEBUG, "WPS: Invalid checksum digit");
  864. ret = os_snprintf(buf, buflen, "FAIL-CHECKSUM\n");
  865. if (os_snprintf_error(buflen, ret))
  866. return -1;
  867. return ret;
  868. }
  869. }
  870. ret = os_snprintf(buf, buflen, "%s", pin);
  871. if (os_snprintf_error(buflen, ret))
  872. return -1;
  873. return ret;
  874. }
  875. #ifdef CONFIG_WPS_NFC
  876. static int wpa_supplicant_ctrl_iface_wps_nfc(struct wpa_supplicant *wpa_s,
  877. char *cmd)
  878. {
  879. u8 bssid[ETH_ALEN], *_bssid = bssid;
  880. if (cmd == NULL || cmd[0] == '\0')
  881. _bssid = NULL;
  882. else if (hwaddr_aton(cmd, bssid))
  883. return -1;
  884. return wpas_wps_start_nfc(wpa_s, NULL, _bssid, NULL, 0, 0, NULL, NULL,
  885. 0, 0);
  886. }
  887. static int wpa_supplicant_ctrl_iface_wps_nfc_config_token(
  888. struct wpa_supplicant *wpa_s, char *cmd, char *reply, size_t max_len)
  889. {
  890. int ndef;
  891. struct wpabuf *buf;
  892. int res;
  893. char *pos;
  894. pos = os_strchr(cmd, ' ');
  895. if (pos)
  896. *pos++ = '\0';
  897. if (os_strcmp(cmd, "WPS") == 0)
  898. ndef = 0;
  899. else if (os_strcmp(cmd, "NDEF") == 0)
  900. ndef = 1;
  901. else
  902. return -1;
  903. buf = wpas_wps_nfc_config_token(wpa_s, ndef, pos);
  904. if (buf == NULL)
  905. return -1;
  906. res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
  907. wpabuf_len(buf));
  908. reply[res++] = '\n';
  909. reply[res] = '\0';
  910. wpabuf_free(buf);
  911. return res;
  912. }
  913. static int wpa_supplicant_ctrl_iface_wps_nfc_token(
  914. struct wpa_supplicant *wpa_s, char *cmd, char *reply, size_t max_len)
  915. {
  916. int ndef;
  917. struct wpabuf *buf;
  918. int res;
  919. if (os_strcmp(cmd, "WPS") == 0)
  920. ndef = 0;
  921. else if (os_strcmp(cmd, "NDEF") == 0)
  922. ndef = 1;
  923. else
  924. return -1;
  925. buf = wpas_wps_nfc_token(wpa_s, ndef);
  926. if (buf == NULL)
  927. return -1;
  928. res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
  929. wpabuf_len(buf));
  930. reply[res++] = '\n';
  931. reply[res] = '\0';
  932. wpabuf_free(buf);
  933. return res;
  934. }
  935. static int wpa_supplicant_ctrl_iface_wps_nfc_tag_read(
  936. struct wpa_supplicant *wpa_s, char *pos)
  937. {
  938. size_t len;
  939. struct wpabuf *buf;
  940. int ret;
  941. char *freq;
  942. int forced_freq = 0;
  943. freq = strstr(pos, " freq=");
  944. if (freq) {
  945. *freq = '\0';
  946. freq += 6;
  947. forced_freq = atoi(freq);
  948. }
  949. len = os_strlen(pos);
  950. if (len & 0x01)
  951. return -1;
  952. len /= 2;
  953. buf = wpabuf_alloc(len);
  954. if (buf == NULL)
  955. return -1;
  956. if (hexstr2bin(pos, wpabuf_put(buf, len), len) < 0) {
  957. wpabuf_free(buf);
  958. return -1;
  959. }
  960. ret = wpas_wps_nfc_tag_read(wpa_s, buf, forced_freq);
  961. wpabuf_free(buf);
  962. return ret;
  963. }
  964. static int wpas_ctrl_nfc_get_handover_req_wps(struct wpa_supplicant *wpa_s,
  965. char *reply, size_t max_len,
  966. int ndef)
  967. {
  968. struct wpabuf *buf;
  969. int res;
  970. buf = wpas_wps_nfc_handover_req(wpa_s, ndef);
  971. if (buf == NULL)
  972. return -1;
  973. res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
  974. wpabuf_len(buf));
  975. reply[res++] = '\n';
  976. reply[res] = '\0';
  977. wpabuf_free(buf);
  978. return res;
  979. }
  980. #ifdef CONFIG_P2P
  981. static int wpas_ctrl_nfc_get_handover_req_p2p(struct wpa_supplicant *wpa_s,
  982. char *reply, size_t max_len,
  983. int ndef)
  984. {
  985. struct wpabuf *buf;
  986. int res;
  987. buf = wpas_p2p_nfc_handover_req(wpa_s, ndef);
  988. if (buf == NULL) {
  989. wpa_printf(MSG_DEBUG, "P2P: Could not generate NFC handover request");
  990. return -1;
  991. }
  992. res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
  993. wpabuf_len(buf));
  994. reply[res++] = '\n';
  995. reply[res] = '\0';
  996. wpabuf_free(buf);
  997. return res;
  998. }
  999. #endif /* CONFIG_P2P */
  1000. static int wpas_ctrl_nfc_get_handover_req(struct wpa_supplicant *wpa_s,
  1001. char *cmd, char *reply,
  1002. size_t max_len)
  1003. {
  1004. char *pos;
  1005. int ndef;
  1006. pos = os_strchr(cmd, ' ');
  1007. if (pos == NULL)
  1008. return -1;
  1009. *pos++ = '\0';
  1010. if (os_strcmp(cmd, "WPS") == 0)
  1011. ndef = 0;
  1012. else if (os_strcmp(cmd, "NDEF") == 0)
  1013. ndef = 1;
  1014. else
  1015. return -1;
  1016. if (os_strcmp(pos, "WPS") == 0 || os_strcmp(pos, "WPS-CR") == 0) {
  1017. if (!ndef)
  1018. return -1;
  1019. return wpas_ctrl_nfc_get_handover_req_wps(
  1020. wpa_s, reply, max_len, ndef);
  1021. }
  1022. #ifdef CONFIG_P2P
  1023. if (os_strcmp(pos, "P2P-CR") == 0) {
  1024. return wpas_ctrl_nfc_get_handover_req_p2p(
  1025. wpa_s, reply, max_len, ndef);
  1026. }
  1027. #endif /* CONFIG_P2P */
  1028. return -1;
  1029. }
  1030. static int wpas_ctrl_nfc_get_handover_sel_wps(struct wpa_supplicant *wpa_s,
  1031. char *reply, size_t max_len,
  1032. int ndef, int cr, char *uuid)
  1033. {
  1034. struct wpabuf *buf;
  1035. int res;
  1036. buf = wpas_wps_nfc_handover_sel(wpa_s, ndef, cr, uuid);
  1037. if (buf == NULL)
  1038. return -1;
  1039. res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
  1040. wpabuf_len(buf));
  1041. reply[res++] = '\n';
  1042. reply[res] = '\0';
  1043. wpabuf_free(buf);
  1044. return res;
  1045. }
  1046. #ifdef CONFIG_P2P
  1047. static int wpas_ctrl_nfc_get_handover_sel_p2p(struct wpa_supplicant *wpa_s,
  1048. char *reply, size_t max_len,
  1049. int ndef, int tag)
  1050. {
  1051. struct wpabuf *buf;
  1052. int res;
  1053. buf = wpas_p2p_nfc_handover_sel(wpa_s, ndef, tag);
  1054. if (buf == NULL)
  1055. return -1;
  1056. res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
  1057. wpabuf_len(buf));
  1058. reply[res++] = '\n';
  1059. reply[res] = '\0';
  1060. wpabuf_free(buf);
  1061. return res;
  1062. }
  1063. #endif /* CONFIG_P2P */
  1064. static int wpas_ctrl_nfc_get_handover_sel(struct wpa_supplicant *wpa_s,
  1065. char *cmd, char *reply,
  1066. size_t max_len)
  1067. {
  1068. char *pos, *pos2;
  1069. int ndef;
  1070. pos = os_strchr(cmd, ' ');
  1071. if (pos == NULL)
  1072. return -1;
  1073. *pos++ = '\0';
  1074. if (os_strcmp(cmd, "WPS") == 0)
  1075. ndef = 0;
  1076. else if (os_strcmp(cmd, "NDEF") == 0)
  1077. ndef = 1;
  1078. else
  1079. return -1;
  1080. pos2 = os_strchr(pos, ' ');
  1081. if (pos2)
  1082. *pos2++ = '\0';
  1083. if (os_strcmp(pos, "WPS") == 0 || os_strcmp(pos, "WPS-CR") == 0) {
  1084. if (!ndef)
  1085. return -1;
  1086. return wpas_ctrl_nfc_get_handover_sel_wps(
  1087. wpa_s, reply, max_len, ndef,
  1088. os_strcmp(pos, "WPS-CR") == 0, pos2);
  1089. }
  1090. #ifdef CONFIG_P2P
  1091. if (os_strcmp(pos, "P2P-CR") == 0) {
  1092. return wpas_ctrl_nfc_get_handover_sel_p2p(
  1093. wpa_s, reply, max_len, ndef, 0);
  1094. }
  1095. if (os_strcmp(pos, "P2P-CR-TAG") == 0) {
  1096. return wpas_ctrl_nfc_get_handover_sel_p2p(
  1097. wpa_s, reply, max_len, ndef, 1);
  1098. }
  1099. #endif /* CONFIG_P2P */
  1100. return -1;
  1101. }
  1102. static int wpas_ctrl_nfc_report_handover(struct wpa_supplicant *wpa_s,
  1103. char *cmd)
  1104. {
  1105. size_t len;
  1106. struct wpabuf *req, *sel;
  1107. int ret;
  1108. char *pos, *role, *type, *pos2;
  1109. #ifdef CONFIG_P2P
  1110. char *freq;
  1111. int forced_freq = 0;
  1112. freq = strstr(cmd, " freq=");
  1113. if (freq) {
  1114. *freq = '\0';
  1115. freq += 6;
  1116. forced_freq = atoi(freq);
  1117. }
  1118. #endif /* CONFIG_P2P */
  1119. role = cmd;
  1120. pos = os_strchr(role, ' ');
  1121. if (pos == NULL) {
  1122. wpa_printf(MSG_DEBUG, "NFC: Missing type in handover report");
  1123. return -1;
  1124. }
  1125. *pos++ = '\0';
  1126. type = pos;
  1127. pos = os_strchr(type, ' ');
  1128. if (pos == NULL) {
  1129. wpa_printf(MSG_DEBUG, "NFC: Missing request message in handover report");
  1130. return -1;
  1131. }
  1132. *pos++ = '\0';
  1133. pos2 = os_strchr(pos, ' ');
  1134. if (pos2 == NULL) {
  1135. wpa_printf(MSG_DEBUG, "NFC: Missing select message in handover report");
  1136. return -1;
  1137. }
  1138. *pos2++ = '\0';
  1139. len = os_strlen(pos);
  1140. if (len & 0x01) {
  1141. wpa_printf(MSG_DEBUG, "NFC: Invalid request message length in handover report");
  1142. return -1;
  1143. }
  1144. len /= 2;
  1145. req = wpabuf_alloc(len);
  1146. if (req == NULL) {
  1147. wpa_printf(MSG_DEBUG, "NFC: Failed to allocate memory for request message");
  1148. return -1;
  1149. }
  1150. if (hexstr2bin(pos, wpabuf_put(req, len), len) < 0) {
  1151. wpa_printf(MSG_DEBUG, "NFC: Invalid request message hexdump in handover report");
  1152. wpabuf_free(req);
  1153. return -1;
  1154. }
  1155. len = os_strlen(pos2);
  1156. if (len & 0x01) {
  1157. wpa_printf(MSG_DEBUG, "NFC: Invalid select message length in handover report");
  1158. wpabuf_free(req);
  1159. return -1;
  1160. }
  1161. len /= 2;
  1162. sel = wpabuf_alloc(len);
  1163. if (sel == NULL) {
  1164. wpa_printf(MSG_DEBUG, "NFC: Failed to allocate memory for select message");
  1165. wpabuf_free(req);
  1166. return -1;
  1167. }
  1168. if (hexstr2bin(pos2, wpabuf_put(sel, len), len) < 0) {
  1169. wpa_printf(MSG_DEBUG, "NFC: Invalid select message hexdump in handover report");
  1170. wpabuf_free(req);
  1171. wpabuf_free(sel);
  1172. return -1;
  1173. }
  1174. wpa_printf(MSG_DEBUG, "NFC: Connection handover reported - role=%s type=%s req_len=%d sel_len=%d",
  1175. role, type, (int) wpabuf_len(req), (int) wpabuf_len(sel));
  1176. if (os_strcmp(role, "INIT") == 0 && os_strcmp(type, "WPS") == 0) {
  1177. ret = wpas_wps_nfc_report_handover(wpa_s, req, sel);
  1178. #ifdef CONFIG_AP
  1179. } else if (os_strcmp(role, "RESP") == 0 && os_strcmp(type, "WPS") == 0)
  1180. {
  1181. ret = wpas_ap_wps_nfc_report_handover(wpa_s, req, sel);
  1182. if (ret < 0)
  1183. ret = wpas_er_wps_nfc_report_handover(wpa_s, req, sel);
  1184. #endif /* CONFIG_AP */
  1185. #ifdef CONFIG_P2P
  1186. } else if (os_strcmp(role, "INIT") == 0 && os_strcmp(type, "P2P") == 0)
  1187. {
  1188. ret = wpas_p2p_nfc_report_handover(wpa_s, 1, req, sel, 0);
  1189. } else if (os_strcmp(role, "RESP") == 0 && os_strcmp(type, "P2P") == 0)
  1190. {
  1191. ret = wpas_p2p_nfc_report_handover(wpa_s, 0, req, sel,
  1192. forced_freq);
  1193. #endif /* CONFIG_P2P */
  1194. } else {
  1195. wpa_printf(MSG_DEBUG, "NFC: Unsupported connection handover "
  1196. "reported: role=%s type=%s", role, type);
  1197. ret = -1;
  1198. }
  1199. wpabuf_free(req);
  1200. wpabuf_free(sel);
  1201. if (ret)
  1202. wpa_printf(MSG_DEBUG, "NFC: Failed to process reported handover messages");
  1203. return ret;
  1204. }
  1205. #endif /* CONFIG_WPS_NFC */
  1206. static int wpa_supplicant_ctrl_iface_wps_reg(struct wpa_supplicant *wpa_s,
  1207. char *cmd)
  1208. {
  1209. u8 bssid[ETH_ALEN];
  1210. char *pin;
  1211. char *new_ssid;
  1212. char *new_auth;
  1213. char *new_encr;
  1214. char *new_key;
  1215. struct wps_new_ap_settings ap;
  1216. pin = os_strchr(cmd, ' ');
  1217. if (pin == NULL)
  1218. return -1;
  1219. *pin++ = '\0';
  1220. if (hwaddr_aton(cmd, bssid)) {
  1221. wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_REG: invalid BSSID '%s'",
  1222. cmd);
  1223. return -1;
  1224. }
  1225. new_ssid = os_strchr(pin, ' ');
  1226. if (new_ssid == NULL)
  1227. return wpas_wps_start_reg(wpa_s, bssid, pin, NULL);
  1228. *new_ssid++ = '\0';
  1229. new_auth = os_strchr(new_ssid, ' ');
  1230. if (new_auth == NULL)
  1231. return -1;
  1232. *new_auth++ = '\0';
  1233. new_encr = os_strchr(new_auth, ' ');
  1234. if (new_encr == NULL)
  1235. return -1;
  1236. *new_encr++ = '\0';
  1237. new_key = os_strchr(new_encr, ' ');
  1238. if (new_key == NULL)
  1239. return -1;
  1240. *new_key++ = '\0';
  1241. os_memset(&ap, 0, sizeof(ap));
  1242. ap.ssid_hex = new_ssid;
  1243. ap.auth = new_auth;
  1244. ap.encr = new_encr;
  1245. ap.key_hex = new_key;
  1246. return wpas_wps_start_reg(wpa_s, bssid, pin, &ap);
  1247. }
  1248. #ifdef CONFIG_AP
  1249. static int wpa_supplicant_ctrl_iface_wps_ap_pin(struct wpa_supplicant *wpa_s,
  1250. char *cmd, char *buf,
  1251. size_t buflen)
  1252. {
  1253. int timeout = 300;
  1254. char *pos;
  1255. const char *pin_txt;
  1256. if (!wpa_s->ap_iface)
  1257. return -1;
  1258. pos = os_strchr(cmd, ' ');
  1259. if (pos)
  1260. *pos++ = '\0';
  1261. if (os_strcmp(cmd, "disable") == 0) {
  1262. wpas_wps_ap_pin_disable(wpa_s);
  1263. return os_snprintf(buf, buflen, "OK\n");
  1264. }
  1265. if (os_strcmp(cmd, "random") == 0) {
  1266. if (pos)
  1267. timeout = atoi(pos);
  1268. pin_txt = wpas_wps_ap_pin_random(wpa_s, timeout);
  1269. if (pin_txt == NULL)
  1270. return -1;
  1271. return os_snprintf(buf, buflen, "%s", pin_txt);
  1272. }
  1273. if (os_strcmp(cmd, "get") == 0) {
  1274. pin_txt = wpas_wps_ap_pin_get(wpa_s);
  1275. if (pin_txt == NULL)
  1276. return -1;
  1277. return os_snprintf(buf, buflen, "%s", pin_txt);
  1278. }
  1279. if (os_strcmp(cmd, "set") == 0) {
  1280. char *pin;
  1281. if (pos == NULL)
  1282. return -1;
  1283. pin = pos;
  1284. pos = os_strchr(pos, ' ');
  1285. if (pos) {
  1286. *pos++ = '\0';
  1287. timeout = atoi(pos);
  1288. }
  1289. if (os_strlen(pin) > buflen)
  1290. return -1;
  1291. if (wpas_wps_ap_pin_set(wpa_s, pin, timeout) < 0)
  1292. return -1;
  1293. return os_snprintf(buf, buflen, "%s", pin);
  1294. }
  1295. return -1;
  1296. }
  1297. #endif /* CONFIG_AP */
  1298. #ifdef CONFIG_WPS_ER
  1299. static int wpa_supplicant_ctrl_iface_wps_er_pin(struct wpa_supplicant *wpa_s,
  1300. char *cmd)
  1301. {
  1302. char *uuid = cmd, *pin, *pos;
  1303. u8 addr_buf[ETH_ALEN], *addr = NULL;
  1304. pin = os_strchr(uuid, ' ');
  1305. if (pin == NULL)
  1306. return -1;
  1307. *pin++ = '\0';
  1308. pos = os_strchr(pin, ' ');
  1309. if (pos) {
  1310. *pos++ = '\0';
  1311. if (hwaddr_aton(pos, addr_buf) == 0)
  1312. addr = addr_buf;
  1313. }
  1314. return wpas_wps_er_add_pin(wpa_s, addr, uuid, pin);
  1315. }
  1316. static int wpa_supplicant_ctrl_iface_wps_er_learn(struct wpa_supplicant *wpa_s,
  1317. char *cmd)
  1318. {
  1319. char *uuid = cmd, *pin;
  1320. pin = os_strchr(uuid, ' ');
  1321. if (pin == NULL)
  1322. return -1;
  1323. *pin++ = '\0';
  1324. return wpas_wps_er_learn(wpa_s, uuid, pin);
  1325. }
  1326. static int wpa_supplicant_ctrl_iface_wps_er_set_config(
  1327. struct wpa_supplicant *wpa_s, char *cmd)
  1328. {
  1329. char *uuid = cmd, *id;
  1330. id = os_strchr(uuid, ' ');
  1331. if (id == NULL)
  1332. return -1;
  1333. *id++ = '\0';
  1334. return wpas_wps_er_set_config(wpa_s, uuid, atoi(id));
  1335. }
  1336. static int wpa_supplicant_ctrl_iface_wps_er_config(
  1337. struct wpa_supplicant *wpa_s, char *cmd)
  1338. {
  1339. char *pin;
  1340. char *new_ssid;
  1341. char *new_auth;
  1342. char *new_encr;
  1343. char *new_key;
  1344. struct wps_new_ap_settings ap;
  1345. pin = os_strchr(cmd, ' ');
  1346. if (pin == NULL)
  1347. return -1;
  1348. *pin++ = '\0';
  1349. new_ssid = os_strchr(pin, ' ');
  1350. if (new_ssid == NULL)
  1351. return -1;
  1352. *new_ssid++ = '\0';
  1353. new_auth = os_strchr(new_ssid, ' ');
  1354. if (new_auth == NULL)
  1355. return -1;
  1356. *new_auth++ = '\0';
  1357. new_encr = os_strchr(new_auth, ' ');
  1358. if (new_encr == NULL)
  1359. return -1;
  1360. *new_encr++ = '\0';
  1361. new_key = os_strchr(new_encr, ' ');
  1362. if (new_key == NULL)
  1363. return -1;
  1364. *new_key++ = '\0';
  1365. os_memset(&ap, 0, sizeof(ap));
  1366. ap.ssid_hex = new_ssid;
  1367. ap.auth = new_auth;
  1368. ap.encr = new_encr;
  1369. ap.key_hex = new_key;
  1370. return wpas_wps_er_config(wpa_s, cmd, pin, &ap);
  1371. }
  1372. #ifdef CONFIG_WPS_NFC
  1373. static int wpa_supplicant_ctrl_iface_wps_er_nfc_config_token(
  1374. struct wpa_supplicant *wpa_s, char *cmd, char *reply, size_t max_len)
  1375. {
  1376. int ndef;
  1377. struct wpabuf *buf;
  1378. int res;
  1379. char *uuid;
  1380. uuid = os_strchr(cmd, ' ');
  1381. if (uuid == NULL)
  1382. return -1;
  1383. *uuid++ = '\0';
  1384. if (os_strcmp(cmd, "WPS") == 0)
  1385. ndef = 0;
  1386. else if (os_strcmp(cmd, "NDEF") == 0)
  1387. ndef = 1;
  1388. else
  1389. return -1;
  1390. buf = wpas_wps_er_nfc_config_token(wpa_s, ndef, uuid);
  1391. if (buf == NULL)
  1392. return -1;
  1393. res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
  1394. wpabuf_len(buf));
  1395. reply[res++] = '\n';
  1396. reply[res] = '\0';
  1397. wpabuf_free(buf);
  1398. return res;
  1399. }
  1400. #endif /* CONFIG_WPS_NFC */
  1401. #endif /* CONFIG_WPS_ER */
  1402. #endif /* CONFIG_WPS */
  1403. #ifdef CONFIG_IBSS_RSN
  1404. static int wpa_supplicant_ctrl_iface_ibss_rsn(
  1405. struct wpa_supplicant *wpa_s, char *addr)
  1406. {
  1407. u8 peer[ETH_ALEN];
  1408. if (hwaddr_aton(addr, peer)) {
  1409. wpa_printf(MSG_DEBUG, "CTRL_IFACE IBSS_RSN: invalid "
  1410. "address '%s'", addr);
  1411. return -1;
  1412. }
  1413. wpa_printf(MSG_DEBUG, "CTRL_IFACE IBSS_RSN " MACSTR,
  1414. MAC2STR(peer));
  1415. return ibss_rsn_start(wpa_s->ibss_rsn, peer);
  1416. }
  1417. #endif /* CONFIG_IBSS_RSN */
  1418. static int wpa_supplicant_ctrl_iface_ctrl_rsp(struct wpa_supplicant *wpa_s,
  1419. char *rsp)
  1420. {
  1421. #ifdef IEEE8021X_EAPOL
  1422. char *pos, *id_pos;
  1423. int id;
  1424. struct wpa_ssid *ssid;
  1425. pos = os_strchr(rsp, '-');
  1426. if (pos == NULL)
  1427. return -1;
  1428. *pos++ = '\0';
  1429. id_pos = pos;
  1430. pos = os_strchr(pos, ':');
  1431. if (pos == NULL)
  1432. return -1;
  1433. *pos++ = '\0';
  1434. id = atoi(id_pos);
  1435. wpa_printf(MSG_DEBUG, "CTRL_IFACE: field=%s id=%d", rsp, id);
  1436. wpa_hexdump_ascii_key(MSG_DEBUG, "CTRL_IFACE: value",
  1437. (u8 *) pos, os_strlen(pos));
  1438. ssid = wpa_config_get_network(wpa_s->conf, id);
  1439. if (ssid == NULL) {
  1440. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
  1441. "to update", id);
  1442. return -1;
  1443. }
  1444. return wpa_supplicant_ctrl_iface_ctrl_rsp_handle(wpa_s, ssid, rsp,
  1445. pos);
  1446. #else /* IEEE8021X_EAPOL */
  1447. wpa_printf(MSG_DEBUG, "CTRL_IFACE: 802.1X not included");
  1448. return -1;
  1449. #endif /* IEEE8021X_EAPOL */
  1450. }
  1451. static int wpa_supplicant_ctrl_iface_status(struct wpa_supplicant *wpa_s,
  1452. const char *params,
  1453. char *buf, size_t buflen)
  1454. {
  1455. char *pos, *end, tmp[30];
  1456. int res, verbose, wps, ret;
  1457. #ifdef CONFIG_HS20
  1458. const u8 *hs20;
  1459. #endif /* CONFIG_HS20 */
  1460. const u8 *sess_id;
  1461. size_t sess_id_len;
  1462. if (os_strcmp(params, "-DRIVER") == 0)
  1463. return wpa_drv_status(wpa_s, buf, buflen);
  1464. verbose = os_strcmp(params, "-VERBOSE") == 0;
  1465. wps = os_strcmp(params, "-WPS") == 0;
  1466. pos = buf;
  1467. end = buf + buflen;
  1468. if (wpa_s->wpa_state >= WPA_ASSOCIATED) {
  1469. struct wpa_ssid *ssid = wpa_s->current_ssid;
  1470. ret = os_snprintf(pos, end - pos, "bssid=" MACSTR "\n",
  1471. MAC2STR(wpa_s->bssid));
  1472. if (os_snprintf_error(end - pos, ret))
  1473. return pos - buf;
  1474. pos += ret;
  1475. ret = os_snprintf(pos, end - pos, "freq=%u\n",
  1476. wpa_s->assoc_freq);
  1477. if (os_snprintf_error(end - pos, ret))
  1478. return pos - buf;
  1479. pos += ret;
  1480. if (ssid) {
  1481. u8 *_ssid = ssid->ssid;
  1482. size_t ssid_len = ssid->ssid_len;
  1483. u8 ssid_buf[SSID_MAX_LEN];
  1484. if (ssid_len == 0) {
  1485. int _res = wpa_drv_get_ssid(wpa_s, ssid_buf);
  1486. if (_res < 0)
  1487. ssid_len = 0;
  1488. else
  1489. ssid_len = _res;
  1490. _ssid = ssid_buf;
  1491. }
  1492. ret = os_snprintf(pos, end - pos, "ssid=%s\nid=%d\n",
  1493. wpa_ssid_txt(_ssid, ssid_len),
  1494. ssid->id);
  1495. if (os_snprintf_error(end - pos, ret))
  1496. return pos - buf;
  1497. pos += ret;
  1498. if (wps && ssid->passphrase &&
  1499. wpa_key_mgmt_wpa_psk(ssid->key_mgmt) &&
  1500. (ssid->mode == WPAS_MODE_AP ||
  1501. ssid->mode == WPAS_MODE_P2P_GO)) {
  1502. ret = os_snprintf(pos, end - pos,
  1503. "passphrase=%s\n",
  1504. ssid->passphrase);
  1505. if (os_snprintf_error(end - pos, ret))
  1506. return pos - buf;
  1507. pos += ret;
  1508. }
  1509. if (ssid->id_str) {
  1510. ret = os_snprintf(pos, end - pos,
  1511. "id_str=%s\n",
  1512. ssid->id_str);
  1513. if (os_snprintf_error(end - pos, ret))
  1514. return pos - buf;
  1515. pos += ret;
  1516. }
  1517. switch (ssid->mode) {
  1518. case WPAS_MODE_INFRA:
  1519. ret = os_snprintf(pos, end - pos,
  1520. "mode=station\n");
  1521. break;
  1522. case WPAS_MODE_IBSS:
  1523. ret = os_snprintf(pos, end - pos,
  1524. "mode=IBSS\n");
  1525. break;
  1526. case WPAS_MODE_AP:
  1527. ret = os_snprintf(pos, end - pos,
  1528. "mode=AP\n");
  1529. break;
  1530. case WPAS_MODE_P2P_GO:
  1531. ret = os_snprintf(pos, end - pos,
  1532. "mode=P2P GO\n");
  1533. break;
  1534. case WPAS_MODE_P2P_GROUP_FORMATION:
  1535. ret = os_snprintf(pos, end - pos,
  1536. "mode=P2P GO - group "
  1537. "formation\n");
  1538. break;
  1539. default:
  1540. ret = 0;
  1541. break;
  1542. }
  1543. if (os_snprintf_error(end - pos, ret))
  1544. return pos - buf;
  1545. pos += ret;
  1546. }
  1547. #ifdef CONFIG_AP
  1548. if (wpa_s->ap_iface) {
  1549. pos += ap_ctrl_iface_wpa_get_status(wpa_s, pos,
  1550. end - pos,
  1551. verbose);
  1552. } else
  1553. #endif /* CONFIG_AP */
  1554. pos += wpa_sm_get_status(wpa_s->wpa, pos, end - pos, verbose);
  1555. }
  1556. #ifdef CONFIG_SAE
  1557. if (wpa_s->wpa_state >= WPA_ASSOCIATED &&
  1558. #ifdef CONFIG_AP
  1559. !wpa_s->ap_iface &&
  1560. #endif /* CONFIG_AP */
  1561. wpa_s->sme.sae.state == SAE_ACCEPTED) {
  1562. ret = os_snprintf(pos, end - pos, "sae_group=%d\n",
  1563. wpa_s->sme.sae.group);
  1564. if (os_snprintf_error(end - pos, ret))
  1565. return pos - buf;
  1566. pos += ret;
  1567. }
  1568. #endif /* CONFIG_SAE */
  1569. ret = os_snprintf(pos, end - pos, "wpa_state=%s\n",
  1570. wpa_supplicant_state_txt(wpa_s->wpa_state));
  1571. if (os_snprintf_error(end - pos, ret))
  1572. return pos - buf;
  1573. pos += ret;
  1574. if (wpa_s->l2 &&
  1575. l2_packet_get_ip_addr(wpa_s->l2, tmp, sizeof(tmp)) >= 0) {
  1576. ret = os_snprintf(pos, end - pos, "ip_address=%s\n", tmp);
  1577. if (os_snprintf_error(end - pos, ret))
  1578. return pos - buf;
  1579. pos += ret;
  1580. }
  1581. #ifdef CONFIG_P2P
  1582. if (wpa_s->global->p2p) {
  1583. ret = os_snprintf(pos, end - pos, "p2p_device_address=" MACSTR
  1584. "\n", MAC2STR(wpa_s->global->p2p_dev_addr));
  1585. if (os_snprintf_error(end - pos, ret))
  1586. return pos - buf;
  1587. pos += ret;
  1588. }
  1589. #endif /* CONFIG_P2P */
  1590. ret = os_snprintf(pos, end - pos, "address=" MACSTR "\n",
  1591. MAC2STR(wpa_s->own_addr));
  1592. if (os_snprintf_error(end - pos, ret))
  1593. return pos - buf;
  1594. pos += ret;
  1595. #ifdef CONFIG_HS20
  1596. if (wpa_s->current_bss &&
  1597. (hs20 = wpa_bss_get_vendor_ie(wpa_s->current_bss,
  1598. HS20_IE_VENDOR_TYPE)) &&
  1599. wpa_s->wpa_proto == WPA_PROTO_RSN &&
  1600. wpa_key_mgmt_wpa_ieee8021x(wpa_s->key_mgmt)) {
  1601. int release = 1;
  1602. if (hs20[1] >= 5) {
  1603. u8 rel_num = (hs20[6] & 0xf0) >> 4;
  1604. release = rel_num + 1;
  1605. }
  1606. ret = os_snprintf(pos, end - pos, "hs20=%d\n", release);
  1607. if (os_snprintf_error(end - pos, ret))
  1608. return pos - buf;
  1609. pos += ret;
  1610. }
  1611. if (wpa_s->current_ssid) {
  1612. struct wpa_cred *cred;
  1613. char *type;
  1614. for (cred = wpa_s->conf->cred; cred; cred = cred->next) {
  1615. size_t i;
  1616. if (wpa_s->current_ssid->parent_cred != cred)
  1617. continue;
  1618. if (cred->provisioning_sp) {
  1619. ret = os_snprintf(pos, end - pos,
  1620. "provisioning_sp=%s\n",
  1621. cred->provisioning_sp);
  1622. if (os_snprintf_error(end - pos, ret))
  1623. return pos - buf;
  1624. pos += ret;
  1625. }
  1626. if (!cred->domain)
  1627. goto no_domain;
  1628. i = 0;
  1629. if (wpa_s->current_bss && wpa_s->current_bss->anqp) {
  1630. struct wpabuf *names =
  1631. wpa_s->current_bss->anqp->domain_name;
  1632. for (i = 0; names && i < cred->num_domain; i++)
  1633. {
  1634. if (domain_name_list_contains(
  1635. names, cred->domain[i], 1))
  1636. break;
  1637. }
  1638. if (i == cred->num_domain)
  1639. i = 0; /* show first entry by default */
  1640. }
  1641. ret = os_snprintf(pos, end - pos, "home_sp=%s\n",
  1642. cred->domain[i]);
  1643. if (os_snprintf_error(end - pos, ret))
  1644. return pos - buf;
  1645. pos += ret;
  1646. no_domain:
  1647. if (wpa_s->current_bss == NULL ||
  1648. wpa_s->current_bss->anqp == NULL)
  1649. res = -1;
  1650. else
  1651. res = interworking_home_sp_cred(
  1652. wpa_s, cred,
  1653. wpa_s->current_bss->anqp->domain_name);
  1654. if (res > 0)
  1655. type = "home";
  1656. else if (res == 0)
  1657. type = "roaming";
  1658. else
  1659. type = "unknown";
  1660. ret = os_snprintf(pos, end - pos, "sp_type=%s\n", type);
  1661. if (os_snprintf_error(end - pos, ret))
  1662. return pos - buf;
  1663. pos += ret;
  1664. break;
  1665. }
  1666. }
  1667. #endif /* CONFIG_HS20 */
  1668. if (wpa_key_mgmt_wpa_ieee8021x(wpa_s->key_mgmt) ||
  1669. wpa_s->key_mgmt == WPA_KEY_MGMT_IEEE8021X_NO_WPA) {
  1670. res = eapol_sm_get_status(wpa_s->eapol, pos, end - pos,
  1671. verbose);
  1672. if (res >= 0)
  1673. pos += res;
  1674. }
  1675. sess_id = eapol_sm_get_session_id(wpa_s->eapol, &sess_id_len);
  1676. if (sess_id) {
  1677. char *start = pos;
  1678. ret = os_snprintf(pos, end - pos, "eap_session_id=");
  1679. if (os_snprintf_error(end - pos, ret))
  1680. return start - buf;
  1681. pos += ret;
  1682. ret = wpa_snprintf_hex(pos, end - pos, sess_id, sess_id_len);
  1683. if (ret <= 0)
  1684. return start - buf;
  1685. pos += ret;
  1686. ret = os_snprintf(pos, end - pos, "\n");
  1687. if (os_snprintf_error(end - pos, ret))
  1688. return start - buf;
  1689. pos += ret;
  1690. }
  1691. res = rsn_preauth_get_status(wpa_s->wpa, pos, end - pos, verbose);
  1692. if (res >= 0)
  1693. pos += res;
  1694. #ifdef CONFIG_WPS
  1695. {
  1696. char uuid_str[100];
  1697. uuid_bin2str(wpa_s->wps->uuid, uuid_str, sizeof(uuid_str));
  1698. ret = os_snprintf(pos, end - pos, "uuid=%s\n", uuid_str);
  1699. if (os_snprintf_error(end - pos, ret))
  1700. return pos - buf;
  1701. pos += ret;
  1702. }
  1703. #endif /* CONFIG_WPS */
  1704. #ifdef ANDROID
  1705. /*
  1706. * Allow using the STATUS command with default behavior, say for debug,
  1707. * i.e., don't generate a "fake" CONNECTION and SUPPLICANT_STATE_CHANGE
  1708. * events with STATUS-NO_EVENTS.
  1709. */
  1710. if (os_strcmp(params, "-NO_EVENTS")) {
  1711. wpa_msg_ctrl(wpa_s, MSG_INFO, WPA_EVENT_STATE_CHANGE
  1712. "id=%d state=%d BSSID=" MACSTR " SSID=%s",
  1713. wpa_s->current_ssid ? wpa_s->current_ssid->id : -1,
  1714. wpa_s->wpa_state,
  1715. MAC2STR(wpa_s->bssid),
  1716. wpa_s->current_ssid && wpa_s->current_ssid->ssid ?
  1717. wpa_ssid_txt(wpa_s->current_ssid->ssid,
  1718. wpa_s->current_ssid->ssid_len) : "");
  1719. if (wpa_s->wpa_state == WPA_COMPLETED) {
  1720. struct wpa_ssid *ssid = wpa_s->current_ssid;
  1721. wpa_msg_ctrl(wpa_s, MSG_INFO, WPA_EVENT_CONNECTED
  1722. "- connection to " MACSTR
  1723. " completed %s [id=%d id_str=%s]",
  1724. MAC2STR(wpa_s->bssid), "(auth)",
  1725. ssid ? ssid->id : -1,
  1726. ssid && ssid->id_str ? ssid->id_str : "");
  1727. }
  1728. }
  1729. #endif /* ANDROID */
  1730. return pos - buf;
  1731. }
  1732. static int wpa_supplicant_ctrl_iface_bssid(struct wpa_supplicant *wpa_s,
  1733. char *cmd)
  1734. {
  1735. char *pos;
  1736. int id;
  1737. struct wpa_ssid *ssid;
  1738. u8 bssid[ETH_ALEN];
  1739. /* cmd: "<network id> <BSSID>" */
  1740. pos = os_strchr(cmd, ' ');
  1741. if (pos == NULL)
  1742. return -1;
  1743. *pos++ = '\0';
  1744. id = atoi(cmd);
  1745. wpa_printf(MSG_DEBUG, "CTRL_IFACE: id=%d bssid='%s'", id, pos);
  1746. if (hwaddr_aton(pos, bssid)) {
  1747. wpa_printf(MSG_DEBUG ,"CTRL_IFACE: invalid BSSID '%s'", pos);
  1748. return -1;
  1749. }
  1750. ssid = wpa_config_get_network(wpa_s->conf, id);
  1751. if (ssid == NULL) {
  1752. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
  1753. "to update", id);
  1754. return -1;
  1755. }
  1756. os_memcpy(ssid->bssid, bssid, ETH_ALEN);
  1757. ssid->bssid_set = !is_zero_ether_addr(bssid);
  1758. return 0;
  1759. }
  1760. static int wpa_supplicant_ctrl_iface_blacklist(struct wpa_supplicant *wpa_s,
  1761. char *cmd, char *buf,
  1762. size_t buflen)
  1763. {
  1764. u8 bssid[ETH_ALEN];
  1765. struct wpa_blacklist *e;
  1766. char *pos, *end;
  1767. int ret;
  1768. /* cmd: "BLACKLIST [<BSSID>]" */
  1769. if (*cmd == '\0') {
  1770. pos = buf;
  1771. end = buf + buflen;
  1772. e = wpa_s->blacklist;
  1773. while (e) {
  1774. ret = os_snprintf(pos, end - pos, MACSTR "\n",
  1775. MAC2STR(e->bssid));
  1776. if (os_snprintf_error(end - pos, ret))
  1777. return pos - buf;
  1778. pos += ret;
  1779. e = e->next;
  1780. }
  1781. return pos - buf;
  1782. }
  1783. cmd++;
  1784. if (os_strncmp(cmd, "clear", 5) == 0) {
  1785. wpa_blacklist_clear(wpa_s);
  1786. os_memcpy(buf, "OK\n", 3);
  1787. return 3;
  1788. }
  1789. wpa_printf(MSG_DEBUG, "CTRL_IFACE: BLACKLIST bssid='%s'", cmd);
  1790. if (hwaddr_aton(cmd, bssid)) {
  1791. wpa_printf(MSG_DEBUG, "CTRL_IFACE: invalid BSSID '%s'", cmd);
  1792. return -1;
  1793. }
  1794. /*
  1795. * Add the BSSID twice, so its count will be 2, causing it to be
  1796. * skipped when processing scan results.
  1797. */
  1798. ret = wpa_blacklist_add(wpa_s, bssid);
  1799. if (ret < 0)
  1800. return -1;
  1801. ret = wpa_blacklist_add(wpa_s, bssid);
  1802. if (ret < 0)
  1803. return -1;
  1804. os_memcpy(buf, "OK\n", 3);
  1805. return 3;
  1806. }
  1807. static const char * debug_level_str(int level)
  1808. {
  1809. switch (level) {
  1810. case MSG_EXCESSIVE:
  1811. return "EXCESSIVE";
  1812. case MSG_MSGDUMP:
  1813. return "MSGDUMP";
  1814. case MSG_DEBUG:
  1815. return "DEBUG";
  1816. case MSG_INFO:
  1817. return "INFO";
  1818. case MSG_WARNING:
  1819. return "WARNING";
  1820. case MSG_ERROR:
  1821. return "ERROR";
  1822. default:
  1823. return "?";
  1824. }
  1825. }
  1826. static int str_to_debug_level(const char *s)
  1827. {
  1828. if (os_strcasecmp(s, "EXCESSIVE") == 0)
  1829. return MSG_EXCESSIVE;
  1830. if (os_strcasecmp(s, "MSGDUMP") == 0)
  1831. return MSG_MSGDUMP;
  1832. if (os_strcasecmp(s, "DEBUG") == 0)
  1833. return MSG_DEBUG;
  1834. if (os_strcasecmp(s, "INFO") == 0)
  1835. return MSG_INFO;
  1836. if (os_strcasecmp(s, "WARNING") == 0)
  1837. return MSG_WARNING;
  1838. if (os_strcasecmp(s, "ERROR") == 0)
  1839. return MSG_ERROR;
  1840. return -1;
  1841. }
  1842. static int wpa_supplicant_ctrl_iface_log_level(struct wpa_supplicant *wpa_s,
  1843. char *cmd, char *buf,
  1844. size_t buflen)
  1845. {
  1846. char *pos, *end, *stamp;
  1847. int ret;
  1848. /* cmd: "LOG_LEVEL [<level>]" */
  1849. if (*cmd == '\0') {
  1850. pos = buf;
  1851. end = buf + buflen;
  1852. ret = os_snprintf(pos, end - pos, "Current level: %s\n"
  1853. "Timestamp: %d\n",
  1854. debug_level_str(wpa_debug_level),
  1855. wpa_debug_timestamp);
  1856. if (os_snprintf_error(end - pos, ret))
  1857. ret = 0;
  1858. return ret;
  1859. }
  1860. while (*cmd == ' ')
  1861. cmd++;
  1862. stamp = os_strchr(cmd, ' ');
  1863. if (stamp) {
  1864. *stamp++ = '\0';
  1865. while (*stamp == ' ') {
  1866. stamp++;
  1867. }
  1868. }
  1869. if (cmd && os_strlen(cmd)) {
  1870. int level = str_to_debug_level(cmd);
  1871. if (level < 0)
  1872. return -1;
  1873. wpa_debug_level = level;
  1874. }
  1875. if (stamp && os_strlen(stamp))
  1876. wpa_debug_timestamp = atoi(stamp);
  1877. os_memcpy(buf, "OK\n", 3);
  1878. return 3;
  1879. }
  1880. static int wpa_supplicant_ctrl_iface_list_networks(
  1881. struct wpa_supplicant *wpa_s, char *cmd, char *buf, size_t buflen)
  1882. {
  1883. char *pos, *end, *prev;
  1884. struct wpa_ssid *ssid;
  1885. int ret;
  1886. pos = buf;
  1887. end = buf + buflen;
  1888. ret = os_snprintf(pos, end - pos,
  1889. "network id / ssid / bssid / flags\n");
  1890. if (os_snprintf_error(end - pos, ret))
  1891. return pos - buf;
  1892. pos += ret;
  1893. ssid = wpa_s->conf->ssid;
  1894. /* skip over ssids until we find next one */
  1895. if (cmd != NULL && os_strncmp(cmd, "LAST_ID=", 8) == 0) {
  1896. int last_id = atoi(cmd + 8);
  1897. if (last_id != -1) {
  1898. while (ssid != NULL && ssid->id <= last_id) {
  1899. ssid = ssid->next;
  1900. }
  1901. }
  1902. }
  1903. while (ssid) {
  1904. prev = pos;
  1905. ret = os_snprintf(pos, end - pos, "%d\t%s",
  1906. ssid->id,
  1907. wpa_ssid_txt(ssid->ssid, ssid->ssid_len));
  1908. if (os_snprintf_error(end - pos, ret))
  1909. return prev - buf;
  1910. pos += ret;
  1911. if (ssid->bssid_set) {
  1912. ret = os_snprintf(pos, end - pos, "\t" MACSTR,
  1913. MAC2STR(ssid->bssid));
  1914. } else {
  1915. ret = os_snprintf(pos, end - pos, "\tany");
  1916. }
  1917. if (os_snprintf_error(end - pos, ret))
  1918. return prev - buf;
  1919. pos += ret;
  1920. ret = os_snprintf(pos, end - pos, "\t%s%s%s%s",
  1921. ssid == wpa_s->current_ssid ?
  1922. "[CURRENT]" : "",
  1923. ssid->disabled ? "[DISABLED]" : "",
  1924. ssid->disabled_until.sec ?
  1925. "[TEMP-DISABLED]" : "",
  1926. ssid->disabled == 2 ? "[P2P-PERSISTENT]" :
  1927. "");
  1928. if (os_snprintf_error(end - pos, ret))
  1929. return prev - buf;
  1930. pos += ret;
  1931. ret = os_snprintf(pos, end - pos, "\n");
  1932. if (os_snprintf_error(end - pos, ret))
  1933. return prev - buf;
  1934. pos += ret;
  1935. ssid = ssid->next;
  1936. }
  1937. return pos - buf;
  1938. }
  1939. static char * wpa_supplicant_cipher_txt(char *pos, char *end, int cipher)
  1940. {
  1941. int ret;
  1942. ret = os_snprintf(pos, end - pos, "-");
  1943. if (os_snprintf_error(end - pos, ret))
  1944. return pos;
  1945. pos += ret;
  1946. ret = wpa_write_ciphers(pos, end, cipher, "+");
  1947. if (ret < 0)
  1948. return pos;
  1949. pos += ret;
  1950. return pos;
  1951. }
  1952. static char * wpa_supplicant_ie_txt(char *pos, char *end, const char *proto,
  1953. const u8 *ie, size_t ie_len)
  1954. {
  1955. struct wpa_ie_data data;
  1956. char *start;
  1957. int ret;
  1958. ret = os_snprintf(pos, end - pos, "[%s-", proto);
  1959. if (os_snprintf_error(end - pos, ret))
  1960. return pos;
  1961. pos += ret;
  1962. if (wpa_parse_wpa_ie(ie, ie_len, &data) < 0) {
  1963. ret = os_snprintf(pos, end - pos, "?]");
  1964. if (os_snprintf_error(end - pos, ret))
  1965. return pos;
  1966. pos += ret;
  1967. return pos;
  1968. }
  1969. start = pos;
  1970. if (data.key_mgmt & WPA_KEY_MGMT_IEEE8021X) {
  1971. ret = os_snprintf(pos, end - pos, "%sEAP",
  1972. pos == start ? "" : "+");
  1973. if (os_snprintf_error(end - pos, ret))
  1974. return pos;
  1975. pos += ret;
  1976. }
  1977. if (data.key_mgmt & WPA_KEY_MGMT_PSK) {
  1978. ret = os_snprintf(pos, end - pos, "%sPSK",
  1979. pos == start ? "" : "+");
  1980. if (os_snprintf_error(end - pos, ret))
  1981. return pos;
  1982. pos += ret;
  1983. }
  1984. if (data.key_mgmt & WPA_KEY_MGMT_WPA_NONE) {
  1985. ret = os_snprintf(pos, end - pos, "%sNone",
  1986. pos == start ? "" : "+");
  1987. if (os_snprintf_error(end - pos, ret))
  1988. return pos;
  1989. pos += ret;
  1990. }
  1991. if (data.key_mgmt & WPA_KEY_MGMT_SAE) {
  1992. ret = os_snprintf(pos, end - pos, "%sSAE",
  1993. pos == start ? "" : "+");
  1994. if (os_snprintf_error(end - pos, ret))
  1995. return pos;
  1996. pos += ret;
  1997. }
  1998. #ifdef CONFIG_IEEE80211R
  1999. if (data.key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X) {
  2000. ret = os_snprintf(pos, end - pos, "%sFT/EAP",
  2001. pos == start ? "" : "+");
  2002. if (os_snprintf_error(end - pos, ret))
  2003. return pos;
  2004. pos += ret;
  2005. }
  2006. if (data.key_mgmt & WPA_KEY_MGMT_FT_PSK) {
  2007. ret = os_snprintf(pos, end - pos, "%sFT/PSK",
  2008. pos == start ? "" : "+");
  2009. if (os_snprintf_error(end - pos, ret))
  2010. return pos;
  2011. pos += ret;
  2012. }
  2013. if (data.key_mgmt & WPA_KEY_MGMT_FT_SAE) {
  2014. ret = os_snprintf(pos, end - pos, "%sFT/SAE",
  2015. pos == start ? "" : "+");
  2016. if (os_snprintf_error(end - pos, ret))
  2017. return pos;
  2018. pos += ret;
  2019. }
  2020. #endif /* CONFIG_IEEE80211R */
  2021. #ifdef CONFIG_IEEE80211W
  2022. if (data.key_mgmt & WPA_KEY_MGMT_IEEE8021X_SHA256) {
  2023. ret = os_snprintf(pos, end - pos, "%sEAP-SHA256",
  2024. pos == start ? "" : "+");
  2025. if (os_snprintf_error(end - pos, ret))
  2026. return pos;
  2027. pos += ret;
  2028. }
  2029. if (data.key_mgmt & WPA_KEY_MGMT_PSK_SHA256) {
  2030. ret = os_snprintf(pos, end - pos, "%sPSK-SHA256",
  2031. pos == start ? "" : "+");
  2032. if (os_snprintf_error(end - pos, ret))
  2033. return pos;
  2034. pos += ret;
  2035. }
  2036. #endif /* CONFIG_IEEE80211W */
  2037. #ifdef CONFIG_SUITEB
  2038. if (data.key_mgmt & WPA_KEY_MGMT_IEEE8021X_SUITE_B) {
  2039. ret = os_snprintf(pos, end - pos, "%sEAP-SUITE-B",
  2040. pos == start ? "" : "+");
  2041. if (os_snprintf_error(end - pos, ret))
  2042. return pos;
  2043. pos += ret;
  2044. }
  2045. #endif /* CONFIG_SUITEB */
  2046. #ifdef CONFIG_SUITEB192
  2047. if (data.key_mgmt & WPA_KEY_MGMT_IEEE8021X_SUITE_B_192) {
  2048. ret = os_snprintf(pos, end - pos, "%sEAP-SUITE-B-192",
  2049. pos == start ? "" : "+");
  2050. if (os_snprintf_error(end - pos, ret))
  2051. return pos;
  2052. pos += ret;
  2053. }
  2054. #endif /* CONFIG_SUITEB192 */
  2055. if (data.key_mgmt & WPA_KEY_MGMT_OSEN) {
  2056. ret = os_snprintf(pos, end - pos, "%sOSEN",
  2057. pos == start ? "" : "+");
  2058. if (os_snprintf_error(end - pos, ret))
  2059. return pos;
  2060. pos += ret;
  2061. }
  2062. pos = wpa_supplicant_cipher_txt(pos, end, data.pairwise_cipher);
  2063. if (data.capabilities & WPA_CAPABILITY_PREAUTH) {
  2064. ret = os_snprintf(pos, end - pos, "-preauth");
  2065. if (os_snprintf_error(end - pos, ret))
  2066. return pos;
  2067. pos += ret;
  2068. }
  2069. ret = os_snprintf(pos, end - pos, "]");
  2070. if (os_snprintf_error(end - pos, ret))
  2071. return pos;
  2072. pos += ret;
  2073. return pos;
  2074. }
  2075. #ifdef CONFIG_WPS
  2076. static char * wpa_supplicant_wps_ie_txt_buf(struct wpa_supplicant *wpa_s,
  2077. char *pos, char *end,
  2078. struct wpabuf *wps_ie)
  2079. {
  2080. int ret;
  2081. const char *txt;
  2082. if (wps_ie == NULL)
  2083. return pos;
  2084. if (wps_is_selected_pbc_registrar(wps_ie))
  2085. txt = "[WPS-PBC]";
  2086. else if (wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 0))
  2087. txt = "[WPS-AUTH]";
  2088. else if (wps_is_selected_pin_registrar(wps_ie))
  2089. txt = "[WPS-PIN]";
  2090. else
  2091. txt = "[WPS]";
  2092. ret = os_snprintf(pos, end - pos, "%s", txt);
  2093. if (!os_snprintf_error(end - pos, ret))
  2094. pos += ret;
  2095. wpabuf_free(wps_ie);
  2096. return pos;
  2097. }
  2098. #endif /* CONFIG_WPS */
  2099. static char * wpa_supplicant_wps_ie_txt(struct wpa_supplicant *wpa_s,
  2100. char *pos, char *end,
  2101. const struct wpa_bss *bss)
  2102. {
  2103. #ifdef CONFIG_WPS
  2104. struct wpabuf *wps_ie;
  2105. wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
  2106. return wpa_supplicant_wps_ie_txt_buf(wpa_s, pos, end, wps_ie);
  2107. #else /* CONFIG_WPS */
  2108. return pos;
  2109. #endif /* CONFIG_WPS */
  2110. }
  2111. /* Format one result on one text line into a buffer. */
  2112. static int wpa_supplicant_ctrl_iface_scan_result(
  2113. struct wpa_supplicant *wpa_s,
  2114. const struct wpa_bss *bss, char *buf, size_t buflen)
  2115. {
  2116. char *pos, *end;
  2117. int ret;
  2118. const u8 *ie, *ie2, *osen_ie, *p2p, *mesh;
  2119. mesh = wpa_bss_get_ie(bss, WLAN_EID_MESH_ID);
  2120. p2p = wpa_bss_get_vendor_ie(bss, P2P_IE_VENDOR_TYPE);
  2121. if (!p2p)
  2122. p2p = wpa_bss_get_vendor_ie_beacon(bss, P2P_IE_VENDOR_TYPE);
  2123. if (p2p && bss->ssid_len == P2P_WILDCARD_SSID_LEN &&
  2124. os_memcmp(bss->ssid, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN) ==
  2125. 0)
  2126. return 0; /* Do not show P2P listen discovery results here */
  2127. pos = buf;
  2128. end = buf + buflen;
  2129. ret = os_snprintf(pos, end - pos, MACSTR "\t%d\t%d\t",
  2130. MAC2STR(bss->bssid), bss->freq, bss->level);
  2131. if (os_snprintf_error(end - pos, ret))
  2132. return -1;
  2133. pos += ret;
  2134. ie = wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE);
  2135. if (ie)
  2136. pos = wpa_supplicant_ie_txt(pos, end, "WPA", ie, 2 + ie[1]);
  2137. ie2 = wpa_bss_get_ie(bss, WLAN_EID_RSN);
  2138. if (ie2) {
  2139. pos = wpa_supplicant_ie_txt(pos, end, mesh ? "RSN" : "WPA2",
  2140. ie2, 2 + ie2[1]);
  2141. }
  2142. osen_ie = wpa_bss_get_vendor_ie(bss, OSEN_IE_VENDOR_TYPE);
  2143. if (osen_ie)
  2144. pos = wpa_supplicant_ie_txt(pos, end, "OSEN",
  2145. osen_ie, 2 + osen_ie[1]);
  2146. pos = wpa_supplicant_wps_ie_txt(wpa_s, pos, end, bss);
  2147. if (!ie && !ie2 && !osen_ie && (bss->caps & IEEE80211_CAP_PRIVACY)) {
  2148. ret = os_snprintf(pos, end - pos, "[WEP]");
  2149. if (os_snprintf_error(end - pos, ret))
  2150. return -1;
  2151. pos += ret;
  2152. }
  2153. if (mesh) {
  2154. ret = os_snprintf(pos, end - pos, "[MESH]");
  2155. if (os_snprintf_error(end - pos, ret))
  2156. return -1;
  2157. pos += ret;
  2158. }
  2159. if (bss_is_dmg(bss)) {
  2160. const char *s;
  2161. ret = os_snprintf(pos, end - pos, "[DMG]");
  2162. if (os_snprintf_error(end - pos, ret))
  2163. return -1;
  2164. pos += ret;
  2165. switch (bss->caps & IEEE80211_CAP_DMG_MASK) {
  2166. case IEEE80211_CAP_DMG_IBSS:
  2167. s = "[IBSS]";
  2168. break;
  2169. case IEEE80211_CAP_DMG_AP:
  2170. s = "[ESS]";
  2171. break;
  2172. case IEEE80211_CAP_DMG_PBSS:
  2173. s = "[PBSS]";
  2174. break;
  2175. default:
  2176. s = "";
  2177. break;
  2178. }
  2179. ret = os_snprintf(pos, end - pos, "%s", s);
  2180. if (os_snprintf_error(end - pos, ret))
  2181. return -1;
  2182. pos += ret;
  2183. } else {
  2184. if (bss->caps & IEEE80211_CAP_IBSS) {
  2185. ret = os_snprintf(pos, end - pos, "[IBSS]");
  2186. if (os_snprintf_error(end - pos, ret))
  2187. return -1;
  2188. pos += ret;
  2189. }
  2190. if (bss->caps & IEEE80211_CAP_ESS) {
  2191. ret = os_snprintf(pos, end - pos, "[ESS]");
  2192. if (os_snprintf_error(end - pos, ret))
  2193. return -1;
  2194. pos += ret;
  2195. }
  2196. }
  2197. if (p2p) {
  2198. ret = os_snprintf(pos, end - pos, "[P2P]");
  2199. if (os_snprintf_error(end - pos, ret))
  2200. return -1;
  2201. pos += ret;
  2202. }
  2203. #ifdef CONFIG_HS20
  2204. if (wpa_bss_get_vendor_ie(bss, HS20_IE_VENDOR_TYPE) && ie2) {
  2205. ret = os_snprintf(pos, end - pos, "[HS20]");
  2206. if (os_snprintf_error(end - pos, ret))
  2207. return -1;
  2208. pos += ret;
  2209. }
  2210. #endif /* CONFIG_HS20 */
  2211. ret = os_snprintf(pos, end - pos, "\t%s",
  2212. wpa_ssid_txt(bss->ssid, bss->ssid_len));
  2213. if (os_snprintf_error(end - pos, ret))
  2214. return -1;
  2215. pos += ret;
  2216. ret = os_snprintf(pos, end - pos, "\n");
  2217. if (os_snprintf_error(end - pos, ret))
  2218. return -1;
  2219. pos += ret;
  2220. return pos - buf;
  2221. }
  2222. static int wpa_supplicant_ctrl_iface_scan_results(
  2223. struct wpa_supplicant *wpa_s, char *buf, size_t buflen)
  2224. {
  2225. char *pos, *end;
  2226. struct wpa_bss *bss;
  2227. int ret;
  2228. pos = buf;
  2229. end = buf + buflen;
  2230. ret = os_snprintf(pos, end - pos, "bssid / frequency / signal level / "
  2231. "flags / ssid\n");
  2232. if (os_snprintf_error(end - pos, ret))
  2233. return pos - buf;
  2234. pos += ret;
  2235. dl_list_for_each(bss, &wpa_s->bss_id, struct wpa_bss, list_id) {
  2236. ret = wpa_supplicant_ctrl_iface_scan_result(wpa_s, bss, pos,
  2237. end - pos);
  2238. if (ret < 0 || ret >= end - pos)
  2239. return pos - buf;
  2240. pos += ret;
  2241. }
  2242. return pos - buf;
  2243. }
  2244. #ifdef CONFIG_MESH
  2245. static int wpa_supplicant_ctrl_iface_mesh_interface_add(
  2246. struct wpa_supplicant *wpa_s, char *cmd, char *reply, size_t max_len)
  2247. {
  2248. char *pos, ifname[IFNAMSIZ + 1];
  2249. ifname[0] = '\0';
  2250. pos = os_strstr(cmd, "ifname=");
  2251. if (pos) {
  2252. pos += 7;
  2253. os_strlcpy(ifname, pos, sizeof(ifname));
  2254. }
  2255. if (wpas_mesh_add_interface(wpa_s, ifname, sizeof(ifname)) < 0)
  2256. return -1;
  2257. os_strlcpy(reply, ifname, max_len);
  2258. return os_strlen(ifname);
  2259. }
  2260. static int wpa_supplicant_ctrl_iface_mesh_group_add(
  2261. struct wpa_supplicant *wpa_s, char *cmd)
  2262. {
  2263. int id;
  2264. struct wpa_ssid *ssid;
  2265. id = atoi(cmd);
  2266. wpa_printf(MSG_DEBUG, "CTRL_IFACE: MESH_GROUP_ADD id=%d", id);
  2267. ssid = wpa_config_get_network(wpa_s->conf, id);
  2268. if (ssid == NULL) {
  2269. wpa_printf(MSG_DEBUG,
  2270. "CTRL_IFACE: Could not find network id=%d", id);
  2271. return -1;
  2272. }
  2273. if (ssid->mode != WPAS_MODE_MESH) {
  2274. wpa_printf(MSG_DEBUG,
  2275. "CTRL_IFACE: Cannot use MESH_GROUP_ADD on a non mesh network");
  2276. return -1;
  2277. }
  2278. if (ssid->key_mgmt != WPA_KEY_MGMT_NONE &&
  2279. ssid->key_mgmt != WPA_KEY_MGMT_SAE) {
  2280. wpa_printf(MSG_ERROR,
  2281. "CTRL_IFACE: key_mgmt for mesh network should be open or SAE");
  2282. return -1;
  2283. }
  2284. /*
  2285. * TODO: If necessary write our own group_add function,
  2286. * for now we can reuse select_network
  2287. */
  2288. wpa_supplicant_select_network(wpa_s, ssid);
  2289. return 0;
  2290. }
  2291. static int wpa_supplicant_ctrl_iface_mesh_group_remove(
  2292. struct wpa_supplicant *wpa_s, char *cmd)
  2293. {
  2294. struct wpa_supplicant *orig;
  2295. struct wpa_global *global;
  2296. int found = 0;
  2297. wpa_printf(MSG_DEBUG, "CTRL_IFACE: MESH_GROUP_REMOVE ifname=%s", cmd);
  2298. global = wpa_s->global;
  2299. orig = wpa_s;
  2300. for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
  2301. if (os_strcmp(wpa_s->ifname, cmd) == 0) {
  2302. found = 1;
  2303. break;
  2304. }
  2305. }
  2306. if (!found) {
  2307. wpa_printf(MSG_ERROR,
  2308. "CTRL_IFACE: MESH_GROUP_REMOVE ifname=%s not found",
  2309. cmd);
  2310. return -1;
  2311. }
  2312. if (wpa_s->mesh_if_created && wpa_s == orig) {
  2313. wpa_printf(MSG_ERROR,
  2314. "CTRL_IFACE: MESH_GROUP_REMOVE can't remove itself");
  2315. return -1;
  2316. }
  2317. wpa_s->reassociate = 0;
  2318. wpa_s->disconnected = 1;
  2319. wpa_supplicant_cancel_sched_scan(wpa_s);
  2320. wpa_supplicant_cancel_scan(wpa_s);
  2321. /*
  2322. * TODO: If necessary write our own group_remove function,
  2323. * for now we can reuse deauthenticate
  2324. */
  2325. wpa_supplicant_deauthenticate(wpa_s, WLAN_REASON_DEAUTH_LEAVING);
  2326. if (wpa_s->mesh_if_created)
  2327. wpa_supplicant_remove_iface(global, wpa_s, 0);
  2328. return 0;
  2329. }
  2330. #endif /* CONFIG_MESH */
  2331. static int wpa_supplicant_ctrl_iface_select_network(
  2332. struct wpa_supplicant *wpa_s, char *cmd)
  2333. {
  2334. int id;
  2335. struct wpa_ssid *ssid;
  2336. char *pos;
  2337. /* cmd: "<network id>" or "any" */
  2338. if (os_strncmp(cmd, "any", 3) == 0) {
  2339. wpa_printf(MSG_DEBUG, "CTRL_IFACE: SELECT_NETWORK any");
  2340. ssid = NULL;
  2341. } else {
  2342. id = atoi(cmd);
  2343. wpa_printf(MSG_DEBUG, "CTRL_IFACE: SELECT_NETWORK id=%d", id);
  2344. ssid = wpa_config_get_network(wpa_s->conf, id);
  2345. if (ssid == NULL) {
  2346. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
  2347. "network id=%d", id);
  2348. return -1;
  2349. }
  2350. if (ssid->disabled == 2) {
  2351. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Cannot use "
  2352. "SELECT_NETWORK with persistent P2P group");
  2353. return -1;
  2354. }
  2355. }
  2356. pos = os_strstr(cmd, " freq=");
  2357. if (pos) {
  2358. int *freqs = freq_range_to_channel_list(wpa_s, pos + 6);
  2359. if (freqs) {
  2360. wpa_s->scan_req = MANUAL_SCAN_REQ;
  2361. os_free(wpa_s->manual_scan_freqs);
  2362. wpa_s->manual_scan_freqs = freqs;
  2363. }
  2364. }
  2365. wpa_supplicant_select_network(wpa_s, ssid);
  2366. return 0;
  2367. }
  2368. static int wpa_supplicant_ctrl_iface_enable_network(
  2369. struct wpa_supplicant *wpa_s, char *cmd)
  2370. {
  2371. int id;
  2372. struct wpa_ssid *ssid;
  2373. /* cmd: "<network id>" or "all" */
  2374. if (os_strcmp(cmd, "all") == 0) {
  2375. wpa_printf(MSG_DEBUG, "CTRL_IFACE: ENABLE_NETWORK all");
  2376. ssid = NULL;
  2377. } else {
  2378. id = atoi(cmd);
  2379. wpa_printf(MSG_DEBUG, "CTRL_IFACE: ENABLE_NETWORK id=%d", id);
  2380. ssid = wpa_config_get_network(wpa_s->conf, id);
  2381. if (ssid == NULL) {
  2382. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
  2383. "network id=%d", id);
  2384. return -1;
  2385. }
  2386. if (ssid->disabled == 2) {
  2387. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Cannot use "
  2388. "ENABLE_NETWORK with persistent P2P group");
  2389. return -1;
  2390. }
  2391. if (os_strstr(cmd, " no-connect")) {
  2392. ssid->disabled = 0;
  2393. return 0;
  2394. }
  2395. }
  2396. wpa_supplicant_enable_network(wpa_s, ssid);
  2397. return 0;
  2398. }
  2399. static int wpa_supplicant_ctrl_iface_disable_network(
  2400. struct wpa_supplicant *wpa_s, char *cmd)
  2401. {
  2402. int id;
  2403. struct wpa_ssid *ssid;
  2404. /* cmd: "<network id>" or "all" */
  2405. if (os_strcmp(cmd, "all") == 0) {
  2406. wpa_printf(MSG_DEBUG, "CTRL_IFACE: DISABLE_NETWORK all");
  2407. ssid = NULL;
  2408. } else {
  2409. id = atoi(cmd);
  2410. wpa_printf(MSG_DEBUG, "CTRL_IFACE: DISABLE_NETWORK id=%d", id);
  2411. ssid = wpa_config_get_network(wpa_s->conf, id);
  2412. if (ssid == NULL) {
  2413. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
  2414. "network id=%d", id);
  2415. return -1;
  2416. }
  2417. if (ssid->disabled == 2) {
  2418. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Cannot use "
  2419. "DISABLE_NETWORK with persistent P2P "
  2420. "group");
  2421. return -1;
  2422. }
  2423. }
  2424. wpa_supplicant_disable_network(wpa_s, ssid);
  2425. return 0;
  2426. }
  2427. static int wpa_supplicant_ctrl_iface_add_network(
  2428. struct wpa_supplicant *wpa_s, char *buf, size_t buflen)
  2429. {
  2430. struct wpa_ssid *ssid;
  2431. int ret;
  2432. wpa_printf(MSG_DEBUG, "CTRL_IFACE: ADD_NETWORK");
  2433. ssid = wpa_config_add_network(wpa_s->conf);
  2434. if (ssid == NULL)
  2435. return -1;
  2436. wpas_notify_network_added(wpa_s, ssid);
  2437. ssid->disabled = 1;
  2438. wpa_config_set_network_defaults(ssid);
  2439. ret = os_snprintf(buf, buflen, "%d\n", ssid->id);
  2440. if (os_snprintf_error(buflen, ret))
  2441. return -1;
  2442. return ret;
  2443. }
  2444. static int wpa_supplicant_ctrl_iface_remove_network(
  2445. struct wpa_supplicant *wpa_s, char *cmd)
  2446. {
  2447. int id;
  2448. struct wpa_ssid *ssid;
  2449. int was_disabled;
  2450. /* cmd: "<network id>" or "all" */
  2451. if (os_strcmp(cmd, "all") == 0) {
  2452. wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_NETWORK all");
  2453. if (wpa_s->sched_scanning)
  2454. wpa_supplicant_cancel_sched_scan(wpa_s);
  2455. eapol_sm_invalidate_cached_session(wpa_s->eapol);
  2456. if (wpa_s->current_ssid) {
  2457. #ifdef CONFIG_SME
  2458. wpa_s->sme.prev_bssid_set = 0;
  2459. #endif /* CONFIG_SME */
  2460. wpa_sm_set_config(wpa_s->wpa, NULL);
  2461. eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
  2462. if (wpa_s->wpa_state >= WPA_AUTHENTICATING)
  2463. wpa_s->own_disconnect_req = 1;
  2464. wpa_supplicant_deauthenticate(
  2465. wpa_s, WLAN_REASON_DEAUTH_LEAVING);
  2466. }
  2467. ssid = wpa_s->conf->ssid;
  2468. while (ssid) {
  2469. struct wpa_ssid *remove_ssid = ssid;
  2470. id = ssid->id;
  2471. ssid = ssid->next;
  2472. if (wpa_s->last_ssid == remove_ssid)
  2473. wpa_s->last_ssid = NULL;
  2474. wpas_notify_network_removed(wpa_s, remove_ssid);
  2475. wpa_config_remove_network(wpa_s->conf, id);
  2476. }
  2477. return 0;
  2478. }
  2479. id = atoi(cmd);
  2480. wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_NETWORK id=%d", id);
  2481. ssid = wpa_config_get_network(wpa_s->conf, id);
  2482. if (ssid)
  2483. wpas_notify_network_removed(wpa_s, ssid);
  2484. if (ssid == NULL) {
  2485. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find network "
  2486. "id=%d", id);
  2487. return -1;
  2488. }
  2489. if (wpa_s->last_ssid == ssid)
  2490. wpa_s->last_ssid = NULL;
  2491. if (ssid == wpa_s->current_ssid || wpa_s->current_ssid == NULL) {
  2492. #ifdef CONFIG_SME
  2493. wpa_s->sme.prev_bssid_set = 0;
  2494. #endif /* CONFIG_SME */
  2495. /*
  2496. * Invalidate the EAP session cache if the current or
  2497. * previously used network is removed.
  2498. */
  2499. eapol_sm_invalidate_cached_session(wpa_s->eapol);
  2500. }
  2501. if (ssid == wpa_s->current_ssid) {
  2502. wpa_sm_set_config(wpa_s->wpa, NULL);
  2503. eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
  2504. if (wpa_s->wpa_state >= WPA_AUTHENTICATING)
  2505. wpa_s->own_disconnect_req = 1;
  2506. wpa_supplicant_deauthenticate(wpa_s,
  2507. WLAN_REASON_DEAUTH_LEAVING);
  2508. }
  2509. was_disabled = ssid->disabled;
  2510. if (wpa_config_remove_network(wpa_s->conf, id) < 0) {
  2511. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Not able to remove the "
  2512. "network id=%d", id);
  2513. return -1;
  2514. }
  2515. if (!was_disabled && wpa_s->sched_scanning) {
  2516. wpa_printf(MSG_DEBUG, "Stop ongoing sched_scan to remove "
  2517. "network from filters");
  2518. wpa_supplicant_cancel_sched_scan(wpa_s);
  2519. wpa_supplicant_req_scan(wpa_s, 0, 0);
  2520. }
  2521. return 0;
  2522. }
  2523. static int wpa_supplicant_ctrl_iface_update_network(
  2524. struct wpa_supplicant *wpa_s, struct wpa_ssid *ssid,
  2525. char *name, char *value)
  2526. {
  2527. if (wpa_config_set(ssid, name, value, 0) < 0) {
  2528. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to set network "
  2529. "variable '%s'", name);
  2530. return -1;
  2531. }
  2532. if (os_strcmp(name, "bssid") != 0 &&
  2533. os_strcmp(name, "priority") != 0)
  2534. wpa_sm_pmksa_cache_flush(wpa_s->wpa, ssid);
  2535. if (wpa_s->current_ssid == ssid || wpa_s->current_ssid == NULL) {
  2536. /*
  2537. * Invalidate the EAP session cache if anything in the current
  2538. * or previously used configuration changes.
  2539. */
  2540. eapol_sm_invalidate_cached_session(wpa_s->eapol);
  2541. }
  2542. if ((os_strcmp(name, "psk") == 0 &&
  2543. value[0] == '"' && ssid->ssid_len) ||
  2544. (os_strcmp(name, "ssid") == 0 && ssid->passphrase))
  2545. wpa_config_update_psk(ssid);
  2546. else if (os_strcmp(name, "priority") == 0)
  2547. wpa_config_update_prio_list(wpa_s->conf);
  2548. return 0;
  2549. }
  2550. static int wpa_supplicant_ctrl_iface_set_network(
  2551. struct wpa_supplicant *wpa_s, char *cmd)
  2552. {
  2553. int id, ret, prev_bssid_set, prev_disabled;
  2554. struct wpa_ssid *ssid;
  2555. char *name, *value;
  2556. u8 prev_bssid[ETH_ALEN];
  2557. /* cmd: "<network id> <variable name> <value>" */
  2558. name = os_strchr(cmd, ' ');
  2559. if (name == NULL)
  2560. return -1;
  2561. *name++ = '\0';
  2562. value = os_strchr(name, ' ');
  2563. if (value == NULL)
  2564. return -1;
  2565. *value++ = '\0';
  2566. id = atoi(cmd);
  2567. wpa_printf(MSG_DEBUG, "CTRL_IFACE: SET_NETWORK id=%d name='%s'",
  2568. id, name);
  2569. wpa_hexdump_ascii_key(MSG_DEBUG, "CTRL_IFACE: value",
  2570. (u8 *) value, os_strlen(value));
  2571. ssid = wpa_config_get_network(wpa_s->conf, id);
  2572. if (ssid == NULL) {
  2573. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find network "
  2574. "id=%d", id);
  2575. return -1;
  2576. }
  2577. prev_bssid_set = ssid->bssid_set;
  2578. prev_disabled = ssid->disabled;
  2579. os_memcpy(prev_bssid, ssid->bssid, ETH_ALEN);
  2580. ret = wpa_supplicant_ctrl_iface_update_network(wpa_s, ssid, name,
  2581. value);
  2582. if (ret == 0 &&
  2583. (ssid->bssid_set != prev_bssid_set ||
  2584. os_memcmp(ssid->bssid, prev_bssid, ETH_ALEN) != 0))
  2585. wpas_notify_network_bssid_set_changed(wpa_s, ssid);
  2586. if (prev_disabled != ssid->disabled &&
  2587. (prev_disabled == 2 || ssid->disabled == 2))
  2588. wpas_notify_network_type_changed(wpa_s, ssid);
  2589. return ret;
  2590. }
  2591. static int wpa_supplicant_ctrl_iface_get_network(
  2592. struct wpa_supplicant *wpa_s, char *cmd, char *buf, size_t buflen)
  2593. {
  2594. int id;
  2595. size_t res;
  2596. struct wpa_ssid *ssid;
  2597. char *name, *value;
  2598. /* cmd: "<network id> <variable name>" */
  2599. name = os_strchr(cmd, ' ');
  2600. if (name == NULL || buflen == 0)
  2601. return -1;
  2602. *name++ = '\0';
  2603. id = atoi(cmd);
  2604. wpa_printf(MSG_DEBUG, "CTRL_IFACE: GET_NETWORK id=%d name='%s'",
  2605. id, name);
  2606. ssid = wpa_config_get_network(wpa_s->conf, id);
  2607. if (ssid == NULL) {
  2608. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find network "
  2609. "id=%d", id);
  2610. return -1;
  2611. }
  2612. value = wpa_config_get_no_key(ssid, name);
  2613. if (value == NULL) {
  2614. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to get network "
  2615. "variable '%s'", name);
  2616. return -1;
  2617. }
  2618. res = os_strlcpy(buf, value, buflen);
  2619. if (res >= buflen) {
  2620. os_free(value);
  2621. return -1;
  2622. }
  2623. os_free(value);
  2624. return res;
  2625. }
  2626. static int wpa_supplicant_ctrl_iface_dup_network(
  2627. struct wpa_supplicant *wpa_s, char *cmd)
  2628. {
  2629. struct wpa_ssid *ssid_s, *ssid_d;
  2630. char *name, *id, *value;
  2631. int id_s, id_d, ret;
  2632. /* cmd: "<src network id> <dst network id> <variable name>" */
  2633. id = os_strchr(cmd, ' ');
  2634. if (id == NULL)
  2635. return -1;
  2636. *id++ = '\0';
  2637. name = os_strchr(id, ' ');
  2638. if (name == NULL)
  2639. return -1;
  2640. *name++ = '\0';
  2641. id_s = atoi(cmd);
  2642. id_d = atoi(id);
  2643. wpa_printf(MSG_DEBUG, "CTRL_IFACE: DUP_NETWORK id=%d -> %d name='%s'",
  2644. id_s, id_d, name);
  2645. ssid_s = wpa_config_get_network(wpa_s->conf, id_s);
  2646. if (ssid_s == NULL) {
  2647. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
  2648. "network id=%d", id_s);
  2649. return -1;
  2650. }
  2651. ssid_d = wpa_config_get_network(wpa_s->conf, id_d);
  2652. if (ssid_d == NULL) {
  2653. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
  2654. "network id=%d", id_d);
  2655. return -1;
  2656. }
  2657. value = wpa_config_get(ssid_s, name);
  2658. if (value == NULL) {
  2659. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to get network "
  2660. "variable '%s'", name);
  2661. return -1;
  2662. }
  2663. ret = wpa_supplicant_ctrl_iface_update_network(wpa_s, ssid_d, name,
  2664. value);
  2665. os_free(value);
  2666. return ret;
  2667. }
  2668. static int wpa_supplicant_ctrl_iface_list_creds(struct wpa_supplicant *wpa_s,
  2669. char *buf, size_t buflen)
  2670. {
  2671. char *pos, *end;
  2672. struct wpa_cred *cred;
  2673. int ret;
  2674. pos = buf;
  2675. end = buf + buflen;
  2676. ret = os_snprintf(pos, end - pos,
  2677. "cred id / realm / username / domain / imsi\n");
  2678. if (os_snprintf_error(end - pos, ret))
  2679. return pos - buf;
  2680. pos += ret;
  2681. cred = wpa_s->conf->cred;
  2682. while (cred) {
  2683. ret = os_snprintf(pos, end - pos, "%d\t%s\t%s\t%s\t%s\n",
  2684. cred->id, cred->realm ? cred->realm : "",
  2685. cred->username ? cred->username : "",
  2686. cred->domain ? cred->domain[0] : "",
  2687. cred->imsi ? cred->imsi : "");
  2688. if (os_snprintf_error(end - pos, ret))
  2689. return pos - buf;
  2690. pos += ret;
  2691. cred = cred->next;
  2692. }
  2693. return pos - buf;
  2694. }
  2695. static int wpa_supplicant_ctrl_iface_add_cred(struct wpa_supplicant *wpa_s,
  2696. char *buf, size_t buflen)
  2697. {
  2698. struct wpa_cred *cred;
  2699. int ret;
  2700. wpa_printf(MSG_DEBUG, "CTRL_IFACE: ADD_CRED");
  2701. cred = wpa_config_add_cred(wpa_s->conf);
  2702. if (cred == NULL)
  2703. return -1;
  2704. wpa_msg(wpa_s, MSG_INFO, CRED_ADDED "%d", cred->id);
  2705. ret = os_snprintf(buf, buflen, "%d\n", cred->id);
  2706. if (os_snprintf_error(buflen, ret))
  2707. return -1;
  2708. return ret;
  2709. }
  2710. static int wpas_ctrl_remove_cred(struct wpa_supplicant *wpa_s,
  2711. struct wpa_cred *cred)
  2712. {
  2713. struct wpa_ssid *ssid;
  2714. char str[20];
  2715. int id;
  2716. if (cred == NULL) {
  2717. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find cred");
  2718. return -1;
  2719. }
  2720. id = cred->id;
  2721. if (wpa_config_remove_cred(wpa_s->conf, id) < 0) {
  2722. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find cred");
  2723. return -1;
  2724. }
  2725. wpa_msg(wpa_s, MSG_INFO, CRED_REMOVED "%d", id);
  2726. /* Remove any network entry created based on the removed credential */
  2727. ssid = wpa_s->conf->ssid;
  2728. while (ssid) {
  2729. if (ssid->parent_cred == cred) {
  2730. int res;
  2731. wpa_printf(MSG_DEBUG, "Remove network id %d since it "
  2732. "used the removed credential", ssid->id);
  2733. res = os_snprintf(str, sizeof(str), "%d", ssid->id);
  2734. if (os_snprintf_error(sizeof(str), res))
  2735. str[sizeof(str) - 1] = '\0';
  2736. ssid = ssid->next;
  2737. wpa_supplicant_ctrl_iface_remove_network(wpa_s, str);
  2738. } else
  2739. ssid = ssid->next;
  2740. }
  2741. return 0;
  2742. }
  2743. static int wpa_supplicant_ctrl_iface_remove_cred(struct wpa_supplicant *wpa_s,
  2744. char *cmd)
  2745. {
  2746. int id;
  2747. struct wpa_cred *cred, *prev;
  2748. /* cmd: "<cred id>", "all", "sp_fqdn=<FQDN>", or
  2749. * "provisioning_sp=<FQDN> */
  2750. if (os_strcmp(cmd, "all") == 0) {
  2751. wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_CRED all");
  2752. cred = wpa_s->conf->cred;
  2753. while (cred) {
  2754. prev = cred;
  2755. cred = cred->next;
  2756. wpas_ctrl_remove_cred(wpa_s, prev);
  2757. }
  2758. return 0;
  2759. }
  2760. if (os_strncmp(cmd, "sp_fqdn=", 8) == 0) {
  2761. wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_CRED SP FQDN '%s'",
  2762. cmd + 8);
  2763. cred = wpa_s->conf->cred;
  2764. while (cred) {
  2765. prev = cred;
  2766. cred = cred->next;
  2767. if (prev->domain) {
  2768. size_t i;
  2769. for (i = 0; i < prev->num_domain; i++) {
  2770. if (os_strcmp(prev->domain[i], cmd + 8)
  2771. != 0)
  2772. continue;
  2773. wpas_ctrl_remove_cred(wpa_s, prev);
  2774. break;
  2775. }
  2776. }
  2777. }
  2778. return 0;
  2779. }
  2780. if (os_strncmp(cmd, "provisioning_sp=", 16) == 0) {
  2781. wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_CRED provisioning SP FQDN '%s'",
  2782. cmd + 16);
  2783. cred = wpa_s->conf->cred;
  2784. while (cred) {
  2785. prev = cred;
  2786. cred = cred->next;
  2787. if (prev->provisioning_sp &&
  2788. os_strcmp(prev->provisioning_sp, cmd + 16) == 0)
  2789. wpas_ctrl_remove_cred(wpa_s, prev);
  2790. }
  2791. return 0;
  2792. }
  2793. id = atoi(cmd);
  2794. wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_CRED id=%d", id);
  2795. cred = wpa_config_get_cred(wpa_s->conf, id);
  2796. return wpas_ctrl_remove_cred(wpa_s, cred);
  2797. }
  2798. static int wpa_supplicant_ctrl_iface_set_cred(struct wpa_supplicant *wpa_s,
  2799. char *cmd)
  2800. {
  2801. int id;
  2802. struct wpa_cred *cred;
  2803. char *name, *value;
  2804. /* cmd: "<cred id> <variable name> <value>" */
  2805. name = os_strchr(cmd, ' ');
  2806. if (name == NULL)
  2807. return -1;
  2808. *name++ = '\0';
  2809. value = os_strchr(name, ' ');
  2810. if (value == NULL)
  2811. return -1;
  2812. *value++ = '\0';
  2813. id = atoi(cmd);
  2814. wpa_printf(MSG_DEBUG, "CTRL_IFACE: SET_CRED id=%d name='%s'",
  2815. id, name);
  2816. wpa_hexdump_ascii_key(MSG_DEBUG, "CTRL_IFACE: value",
  2817. (u8 *) value, os_strlen(value));
  2818. cred = wpa_config_get_cred(wpa_s->conf, id);
  2819. if (cred == NULL) {
  2820. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find cred id=%d",
  2821. id);
  2822. return -1;
  2823. }
  2824. if (wpa_config_set_cred(cred, name, value, 0) < 0) {
  2825. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to set cred "
  2826. "variable '%s'", name);
  2827. return -1;
  2828. }
  2829. wpa_msg(wpa_s, MSG_INFO, CRED_MODIFIED "%d %s", cred->id, name);
  2830. return 0;
  2831. }
  2832. static int wpa_supplicant_ctrl_iface_get_cred(struct wpa_supplicant *wpa_s,
  2833. char *cmd, char *buf,
  2834. size_t buflen)
  2835. {
  2836. int id;
  2837. size_t res;
  2838. struct wpa_cred *cred;
  2839. char *name, *value;
  2840. /* cmd: "<cred id> <variable name>" */
  2841. name = os_strchr(cmd, ' ');
  2842. if (name == NULL)
  2843. return -1;
  2844. *name++ = '\0';
  2845. id = atoi(cmd);
  2846. wpa_printf(MSG_DEBUG, "CTRL_IFACE: GET_CRED id=%d name='%s'",
  2847. id, name);
  2848. cred = wpa_config_get_cred(wpa_s->conf, id);
  2849. if (cred == NULL) {
  2850. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find cred id=%d",
  2851. id);
  2852. return -1;
  2853. }
  2854. value = wpa_config_get_cred_no_key(cred, name);
  2855. if (value == NULL) {
  2856. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to get cred variable '%s'",
  2857. name);
  2858. return -1;
  2859. }
  2860. res = os_strlcpy(buf, value, buflen);
  2861. if (res >= buflen) {
  2862. os_free(value);
  2863. return -1;
  2864. }
  2865. os_free(value);
  2866. return res;
  2867. }
  2868. #ifndef CONFIG_NO_CONFIG_WRITE
  2869. static int wpa_supplicant_ctrl_iface_save_config(struct wpa_supplicant *wpa_s)
  2870. {
  2871. int ret;
  2872. if (!wpa_s->conf->update_config) {
  2873. wpa_printf(MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Not allowed "
  2874. "to update configuration (update_config=0)");
  2875. return -1;
  2876. }
  2877. ret = wpa_config_write(wpa_s->confname, wpa_s->conf);
  2878. if (ret) {
  2879. wpa_printf(MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Failed to "
  2880. "update configuration");
  2881. } else {
  2882. wpa_printf(MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Configuration"
  2883. " updated");
  2884. }
  2885. return ret;
  2886. }
  2887. #endif /* CONFIG_NO_CONFIG_WRITE */
  2888. struct cipher_info {
  2889. unsigned int capa;
  2890. const char *name;
  2891. int group_only;
  2892. };
  2893. static const struct cipher_info ciphers[] = {
  2894. { WPA_DRIVER_CAPA_ENC_CCMP_256, "CCMP-256", 0 },
  2895. { WPA_DRIVER_CAPA_ENC_GCMP_256, "GCMP-256", 0 },
  2896. { WPA_DRIVER_CAPA_ENC_CCMP, "CCMP", 0 },
  2897. { WPA_DRIVER_CAPA_ENC_GCMP, "GCMP", 0 },
  2898. { WPA_DRIVER_CAPA_ENC_TKIP, "TKIP", 0 },
  2899. { WPA_DRIVER_CAPA_KEY_MGMT_WPA_NONE, "NONE", 0 },
  2900. { WPA_DRIVER_CAPA_ENC_WEP104, "WEP104", 1 },
  2901. { WPA_DRIVER_CAPA_ENC_WEP40, "WEP40", 1 }
  2902. };
  2903. static const struct cipher_info ciphers_group_mgmt[] = {
  2904. { WPA_DRIVER_CAPA_ENC_BIP, "AES-128-CMAC", 1 },
  2905. { WPA_DRIVER_CAPA_ENC_BIP_GMAC_128, "BIP-GMAC-128", 1 },
  2906. { WPA_DRIVER_CAPA_ENC_BIP_GMAC_256, "BIP-GMAC-256", 1 },
  2907. { WPA_DRIVER_CAPA_ENC_BIP_CMAC_256, "BIP-CMAC-256", 1 },
  2908. };
  2909. static int ctrl_iface_get_capability_pairwise(int res, char *strict,
  2910. struct wpa_driver_capa *capa,
  2911. char *buf, size_t buflen)
  2912. {
  2913. int ret;
  2914. char *pos, *end;
  2915. size_t len;
  2916. unsigned int i;
  2917. pos = buf;
  2918. end = pos + buflen;
  2919. if (res < 0) {
  2920. if (strict)
  2921. return 0;
  2922. len = os_strlcpy(buf, "CCMP TKIP NONE", buflen);
  2923. if (len >= buflen)
  2924. return -1;
  2925. return len;
  2926. }
  2927. for (i = 0; i < ARRAY_SIZE(ciphers); i++) {
  2928. if (!ciphers[i].group_only && capa->enc & ciphers[i].capa) {
  2929. ret = os_snprintf(pos, end - pos, "%s%s",
  2930. pos == buf ? "" : " ",
  2931. ciphers[i].name);
  2932. if (os_snprintf_error(end - pos, ret))
  2933. return pos - buf;
  2934. pos += ret;
  2935. }
  2936. }
  2937. return pos - buf;
  2938. }
  2939. static int ctrl_iface_get_capability_group(int res, char *strict,
  2940. struct wpa_driver_capa *capa,
  2941. char *buf, size_t buflen)
  2942. {
  2943. int ret;
  2944. char *pos, *end;
  2945. size_t len;
  2946. unsigned int i;
  2947. pos = buf;
  2948. end = pos + buflen;
  2949. if (res < 0) {
  2950. if (strict)
  2951. return 0;
  2952. len = os_strlcpy(buf, "CCMP TKIP WEP104 WEP40", buflen);
  2953. if (len >= buflen)
  2954. return -1;
  2955. return len;
  2956. }
  2957. for (i = 0; i < ARRAY_SIZE(ciphers); i++) {
  2958. if (capa->enc & ciphers[i].capa) {
  2959. ret = os_snprintf(pos, end - pos, "%s%s",
  2960. pos == buf ? "" : " ",
  2961. ciphers[i].name);
  2962. if (os_snprintf_error(end - pos, ret))
  2963. return pos - buf;
  2964. pos += ret;
  2965. }
  2966. }
  2967. return pos - buf;
  2968. }
  2969. static int ctrl_iface_get_capability_group_mgmt(int res, char *strict,
  2970. struct wpa_driver_capa *capa,
  2971. char *buf, size_t buflen)
  2972. {
  2973. int ret;
  2974. char *pos, *end;
  2975. unsigned int i;
  2976. pos = buf;
  2977. end = pos + buflen;
  2978. if (res < 0)
  2979. return 0;
  2980. for (i = 0; i < ARRAY_SIZE(ciphers_group_mgmt); i++) {
  2981. if (capa->enc & ciphers_group_mgmt[i].capa) {
  2982. ret = os_snprintf(pos, end - pos, "%s%s",
  2983. pos == buf ? "" : " ",
  2984. ciphers_group_mgmt[i].name);
  2985. if (os_snprintf_error(end - pos, ret))
  2986. return pos - buf;
  2987. pos += ret;
  2988. }
  2989. }
  2990. return pos - buf;
  2991. }
  2992. static int ctrl_iface_get_capability_key_mgmt(int res, char *strict,
  2993. struct wpa_driver_capa *capa,
  2994. char *buf, size_t buflen)
  2995. {
  2996. int ret;
  2997. char *pos, *end;
  2998. size_t len;
  2999. pos = buf;
  3000. end = pos + buflen;
  3001. if (res < 0) {
  3002. if (strict)
  3003. return 0;
  3004. len = os_strlcpy(buf, "WPA-PSK WPA-EAP IEEE8021X WPA-NONE "
  3005. "NONE", buflen);
  3006. if (len >= buflen)
  3007. return -1;
  3008. return len;
  3009. }
  3010. ret = os_snprintf(pos, end - pos, "NONE IEEE8021X");
  3011. if (os_snprintf_error(end - pos, ret))
  3012. return pos - buf;
  3013. pos += ret;
  3014. if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA |
  3015. WPA_DRIVER_CAPA_KEY_MGMT_WPA2)) {
  3016. ret = os_snprintf(pos, end - pos, " WPA-EAP");
  3017. if (os_snprintf_error(end - pos, ret))
  3018. return pos - buf;
  3019. pos += ret;
  3020. }
  3021. if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA_PSK |
  3022. WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK)) {
  3023. ret = os_snprintf(pos, end - pos, " WPA-PSK");
  3024. if (os_snprintf_error(end - pos, ret))
  3025. return pos - buf;
  3026. pos += ret;
  3027. }
  3028. if (capa->key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_WPA_NONE) {
  3029. ret = os_snprintf(pos, end - pos, " WPA-NONE");
  3030. if (os_snprintf_error(end - pos, ret))
  3031. return pos - buf;
  3032. pos += ret;
  3033. }
  3034. #ifdef CONFIG_SUITEB
  3035. if (capa->key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_SUITE_B) {
  3036. ret = os_snprintf(pos, end - pos, " WPA-EAP-SUITE-B");
  3037. if (os_snprintf_error(end - pos, ret))
  3038. return pos - buf;
  3039. pos += ret;
  3040. }
  3041. #endif /* CONFIG_SUITEB */
  3042. #ifdef CONFIG_SUITEB192
  3043. if (capa->key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_SUITE_B_192) {
  3044. ret = os_snprintf(pos, end - pos, " WPA-EAP-SUITE-B-192");
  3045. if (os_snprintf_error(end - pos, ret))
  3046. return pos - buf;
  3047. pos += ret;
  3048. }
  3049. #endif /* CONFIG_SUITEB192 */
  3050. return pos - buf;
  3051. }
  3052. static int ctrl_iface_get_capability_proto(int res, char *strict,
  3053. struct wpa_driver_capa *capa,
  3054. char *buf, size_t buflen)
  3055. {
  3056. int ret;
  3057. char *pos, *end;
  3058. size_t len;
  3059. pos = buf;
  3060. end = pos + buflen;
  3061. if (res < 0) {
  3062. if (strict)
  3063. return 0;
  3064. len = os_strlcpy(buf, "RSN WPA", buflen);
  3065. if (len >= buflen)
  3066. return -1;
  3067. return len;
  3068. }
  3069. if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA2 |
  3070. WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK)) {
  3071. ret = os_snprintf(pos, end - pos, "%sRSN",
  3072. pos == buf ? "" : " ");
  3073. if (os_snprintf_error(end - pos, ret))
  3074. return pos - buf;
  3075. pos += ret;
  3076. }
  3077. if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA |
  3078. WPA_DRIVER_CAPA_KEY_MGMT_WPA_PSK)) {
  3079. ret = os_snprintf(pos, end - pos, "%sWPA",
  3080. pos == buf ? "" : " ");
  3081. if (os_snprintf_error(end - pos, ret))
  3082. return pos - buf;
  3083. pos += ret;
  3084. }
  3085. return pos - buf;
  3086. }
  3087. static int ctrl_iface_get_capability_auth_alg(struct wpa_supplicant *wpa_s,
  3088. int res, char *strict,
  3089. struct wpa_driver_capa *capa,
  3090. char *buf, size_t buflen)
  3091. {
  3092. int ret;
  3093. char *pos, *end;
  3094. size_t len;
  3095. pos = buf;
  3096. end = pos + buflen;
  3097. if (res < 0) {
  3098. if (strict)
  3099. return 0;
  3100. len = os_strlcpy(buf, "OPEN SHARED LEAP", buflen);
  3101. if (len >= buflen)
  3102. return -1;
  3103. return len;
  3104. }
  3105. if (capa->auth & (WPA_DRIVER_AUTH_OPEN)) {
  3106. ret = os_snprintf(pos, end - pos, "%sOPEN",
  3107. pos == buf ? "" : " ");
  3108. if (os_snprintf_error(end - pos, ret))
  3109. return pos - buf;
  3110. pos += ret;
  3111. }
  3112. if (capa->auth & (WPA_DRIVER_AUTH_SHARED)) {
  3113. ret = os_snprintf(pos, end - pos, "%sSHARED",
  3114. pos == buf ? "" : " ");
  3115. if (os_snprintf_error(end - pos, ret))
  3116. return pos - buf;
  3117. pos += ret;
  3118. }
  3119. if (capa->auth & (WPA_DRIVER_AUTH_LEAP)) {
  3120. ret = os_snprintf(pos, end - pos, "%sLEAP",
  3121. pos == buf ? "" : " ");
  3122. if (os_snprintf_error(end - pos, ret))
  3123. return pos - buf;
  3124. pos += ret;
  3125. }
  3126. #ifdef CONFIG_SAE
  3127. if (wpa_s->drv_flags & WPA_DRIVER_FLAGS_SAE) {
  3128. ret = os_snprintf(pos, end - pos, "%sSAE",
  3129. pos == buf ? "" : " ");
  3130. if (os_snprintf_error(end - pos, ret))
  3131. return pos - buf;
  3132. pos += ret;
  3133. }
  3134. #endif /* CONFIG_SAE */
  3135. return pos - buf;
  3136. }
  3137. static int ctrl_iface_get_capability_modes(int res, char *strict,
  3138. struct wpa_driver_capa *capa,
  3139. char *buf, size_t buflen)
  3140. {
  3141. int ret;
  3142. char *pos, *end;
  3143. size_t len;
  3144. pos = buf;
  3145. end = pos + buflen;
  3146. if (res < 0) {
  3147. if (strict)
  3148. return 0;
  3149. len = os_strlcpy(buf, "IBSS AP", buflen);
  3150. if (len >= buflen)
  3151. return -1;
  3152. return len;
  3153. }
  3154. if (capa->flags & WPA_DRIVER_FLAGS_IBSS) {
  3155. ret = os_snprintf(pos, end - pos, "%sIBSS",
  3156. pos == buf ? "" : " ");
  3157. if (os_snprintf_error(end - pos, ret))
  3158. return pos - buf;
  3159. pos += ret;
  3160. }
  3161. if (capa->flags & WPA_DRIVER_FLAGS_AP) {
  3162. ret = os_snprintf(pos, end - pos, "%sAP",
  3163. pos == buf ? "" : " ");
  3164. if (os_snprintf_error(end - pos, ret))
  3165. return pos - buf;
  3166. pos += ret;
  3167. }
  3168. #ifdef CONFIG_MESH
  3169. if (capa->flags & WPA_DRIVER_FLAGS_MESH) {
  3170. ret = os_snprintf(pos, end - pos, "%sMESH",
  3171. pos == buf ? "" : " ");
  3172. if (os_snprintf_error(end - pos, ret))
  3173. return pos - buf;
  3174. pos += ret;
  3175. }
  3176. #endif /* CONFIG_MESH */
  3177. return pos - buf;
  3178. }
  3179. static int ctrl_iface_get_capability_channels(struct wpa_supplicant *wpa_s,
  3180. char *buf, size_t buflen)
  3181. {
  3182. struct hostapd_channel_data *chnl;
  3183. int ret, i, j;
  3184. char *pos, *end, *hmode;
  3185. pos = buf;
  3186. end = pos + buflen;
  3187. for (j = 0; j < wpa_s->hw.num_modes; j++) {
  3188. switch (wpa_s->hw.modes[j].mode) {
  3189. case HOSTAPD_MODE_IEEE80211B:
  3190. hmode = "B";
  3191. break;
  3192. case HOSTAPD_MODE_IEEE80211G:
  3193. hmode = "G";
  3194. break;
  3195. case HOSTAPD_MODE_IEEE80211A:
  3196. hmode = "A";
  3197. break;
  3198. case HOSTAPD_MODE_IEEE80211AD:
  3199. hmode = "AD";
  3200. break;
  3201. default:
  3202. continue;
  3203. }
  3204. ret = os_snprintf(pos, end - pos, "Mode[%s] Channels:", hmode);
  3205. if (os_snprintf_error(end - pos, ret))
  3206. return pos - buf;
  3207. pos += ret;
  3208. chnl = wpa_s->hw.modes[j].channels;
  3209. for (i = 0; i < wpa_s->hw.modes[j].num_channels; i++) {
  3210. if (chnl[i].flag & HOSTAPD_CHAN_DISABLED)
  3211. continue;
  3212. ret = os_snprintf(pos, end - pos, " %d", chnl[i].chan);
  3213. if (os_snprintf_error(end - pos, ret))
  3214. return pos - buf;
  3215. pos += ret;
  3216. }
  3217. ret = os_snprintf(pos, end - pos, "\n");
  3218. if (os_snprintf_error(end - pos, ret))
  3219. return pos - buf;
  3220. pos += ret;
  3221. }
  3222. return pos - buf;
  3223. }
  3224. static int ctrl_iface_get_capability_freq(struct wpa_supplicant *wpa_s,
  3225. char *buf, size_t buflen)
  3226. {
  3227. struct hostapd_channel_data *chnl;
  3228. int ret, i, j;
  3229. char *pos, *end, *hmode;
  3230. pos = buf;
  3231. end = pos + buflen;
  3232. for (j = 0; j < wpa_s->hw.num_modes; j++) {
  3233. switch (wpa_s->hw.modes[j].mode) {
  3234. case HOSTAPD_MODE_IEEE80211B:
  3235. hmode = "B";
  3236. break;
  3237. case HOSTAPD_MODE_IEEE80211G:
  3238. hmode = "G";
  3239. break;
  3240. case HOSTAPD_MODE_IEEE80211A:
  3241. hmode = "A";
  3242. break;
  3243. case HOSTAPD_MODE_IEEE80211AD:
  3244. hmode = "AD";
  3245. break;
  3246. default:
  3247. continue;
  3248. }
  3249. ret = os_snprintf(pos, end - pos, "Mode[%s] Channels:\n",
  3250. hmode);
  3251. if (os_snprintf_error(end - pos, ret))
  3252. return pos - buf;
  3253. pos += ret;
  3254. chnl = wpa_s->hw.modes[j].channels;
  3255. for (i = 0; i < wpa_s->hw.modes[j].num_channels; i++) {
  3256. if (chnl[i].flag & HOSTAPD_CHAN_DISABLED)
  3257. continue;
  3258. ret = os_snprintf(pos, end - pos, " %d = %d MHz%s%s\n",
  3259. chnl[i].chan, chnl[i].freq,
  3260. chnl[i].flag & HOSTAPD_CHAN_NO_IR ?
  3261. " (NO_IR)" : "",
  3262. chnl[i].flag & HOSTAPD_CHAN_RADAR ?
  3263. " (DFS)" : "");
  3264. if (os_snprintf_error(end - pos, ret))
  3265. return pos - buf;
  3266. pos += ret;
  3267. }
  3268. ret = os_snprintf(pos, end - pos, "\n");
  3269. if (os_snprintf_error(end - pos, ret))
  3270. return pos - buf;
  3271. pos += ret;
  3272. }
  3273. return pos - buf;
  3274. }
  3275. static int wpa_supplicant_ctrl_iface_get_capability(
  3276. struct wpa_supplicant *wpa_s, const char *_field, char *buf,
  3277. size_t buflen)
  3278. {
  3279. struct wpa_driver_capa capa;
  3280. int res;
  3281. char *strict;
  3282. char field[30];
  3283. size_t len;
  3284. /* Determine whether or not strict checking was requested */
  3285. len = os_strlcpy(field, _field, sizeof(field));
  3286. if (len >= sizeof(field))
  3287. return -1;
  3288. strict = os_strchr(field, ' ');
  3289. if (strict != NULL) {
  3290. *strict++ = '\0';
  3291. if (os_strcmp(strict, "strict") != 0)
  3292. return -1;
  3293. }
  3294. wpa_printf(MSG_DEBUG, "CTRL_IFACE: GET_CAPABILITY '%s' %s",
  3295. field, strict ? strict : "");
  3296. if (os_strcmp(field, "eap") == 0) {
  3297. return eap_get_names(buf, buflen);
  3298. }
  3299. res = wpa_drv_get_capa(wpa_s, &capa);
  3300. if (os_strcmp(field, "pairwise") == 0)
  3301. return ctrl_iface_get_capability_pairwise(res, strict, &capa,
  3302. buf, buflen);
  3303. if (os_strcmp(field, "group") == 0)
  3304. return ctrl_iface_get_capability_group(res, strict, &capa,
  3305. buf, buflen);
  3306. if (os_strcmp(field, "group_mgmt") == 0)
  3307. return ctrl_iface_get_capability_group_mgmt(res, strict, &capa,
  3308. buf, buflen);
  3309. if (os_strcmp(field, "key_mgmt") == 0)
  3310. return ctrl_iface_get_capability_key_mgmt(res, strict, &capa,
  3311. buf, buflen);
  3312. if (os_strcmp(field, "proto") == 0)
  3313. return ctrl_iface_get_capability_proto(res, strict, &capa,
  3314. buf, buflen);
  3315. if (os_strcmp(field, "auth_alg") == 0)
  3316. return ctrl_iface_get_capability_auth_alg(wpa_s, res, strict,
  3317. &capa, buf, buflen);
  3318. if (os_strcmp(field, "modes") == 0)
  3319. return ctrl_iface_get_capability_modes(res, strict, &capa,
  3320. buf, buflen);
  3321. if (os_strcmp(field, "channels") == 0)
  3322. return ctrl_iface_get_capability_channels(wpa_s, buf, buflen);
  3323. if (os_strcmp(field, "freq") == 0)
  3324. return ctrl_iface_get_capability_freq(wpa_s, buf, buflen);
  3325. #ifdef CONFIG_TDLS
  3326. if (os_strcmp(field, "tdls") == 0)
  3327. return ctrl_iface_get_capability_tdls(wpa_s, buf, buflen);
  3328. #endif /* CONFIG_TDLS */
  3329. #ifdef CONFIG_ERP
  3330. if (os_strcmp(field, "erp") == 0) {
  3331. res = os_snprintf(buf, buflen, "ERP");
  3332. if (os_snprintf_error(buflen, res))
  3333. return -1;
  3334. return res;
  3335. }
  3336. #endif /* CONFIG_EPR */
  3337. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Unknown GET_CAPABILITY field '%s'",
  3338. field);
  3339. return -1;
  3340. }
  3341. #ifdef CONFIG_INTERWORKING
  3342. static char * anqp_add_hex(char *pos, char *end, const char *title,
  3343. struct wpabuf *data)
  3344. {
  3345. char *start = pos;
  3346. size_t i;
  3347. int ret;
  3348. const u8 *d;
  3349. if (data == NULL)
  3350. return start;
  3351. ret = os_snprintf(pos, end - pos, "%s=", title);
  3352. if (os_snprintf_error(end - pos, ret))
  3353. return start;
  3354. pos += ret;
  3355. d = wpabuf_head_u8(data);
  3356. for (i = 0; i < wpabuf_len(data); i++) {
  3357. ret = os_snprintf(pos, end - pos, "%02x", *d++);
  3358. if (os_snprintf_error(end - pos, ret))
  3359. return start;
  3360. pos += ret;
  3361. }
  3362. ret = os_snprintf(pos, end - pos, "\n");
  3363. if (os_snprintf_error(end - pos, ret))
  3364. return start;
  3365. pos += ret;
  3366. return pos;
  3367. }
  3368. #endif /* CONFIG_INTERWORKING */
  3369. static int print_bss_info(struct wpa_supplicant *wpa_s, struct wpa_bss *bss,
  3370. unsigned long mask, char *buf, size_t buflen)
  3371. {
  3372. size_t i;
  3373. int ret;
  3374. char *pos, *end;
  3375. const u8 *ie, *ie2, *osen_ie;
  3376. pos = buf;
  3377. end = buf + buflen;
  3378. if (mask & WPA_BSS_MASK_ID) {
  3379. ret = os_snprintf(pos, end - pos, "id=%u\n", bss->id);
  3380. if (os_snprintf_error(end - pos, ret))
  3381. return 0;
  3382. pos += ret;
  3383. }
  3384. if (mask & WPA_BSS_MASK_BSSID) {
  3385. ret = os_snprintf(pos, end - pos, "bssid=" MACSTR "\n",
  3386. MAC2STR(bss->bssid));
  3387. if (os_snprintf_error(end - pos, ret))
  3388. return 0;
  3389. pos += ret;
  3390. }
  3391. if (mask & WPA_BSS_MASK_FREQ) {
  3392. ret = os_snprintf(pos, end - pos, "freq=%d\n", bss->freq);
  3393. if (os_snprintf_error(end - pos, ret))
  3394. return 0;
  3395. pos += ret;
  3396. }
  3397. if (mask & WPA_BSS_MASK_BEACON_INT) {
  3398. ret = os_snprintf(pos, end - pos, "beacon_int=%d\n",
  3399. bss->beacon_int);
  3400. if (os_snprintf_error(end - pos, ret))
  3401. return 0;
  3402. pos += ret;
  3403. }
  3404. if (mask & WPA_BSS_MASK_CAPABILITIES) {
  3405. ret = os_snprintf(pos, end - pos, "capabilities=0x%04x\n",
  3406. bss->caps);
  3407. if (os_snprintf_error(end - pos, ret))
  3408. return 0;
  3409. pos += ret;
  3410. }
  3411. if (mask & WPA_BSS_MASK_QUAL) {
  3412. ret = os_snprintf(pos, end - pos, "qual=%d\n", bss->qual);
  3413. if (os_snprintf_error(end - pos, ret))
  3414. return 0;
  3415. pos += ret;
  3416. }
  3417. if (mask & WPA_BSS_MASK_NOISE) {
  3418. ret = os_snprintf(pos, end - pos, "noise=%d\n", bss->noise);
  3419. if (os_snprintf_error(end - pos, ret))
  3420. return 0;
  3421. pos += ret;
  3422. }
  3423. if (mask & WPA_BSS_MASK_LEVEL) {
  3424. ret = os_snprintf(pos, end - pos, "level=%d\n", bss->level);
  3425. if (os_snprintf_error(end - pos, ret))
  3426. return 0;
  3427. pos += ret;
  3428. }
  3429. if (mask & WPA_BSS_MASK_TSF) {
  3430. ret = os_snprintf(pos, end - pos, "tsf=%016llu\n",
  3431. (unsigned long long) bss->tsf);
  3432. if (os_snprintf_error(end - pos, ret))
  3433. return 0;
  3434. pos += ret;
  3435. }
  3436. if (mask & WPA_BSS_MASK_AGE) {
  3437. struct os_reltime now;
  3438. os_get_reltime(&now);
  3439. ret = os_snprintf(pos, end - pos, "age=%d\n",
  3440. (int) (now.sec - bss->last_update.sec));
  3441. if (os_snprintf_error(end - pos, ret))
  3442. return 0;
  3443. pos += ret;
  3444. }
  3445. if (mask & WPA_BSS_MASK_IE) {
  3446. ret = os_snprintf(pos, end - pos, "ie=");
  3447. if (os_snprintf_error(end - pos, ret))
  3448. return 0;
  3449. pos += ret;
  3450. ie = (const u8 *) (bss + 1);
  3451. for (i = 0; i < bss->ie_len; i++) {
  3452. ret = os_snprintf(pos, end - pos, "%02x", *ie++);
  3453. if (os_snprintf_error(end - pos, ret))
  3454. return 0;
  3455. pos += ret;
  3456. }
  3457. ret = os_snprintf(pos, end - pos, "\n");
  3458. if (os_snprintf_error(end - pos, ret))
  3459. return 0;
  3460. pos += ret;
  3461. }
  3462. if (mask & WPA_BSS_MASK_FLAGS) {
  3463. ret = os_snprintf(pos, end - pos, "flags=");
  3464. if (os_snprintf_error(end - pos, ret))
  3465. return 0;
  3466. pos += ret;
  3467. ie = wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE);
  3468. if (ie)
  3469. pos = wpa_supplicant_ie_txt(pos, end, "WPA", ie,
  3470. 2 + ie[1]);
  3471. ie2 = wpa_bss_get_ie(bss, WLAN_EID_RSN);
  3472. if (ie2)
  3473. pos = wpa_supplicant_ie_txt(pos, end, "WPA2", ie2,
  3474. 2 + ie2[1]);
  3475. osen_ie = wpa_bss_get_vendor_ie(bss, OSEN_IE_VENDOR_TYPE);
  3476. if (osen_ie)
  3477. pos = wpa_supplicant_ie_txt(pos, end, "OSEN",
  3478. osen_ie, 2 + osen_ie[1]);
  3479. pos = wpa_supplicant_wps_ie_txt(wpa_s, pos, end, bss);
  3480. if (!ie && !ie2 && !osen_ie &&
  3481. (bss->caps & IEEE80211_CAP_PRIVACY)) {
  3482. ret = os_snprintf(pos, end - pos, "[WEP]");
  3483. if (os_snprintf_error(end - pos, ret))
  3484. return 0;
  3485. pos += ret;
  3486. }
  3487. if (bss_is_dmg(bss)) {
  3488. const char *s;
  3489. ret = os_snprintf(pos, end - pos, "[DMG]");
  3490. if (os_snprintf_error(end - pos, ret))
  3491. return 0;
  3492. pos += ret;
  3493. switch (bss->caps & IEEE80211_CAP_DMG_MASK) {
  3494. case IEEE80211_CAP_DMG_IBSS:
  3495. s = "[IBSS]";
  3496. break;
  3497. case IEEE80211_CAP_DMG_AP:
  3498. s = "[ESS]";
  3499. break;
  3500. case IEEE80211_CAP_DMG_PBSS:
  3501. s = "[PBSS]";
  3502. break;
  3503. default:
  3504. s = "";
  3505. break;
  3506. }
  3507. ret = os_snprintf(pos, end - pos, "%s", s);
  3508. if (os_snprintf_error(end - pos, ret))
  3509. return 0;
  3510. pos += ret;
  3511. } else {
  3512. if (bss->caps & IEEE80211_CAP_IBSS) {
  3513. ret = os_snprintf(pos, end - pos, "[IBSS]");
  3514. if (os_snprintf_error(end - pos, ret))
  3515. return 0;
  3516. pos += ret;
  3517. }
  3518. if (bss->caps & IEEE80211_CAP_ESS) {
  3519. ret = os_snprintf(pos, end - pos, "[ESS]");
  3520. if (os_snprintf_error(end - pos, ret))
  3521. return 0;
  3522. pos += ret;
  3523. }
  3524. }
  3525. if (wpa_bss_get_vendor_ie(bss, P2P_IE_VENDOR_TYPE) ||
  3526. wpa_bss_get_vendor_ie_beacon(bss, P2P_IE_VENDOR_TYPE)) {
  3527. ret = os_snprintf(pos, end - pos, "[P2P]");
  3528. if (os_snprintf_error(end - pos, ret))
  3529. return 0;
  3530. pos += ret;
  3531. }
  3532. #ifdef CONFIG_HS20
  3533. if (wpa_bss_get_vendor_ie(bss, HS20_IE_VENDOR_TYPE)) {
  3534. ret = os_snprintf(pos, end - pos, "[HS20]");
  3535. if (os_snprintf_error(end - pos, ret))
  3536. return 0;
  3537. pos += ret;
  3538. }
  3539. #endif /* CONFIG_HS20 */
  3540. ret = os_snprintf(pos, end - pos, "\n");
  3541. if (os_snprintf_error(end - pos, ret))
  3542. return 0;
  3543. pos += ret;
  3544. }
  3545. if (mask & WPA_BSS_MASK_SSID) {
  3546. ret = os_snprintf(pos, end - pos, "ssid=%s\n",
  3547. wpa_ssid_txt(bss->ssid, bss->ssid_len));
  3548. if (os_snprintf_error(end - pos, ret))
  3549. return 0;
  3550. pos += ret;
  3551. }
  3552. #ifdef CONFIG_WPS
  3553. if (mask & WPA_BSS_MASK_WPS_SCAN) {
  3554. ie = (const u8 *) (bss + 1);
  3555. ret = wpas_wps_scan_result_text(ie, bss->ie_len, pos, end);
  3556. if (ret < 0 || ret >= end - pos)
  3557. return 0;
  3558. pos += ret;
  3559. }
  3560. #endif /* CONFIG_WPS */
  3561. #ifdef CONFIG_P2P
  3562. if (mask & WPA_BSS_MASK_P2P_SCAN) {
  3563. ie = (const u8 *) (bss + 1);
  3564. ret = wpas_p2p_scan_result_text(ie, bss->ie_len, pos, end);
  3565. if (ret < 0 || ret >= end - pos)
  3566. return 0;
  3567. pos += ret;
  3568. }
  3569. #endif /* CONFIG_P2P */
  3570. #ifdef CONFIG_WIFI_DISPLAY
  3571. if (mask & WPA_BSS_MASK_WIFI_DISPLAY) {
  3572. struct wpabuf *wfd;
  3573. ie = (const u8 *) (bss + 1);
  3574. wfd = ieee802_11_vendor_ie_concat(ie, bss->ie_len,
  3575. WFD_IE_VENDOR_TYPE);
  3576. if (wfd) {
  3577. ret = os_snprintf(pos, end - pos, "wfd_subelems=");
  3578. if (os_snprintf_error(end - pos, ret)) {
  3579. wpabuf_free(wfd);
  3580. return 0;
  3581. }
  3582. pos += ret;
  3583. pos += wpa_snprintf_hex(pos, end - pos,
  3584. wpabuf_head(wfd),
  3585. wpabuf_len(wfd));
  3586. wpabuf_free(wfd);
  3587. ret = os_snprintf(pos, end - pos, "\n");
  3588. if (os_snprintf_error(end - pos, ret))
  3589. return 0;
  3590. pos += ret;
  3591. }
  3592. }
  3593. #endif /* CONFIG_WIFI_DISPLAY */
  3594. #ifdef CONFIG_INTERWORKING
  3595. if ((mask & WPA_BSS_MASK_INTERNETW) && bss->anqp) {
  3596. struct wpa_bss_anqp *anqp = bss->anqp;
  3597. pos = anqp_add_hex(pos, end, "anqp_capability_list",
  3598. anqp->capability_list);
  3599. pos = anqp_add_hex(pos, end, "anqp_venue_name",
  3600. anqp->venue_name);
  3601. pos = anqp_add_hex(pos, end, "anqp_network_auth_type",
  3602. anqp->network_auth_type);
  3603. pos = anqp_add_hex(pos, end, "anqp_roaming_consortium",
  3604. anqp->roaming_consortium);
  3605. pos = anqp_add_hex(pos, end, "anqp_ip_addr_type_availability",
  3606. anqp->ip_addr_type_availability);
  3607. pos = anqp_add_hex(pos, end, "anqp_nai_realm",
  3608. anqp->nai_realm);
  3609. pos = anqp_add_hex(pos, end, "anqp_3gpp", anqp->anqp_3gpp);
  3610. pos = anqp_add_hex(pos, end, "anqp_domain_name",
  3611. anqp->domain_name);
  3612. #ifdef CONFIG_HS20
  3613. pos = anqp_add_hex(pos, end, "hs20_capability_list",
  3614. anqp->hs20_capability_list);
  3615. pos = anqp_add_hex(pos, end, "hs20_operator_friendly_name",
  3616. anqp->hs20_operator_friendly_name);
  3617. pos = anqp_add_hex(pos, end, "hs20_wan_metrics",
  3618. anqp->hs20_wan_metrics);
  3619. pos = anqp_add_hex(pos, end, "hs20_connection_capability",
  3620. anqp->hs20_connection_capability);
  3621. pos = anqp_add_hex(pos, end, "hs20_operating_class",
  3622. anqp->hs20_operating_class);
  3623. pos = anqp_add_hex(pos, end, "hs20_osu_providers_list",
  3624. anqp->hs20_osu_providers_list);
  3625. #endif /* CONFIG_HS20 */
  3626. }
  3627. #endif /* CONFIG_INTERWORKING */
  3628. #ifdef CONFIG_MESH
  3629. if (mask & WPA_BSS_MASK_MESH_SCAN) {
  3630. ie = (const u8 *) (bss + 1);
  3631. ret = wpas_mesh_scan_result_text(ie, bss->ie_len, pos, end);
  3632. if (ret < 0 || ret >= end - pos)
  3633. return 0;
  3634. pos += ret;
  3635. }
  3636. #endif /* CONFIG_MESH */
  3637. if (mask & WPA_BSS_MASK_SNR) {
  3638. ret = os_snprintf(pos, end - pos, "snr=%d\n", bss->snr);
  3639. if (os_snprintf_error(end - pos, ret))
  3640. return 0;
  3641. pos += ret;
  3642. }
  3643. if (mask & WPA_BSS_MASK_EST_THROUGHPUT) {
  3644. ret = os_snprintf(pos, end - pos, "est_throughput=%d\n",
  3645. bss->est_throughput);
  3646. if (os_snprintf_error(end - pos, ret))
  3647. return 0;
  3648. pos += ret;
  3649. }
  3650. if (mask & WPA_BSS_MASK_DELIM) {
  3651. ret = os_snprintf(pos, end - pos, "====\n");
  3652. if (os_snprintf_error(end - pos, ret))
  3653. return 0;
  3654. pos += ret;
  3655. }
  3656. return pos - buf;
  3657. }
  3658. static int wpa_supplicant_ctrl_iface_bss(struct wpa_supplicant *wpa_s,
  3659. const char *cmd, char *buf,
  3660. size_t buflen)
  3661. {
  3662. u8 bssid[ETH_ALEN];
  3663. size_t i;
  3664. struct wpa_bss *bss;
  3665. struct wpa_bss *bsslast = NULL;
  3666. struct dl_list *next;
  3667. int ret = 0;
  3668. int len;
  3669. char *ctmp, *end = buf + buflen;
  3670. unsigned long mask = WPA_BSS_MASK_ALL;
  3671. if (os_strncmp(cmd, "RANGE=", 6) == 0) {
  3672. if (os_strncmp(cmd + 6, "ALL", 3) == 0) {
  3673. bss = dl_list_first(&wpa_s->bss_id, struct wpa_bss,
  3674. list_id);
  3675. bsslast = dl_list_last(&wpa_s->bss_id, struct wpa_bss,
  3676. list_id);
  3677. } else { /* N1-N2 */
  3678. unsigned int id1, id2;
  3679. if ((ctmp = os_strchr(cmd + 6, '-')) == NULL) {
  3680. wpa_printf(MSG_INFO, "Wrong BSS range "
  3681. "format");
  3682. return 0;
  3683. }
  3684. if (*(cmd + 6) == '-')
  3685. id1 = 0;
  3686. else
  3687. id1 = atoi(cmd + 6);
  3688. ctmp++;
  3689. if (*ctmp >= '0' && *ctmp <= '9')
  3690. id2 = atoi(ctmp);
  3691. else
  3692. id2 = (unsigned int) -1;
  3693. bss = wpa_bss_get_id_range(wpa_s, id1, id2);
  3694. if (id2 == (unsigned int) -1)
  3695. bsslast = dl_list_last(&wpa_s->bss_id,
  3696. struct wpa_bss,
  3697. list_id);
  3698. else {
  3699. bsslast = wpa_bss_get_id(wpa_s, id2);
  3700. if (bsslast == NULL && bss && id2 > id1) {
  3701. struct wpa_bss *tmp = bss;
  3702. for (;;) {
  3703. next = tmp->list_id.next;
  3704. if (next == &wpa_s->bss_id)
  3705. break;
  3706. tmp = dl_list_entry(
  3707. next, struct wpa_bss,
  3708. list_id);
  3709. if (tmp->id > id2)
  3710. break;
  3711. bsslast = tmp;
  3712. }
  3713. }
  3714. }
  3715. }
  3716. } else if (os_strncmp(cmd, "FIRST", 5) == 0)
  3717. bss = dl_list_first(&wpa_s->bss_id, struct wpa_bss, list_id);
  3718. else if (os_strncmp(cmd, "LAST", 4) == 0)
  3719. bss = dl_list_last(&wpa_s->bss_id, struct wpa_bss, list_id);
  3720. else if (os_strncmp(cmd, "ID-", 3) == 0) {
  3721. i = atoi(cmd + 3);
  3722. bss = wpa_bss_get_id(wpa_s, i);
  3723. } else if (os_strncmp(cmd, "NEXT-", 5) == 0) {
  3724. i = atoi(cmd + 5);
  3725. bss = wpa_bss_get_id(wpa_s, i);
  3726. if (bss) {
  3727. next = bss->list_id.next;
  3728. if (next == &wpa_s->bss_id)
  3729. bss = NULL;
  3730. else
  3731. bss = dl_list_entry(next, struct wpa_bss,
  3732. list_id);
  3733. }
  3734. #ifdef CONFIG_P2P
  3735. } else if (os_strncmp(cmd, "p2p_dev_addr=", 13) == 0) {
  3736. if (hwaddr_aton(cmd + 13, bssid) == 0)
  3737. bss = wpa_bss_get_p2p_dev_addr(wpa_s, bssid);
  3738. else
  3739. bss = NULL;
  3740. #endif /* CONFIG_P2P */
  3741. } else if (hwaddr_aton(cmd, bssid) == 0)
  3742. bss = wpa_bss_get_bssid(wpa_s, bssid);
  3743. else {
  3744. struct wpa_bss *tmp;
  3745. i = atoi(cmd);
  3746. bss = NULL;
  3747. dl_list_for_each(tmp, &wpa_s->bss_id, struct wpa_bss, list_id)
  3748. {
  3749. if (i-- == 0) {
  3750. bss = tmp;
  3751. break;
  3752. }
  3753. }
  3754. }
  3755. if ((ctmp = os_strstr(cmd, "MASK=")) != NULL) {
  3756. mask = strtoul(ctmp + 5, NULL, 0x10);
  3757. if (mask == 0)
  3758. mask = WPA_BSS_MASK_ALL;
  3759. }
  3760. if (bss == NULL)
  3761. return 0;
  3762. if (bsslast == NULL)
  3763. bsslast = bss;
  3764. do {
  3765. len = print_bss_info(wpa_s, bss, mask, buf, buflen);
  3766. ret += len;
  3767. buf += len;
  3768. buflen -= len;
  3769. if (bss == bsslast) {
  3770. if ((mask & WPA_BSS_MASK_DELIM) && len &&
  3771. (bss == dl_list_last(&wpa_s->bss_id,
  3772. struct wpa_bss, list_id))) {
  3773. int res;
  3774. res = os_snprintf(buf - 5, end - buf + 5,
  3775. "####\n");
  3776. if (os_snprintf_error(end - buf + 5, res)) {
  3777. wpa_printf(MSG_DEBUG,
  3778. "Could not add end delim");
  3779. }
  3780. }
  3781. break;
  3782. }
  3783. next = bss->list_id.next;
  3784. if (next == &wpa_s->bss_id)
  3785. break;
  3786. bss = dl_list_entry(next, struct wpa_bss, list_id);
  3787. } while (bss && len);
  3788. return ret;
  3789. }
  3790. static int wpa_supplicant_ctrl_iface_ap_scan(
  3791. struct wpa_supplicant *wpa_s, char *cmd)
  3792. {
  3793. int ap_scan = atoi(cmd);
  3794. return wpa_supplicant_set_ap_scan(wpa_s, ap_scan);
  3795. }
  3796. static int wpa_supplicant_ctrl_iface_scan_interval(
  3797. struct wpa_supplicant *wpa_s, char *cmd)
  3798. {
  3799. int scan_int = atoi(cmd);
  3800. return wpa_supplicant_set_scan_interval(wpa_s, scan_int);
  3801. }
  3802. static int wpa_supplicant_ctrl_iface_bss_expire_age(
  3803. struct wpa_supplicant *wpa_s, char *cmd)
  3804. {
  3805. int expire_age = atoi(cmd);
  3806. return wpa_supplicant_set_bss_expiration_age(wpa_s, expire_age);
  3807. }
  3808. static int wpa_supplicant_ctrl_iface_bss_expire_count(
  3809. struct wpa_supplicant *wpa_s, char *cmd)
  3810. {
  3811. int expire_count = atoi(cmd);
  3812. return wpa_supplicant_set_bss_expiration_count(wpa_s, expire_count);
  3813. }
  3814. static void wpa_supplicant_ctrl_iface_bss_flush(
  3815. struct wpa_supplicant *wpa_s, char *cmd)
  3816. {
  3817. int flush_age = atoi(cmd);
  3818. if (flush_age == 0)
  3819. wpa_bss_flush(wpa_s);
  3820. else
  3821. wpa_bss_flush_by_age(wpa_s, flush_age);
  3822. }
  3823. #ifdef CONFIG_TESTING_OPTIONS
  3824. static void wpa_supplicant_ctrl_iface_drop_sa(struct wpa_supplicant *wpa_s)
  3825. {
  3826. wpa_printf(MSG_DEBUG, "Dropping SA without deauthentication");
  3827. /* MLME-DELETEKEYS.request */
  3828. wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 0, 0, NULL, 0, NULL, 0);
  3829. wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 1, 0, NULL, 0, NULL, 0);
  3830. wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 2, 0, NULL, 0, NULL, 0);
  3831. wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 3, 0, NULL, 0, NULL, 0);
  3832. #ifdef CONFIG_IEEE80211W
  3833. wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 4, 0, NULL, 0, NULL, 0);
  3834. wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 5, 0, NULL, 0, NULL, 0);
  3835. #endif /* CONFIG_IEEE80211W */
  3836. wpa_drv_set_key(wpa_s, WPA_ALG_NONE, wpa_s->bssid, 0, 0, NULL, 0, NULL,
  3837. 0);
  3838. /* MLME-SETPROTECTION.request(None) */
  3839. wpa_drv_mlme_setprotection(wpa_s, wpa_s->bssid,
  3840. MLME_SETPROTECTION_PROTECT_TYPE_NONE,
  3841. MLME_SETPROTECTION_KEY_TYPE_PAIRWISE);
  3842. wpa_sm_drop_sa(wpa_s->wpa);
  3843. }
  3844. #endif /* CONFIG_TESTING_OPTIONS */
  3845. static int wpa_supplicant_ctrl_iface_roam(struct wpa_supplicant *wpa_s,
  3846. char *addr)
  3847. {
  3848. #ifdef CONFIG_NO_SCAN_PROCESSING
  3849. return -1;
  3850. #else /* CONFIG_NO_SCAN_PROCESSING */
  3851. u8 bssid[ETH_ALEN];
  3852. struct wpa_bss *bss;
  3853. struct wpa_ssid *ssid = wpa_s->current_ssid;
  3854. if (hwaddr_aton(addr, bssid)) {
  3855. wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM: invalid "
  3856. "address '%s'", addr);
  3857. return -1;
  3858. }
  3859. wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM " MACSTR, MAC2STR(bssid));
  3860. if (!ssid) {
  3861. wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM: No network "
  3862. "configuration known for the target AP");
  3863. return -1;
  3864. }
  3865. bss = wpa_bss_get(wpa_s, bssid, ssid->ssid, ssid->ssid_len);
  3866. if (!bss) {
  3867. wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM: Target AP not found "
  3868. "from BSS table");
  3869. return -1;
  3870. }
  3871. /*
  3872. * TODO: Find best network configuration block from configuration to
  3873. * allow roaming to other networks
  3874. */
  3875. wpa_s->reassociate = 1;
  3876. wpa_supplicant_connect(wpa_s, bss, ssid);
  3877. return 0;
  3878. #endif /* CONFIG_NO_SCAN_PROCESSING */
  3879. }
  3880. #ifdef CONFIG_P2P
  3881. static int p2p_ctrl_find(struct wpa_supplicant *wpa_s, char *cmd)
  3882. {
  3883. unsigned int timeout = atoi(cmd);
  3884. enum p2p_discovery_type type = P2P_FIND_START_WITH_FULL;
  3885. u8 dev_id[ETH_ALEN], *_dev_id = NULL;
  3886. u8 dev_type[WPS_DEV_TYPE_LEN], *_dev_type = NULL;
  3887. char *pos;
  3888. unsigned int search_delay;
  3889. const char *_seek[P2P_MAX_QUERY_HASH + 1], **seek = NULL;
  3890. u8 seek_count = 0;
  3891. int freq = 0;
  3892. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED) {
  3893. wpa_dbg(wpa_s, MSG_INFO,
  3894. "Reject P2P_FIND since interface is disabled");
  3895. return -1;
  3896. }
  3897. if (os_strstr(cmd, "type=social"))
  3898. type = P2P_FIND_ONLY_SOCIAL;
  3899. else if (os_strstr(cmd, "type=progressive"))
  3900. type = P2P_FIND_PROGRESSIVE;
  3901. pos = os_strstr(cmd, "dev_id=");
  3902. if (pos) {
  3903. pos += 7;
  3904. if (hwaddr_aton(pos, dev_id))
  3905. return -1;
  3906. _dev_id = dev_id;
  3907. }
  3908. pos = os_strstr(cmd, "dev_type=");
  3909. if (pos) {
  3910. pos += 9;
  3911. if (wps_dev_type_str2bin(pos, dev_type) < 0)
  3912. return -1;
  3913. _dev_type = dev_type;
  3914. }
  3915. pos = os_strstr(cmd, "delay=");
  3916. if (pos) {
  3917. pos += 6;
  3918. search_delay = atoi(pos);
  3919. } else
  3920. search_delay = wpas_p2p_search_delay(wpa_s);
  3921. /* Must be searched for last, because it adds nul termination */
  3922. pos = os_strstr(cmd, " seek=");
  3923. if (pos)
  3924. pos += 6;
  3925. while (pos && seek_count < P2P_MAX_QUERY_HASH + 1) {
  3926. char *term;
  3927. _seek[seek_count++] = pos;
  3928. seek = _seek;
  3929. term = os_strchr(pos, ' ');
  3930. if (!term)
  3931. break;
  3932. *term = '\0';
  3933. pos = os_strstr(term + 1, "seek=");
  3934. if (pos)
  3935. pos += 5;
  3936. }
  3937. if (seek_count > P2P_MAX_QUERY_HASH) {
  3938. seek[0] = NULL;
  3939. seek_count = 1;
  3940. }
  3941. pos = os_strstr(cmd, "freq=");
  3942. if (pos) {
  3943. pos += 5;
  3944. freq = atoi(pos);
  3945. if (freq <= 0)
  3946. return -1;
  3947. }
  3948. return wpas_p2p_find(wpa_s, timeout, type, _dev_type != NULL, _dev_type,
  3949. _dev_id, search_delay, seek_count, seek, freq);
  3950. }
  3951. static struct p2ps_provision * p2p_parse_asp_provision_cmd(const char *cmd)
  3952. {
  3953. struct p2ps_provision *p2ps_prov;
  3954. char *pos;
  3955. size_t info_len = 0;
  3956. char *info = NULL;
  3957. u8 role = P2PS_SETUP_NONE;
  3958. long long unsigned val;
  3959. pos = os_strstr(cmd, "info=");
  3960. if (pos) {
  3961. pos += 5;
  3962. info_len = os_strlen(pos);
  3963. if (info_len) {
  3964. info = os_malloc(info_len + 1);
  3965. if (info) {
  3966. info_len = utf8_unescape(pos, info_len,
  3967. info, info_len + 1);
  3968. } else
  3969. info_len = 0;
  3970. }
  3971. }
  3972. p2ps_prov = os_zalloc(sizeof(struct p2ps_provision) + info_len + 1);
  3973. if (p2ps_prov == NULL) {
  3974. os_free(info);
  3975. return NULL;
  3976. }
  3977. if (info) {
  3978. os_memcpy(p2ps_prov->info, info, info_len);
  3979. p2ps_prov->info[info_len] = '\0';
  3980. os_free(info);
  3981. }
  3982. pos = os_strstr(cmd, "status=");
  3983. if (pos)
  3984. p2ps_prov->status = atoi(pos + 7);
  3985. else
  3986. p2ps_prov->status = -1;
  3987. pos = os_strstr(cmd, "adv_id=");
  3988. if (!pos || sscanf(pos + 7, "%llx", &val) != 1 || val > 0xffffffffULL)
  3989. goto invalid_args;
  3990. p2ps_prov->adv_id = val;
  3991. pos = os_strstr(cmd, "method=");
  3992. if (pos)
  3993. p2ps_prov->method = strtol(pos + 7, NULL, 16);
  3994. else
  3995. p2ps_prov->method = 0;
  3996. pos = os_strstr(cmd, "session=");
  3997. if (!pos || sscanf(pos + 8, "%llx", &val) != 1 || val > 0xffffffffULL)
  3998. goto invalid_args;
  3999. p2ps_prov->session_id = val;
  4000. pos = os_strstr(cmd, "adv_mac=");
  4001. if (!pos || hwaddr_aton(pos + 8, p2ps_prov->adv_mac))
  4002. goto invalid_args;
  4003. pos = os_strstr(cmd, "session_mac=");
  4004. if (!pos || hwaddr_aton(pos + 12, p2ps_prov->session_mac))
  4005. goto invalid_args;
  4006. /* force conncap with tstCap (no sanity checks) */
  4007. pos = os_strstr(cmd, "tstCap=");
  4008. if (pos) {
  4009. role = strtol(pos + 7, NULL, 16);
  4010. } else {
  4011. pos = os_strstr(cmd, "role=");
  4012. if (pos) {
  4013. role = strtol(pos + 5, NULL, 16);
  4014. if (role != P2PS_SETUP_CLIENT &&
  4015. role != P2PS_SETUP_GROUP_OWNER)
  4016. role = P2PS_SETUP_NONE;
  4017. }
  4018. }
  4019. p2ps_prov->role = role;
  4020. return p2ps_prov;
  4021. invalid_args:
  4022. os_free(p2ps_prov);
  4023. return NULL;
  4024. }
  4025. static int p2p_ctrl_asp_provision_resp(struct wpa_supplicant *wpa_s, char *cmd)
  4026. {
  4027. u8 addr[ETH_ALEN];
  4028. struct p2ps_provision *p2ps_prov;
  4029. char *pos;
  4030. /* <addr> id=<adv_id> [role=<conncap>] [info=<infodata>] */
  4031. wpa_printf(MSG_DEBUG, "%s: %s", __func__, cmd);
  4032. if (hwaddr_aton(cmd, addr))
  4033. return -1;
  4034. pos = cmd + 17;
  4035. if (*pos != ' ')
  4036. return -1;
  4037. p2ps_prov = p2p_parse_asp_provision_cmd(pos);
  4038. if (!p2ps_prov)
  4039. return -1;
  4040. if (p2ps_prov->status < 0) {
  4041. os_free(p2ps_prov);
  4042. return -1;
  4043. }
  4044. return wpas_p2p_prov_disc(wpa_s, addr, NULL, WPAS_P2P_PD_FOR_ASP,
  4045. p2ps_prov);
  4046. }
  4047. static int p2p_ctrl_asp_provision(struct wpa_supplicant *wpa_s, char *cmd)
  4048. {
  4049. u8 addr[ETH_ALEN];
  4050. struct p2ps_provision *p2ps_prov;
  4051. char *pos;
  4052. /* <addr> id=<adv_id> adv_mac=<adv_mac> conncap=<conncap>
  4053. * session=<ses_id> mac=<ses_mac> [info=<infodata>]
  4054. */
  4055. wpa_printf(MSG_DEBUG, "%s: %s", __func__, cmd);
  4056. if (hwaddr_aton(cmd, addr))
  4057. return -1;
  4058. pos = cmd + 17;
  4059. if (*pos != ' ')
  4060. return -1;
  4061. p2ps_prov = p2p_parse_asp_provision_cmd(pos);
  4062. if (!p2ps_prov)
  4063. return -1;
  4064. return wpas_p2p_prov_disc(wpa_s, addr, NULL, WPAS_P2P_PD_FOR_ASP,
  4065. p2ps_prov);
  4066. }
  4067. static int p2p_ctrl_connect(struct wpa_supplicant *wpa_s, char *cmd,
  4068. char *buf, size_t buflen)
  4069. {
  4070. u8 addr[ETH_ALEN];
  4071. char *pos, *pos2;
  4072. char *pin = NULL;
  4073. enum p2p_wps_method wps_method;
  4074. int new_pin;
  4075. int ret;
  4076. int persistent_group, persistent_id = -1;
  4077. int join;
  4078. int auth;
  4079. int automatic;
  4080. int go_intent = -1;
  4081. int freq = 0;
  4082. int pd;
  4083. int ht40, vht;
  4084. if (!wpa_s->global->p2p_init_wpa_s)
  4085. return -1;
  4086. if (wpa_s->global->p2p_init_wpa_s != wpa_s) {
  4087. wpa_dbg(wpa_s, MSG_DEBUG, "Direct P2P_CONNECT command to %s",
  4088. wpa_s->global->p2p_init_wpa_s->ifname);
  4089. wpa_s = wpa_s->global->p2p_init_wpa_s;
  4090. }
  4091. /* <addr> <"pbc" | "pin" | PIN> [label|display|keypad|p2ps]
  4092. * [persistent|persistent=<network id>]
  4093. * [join] [auth] [go_intent=<0..15>] [freq=<in MHz>] [provdisc]
  4094. * [ht40] [vht] [auto] */
  4095. if (hwaddr_aton(cmd, addr))
  4096. return -1;
  4097. pos = cmd + 17;
  4098. if (*pos != ' ')
  4099. return -1;
  4100. pos++;
  4101. persistent_group = os_strstr(pos, " persistent") != NULL;
  4102. pos2 = os_strstr(pos, " persistent=");
  4103. if (pos2) {
  4104. struct wpa_ssid *ssid;
  4105. persistent_id = atoi(pos2 + 12);
  4106. ssid = wpa_config_get_network(wpa_s->conf, persistent_id);
  4107. if (ssid == NULL || ssid->disabled != 2 ||
  4108. ssid->mode != WPAS_MODE_P2P_GO) {
  4109. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
  4110. "SSID id=%d for persistent P2P group (GO)",
  4111. persistent_id);
  4112. return -1;
  4113. }
  4114. }
  4115. join = os_strstr(pos, " join") != NULL;
  4116. auth = os_strstr(pos, " auth") != NULL;
  4117. automatic = os_strstr(pos, " auto") != NULL;
  4118. pd = os_strstr(pos, " provdisc") != NULL;
  4119. vht = (os_strstr(cmd, " vht") != NULL) || wpa_s->conf->p2p_go_vht;
  4120. ht40 = (os_strstr(cmd, " ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
  4121. vht;
  4122. pos2 = os_strstr(pos, " go_intent=");
  4123. if (pos2) {
  4124. pos2 += 11;
  4125. go_intent = atoi(pos2);
  4126. if (go_intent < 0 || go_intent > 15)
  4127. return -1;
  4128. }
  4129. pos2 = os_strstr(pos, " freq=");
  4130. if (pos2) {
  4131. pos2 += 6;
  4132. freq = atoi(pos2);
  4133. if (freq <= 0)
  4134. return -1;
  4135. }
  4136. if (os_strncmp(pos, "pin", 3) == 0) {
  4137. /* Request random PIN (to be displayed) and enable the PIN */
  4138. wps_method = WPS_PIN_DISPLAY;
  4139. } else if (os_strncmp(pos, "pbc", 3) == 0) {
  4140. wps_method = WPS_PBC;
  4141. } else {
  4142. pin = pos;
  4143. pos = os_strchr(pin, ' ');
  4144. wps_method = WPS_PIN_KEYPAD;
  4145. if (pos) {
  4146. *pos++ = '\0';
  4147. if (os_strncmp(pos, "display", 7) == 0)
  4148. wps_method = WPS_PIN_DISPLAY;
  4149. else if (os_strncmp(pos, "p2ps", 4) == 0)
  4150. wps_method = WPS_P2PS;
  4151. }
  4152. if (!wps_pin_str_valid(pin)) {
  4153. os_memcpy(buf, "FAIL-INVALID-PIN\n", 17);
  4154. return 17;
  4155. }
  4156. }
  4157. new_pin = wpas_p2p_connect(wpa_s, addr, pin, wps_method,
  4158. persistent_group, automatic, join,
  4159. auth, go_intent, freq, persistent_id, pd,
  4160. ht40, vht);
  4161. if (new_pin == -2) {
  4162. os_memcpy(buf, "FAIL-CHANNEL-UNAVAILABLE\n", 25);
  4163. return 25;
  4164. }
  4165. if (new_pin == -3) {
  4166. os_memcpy(buf, "FAIL-CHANNEL-UNSUPPORTED\n", 25);
  4167. return 25;
  4168. }
  4169. if (new_pin < 0)
  4170. return -1;
  4171. if (wps_method == WPS_PIN_DISPLAY && pin == NULL) {
  4172. ret = os_snprintf(buf, buflen, "%08d", new_pin);
  4173. if (os_snprintf_error(buflen, ret))
  4174. return -1;
  4175. return ret;
  4176. }
  4177. os_memcpy(buf, "OK\n", 3);
  4178. return 3;
  4179. }
  4180. static int p2p_ctrl_listen(struct wpa_supplicant *wpa_s, char *cmd)
  4181. {
  4182. unsigned int timeout = atoi(cmd);
  4183. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED) {
  4184. wpa_dbg(wpa_s, MSG_INFO,
  4185. "Reject P2P_LISTEN since interface is disabled");
  4186. return -1;
  4187. }
  4188. return wpas_p2p_listen(wpa_s, timeout);
  4189. }
  4190. static int p2p_ctrl_prov_disc(struct wpa_supplicant *wpa_s, char *cmd)
  4191. {
  4192. u8 addr[ETH_ALEN];
  4193. char *pos;
  4194. enum wpas_p2p_prov_disc_use use = WPAS_P2P_PD_FOR_GO_NEG;
  4195. /* <addr> <config method> [join|auto] */
  4196. if (hwaddr_aton(cmd, addr))
  4197. return -1;
  4198. pos = cmd + 17;
  4199. if (*pos != ' ')
  4200. return -1;
  4201. pos++;
  4202. if (os_strstr(pos, " join") != NULL)
  4203. use = WPAS_P2P_PD_FOR_JOIN;
  4204. else if (os_strstr(pos, " auto") != NULL)
  4205. use = WPAS_P2P_PD_AUTO;
  4206. return wpas_p2p_prov_disc(wpa_s, addr, pos, use, NULL);
  4207. }
  4208. static int p2p_get_passphrase(struct wpa_supplicant *wpa_s, char *buf,
  4209. size_t buflen)
  4210. {
  4211. struct wpa_ssid *ssid = wpa_s->current_ssid;
  4212. if (ssid == NULL || ssid->mode != WPAS_MODE_P2P_GO ||
  4213. ssid->passphrase == NULL)
  4214. return -1;
  4215. os_strlcpy(buf, ssid->passphrase, buflen);
  4216. return os_strlen(buf);
  4217. }
  4218. static int p2p_ctrl_serv_disc_req(struct wpa_supplicant *wpa_s, char *cmd,
  4219. char *buf, size_t buflen)
  4220. {
  4221. u64 ref;
  4222. int res;
  4223. u8 dst_buf[ETH_ALEN], *dst;
  4224. struct wpabuf *tlvs;
  4225. char *pos;
  4226. size_t len;
  4227. if (hwaddr_aton(cmd, dst_buf))
  4228. return -1;
  4229. dst = dst_buf;
  4230. if (dst[0] == 0 && dst[1] == 0 && dst[2] == 0 &&
  4231. dst[3] == 0 && dst[4] == 0 && dst[5] == 0)
  4232. dst = NULL;
  4233. pos = cmd + 17;
  4234. if (*pos != ' ')
  4235. return -1;
  4236. pos++;
  4237. if (os_strncmp(pos, "upnp ", 5) == 0) {
  4238. u8 version;
  4239. pos += 5;
  4240. if (hexstr2bin(pos, &version, 1) < 0)
  4241. return -1;
  4242. pos += 2;
  4243. if (*pos != ' ')
  4244. return -1;
  4245. pos++;
  4246. ref = wpas_p2p_sd_request_upnp(wpa_s, dst, version, pos);
  4247. #ifdef CONFIG_WIFI_DISPLAY
  4248. } else if (os_strncmp(pos, "wifi-display ", 13) == 0) {
  4249. ref = wpas_p2p_sd_request_wifi_display(wpa_s, dst, pos + 13);
  4250. #endif /* CONFIG_WIFI_DISPLAY */
  4251. } else if (os_strncmp(pos, "asp ", 4) == 0) {
  4252. char *svc_str;
  4253. char *svc_info = NULL;
  4254. u32 id;
  4255. pos += 4;
  4256. if (sscanf(pos, "%x", &id) != 1 || id > 0xff)
  4257. return -1;
  4258. pos = os_strchr(pos, ' ');
  4259. if (pos == NULL || pos[1] == '\0' || pos[1] == ' ')
  4260. return -1;
  4261. svc_str = pos + 1;
  4262. pos = os_strchr(svc_str, ' ');
  4263. if (pos)
  4264. *pos++ = '\0';
  4265. /* All remaining data is the svc_info string */
  4266. if (pos && pos[0] && pos[0] != ' ') {
  4267. len = os_strlen(pos);
  4268. /* Unescape in place */
  4269. len = utf8_unescape(pos, len, pos, len);
  4270. if (len > 0xff)
  4271. return -1;
  4272. svc_info = pos;
  4273. }
  4274. ref = wpas_p2p_sd_request_asp(wpa_s, dst, (u8) id,
  4275. svc_str, svc_info);
  4276. } else {
  4277. len = os_strlen(pos);
  4278. if (len & 1)
  4279. return -1;
  4280. len /= 2;
  4281. tlvs = wpabuf_alloc(len);
  4282. if (tlvs == NULL)
  4283. return -1;
  4284. if (hexstr2bin(pos, wpabuf_put(tlvs, len), len) < 0) {
  4285. wpabuf_free(tlvs);
  4286. return -1;
  4287. }
  4288. ref = wpas_p2p_sd_request(wpa_s, dst, tlvs);
  4289. wpabuf_free(tlvs);
  4290. }
  4291. if (ref == 0)
  4292. return -1;
  4293. res = os_snprintf(buf, buflen, "%llx", (long long unsigned) ref);
  4294. if (os_snprintf_error(buflen, res))
  4295. return -1;
  4296. return res;
  4297. }
  4298. static int p2p_ctrl_serv_disc_cancel_req(struct wpa_supplicant *wpa_s,
  4299. char *cmd)
  4300. {
  4301. long long unsigned val;
  4302. u64 req;
  4303. if (sscanf(cmd, "%llx", &val) != 1)
  4304. return -1;
  4305. req = val;
  4306. return wpas_p2p_sd_cancel_request(wpa_s, req);
  4307. }
  4308. static int p2p_ctrl_serv_disc_resp(struct wpa_supplicant *wpa_s, char *cmd)
  4309. {
  4310. int freq;
  4311. u8 dst[ETH_ALEN];
  4312. u8 dialog_token;
  4313. struct wpabuf *resp_tlvs;
  4314. char *pos, *pos2;
  4315. size_t len;
  4316. pos = os_strchr(cmd, ' ');
  4317. if (pos == NULL)
  4318. return -1;
  4319. *pos++ = '\0';
  4320. freq = atoi(cmd);
  4321. if (freq == 0)
  4322. return -1;
  4323. if (hwaddr_aton(pos, dst))
  4324. return -1;
  4325. pos += 17;
  4326. if (*pos != ' ')
  4327. return -1;
  4328. pos++;
  4329. pos2 = os_strchr(pos, ' ');
  4330. if (pos2 == NULL)
  4331. return -1;
  4332. *pos2++ = '\0';
  4333. dialog_token = atoi(pos);
  4334. len = os_strlen(pos2);
  4335. if (len & 1)
  4336. return -1;
  4337. len /= 2;
  4338. resp_tlvs = wpabuf_alloc(len);
  4339. if (resp_tlvs == NULL)
  4340. return -1;
  4341. if (hexstr2bin(pos2, wpabuf_put(resp_tlvs, len), len) < 0) {
  4342. wpabuf_free(resp_tlvs);
  4343. return -1;
  4344. }
  4345. wpas_p2p_sd_response(wpa_s, freq, dst, dialog_token, resp_tlvs);
  4346. wpabuf_free(resp_tlvs);
  4347. return 0;
  4348. }
  4349. static int p2p_ctrl_serv_disc_external(struct wpa_supplicant *wpa_s,
  4350. char *cmd)
  4351. {
  4352. if (os_strcmp(cmd, "0") && os_strcmp(cmd, "1"))
  4353. return -1;
  4354. wpa_s->p2p_sd_over_ctrl_iface = atoi(cmd);
  4355. return 0;
  4356. }
  4357. static int p2p_ctrl_service_add_bonjour(struct wpa_supplicant *wpa_s,
  4358. char *cmd)
  4359. {
  4360. char *pos;
  4361. size_t len;
  4362. struct wpabuf *query, *resp;
  4363. pos = os_strchr(cmd, ' ');
  4364. if (pos == NULL)
  4365. return -1;
  4366. *pos++ = '\0';
  4367. len = os_strlen(cmd);
  4368. if (len & 1)
  4369. return -1;
  4370. len /= 2;
  4371. query = wpabuf_alloc(len);
  4372. if (query == NULL)
  4373. return -1;
  4374. if (hexstr2bin(cmd, wpabuf_put(query, len), len) < 0) {
  4375. wpabuf_free(query);
  4376. return -1;
  4377. }
  4378. len = os_strlen(pos);
  4379. if (len & 1) {
  4380. wpabuf_free(query);
  4381. return -1;
  4382. }
  4383. len /= 2;
  4384. resp = wpabuf_alloc(len);
  4385. if (resp == NULL) {
  4386. wpabuf_free(query);
  4387. return -1;
  4388. }
  4389. if (hexstr2bin(pos, wpabuf_put(resp, len), len) < 0) {
  4390. wpabuf_free(query);
  4391. wpabuf_free(resp);
  4392. return -1;
  4393. }
  4394. if (wpas_p2p_service_add_bonjour(wpa_s, query, resp) < 0) {
  4395. wpabuf_free(query);
  4396. wpabuf_free(resp);
  4397. return -1;
  4398. }
  4399. return 0;
  4400. }
  4401. static int p2p_ctrl_service_add_upnp(struct wpa_supplicant *wpa_s, char *cmd)
  4402. {
  4403. char *pos;
  4404. u8 version;
  4405. pos = os_strchr(cmd, ' ');
  4406. if (pos == NULL)
  4407. return -1;
  4408. *pos++ = '\0';
  4409. if (hexstr2bin(cmd, &version, 1) < 0)
  4410. return -1;
  4411. return wpas_p2p_service_add_upnp(wpa_s, version, pos);
  4412. }
  4413. static int p2p_ctrl_service_add_asp(struct wpa_supplicant *wpa_s,
  4414. u8 replace, char *cmd)
  4415. {
  4416. char *pos;
  4417. char *adv_str;
  4418. u32 auto_accept, adv_id, svc_state, config_methods;
  4419. char *svc_info = NULL;
  4420. pos = os_strchr(cmd, ' ');
  4421. if (pos == NULL)
  4422. return -1;
  4423. *pos++ = '\0';
  4424. /* Auto-Accept value is mandatory, and must be one of the
  4425. * single values (0, 1, 2, 4) */
  4426. auto_accept = atoi(cmd);
  4427. switch (auto_accept) {
  4428. case P2PS_SETUP_NONE: /* No auto-accept */
  4429. case P2PS_SETUP_NEW:
  4430. case P2PS_SETUP_CLIENT:
  4431. case P2PS_SETUP_GROUP_OWNER:
  4432. break;
  4433. default:
  4434. return -1;
  4435. }
  4436. /* Advertisement ID is mandatory */
  4437. cmd = pos;
  4438. pos = os_strchr(cmd, ' ');
  4439. if (pos == NULL)
  4440. return -1;
  4441. *pos++ = '\0';
  4442. /* Handle Adv_ID == 0 (wildcard "org.wi-fi.wfds") internally. */
  4443. if (sscanf(cmd, "%x", &adv_id) != 1 || adv_id == 0)
  4444. return -1;
  4445. /* Only allow replacements if exist, and adds if not */
  4446. if (wpas_p2p_service_p2ps_id_exists(wpa_s, adv_id)) {
  4447. if (!replace)
  4448. return -1;
  4449. } else {
  4450. if (replace)
  4451. return -1;
  4452. }
  4453. /* svc_state between 0 - 0xff is mandatory */
  4454. if (sscanf(pos, "%x", &svc_state) != 1 || svc_state > 0xff)
  4455. return -1;
  4456. pos = os_strchr(pos, ' ');
  4457. if (pos == NULL)
  4458. return -1;
  4459. /* config_methods is mandatory */
  4460. pos++;
  4461. if (sscanf(pos, "%x", &config_methods) != 1)
  4462. return -1;
  4463. if (!(config_methods &
  4464. (WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD | WPS_CONFIG_P2PS)))
  4465. return -1;
  4466. pos = os_strchr(pos, ' ');
  4467. if (pos == NULL)
  4468. return -1;
  4469. pos++;
  4470. adv_str = pos;
  4471. /* Advertisement string is mandatory */
  4472. if (!pos[0] || pos[0] == ' ')
  4473. return -1;
  4474. /* Terminate svc string */
  4475. pos = os_strchr(pos, ' ');
  4476. if (pos != NULL)
  4477. *pos++ = '\0';
  4478. /* Service and Response Information are optional */
  4479. if (pos && pos[0]) {
  4480. size_t len;
  4481. /* Note the bare ' included, which cannot exist legally
  4482. * in unescaped string. */
  4483. svc_info = os_strstr(pos, "svc_info='");
  4484. if (svc_info) {
  4485. svc_info += 9;
  4486. len = os_strlen(svc_info);
  4487. utf8_unescape(svc_info, len, svc_info, len);
  4488. }
  4489. }
  4490. return wpas_p2p_service_add_asp(wpa_s, auto_accept, adv_id, adv_str,
  4491. (u8) svc_state, (u16) config_methods,
  4492. svc_info);
  4493. }
  4494. static int p2p_ctrl_service_add(struct wpa_supplicant *wpa_s, char *cmd)
  4495. {
  4496. char *pos;
  4497. pos = os_strchr(cmd, ' ');
  4498. if (pos == NULL)
  4499. return -1;
  4500. *pos++ = '\0';
  4501. if (os_strcmp(cmd, "bonjour") == 0)
  4502. return p2p_ctrl_service_add_bonjour(wpa_s, pos);
  4503. if (os_strcmp(cmd, "upnp") == 0)
  4504. return p2p_ctrl_service_add_upnp(wpa_s, pos);
  4505. if (os_strcmp(cmd, "asp") == 0)
  4506. return p2p_ctrl_service_add_asp(wpa_s, 0, pos);
  4507. wpa_printf(MSG_DEBUG, "Unknown service '%s'", cmd);
  4508. return -1;
  4509. }
  4510. static int p2p_ctrl_service_del_bonjour(struct wpa_supplicant *wpa_s,
  4511. char *cmd)
  4512. {
  4513. size_t len;
  4514. struct wpabuf *query;
  4515. int ret;
  4516. len = os_strlen(cmd);
  4517. if (len & 1)
  4518. return -1;
  4519. len /= 2;
  4520. query = wpabuf_alloc(len);
  4521. if (query == NULL)
  4522. return -1;
  4523. if (hexstr2bin(cmd, wpabuf_put(query, len), len) < 0) {
  4524. wpabuf_free(query);
  4525. return -1;
  4526. }
  4527. ret = wpas_p2p_service_del_bonjour(wpa_s, query);
  4528. wpabuf_free(query);
  4529. return ret;
  4530. }
  4531. static int p2p_ctrl_service_del_upnp(struct wpa_supplicant *wpa_s, char *cmd)
  4532. {
  4533. char *pos;
  4534. u8 version;
  4535. pos = os_strchr(cmd, ' ');
  4536. if (pos == NULL)
  4537. return -1;
  4538. *pos++ = '\0';
  4539. if (hexstr2bin(cmd, &version, 1) < 0)
  4540. return -1;
  4541. return wpas_p2p_service_del_upnp(wpa_s, version, pos);
  4542. }
  4543. static int p2p_ctrl_service_del_asp(struct wpa_supplicant *wpa_s, char *cmd)
  4544. {
  4545. u32 adv_id;
  4546. if (os_strcmp(cmd, "all") == 0) {
  4547. wpas_p2p_service_flush_asp(wpa_s);
  4548. return 0;
  4549. }
  4550. if (sscanf(cmd, "%x", &adv_id) != 1)
  4551. return -1;
  4552. return wpas_p2p_service_del_asp(wpa_s, adv_id);
  4553. }
  4554. static int p2p_ctrl_service_del(struct wpa_supplicant *wpa_s, char *cmd)
  4555. {
  4556. char *pos;
  4557. pos = os_strchr(cmd, ' ');
  4558. if (pos == NULL)
  4559. return -1;
  4560. *pos++ = '\0';
  4561. if (os_strcmp(cmd, "bonjour") == 0)
  4562. return p2p_ctrl_service_del_bonjour(wpa_s, pos);
  4563. if (os_strcmp(cmd, "upnp") == 0)
  4564. return p2p_ctrl_service_del_upnp(wpa_s, pos);
  4565. if (os_strcmp(cmd, "asp") == 0)
  4566. return p2p_ctrl_service_del_asp(wpa_s, pos);
  4567. wpa_printf(MSG_DEBUG, "Unknown service '%s'", cmd);
  4568. return -1;
  4569. }
  4570. static int p2p_ctrl_service_replace(struct wpa_supplicant *wpa_s, char *cmd)
  4571. {
  4572. char *pos;
  4573. pos = os_strchr(cmd, ' ');
  4574. if (pos == NULL)
  4575. return -1;
  4576. *pos++ = '\0';
  4577. if (os_strcmp(cmd, "asp") == 0)
  4578. return p2p_ctrl_service_add_asp(wpa_s, 1, pos);
  4579. wpa_printf(MSG_DEBUG, "Unknown service '%s'", cmd);
  4580. return -1;
  4581. }
  4582. static int p2p_ctrl_reject(struct wpa_supplicant *wpa_s, char *cmd)
  4583. {
  4584. u8 addr[ETH_ALEN];
  4585. /* <addr> */
  4586. if (hwaddr_aton(cmd, addr))
  4587. return -1;
  4588. return wpas_p2p_reject(wpa_s, addr);
  4589. }
  4590. static int p2p_ctrl_invite_persistent(struct wpa_supplicant *wpa_s, char *cmd)
  4591. {
  4592. char *pos;
  4593. int id;
  4594. struct wpa_ssid *ssid;
  4595. u8 *_peer = NULL, peer[ETH_ALEN];
  4596. int freq = 0, pref_freq = 0;
  4597. int ht40, vht;
  4598. id = atoi(cmd);
  4599. pos = os_strstr(cmd, " peer=");
  4600. if (pos) {
  4601. pos += 6;
  4602. if (hwaddr_aton(pos, peer))
  4603. return -1;
  4604. _peer = peer;
  4605. }
  4606. ssid = wpa_config_get_network(wpa_s->conf, id);
  4607. if (ssid == NULL || ssid->disabled != 2) {
  4608. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
  4609. "for persistent P2P group",
  4610. id);
  4611. return -1;
  4612. }
  4613. pos = os_strstr(cmd, " freq=");
  4614. if (pos) {
  4615. pos += 6;
  4616. freq = atoi(pos);
  4617. if (freq <= 0)
  4618. return -1;
  4619. }
  4620. pos = os_strstr(cmd, " pref=");
  4621. if (pos) {
  4622. pos += 6;
  4623. pref_freq = atoi(pos);
  4624. if (pref_freq <= 0)
  4625. return -1;
  4626. }
  4627. vht = (os_strstr(cmd, " vht") != NULL) || wpa_s->conf->p2p_go_vht;
  4628. ht40 = (os_strstr(cmd, " ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
  4629. vht;
  4630. return wpas_p2p_invite(wpa_s, _peer, ssid, NULL, freq, ht40, vht,
  4631. pref_freq);
  4632. }
  4633. static int p2p_ctrl_invite_group(struct wpa_supplicant *wpa_s, char *cmd)
  4634. {
  4635. char *pos;
  4636. u8 peer[ETH_ALEN], go_dev_addr[ETH_ALEN], *go_dev = NULL;
  4637. pos = os_strstr(cmd, " peer=");
  4638. if (!pos)
  4639. return -1;
  4640. *pos = '\0';
  4641. pos += 6;
  4642. if (hwaddr_aton(pos, peer)) {
  4643. wpa_printf(MSG_DEBUG, "P2P: Invalid MAC address '%s'", pos);
  4644. return -1;
  4645. }
  4646. pos = os_strstr(pos, " go_dev_addr=");
  4647. if (pos) {
  4648. pos += 13;
  4649. if (hwaddr_aton(pos, go_dev_addr)) {
  4650. wpa_printf(MSG_DEBUG, "P2P: Invalid MAC address '%s'",
  4651. pos);
  4652. return -1;
  4653. }
  4654. go_dev = go_dev_addr;
  4655. }
  4656. return wpas_p2p_invite_group(wpa_s, cmd, peer, go_dev);
  4657. }
  4658. static int p2p_ctrl_invite(struct wpa_supplicant *wpa_s, char *cmd)
  4659. {
  4660. if (os_strncmp(cmd, "persistent=", 11) == 0)
  4661. return p2p_ctrl_invite_persistent(wpa_s, cmd + 11);
  4662. if (os_strncmp(cmd, "group=", 6) == 0)
  4663. return p2p_ctrl_invite_group(wpa_s, cmd + 6);
  4664. return -1;
  4665. }
  4666. static int p2p_ctrl_group_add_persistent(struct wpa_supplicant *wpa_s,
  4667. char *cmd, int freq, int ht40,
  4668. int vht)
  4669. {
  4670. int id;
  4671. struct wpa_ssid *ssid;
  4672. id = atoi(cmd);
  4673. ssid = wpa_config_get_network(wpa_s->conf, id);
  4674. if (ssid == NULL || ssid->disabled != 2) {
  4675. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
  4676. "for persistent P2P group",
  4677. id);
  4678. return -1;
  4679. }
  4680. return wpas_p2p_group_add_persistent(wpa_s, ssid, 0, freq, 0, ht40, vht,
  4681. NULL, 0);
  4682. }
  4683. static int p2p_ctrl_group_add(struct wpa_supplicant *wpa_s, char *cmd)
  4684. {
  4685. int freq = 0, persistent_group = 0, ht40, vht;
  4686. char *pos;
  4687. pos = os_strstr(cmd, "freq=");
  4688. if (pos)
  4689. freq = atoi(pos + 5);
  4690. vht = (os_strstr(cmd, "vht") != NULL) || wpa_s->conf->p2p_go_vht;
  4691. ht40 = (os_strstr(cmd, "ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
  4692. vht;
  4693. if (os_strncmp(cmd, "persistent=", 11) == 0)
  4694. return p2p_ctrl_group_add_persistent(wpa_s, cmd + 11, freq,
  4695. ht40, vht);
  4696. if (os_strcmp(cmd, "persistent") == 0 ||
  4697. os_strncmp(cmd, "persistent ", 11) == 0)
  4698. persistent_group = 1;
  4699. if (!persistent_group && !freq && !ht40) {
  4700. wpa_printf(MSG_DEBUG,
  4701. "CTRL: Invalid P2P_GROUP_ADD parameters '%s'", cmd);
  4702. return -1;
  4703. }
  4704. return wpas_p2p_group_add(wpa_s, persistent_group, freq, ht40, vht);
  4705. }
  4706. static int p2p_ctrl_peer(struct wpa_supplicant *wpa_s, char *cmd,
  4707. char *buf, size_t buflen)
  4708. {
  4709. u8 addr[ETH_ALEN], *addr_ptr;
  4710. int next, res;
  4711. const struct p2p_peer_info *info;
  4712. char *pos, *end;
  4713. char devtype[WPS_DEV_TYPE_BUFSIZE];
  4714. struct wpa_ssid *ssid;
  4715. size_t i;
  4716. if (!wpa_s->global->p2p)
  4717. return -1;
  4718. if (os_strcmp(cmd, "FIRST") == 0) {
  4719. addr_ptr = NULL;
  4720. next = 0;
  4721. } else if (os_strncmp(cmd, "NEXT-", 5) == 0) {
  4722. if (hwaddr_aton(cmd + 5, addr) < 0)
  4723. return -1;
  4724. addr_ptr = addr;
  4725. next = 1;
  4726. } else {
  4727. if (hwaddr_aton(cmd, addr) < 0)
  4728. return -1;
  4729. addr_ptr = addr;
  4730. next = 0;
  4731. }
  4732. info = p2p_get_peer_info(wpa_s->global->p2p, addr_ptr, next);
  4733. if (info == NULL)
  4734. return -1;
  4735. pos = buf;
  4736. end = buf + buflen;
  4737. res = os_snprintf(pos, end - pos, MACSTR "\n"
  4738. "pri_dev_type=%s\n"
  4739. "device_name=%s\n"
  4740. "manufacturer=%s\n"
  4741. "model_name=%s\n"
  4742. "model_number=%s\n"
  4743. "serial_number=%s\n"
  4744. "config_methods=0x%x\n"
  4745. "dev_capab=0x%x\n"
  4746. "group_capab=0x%x\n"
  4747. "level=%d\n",
  4748. MAC2STR(info->p2p_device_addr),
  4749. wps_dev_type_bin2str(info->pri_dev_type,
  4750. devtype, sizeof(devtype)),
  4751. info->device_name,
  4752. info->manufacturer,
  4753. info->model_name,
  4754. info->model_number,
  4755. info->serial_number,
  4756. info->config_methods,
  4757. info->dev_capab,
  4758. info->group_capab,
  4759. info->level);
  4760. if (os_snprintf_error(end - pos, res))
  4761. return pos - buf;
  4762. pos += res;
  4763. for (i = 0; i < info->wps_sec_dev_type_list_len / WPS_DEV_TYPE_LEN; i++)
  4764. {
  4765. const u8 *t;
  4766. t = &info->wps_sec_dev_type_list[i * WPS_DEV_TYPE_LEN];
  4767. res = os_snprintf(pos, end - pos, "sec_dev_type=%s\n",
  4768. wps_dev_type_bin2str(t, devtype,
  4769. sizeof(devtype)));
  4770. if (os_snprintf_error(end - pos, res))
  4771. return pos - buf;
  4772. pos += res;
  4773. }
  4774. ssid = wpas_p2p_get_persistent(wpa_s, info->p2p_device_addr, NULL, 0);
  4775. if (ssid) {
  4776. res = os_snprintf(pos, end - pos, "persistent=%d\n", ssid->id);
  4777. if (os_snprintf_error(end - pos, res))
  4778. return pos - buf;
  4779. pos += res;
  4780. }
  4781. res = p2p_get_peer_info_txt(info, pos, end - pos);
  4782. if (res < 0)
  4783. return pos - buf;
  4784. pos += res;
  4785. if (info->vendor_elems) {
  4786. res = os_snprintf(pos, end - pos, "vendor_elems=");
  4787. if (os_snprintf_error(end - pos, res))
  4788. return pos - buf;
  4789. pos += res;
  4790. pos += wpa_snprintf_hex(pos, end - pos,
  4791. wpabuf_head(info->vendor_elems),
  4792. wpabuf_len(info->vendor_elems));
  4793. res = os_snprintf(pos, end - pos, "\n");
  4794. if (os_snprintf_error(end - pos, res))
  4795. return pos - buf;
  4796. pos += res;
  4797. }
  4798. return pos - buf;
  4799. }
  4800. static int p2p_ctrl_disallow_freq(struct wpa_supplicant *wpa_s,
  4801. const char *param)
  4802. {
  4803. unsigned int i;
  4804. if (wpa_s->global->p2p == NULL)
  4805. return -1;
  4806. if (freq_range_list_parse(&wpa_s->global->p2p_disallow_freq, param) < 0)
  4807. return -1;
  4808. for (i = 0; i < wpa_s->global->p2p_disallow_freq.num; i++) {
  4809. struct wpa_freq_range *freq;
  4810. freq = &wpa_s->global->p2p_disallow_freq.range[i];
  4811. wpa_printf(MSG_DEBUG, "P2P: Disallowed frequency range %u-%u",
  4812. freq->min, freq->max);
  4813. }
  4814. wpas_p2p_update_channel_list(wpa_s);
  4815. return 0;
  4816. }
  4817. static int p2p_ctrl_set(struct wpa_supplicant *wpa_s, char *cmd)
  4818. {
  4819. char *param;
  4820. if (wpa_s->global->p2p == NULL)
  4821. return -1;
  4822. param = os_strchr(cmd, ' ');
  4823. if (param == NULL)
  4824. return -1;
  4825. *param++ = '\0';
  4826. if (os_strcmp(cmd, "discoverability") == 0) {
  4827. p2p_set_client_discoverability(wpa_s->global->p2p,
  4828. atoi(param));
  4829. return 0;
  4830. }
  4831. if (os_strcmp(cmd, "managed") == 0) {
  4832. p2p_set_managed_oper(wpa_s->global->p2p, atoi(param));
  4833. return 0;
  4834. }
  4835. if (os_strcmp(cmd, "listen_channel") == 0) {
  4836. return p2p_set_listen_channel(wpa_s->global->p2p, 81,
  4837. atoi(param), 1);
  4838. }
  4839. if (os_strcmp(cmd, "ssid_postfix") == 0) {
  4840. return p2p_set_ssid_postfix(wpa_s->global->p2p, (u8 *) param,
  4841. os_strlen(param));
  4842. }
  4843. if (os_strcmp(cmd, "noa") == 0) {
  4844. char *pos;
  4845. int count, start, duration;
  4846. /* GO NoA parameters: count,start_offset(ms),duration(ms) */
  4847. count = atoi(param);
  4848. pos = os_strchr(param, ',');
  4849. if (pos == NULL)
  4850. return -1;
  4851. pos++;
  4852. start = atoi(pos);
  4853. pos = os_strchr(pos, ',');
  4854. if (pos == NULL)
  4855. return -1;
  4856. pos++;
  4857. duration = atoi(pos);
  4858. if (count < 0 || count > 255 || start < 0 || duration < 0)
  4859. return -1;
  4860. if (count == 0 && duration > 0)
  4861. return -1;
  4862. wpa_printf(MSG_DEBUG, "CTRL_IFACE: P2P_SET GO NoA: count=%d "
  4863. "start=%d duration=%d", count, start, duration);
  4864. return wpas_p2p_set_noa(wpa_s, count, start, duration);
  4865. }
  4866. if (os_strcmp(cmd, "ps") == 0)
  4867. return wpa_drv_set_p2p_powersave(wpa_s, atoi(param), -1, -1);
  4868. if (os_strcmp(cmd, "oppps") == 0)
  4869. return wpa_drv_set_p2p_powersave(wpa_s, -1, atoi(param), -1);
  4870. if (os_strcmp(cmd, "ctwindow") == 0)
  4871. return wpa_drv_set_p2p_powersave(wpa_s, -1, -1, atoi(param));
  4872. if (os_strcmp(cmd, "disabled") == 0) {
  4873. wpa_s->global->p2p_disabled = atoi(param);
  4874. wpa_printf(MSG_DEBUG, "P2P functionality %s",
  4875. wpa_s->global->p2p_disabled ?
  4876. "disabled" : "enabled");
  4877. if (wpa_s->global->p2p_disabled) {
  4878. wpas_p2p_stop_find(wpa_s);
  4879. os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
  4880. p2p_flush(wpa_s->global->p2p);
  4881. }
  4882. return 0;
  4883. }
  4884. if (os_strcmp(cmd, "conc_pref") == 0) {
  4885. if (os_strcmp(param, "sta") == 0)
  4886. wpa_s->global->conc_pref = WPA_CONC_PREF_STA;
  4887. else if (os_strcmp(param, "p2p") == 0)
  4888. wpa_s->global->conc_pref = WPA_CONC_PREF_P2P;
  4889. else {
  4890. wpa_printf(MSG_INFO, "Invalid conc_pref value");
  4891. return -1;
  4892. }
  4893. wpa_printf(MSG_DEBUG, "Single channel concurrency preference: "
  4894. "%s", param);
  4895. return 0;
  4896. }
  4897. if (os_strcmp(cmd, "force_long_sd") == 0) {
  4898. wpa_s->force_long_sd = atoi(param);
  4899. return 0;
  4900. }
  4901. if (os_strcmp(cmd, "peer_filter") == 0) {
  4902. u8 addr[ETH_ALEN];
  4903. if (hwaddr_aton(param, addr))
  4904. return -1;
  4905. p2p_set_peer_filter(wpa_s->global->p2p, addr);
  4906. return 0;
  4907. }
  4908. if (os_strcmp(cmd, "cross_connect") == 0)
  4909. return wpas_p2p_set_cross_connect(wpa_s, atoi(param));
  4910. if (os_strcmp(cmd, "go_apsd") == 0) {
  4911. if (os_strcmp(param, "disable") == 0)
  4912. wpa_s->set_ap_uapsd = 0;
  4913. else {
  4914. wpa_s->set_ap_uapsd = 1;
  4915. wpa_s->ap_uapsd = atoi(param);
  4916. }
  4917. return 0;
  4918. }
  4919. if (os_strcmp(cmd, "client_apsd") == 0) {
  4920. if (os_strcmp(param, "disable") == 0)
  4921. wpa_s->set_sta_uapsd = 0;
  4922. else {
  4923. int be, bk, vi, vo;
  4924. char *pos;
  4925. /* format: BE,BK,VI,VO;max SP Length */
  4926. be = atoi(param);
  4927. pos = os_strchr(param, ',');
  4928. if (pos == NULL)
  4929. return -1;
  4930. pos++;
  4931. bk = atoi(pos);
  4932. pos = os_strchr(pos, ',');
  4933. if (pos == NULL)
  4934. return -1;
  4935. pos++;
  4936. vi = atoi(pos);
  4937. pos = os_strchr(pos, ',');
  4938. if (pos == NULL)
  4939. return -1;
  4940. pos++;
  4941. vo = atoi(pos);
  4942. /* ignore max SP Length for now */
  4943. wpa_s->set_sta_uapsd = 1;
  4944. wpa_s->sta_uapsd = 0;
  4945. if (be)
  4946. wpa_s->sta_uapsd |= BIT(0);
  4947. if (bk)
  4948. wpa_s->sta_uapsd |= BIT(1);
  4949. if (vi)
  4950. wpa_s->sta_uapsd |= BIT(2);
  4951. if (vo)
  4952. wpa_s->sta_uapsd |= BIT(3);
  4953. }
  4954. return 0;
  4955. }
  4956. if (os_strcmp(cmd, "disallow_freq") == 0)
  4957. return p2p_ctrl_disallow_freq(wpa_s, param);
  4958. if (os_strcmp(cmd, "disc_int") == 0) {
  4959. int min_disc_int, max_disc_int, max_disc_tu;
  4960. char *pos;
  4961. pos = param;
  4962. min_disc_int = atoi(pos);
  4963. pos = os_strchr(pos, ' ');
  4964. if (pos == NULL)
  4965. return -1;
  4966. *pos++ = '\0';
  4967. max_disc_int = atoi(pos);
  4968. pos = os_strchr(pos, ' ');
  4969. if (pos == NULL)
  4970. return -1;
  4971. *pos++ = '\0';
  4972. max_disc_tu = atoi(pos);
  4973. return p2p_set_disc_int(wpa_s->global->p2p, min_disc_int,
  4974. max_disc_int, max_disc_tu);
  4975. }
  4976. if (os_strcmp(cmd, "per_sta_psk") == 0) {
  4977. wpa_s->global->p2p_per_sta_psk = !!atoi(param);
  4978. return 0;
  4979. }
  4980. #ifdef CONFIG_WPS_NFC
  4981. if (os_strcmp(cmd, "nfc_tag") == 0)
  4982. return wpas_p2p_nfc_tag_enabled(wpa_s, !!atoi(param));
  4983. #endif /* CONFIG_WPS_NFC */
  4984. if (os_strcmp(cmd, "disable_ip_addr_req") == 0) {
  4985. wpa_s->p2p_disable_ip_addr_req = !!atoi(param);
  4986. return 0;
  4987. }
  4988. wpa_printf(MSG_DEBUG, "CTRL_IFACE: Unknown P2P_SET field value '%s'",
  4989. cmd);
  4990. return -1;
  4991. }
  4992. static void p2p_ctrl_flush(struct wpa_supplicant *wpa_s)
  4993. {
  4994. os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
  4995. wpa_s->force_long_sd = 0;
  4996. wpas_p2p_stop_find(wpa_s);
  4997. if (wpa_s->global->p2p)
  4998. p2p_flush(wpa_s->global->p2p);
  4999. }
  5000. static int p2p_ctrl_presence_req(struct wpa_supplicant *wpa_s, char *cmd)
  5001. {
  5002. char *pos, *pos2;
  5003. unsigned int dur1 = 0, int1 = 0, dur2 = 0, int2 = 0;
  5004. if (cmd[0]) {
  5005. pos = os_strchr(cmd, ' ');
  5006. if (pos == NULL)
  5007. return -1;
  5008. *pos++ = '\0';
  5009. dur1 = atoi(cmd);
  5010. pos2 = os_strchr(pos, ' ');
  5011. if (pos2)
  5012. *pos2++ = '\0';
  5013. int1 = atoi(pos);
  5014. } else
  5015. pos2 = NULL;
  5016. if (pos2) {
  5017. pos = os_strchr(pos2, ' ');
  5018. if (pos == NULL)
  5019. return -1;
  5020. *pos++ = '\0';
  5021. dur2 = atoi(pos2);
  5022. int2 = atoi(pos);
  5023. }
  5024. return wpas_p2p_presence_req(wpa_s, dur1, int1, dur2, int2);
  5025. }
  5026. static int p2p_ctrl_ext_listen(struct wpa_supplicant *wpa_s, char *cmd)
  5027. {
  5028. char *pos;
  5029. unsigned int period = 0, interval = 0;
  5030. if (cmd[0]) {
  5031. pos = os_strchr(cmd, ' ');
  5032. if (pos == NULL)
  5033. return -1;
  5034. *pos++ = '\0';
  5035. period = atoi(cmd);
  5036. interval = atoi(pos);
  5037. }
  5038. return wpas_p2p_ext_listen(wpa_s, period, interval);
  5039. }
  5040. static int p2p_ctrl_remove_client(struct wpa_supplicant *wpa_s, const char *cmd)
  5041. {
  5042. const char *pos;
  5043. u8 peer[ETH_ALEN];
  5044. int iface_addr = 0;
  5045. pos = cmd;
  5046. if (os_strncmp(pos, "iface=", 6) == 0) {
  5047. iface_addr = 1;
  5048. pos += 6;
  5049. }
  5050. if (hwaddr_aton(pos, peer))
  5051. return -1;
  5052. wpas_p2p_remove_client(wpa_s, peer, iface_addr);
  5053. return 0;
  5054. }
  5055. #endif /* CONFIG_P2P */
  5056. static int * freq_range_to_channel_list(struct wpa_supplicant *wpa_s, char *val)
  5057. {
  5058. struct wpa_freq_range_list ranges;
  5059. int *freqs = NULL;
  5060. struct hostapd_hw_modes *mode;
  5061. u16 i;
  5062. if (wpa_s->hw.modes == NULL)
  5063. return NULL;
  5064. os_memset(&ranges, 0, sizeof(ranges));
  5065. if (freq_range_list_parse(&ranges, val) < 0)
  5066. return NULL;
  5067. for (i = 0; i < wpa_s->hw.num_modes; i++) {
  5068. int j;
  5069. mode = &wpa_s->hw.modes[i];
  5070. for (j = 0; j < mode->num_channels; j++) {
  5071. unsigned int freq;
  5072. if (mode->channels[j].flag & HOSTAPD_CHAN_DISABLED)
  5073. continue;
  5074. freq = mode->channels[j].freq;
  5075. if (!freq_range_list_includes(&ranges, freq))
  5076. continue;
  5077. int_array_add_unique(&freqs, freq);
  5078. }
  5079. }
  5080. os_free(ranges.range);
  5081. return freqs;
  5082. }
  5083. #ifdef CONFIG_INTERWORKING
  5084. static int ctrl_interworking_select(struct wpa_supplicant *wpa_s, char *param)
  5085. {
  5086. int auto_sel = 0;
  5087. int *freqs = NULL;
  5088. if (param) {
  5089. char *pos;
  5090. auto_sel = os_strstr(param, "auto") != NULL;
  5091. pos = os_strstr(param, "freq=");
  5092. if (pos) {
  5093. freqs = freq_range_to_channel_list(wpa_s, pos + 5);
  5094. if (freqs == NULL)
  5095. return -1;
  5096. }
  5097. }
  5098. return interworking_select(wpa_s, auto_sel, freqs);
  5099. }
  5100. static int ctrl_interworking_connect(struct wpa_supplicant *wpa_s, char *dst,
  5101. int only_add)
  5102. {
  5103. u8 bssid[ETH_ALEN];
  5104. struct wpa_bss *bss;
  5105. if (hwaddr_aton(dst, bssid)) {
  5106. wpa_printf(MSG_DEBUG, "Invalid BSSID '%s'", dst);
  5107. return -1;
  5108. }
  5109. bss = wpa_bss_get_bssid(wpa_s, bssid);
  5110. if (bss == NULL) {
  5111. wpa_printf(MSG_DEBUG, "Could not find BSS " MACSTR,
  5112. MAC2STR(bssid));
  5113. return -1;
  5114. }
  5115. if (bss->ssid_len == 0) {
  5116. int found = 0;
  5117. wpa_printf(MSG_DEBUG, "Selected BSS entry for " MACSTR
  5118. " does not have SSID information", MAC2STR(bssid));
  5119. dl_list_for_each_reverse(bss, &wpa_s->bss, struct wpa_bss,
  5120. list) {
  5121. if (os_memcmp(bss->bssid, bssid, ETH_ALEN) == 0 &&
  5122. bss->ssid_len > 0) {
  5123. found = 1;
  5124. break;
  5125. }
  5126. }
  5127. if (!found)
  5128. return -1;
  5129. wpa_printf(MSG_DEBUG,
  5130. "Found another matching BSS entry with SSID");
  5131. }
  5132. return interworking_connect(wpa_s, bss, only_add);
  5133. }
  5134. static int get_anqp(struct wpa_supplicant *wpa_s, char *dst)
  5135. {
  5136. u8 dst_addr[ETH_ALEN];
  5137. int used;
  5138. char *pos;
  5139. #define MAX_ANQP_INFO_ID 100
  5140. u16 id[MAX_ANQP_INFO_ID];
  5141. size_t num_id = 0;
  5142. u32 subtypes = 0;
  5143. used = hwaddr_aton2(dst, dst_addr);
  5144. if (used < 0)
  5145. return -1;
  5146. pos = dst + used;
  5147. if (*pos == ' ')
  5148. pos++;
  5149. while (num_id < MAX_ANQP_INFO_ID) {
  5150. if (os_strncmp(pos, "hs20:", 5) == 0) {
  5151. #ifdef CONFIG_HS20
  5152. int num = atoi(pos + 5);
  5153. if (num <= 0 || num > 31)
  5154. return -1;
  5155. subtypes |= BIT(num);
  5156. #else /* CONFIG_HS20 */
  5157. return -1;
  5158. #endif /* CONFIG_HS20 */
  5159. } else {
  5160. id[num_id] = atoi(pos);
  5161. if (id[num_id])
  5162. num_id++;
  5163. }
  5164. pos = os_strchr(pos + 1, ',');
  5165. if (pos == NULL)
  5166. break;
  5167. pos++;
  5168. }
  5169. if (num_id == 0)
  5170. return -1;
  5171. return anqp_send_req(wpa_s, dst_addr, id, num_id, subtypes);
  5172. }
  5173. static int gas_request(struct wpa_supplicant *wpa_s, char *cmd)
  5174. {
  5175. u8 dst_addr[ETH_ALEN];
  5176. struct wpabuf *advproto, *query = NULL;
  5177. int used, ret = -1;
  5178. char *pos, *end;
  5179. size_t len;
  5180. used = hwaddr_aton2(cmd, dst_addr);
  5181. if (used < 0)
  5182. return -1;
  5183. pos = cmd + used;
  5184. while (*pos == ' ')
  5185. pos++;
  5186. /* Advertisement Protocol ID */
  5187. end = os_strchr(pos, ' ');
  5188. if (end)
  5189. len = end - pos;
  5190. else
  5191. len = os_strlen(pos);
  5192. if (len & 0x01)
  5193. return -1;
  5194. len /= 2;
  5195. if (len == 0)
  5196. return -1;
  5197. advproto = wpabuf_alloc(len);
  5198. if (advproto == NULL)
  5199. return -1;
  5200. if (hexstr2bin(pos, wpabuf_put(advproto, len), len) < 0)
  5201. goto fail;
  5202. if (end) {
  5203. /* Optional Query Request */
  5204. pos = end + 1;
  5205. while (*pos == ' ')
  5206. pos++;
  5207. len = os_strlen(pos);
  5208. if (len) {
  5209. if (len & 0x01)
  5210. goto fail;
  5211. len /= 2;
  5212. if (len == 0)
  5213. goto fail;
  5214. query = wpabuf_alloc(len);
  5215. if (query == NULL)
  5216. goto fail;
  5217. if (hexstr2bin(pos, wpabuf_put(query, len), len) < 0)
  5218. goto fail;
  5219. }
  5220. }
  5221. ret = gas_send_request(wpa_s, dst_addr, advproto, query);
  5222. fail:
  5223. wpabuf_free(advproto);
  5224. wpabuf_free(query);
  5225. return ret;
  5226. }
  5227. static int gas_response_get(struct wpa_supplicant *wpa_s, char *cmd, char *buf,
  5228. size_t buflen)
  5229. {
  5230. u8 addr[ETH_ALEN];
  5231. int dialog_token;
  5232. int used;
  5233. char *pos;
  5234. size_t resp_len, start, requested_len;
  5235. struct wpabuf *resp;
  5236. int ret;
  5237. used = hwaddr_aton2(cmd, addr);
  5238. if (used < 0)
  5239. return -1;
  5240. pos = cmd + used;
  5241. while (*pos == ' ')
  5242. pos++;
  5243. dialog_token = atoi(pos);
  5244. if (wpa_s->last_gas_resp &&
  5245. os_memcmp(addr, wpa_s->last_gas_addr, ETH_ALEN) == 0 &&
  5246. dialog_token == wpa_s->last_gas_dialog_token)
  5247. resp = wpa_s->last_gas_resp;
  5248. else if (wpa_s->prev_gas_resp &&
  5249. os_memcmp(addr, wpa_s->prev_gas_addr, ETH_ALEN) == 0 &&
  5250. dialog_token == wpa_s->prev_gas_dialog_token)
  5251. resp = wpa_s->prev_gas_resp;
  5252. else
  5253. return -1;
  5254. resp_len = wpabuf_len(resp);
  5255. start = 0;
  5256. requested_len = resp_len;
  5257. pos = os_strchr(pos, ' ');
  5258. if (pos) {
  5259. start = atoi(pos);
  5260. if (start > resp_len)
  5261. return os_snprintf(buf, buflen, "FAIL-Invalid range");
  5262. pos = os_strchr(pos, ',');
  5263. if (pos == NULL)
  5264. return -1;
  5265. pos++;
  5266. requested_len = atoi(pos);
  5267. if (start + requested_len > resp_len)
  5268. return os_snprintf(buf, buflen, "FAIL-Invalid range");
  5269. }
  5270. if (requested_len * 2 + 1 > buflen)
  5271. return os_snprintf(buf, buflen, "FAIL-Too long response");
  5272. ret = wpa_snprintf_hex(buf, buflen, wpabuf_head_u8(resp) + start,
  5273. requested_len);
  5274. if (start + requested_len == resp_len) {
  5275. /*
  5276. * Free memory by dropping the response after it has been
  5277. * fetched.
  5278. */
  5279. if (resp == wpa_s->prev_gas_resp) {
  5280. wpabuf_free(wpa_s->prev_gas_resp);
  5281. wpa_s->prev_gas_resp = NULL;
  5282. } else {
  5283. wpabuf_free(wpa_s->last_gas_resp);
  5284. wpa_s->last_gas_resp = NULL;
  5285. }
  5286. }
  5287. return ret;
  5288. }
  5289. #endif /* CONFIG_INTERWORKING */
  5290. #ifdef CONFIG_HS20
  5291. static int get_hs20_anqp(struct wpa_supplicant *wpa_s, char *dst)
  5292. {
  5293. u8 dst_addr[ETH_ALEN];
  5294. int used;
  5295. char *pos;
  5296. u32 subtypes = 0;
  5297. used = hwaddr_aton2(dst, dst_addr);
  5298. if (used < 0)
  5299. return -1;
  5300. pos = dst + used;
  5301. if (*pos == ' ')
  5302. pos++;
  5303. for (;;) {
  5304. int num = atoi(pos);
  5305. if (num <= 0 || num > 31)
  5306. return -1;
  5307. subtypes |= BIT(num);
  5308. pos = os_strchr(pos + 1, ',');
  5309. if (pos == NULL)
  5310. break;
  5311. pos++;
  5312. }
  5313. if (subtypes == 0)
  5314. return -1;
  5315. return hs20_anqp_send_req(wpa_s, dst_addr, subtypes, NULL, 0);
  5316. }
  5317. static int hs20_nai_home_realm_list(struct wpa_supplicant *wpa_s,
  5318. const u8 *addr, const char *realm)
  5319. {
  5320. u8 *buf;
  5321. size_t rlen, len;
  5322. int ret;
  5323. rlen = os_strlen(realm);
  5324. len = 3 + rlen;
  5325. buf = os_malloc(len);
  5326. if (buf == NULL)
  5327. return -1;
  5328. buf[0] = 1; /* NAI Home Realm Count */
  5329. buf[1] = 0; /* Formatted in accordance with RFC 4282 */
  5330. buf[2] = rlen;
  5331. os_memcpy(buf + 3, realm, rlen);
  5332. ret = hs20_anqp_send_req(wpa_s, addr,
  5333. BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
  5334. buf, len);
  5335. os_free(buf);
  5336. return ret;
  5337. }
  5338. static int hs20_get_nai_home_realm_list(struct wpa_supplicant *wpa_s,
  5339. char *dst)
  5340. {
  5341. struct wpa_cred *cred = wpa_s->conf->cred;
  5342. u8 dst_addr[ETH_ALEN];
  5343. int used;
  5344. u8 *buf;
  5345. size_t len;
  5346. int ret;
  5347. used = hwaddr_aton2(dst, dst_addr);
  5348. if (used < 0)
  5349. return -1;
  5350. while (dst[used] == ' ')
  5351. used++;
  5352. if (os_strncmp(dst + used, "realm=", 6) == 0)
  5353. return hs20_nai_home_realm_list(wpa_s, dst_addr,
  5354. dst + used + 6);
  5355. len = os_strlen(dst + used);
  5356. if (len == 0 && cred && cred->realm)
  5357. return hs20_nai_home_realm_list(wpa_s, dst_addr, cred->realm);
  5358. if (len & 1)
  5359. return -1;
  5360. len /= 2;
  5361. buf = os_malloc(len);
  5362. if (buf == NULL)
  5363. return -1;
  5364. if (hexstr2bin(dst + used, buf, len) < 0) {
  5365. os_free(buf);
  5366. return -1;
  5367. }
  5368. ret = hs20_anqp_send_req(wpa_s, dst_addr,
  5369. BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
  5370. buf, len);
  5371. os_free(buf);
  5372. return ret;
  5373. }
  5374. static int hs20_icon_request(struct wpa_supplicant *wpa_s, char *cmd)
  5375. {
  5376. u8 dst_addr[ETH_ALEN];
  5377. int used;
  5378. char *icon;
  5379. used = hwaddr_aton2(cmd, dst_addr);
  5380. if (used < 0)
  5381. return -1;
  5382. while (cmd[used] == ' ')
  5383. used++;
  5384. icon = &cmd[used];
  5385. wpa_s->fetch_osu_icon_in_progress = 0;
  5386. return hs20_anqp_send_req(wpa_s, dst_addr, BIT(HS20_STYPE_ICON_REQUEST),
  5387. (u8 *) icon, os_strlen(icon));
  5388. }
  5389. #endif /* CONFIG_HS20 */
  5390. #ifdef CONFIG_AUTOSCAN
  5391. static int wpa_supplicant_ctrl_iface_autoscan(struct wpa_supplicant *wpa_s,
  5392. char *cmd)
  5393. {
  5394. enum wpa_states state = wpa_s->wpa_state;
  5395. char *new_params = NULL;
  5396. if (os_strlen(cmd) > 0) {
  5397. new_params = os_strdup(cmd);
  5398. if (new_params == NULL)
  5399. return -1;
  5400. }
  5401. os_free(wpa_s->conf->autoscan);
  5402. wpa_s->conf->autoscan = new_params;
  5403. if (wpa_s->conf->autoscan == NULL)
  5404. autoscan_deinit(wpa_s);
  5405. else if (state == WPA_DISCONNECTED || state == WPA_INACTIVE)
  5406. autoscan_init(wpa_s, 1);
  5407. else if (state == WPA_SCANNING)
  5408. wpa_supplicant_reinit_autoscan(wpa_s);
  5409. return 0;
  5410. }
  5411. #endif /* CONFIG_AUTOSCAN */
  5412. #ifdef CONFIG_WNM
  5413. static int wpas_ctrl_iface_wnm_sleep(struct wpa_supplicant *wpa_s, char *cmd)
  5414. {
  5415. int enter;
  5416. int intval = 0;
  5417. char *pos;
  5418. int ret;
  5419. struct wpabuf *tfs_req = NULL;
  5420. if (os_strncmp(cmd, "enter", 5) == 0)
  5421. enter = 1;
  5422. else if (os_strncmp(cmd, "exit", 4) == 0)
  5423. enter = 0;
  5424. else
  5425. return -1;
  5426. pos = os_strstr(cmd, " interval=");
  5427. if (pos)
  5428. intval = atoi(pos + 10);
  5429. pos = os_strstr(cmd, " tfs_req=");
  5430. if (pos) {
  5431. char *end;
  5432. size_t len;
  5433. pos += 9;
  5434. end = os_strchr(pos, ' ');
  5435. if (end)
  5436. len = end - pos;
  5437. else
  5438. len = os_strlen(pos);
  5439. if (len & 1)
  5440. return -1;
  5441. len /= 2;
  5442. tfs_req = wpabuf_alloc(len);
  5443. if (tfs_req == NULL)
  5444. return -1;
  5445. if (hexstr2bin(pos, wpabuf_put(tfs_req, len), len) < 0) {
  5446. wpabuf_free(tfs_req);
  5447. return -1;
  5448. }
  5449. }
  5450. ret = ieee802_11_send_wnmsleep_req(wpa_s, enter ? WNM_SLEEP_MODE_ENTER :
  5451. WNM_SLEEP_MODE_EXIT, intval,
  5452. tfs_req);
  5453. wpabuf_free(tfs_req);
  5454. return ret;
  5455. }
  5456. static int wpas_ctrl_iface_wnm_bss_query(struct wpa_supplicant *wpa_s, char *cmd)
  5457. {
  5458. int query_reason;
  5459. query_reason = atoi(cmd);
  5460. wpa_printf(MSG_DEBUG, "CTRL_IFACE: WNM_BSS_QUERY query_reason=%d",
  5461. query_reason);
  5462. return wnm_send_bss_transition_mgmt_query(wpa_s, query_reason);
  5463. }
  5464. #endif /* CONFIG_WNM */
  5465. static int wpa_supplicant_signal_poll(struct wpa_supplicant *wpa_s, char *buf,
  5466. size_t buflen)
  5467. {
  5468. struct wpa_signal_info si;
  5469. int ret;
  5470. char *pos, *end;
  5471. ret = wpa_drv_signal_poll(wpa_s, &si);
  5472. if (ret)
  5473. return -1;
  5474. pos = buf;
  5475. end = buf + buflen;
  5476. ret = os_snprintf(pos, end - pos, "RSSI=%d\nLINKSPEED=%d\n"
  5477. "NOISE=%d\nFREQUENCY=%u\n",
  5478. si.current_signal, si.current_txrate / 1000,
  5479. si.current_noise, si.frequency);
  5480. if (os_snprintf_error(end - pos, ret))
  5481. return -1;
  5482. pos += ret;
  5483. if (si.chanwidth != CHAN_WIDTH_UNKNOWN) {
  5484. ret = os_snprintf(pos, end - pos, "WIDTH=%s\n",
  5485. channel_width_to_string(si.chanwidth));
  5486. if (os_snprintf_error(end - pos, ret))
  5487. return -1;
  5488. pos += ret;
  5489. }
  5490. if (si.center_frq1 > 0 && si.center_frq2 > 0) {
  5491. ret = os_snprintf(pos, end - pos,
  5492. "CENTER_FRQ1=%d\nCENTER_FRQ2=%d\n",
  5493. si.center_frq1, si.center_frq2);
  5494. if (os_snprintf_error(end - pos, ret))
  5495. return -1;
  5496. pos += ret;
  5497. }
  5498. if (si.avg_signal) {
  5499. ret = os_snprintf(pos, end - pos,
  5500. "AVG_RSSI=%d\n", si.avg_signal);
  5501. if (os_snprintf_error(end - pos, ret))
  5502. return -1;
  5503. pos += ret;
  5504. }
  5505. if (si.avg_beacon_signal) {
  5506. ret = os_snprintf(pos, end - pos,
  5507. "AVG_BEACON_RSSI=%d\n", si.avg_beacon_signal);
  5508. if (os_snprintf_error(end - pos, ret))
  5509. return -1;
  5510. pos += ret;
  5511. }
  5512. return pos - buf;
  5513. }
  5514. static int wpa_supplicant_pktcnt_poll(struct wpa_supplicant *wpa_s, char *buf,
  5515. size_t buflen)
  5516. {
  5517. struct hostap_sta_driver_data sta;
  5518. int ret;
  5519. ret = wpa_drv_pktcnt_poll(wpa_s, &sta);
  5520. if (ret)
  5521. return -1;
  5522. ret = os_snprintf(buf, buflen, "TXGOOD=%lu\nTXBAD=%lu\nRXGOOD=%lu\n",
  5523. sta.tx_packets, sta.tx_retry_failed, sta.rx_packets);
  5524. if (os_snprintf_error(buflen, ret))
  5525. return -1;
  5526. return ret;
  5527. }
  5528. #ifdef ANDROID
  5529. static int wpa_supplicant_driver_cmd(struct wpa_supplicant *wpa_s, char *cmd,
  5530. char *buf, size_t buflen)
  5531. {
  5532. int ret;
  5533. ret = wpa_drv_driver_cmd(wpa_s, cmd, buf, buflen);
  5534. if (ret == 0) {
  5535. if (os_strncasecmp(cmd, "COUNTRY", 7) == 0) {
  5536. struct p2p_data *p2p = wpa_s->global->p2p;
  5537. if (p2p) {
  5538. char country[3];
  5539. country[0] = cmd[8];
  5540. country[1] = cmd[9];
  5541. country[2] = 0x04;
  5542. p2p_set_country(p2p, country);
  5543. }
  5544. }
  5545. ret = os_snprintf(buf, buflen, "%s\n", "OK");
  5546. if (os_snprintf_error(buflen, ret))
  5547. ret = -1;
  5548. }
  5549. return ret;
  5550. }
  5551. #endif /* ANDROID */
  5552. static int wpa_supplicant_vendor_cmd(struct wpa_supplicant *wpa_s, char *cmd,
  5553. char *buf, size_t buflen)
  5554. {
  5555. int ret;
  5556. char *pos;
  5557. u8 *data = NULL;
  5558. unsigned int vendor_id, subcmd;
  5559. struct wpabuf *reply;
  5560. size_t data_len = 0;
  5561. /* cmd: <vendor id> <subcommand id> [<hex formatted data>] */
  5562. vendor_id = strtoul(cmd, &pos, 16);
  5563. if (!isblank(*pos))
  5564. return -EINVAL;
  5565. subcmd = strtoul(pos, &pos, 10);
  5566. if (*pos != '\0') {
  5567. if (!isblank(*pos++))
  5568. return -EINVAL;
  5569. data_len = os_strlen(pos);
  5570. }
  5571. if (data_len) {
  5572. data_len /= 2;
  5573. data = os_malloc(data_len);
  5574. if (!data)
  5575. return -1;
  5576. if (hexstr2bin(pos, data, data_len)) {
  5577. wpa_printf(MSG_DEBUG,
  5578. "Vendor command: wrong parameter format");
  5579. os_free(data);
  5580. return -EINVAL;
  5581. }
  5582. }
  5583. reply = wpabuf_alloc((buflen - 1) / 2);
  5584. if (!reply) {
  5585. os_free(data);
  5586. return -1;
  5587. }
  5588. ret = wpa_drv_vendor_cmd(wpa_s, vendor_id, subcmd, data, data_len,
  5589. reply);
  5590. if (ret == 0)
  5591. ret = wpa_snprintf_hex(buf, buflen, wpabuf_head_u8(reply),
  5592. wpabuf_len(reply));
  5593. wpabuf_free(reply);
  5594. os_free(data);
  5595. return ret;
  5596. }
  5597. static void wpa_supplicant_ctrl_iface_flush(struct wpa_supplicant *wpa_s)
  5598. {
  5599. #ifdef CONFIG_P2P
  5600. struct wpa_supplicant *p2p_wpa_s = wpa_s->global->p2p_init_wpa_s ?
  5601. wpa_s->global->p2p_init_wpa_s : wpa_s;
  5602. #endif /* CONFIG_P2P */
  5603. wpa_dbg(wpa_s, MSG_DEBUG, "Flush all wpa_supplicant state");
  5604. #ifdef CONFIG_P2P
  5605. wpas_p2p_cancel(p2p_wpa_s);
  5606. p2p_ctrl_flush(p2p_wpa_s);
  5607. wpas_p2p_group_remove(p2p_wpa_s, "*");
  5608. wpas_p2p_service_flush(p2p_wpa_s);
  5609. p2p_wpa_s->global->p2p_disabled = 0;
  5610. p2p_wpa_s->global->p2p_per_sta_psk = 0;
  5611. p2p_wpa_s->conf->num_sec_device_types = 0;
  5612. p2p_wpa_s->p2p_disable_ip_addr_req = 0;
  5613. os_free(p2p_wpa_s->global->p2p_go_avoid_freq.range);
  5614. p2p_wpa_s->global->p2p_go_avoid_freq.range = NULL;
  5615. p2p_wpa_s->global->pending_p2ps_group = 0;
  5616. #endif /* CONFIG_P2P */
  5617. #ifdef CONFIG_WPS_TESTING
  5618. wps_version_number = 0x20;
  5619. wps_testing_dummy_cred = 0;
  5620. wps_corrupt_pkhash = 0;
  5621. #endif /* CONFIG_WPS_TESTING */
  5622. #ifdef CONFIG_WPS
  5623. wpa_s->wps_fragment_size = 0;
  5624. wpas_wps_cancel(wpa_s);
  5625. wps_registrar_flush(wpa_s->wps->registrar);
  5626. #endif /* CONFIG_WPS */
  5627. wpa_s->after_wps = 0;
  5628. wpa_s->known_wps_freq = 0;
  5629. #ifdef CONFIG_TDLS
  5630. #ifdef CONFIG_TDLS_TESTING
  5631. extern unsigned int tdls_testing;
  5632. tdls_testing = 0;
  5633. #endif /* CONFIG_TDLS_TESTING */
  5634. wpa_drv_tdls_oper(wpa_s, TDLS_ENABLE, NULL);
  5635. wpa_tdls_enable(wpa_s->wpa, 1);
  5636. #endif /* CONFIG_TDLS */
  5637. eloop_cancel_timeout(wpa_supplicant_stop_countermeasures, wpa_s, NULL);
  5638. wpa_supplicant_stop_countermeasures(wpa_s, NULL);
  5639. wpa_s->no_keep_alive = 0;
  5640. wpa_s->own_disconnect_req = 0;
  5641. os_free(wpa_s->disallow_aps_bssid);
  5642. wpa_s->disallow_aps_bssid = NULL;
  5643. wpa_s->disallow_aps_bssid_count = 0;
  5644. os_free(wpa_s->disallow_aps_ssid);
  5645. wpa_s->disallow_aps_ssid = NULL;
  5646. wpa_s->disallow_aps_ssid_count = 0;
  5647. wpa_s->set_sta_uapsd = 0;
  5648. wpa_s->sta_uapsd = 0;
  5649. wpa_drv_radio_disable(wpa_s, 0);
  5650. wpa_blacklist_clear(wpa_s);
  5651. wpa_s->extra_blacklist_count = 0;
  5652. wpa_supplicant_ctrl_iface_remove_network(wpa_s, "all");
  5653. wpa_supplicant_ctrl_iface_remove_cred(wpa_s, "all");
  5654. wpa_config_flush_blobs(wpa_s->conf);
  5655. wpa_s->conf->auto_interworking = 0;
  5656. wpa_s->conf->okc = 0;
  5657. wpa_sm_pmksa_cache_flush(wpa_s->wpa, NULL);
  5658. rsn_preauth_deinit(wpa_s->wpa);
  5659. wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_LIFETIME, 43200);
  5660. wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_REAUTH_THRESHOLD, 70);
  5661. wpa_sm_set_param(wpa_s->wpa, RSNA_SA_TIMEOUT, 60);
  5662. eapol_sm_notify_logoff(wpa_s->eapol, FALSE);
  5663. radio_remove_works(wpa_s, NULL, 1);
  5664. wpa_s->ext_work_in_progress = 0;
  5665. wpa_s->next_ssid = NULL;
  5666. #ifdef CONFIG_INTERWORKING
  5667. hs20_cancel_fetch_osu(wpa_s);
  5668. #endif /* CONFIG_INTERWORKING */
  5669. wpa_s->ext_mgmt_frame_handling = 0;
  5670. wpa_s->ext_eapol_frame_io = 0;
  5671. #ifdef CONFIG_TESTING_OPTIONS
  5672. wpa_s->extra_roc_dur = 0;
  5673. wpa_s->test_failure = WPAS_TEST_FAILURE_NONE;
  5674. #endif /* CONFIG_TESTING_OPTIONS */
  5675. wpa_s->disconnected = 0;
  5676. os_free(wpa_s->next_scan_freqs);
  5677. wpa_s->next_scan_freqs = NULL;
  5678. wpa_bss_flush(wpa_s);
  5679. if (!dl_list_empty(&wpa_s->bss)) {
  5680. wpa_printf(MSG_DEBUG,
  5681. "BSS table not empty after flush: %u entries, current_bss=%p bssid="
  5682. MACSTR " pending_bssid=" MACSTR,
  5683. dl_list_len(&wpa_s->bss), wpa_s->current_bss,
  5684. MAC2STR(wpa_s->bssid),
  5685. MAC2STR(wpa_s->pending_bssid));
  5686. }
  5687. eloop_cancel_timeout(wpas_network_reenabled, wpa_s, NULL);
  5688. }
  5689. static int wpas_ctrl_radio_work_show(struct wpa_supplicant *wpa_s,
  5690. char *buf, size_t buflen)
  5691. {
  5692. struct wpa_radio_work *work;
  5693. char *pos, *end;
  5694. struct os_reltime now, diff;
  5695. pos = buf;
  5696. end = buf + buflen;
  5697. os_get_reltime(&now);
  5698. dl_list_for_each(work, &wpa_s->radio->work, struct wpa_radio_work, list)
  5699. {
  5700. int ret;
  5701. os_reltime_sub(&now, &work->time, &diff);
  5702. ret = os_snprintf(pos, end - pos, "%s@%s:%u:%u:%ld.%06ld\n",
  5703. work->type, work->wpa_s->ifname, work->freq,
  5704. work->started, diff.sec, diff.usec);
  5705. if (os_snprintf_error(end - pos, ret))
  5706. break;
  5707. pos += ret;
  5708. }
  5709. return pos - buf;
  5710. }
  5711. static void wpas_ctrl_radio_work_timeout(void *eloop_ctx, void *timeout_ctx)
  5712. {
  5713. struct wpa_radio_work *work = eloop_ctx;
  5714. struct wpa_external_work *ework = work->ctx;
  5715. wpa_dbg(work->wpa_s, MSG_DEBUG,
  5716. "Timing out external radio work %u (%s)",
  5717. ework->id, work->type);
  5718. wpa_msg(work->wpa_s, MSG_INFO, EXT_RADIO_WORK_TIMEOUT "%u", ework->id);
  5719. work->wpa_s->ext_work_in_progress = 0;
  5720. radio_work_done(work);
  5721. os_free(ework);
  5722. }
  5723. static void wpas_ctrl_radio_work_cb(struct wpa_radio_work *work, int deinit)
  5724. {
  5725. struct wpa_external_work *ework = work->ctx;
  5726. if (deinit) {
  5727. if (work->started)
  5728. eloop_cancel_timeout(wpas_ctrl_radio_work_timeout,
  5729. work, NULL);
  5730. os_free(ework);
  5731. return;
  5732. }
  5733. wpa_dbg(work->wpa_s, MSG_DEBUG, "Starting external radio work %u (%s)",
  5734. ework->id, ework->type);
  5735. wpa_msg(work->wpa_s, MSG_INFO, EXT_RADIO_WORK_START "%u", ework->id);
  5736. work->wpa_s->ext_work_in_progress = 1;
  5737. if (!ework->timeout)
  5738. ework->timeout = 10;
  5739. eloop_register_timeout(ework->timeout, 0, wpas_ctrl_radio_work_timeout,
  5740. work, NULL);
  5741. }
  5742. static int wpas_ctrl_radio_work_add(struct wpa_supplicant *wpa_s, char *cmd,
  5743. char *buf, size_t buflen)
  5744. {
  5745. struct wpa_external_work *ework;
  5746. char *pos, *pos2;
  5747. size_t type_len;
  5748. int ret;
  5749. unsigned int freq = 0;
  5750. /* format: <name> [freq=<MHz>] [timeout=<seconds>] */
  5751. ework = os_zalloc(sizeof(*ework));
  5752. if (ework == NULL)
  5753. return -1;
  5754. pos = os_strchr(cmd, ' ');
  5755. if (pos) {
  5756. type_len = pos - cmd;
  5757. pos++;
  5758. pos2 = os_strstr(pos, "freq=");
  5759. if (pos2)
  5760. freq = atoi(pos2 + 5);
  5761. pos2 = os_strstr(pos, "timeout=");
  5762. if (pos2)
  5763. ework->timeout = atoi(pos2 + 8);
  5764. } else {
  5765. type_len = os_strlen(cmd);
  5766. }
  5767. if (4 + type_len >= sizeof(ework->type))
  5768. type_len = sizeof(ework->type) - 4 - 1;
  5769. os_strlcpy(ework->type, "ext:", sizeof(ework->type));
  5770. os_memcpy(ework->type + 4, cmd, type_len);
  5771. ework->type[4 + type_len] = '\0';
  5772. wpa_s->ext_work_id++;
  5773. if (wpa_s->ext_work_id == 0)
  5774. wpa_s->ext_work_id++;
  5775. ework->id = wpa_s->ext_work_id;
  5776. if (radio_add_work(wpa_s, freq, ework->type, 0, wpas_ctrl_radio_work_cb,
  5777. ework) < 0) {
  5778. os_free(ework);
  5779. return -1;
  5780. }
  5781. ret = os_snprintf(buf, buflen, "%u", ework->id);
  5782. if (os_snprintf_error(buflen, ret))
  5783. return -1;
  5784. return ret;
  5785. }
  5786. static int wpas_ctrl_radio_work_done(struct wpa_supplicant *wpa_s, char *cmd)
  5787. {
  5788. struct wpa_radio_work *work;
  5789. unsigned int id = atoi(cmd);
  5790. dl_list_for_each(work, &wpa_s->radio->work, struct wpa_radio_work, list)
  5791. {
  5792. struct wpa_external_work *ework;
  5793. if (os_strncmp(work->type, "ext:", 4) != 0)
  5794. continue;
  5795. ework = work->ctx;
  5796. if (id && ework->id != id)
  5797. continue;
  5798. wpa_dbg(wpa_s, MSG_DEBUG,
  5799. "Completed external radio work %u (%s)",
  5800. ework->id, ework->type);
  5801. eloop_cancel_timeout(wpas_ctrl_radio_work_timeout, work, NULL);
  5802. wpa_s->ext_work_in_progress = 0;
  5803. radio_work_done(work);
  5804. os_free(ework);
  5805. return 3; /* "OK\n" */
  5806. }
  5807. return -1;
  5808. }
  5809. static int wpas_ctrl_radio_work(struct wpa_supplicant *wpa_s, char *cmd,
  5810. char *buf, size_t buflen)
  5811. {
  5812. if (os_strcmp(cmd, "show") == 0)
  5813. return wpas_ctrl_radio_work_show(wpa_s, buf, buflen);
  5814. if (os_strncmp(cmd, "add ", 4) == 0)
  5815. return wpas_ctrl_radio_work_add(wpa_s, cmd + 4, buf, buflen);
  5816. if (os_strncmp(cmd, "done ", 5) == 0)
  5817. return wpas_ctrl_radio_work_done(wpa_s, cmd + 4);
  5818. return -1;
  5819. }
  5820. void wpas_ctrl_radio_work_flush(struct wpa_supplicant *wpa_s)
  5821. {
  5822. struct wpa_radio_work *work, *tmp;
  5823. if (!wpa_s || !wpa_s->radio)
  5824. return;
  5825. dl_list_for_each_safe(work, tmp, &wpa_s->radio->work,
  5826. struct wpa_radio_work, list) {
  5827. struct wpa_external_work *ework;
  5828. if (os_strncmp(work->type, "ext:", 4) != 0)
  5829. continue;
  5830. ework = work->ctx;
  5831. wpa_dbg(wpa_s, MSG_DEBUG,
  5832. "Flushing%s external radio work %u (%s)",
  5833. work->started ? " started" : "", ework->id,
  5834. ework->type);
  5835. if (work->started)
  5836. eloop_cancel_timeout(wpas_ctrl_radio_work_timeout,
  5837. work, NULL);
  5838. radio_work_done(work);
  5839. os_free(ework);
  5840. }
  5841. }
  5842. static void wpas_ctrl_eapol_response(void *eloop_ctx, void *timeout_ctx)
  5843. {
  5844. struct wpa_supplicant *wpa_s = eloop_ctx;
  5845. eapol_sm_notify_ctrl_response(wpa_s->eapol);
  5846. }
  5847. static int scan_id_list_parse(struct wpa_supplicant *wpa_s, const char *value,
  5848. unsigned int *scan_id_count, int scan_id[])
  5849. {
  5850. const char *pos = value;
  5851. while (pos) {
  5852. if (*pos == ' ' || *pos == '\0')
  5853. break;
  5854. if (*scan_id_count == MAX_SCAN_ID)
  5855. return -1;
  5856. scan_id[(*scan_id_count)++] = atoi(pos);
  5857. pos = os_strchr(pos, ',');
  5858. if (pos)
  5859. pos++;
  5860. }
  5861. return 0;
  5862. }
  5863. static void wpas_ctrl_scan(struct wpa_supplicant *wpa_s, char *params,
  5864. char *reply, int reply_size, int *reply_len)
  5865. {
  5866. char *pos;
  5867. unsigned int manual_scan_passive = 0;
  5868. unsigned int manual_scan_use_id = 0;
  5869. unsigned int manual_scan_only_new = 0;
  5870. unsigned int scan_only = 0;
  5871. unsigned int scan_id_count = 0;
  5872. int scan_id[MAX_SCAN_ID];
  5873. void (*scan_res_handler)(struct wpa_supplicant *wpa_s,
  5874. struct wpa_scan_results *scan_res);
  5875. int *manual_scan_freqs = NULL;
  5876. struct wpa_ssid_value *ssid = NULL, *ns;
  5877. unsigned int ssid_count = 0;
  5878. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED) {
  5879. *reply_len = -1;
  5880. return;
  5881. }
  5882. if (radio_work_pending(wpa_s, "scan")) {
  5883. wpa_printf(MSG_DEBUG,
  5884. "Pending scan scheduled - reject new request");
  5885. *reply_len = os_snprintf(reply, reply_size, "FAIL-BUSY\n");
  5886. return;
  5887. }
  5888. #ifdef CONFIG_INTERWORKING
  5889. if (wpa_s->fetch_anqp_in_progress || wpa_s->network_select) {
  5890. wpa_printf(MSG_DEBUG,
  5891. "Interworking select in progress - reject new scan");
  5892. *reply_len = os_snprintf(reply, reply_size, "FAIL-BUSY\n");
  5893. return;
  5894. }
  5895. #endif /* CONFIG_INTERWORKING */
  5896. if (params) {
  5897. if (os_strncasecmp(params, "TYPE=ONLY", 9) == 0)
  5898. scan_only = 1;
  5899. pos = os_strstr(params, "freq=");
  5900. if (pos) {
  5901. manual_scan_freqs = freq_range_to_channel_list(wpa_s,
  5902. pos + 5);
  5903. if (manual_scan_freqs == NULL) {
  5904. *reply_len = -1;
  5905. goto done;
  5906. }
  5907. }
  5908. pos = os_strstr(params, "passive=");
  5909. if (pos)
  5910. manual_scan_passive = !!atoi(pos + 8);
  5911. pos = os_strstr(params, "use_id=");
  5912. if (pos)
  5913. manual_scan_use_id = atoi(pos + 7);
  5914. pos = os_strstr(params, "only_new=1");
  5915. if (pos)
  5916. manual_scan_only_new = 1;
  5917. pos = os_strstr(params, "scan_id=");
  5918. if (pos && scan_id_list_parse(wpa_s, pos + 8, &scan_id_count,
  5919. scan_id) < 0) {
  5920. *reply_len = -1;
  5921. goto done;
  5922. }
  5923. pos = params;
  5924. while (pos && *pos != '\0') {
  5925. if (os_strncmp(pos, "ssid ", 5) == 0) {
  5926. char *end;
  5927. pos += 5;
  5928. end = pos;
  5929. while (*end) {
  5930. if (*end == '\0' || *end == ' ')
  5931. break;
  5932. end++;
  5933. }
  5934. ns = os_realloc_array(
  5935. ssid, ssid_count + 1,
  5936. sizeof(struct wpa_ssid_value));
  5937. if (ns == NULL) {
  5938. *reply_len = -1;
  5939. goto done;
  5940. }
  5941. ssid = ns;
  5942. if ((end - pos) & 0x01 ||
  5943. end - pos > 2 * SSID_MAX_LEN ||
  5944. hexstr2bin(pos, ssid[ssid_count].ssid,
  5945. (end - pos) / 2) < 0) {
  5946. wpa_printf(MSG_DEBUG,
  5947. "Invalid SSID value '%s'",
  5948. pos);
  5949. *reply_len = -1;
  5950. goto done;
  5951. }
  5952. ssid[ssid_count].ssid_len = (end - pos) / 2;
  5953. wpa_hexdump_ascii(MSG_DEBUG, "scan SSID",
  5954. ssid[ssid_count].ssid,
  5955. ssid[ssid_count].ssid_len);
  5956. ssid_count++;
  5957. pos = end;
  5958. }
  5959. pos = os_strchr(pos, ' ');
  5960. if (pos)
  5961. pos++;
  5962. }
  5963. }
  5964. wpa_s->num_ssids_from_scan_req = ssid_count;
  5965. os_free(wpa_s->ssids_from_scan_req);
  5966. if (ssid_count) {
  5967. wpa_s->ssids_from_scan_req = ssid;
  5968. ssid = NULL;
  5969. } else {
  5970. wpa_s->ssids_from_scan_req = NULL;
  5971. }
  5972. if (scan_only)
  5973. scan_res_handler = scan_only_handler;
  5974. else if (wpa_s->scan_res_handler == scan_only_handler)
  5975. scan_res_handler = NULL;
  5976. else
  5977. scan_res_handler = wpa_s->scan_res_handler;
  5978. if (!wpa_s->sched_scanning && !wpa_s->scanning &&
  5979. ((wpa_s->wpa_state <= WPA_SCANNING) ||
  5980. (wpa_s->wpa_state == WPA_COMPLETED))) {
  5981. wpa_s->manual_scan_passive = manual_scan_passive;
  5982. wpa_s->manual_scan_use_id = manual_scan_use_id;
  5983. wpa_s->manual_scan_only_new = manual_scan_only_new;
  5984. wpa_s->scan_id_count = scan_id_count;
  5985. os_memcpy(wpa_s->scan_id, scan_id, scan_id_count * sizeof(int));
  5986. wpa_s->scan_res_handler = scan_res_handler;
  5987. os_free(wpa_s->manual_scan_freqs);
  5988. wpa_s->manual_scan_freqs = manual_scan_freqs;
  5989. manual_scan_freqs = NULL;
  5990. wpa_s->normal_scans = 0;
  5991. wpa_s->scan_req = MANUAL_SCAN_REQ;
  5992. wpa_s->after_wps = 0;
  5993. wpa_s->known_wps_freq = 0;
  5994. wpa_supplicant_req_scan(wpa_s, 0, 0);
  5995. if (wpa_s->manual_scan_use_id) {
  5996. wpa_s->manual_scan_id++;
  5997. wpa_dbg(wpa_s, MSG_DEBUG, "Assigned scan id %u",
  5998. wpa_s->manual_scan_id);
  5999. *reply_len = os_snprintf(reply, reply_size, "%u\n",
  6000. wpa_s->manual_scan_id);
  6001. }
  6002. } else if (wpa_s->sched_scanning) {
  6003. wpa_s->manual_scan_passive = manual_scan_passive;
  6004. wpa_s->manual_scan_use_id = manual_scan_use_id;
  6005. wpa_s->manual_scan_only_new = manual_scan_only_new;
  6006. wpa_s->scan_id_count = scan_id_count;
  6007. os_memcpy(wpa_s->scan_id, scan_id, scan_id_count * sizeof(int));
  6008. wpa_s->scan_res_handler = scan_res_handler;
  6009. os_free(wpa_s->manual_scan_freqs);
  6010. wpa_s->manual_scan_freqs = manual_scan_freqs;
  6011. manual_scan_freqs = NULL;
  6012. wpa_printf(MSG_DEBUG, "Stop ongoing sched_scan to allow requested full scan to proceed");
  6013. wpa_supplicant_cancel_sched_scan(wpa_s);
  6014. wpa_s->scan_req = MANUAL_SCAN_REQ;
  6015. wpa_supplicant_req_scan(wpa_s, 0, 0);
  6016. if (wpa_s->manual_scan_use_id) {
  6017. wpa_s->manual_scan_id++;
  6018. *reply_len = os_snprintf(reply, reply_size, "%u\n",
  6019. wpa_s->manual_scan_id);
  6020. wpa_dbg(wpa_s, MSG_DEBUG, "Assigned scan id %u",
  6021. wpa_s->manual_scan_id);
  6022. }
  6023. } else {
  6024. wpa_printf(MSG_DEBUG, "Ongoing scan action - reject new request");
  6025. *reply_len = os_snprintf(reply, reply_size, "FAIL-BUSY\n");
  6026. }
  6027. done:
  6028. os_free(manual_scan_freqs);
  6029. os_free(ssid);
  6030. }
  6031. #ifdef CONFIG_TESTING_OPTIONS
  6032. static void wpas_ctrl_iface_mgmt_tx_cb(struct wpa_supplicant *wpa_s,
  6033. unsigned int freq, const u8 *dst,
  6034. const u8 *src, const u8 *bssid,
  6035. const u8 *data, size_t data_len,
  6036. enum offchannel_send_action_result
  6037. result)
  6038. {
  6039. wpa_msg(wpa_s, MSG_INFO, "MGMT-TX-STATUS freq=%u dst=" MACSTR
  6040. " src=" MACSTR " bssid=" MACSTR " result=%s",
  6041. freq, MAC2STR(dst), MAC2STR(src), MAC2STR(bssid),
  6042. result == OFFCHANNEL_SEND_ACTION_SUCCESS ?
  6043. "SUCCESS" : (result == OFFCHANNEL_SEND_ACTION_NO_ACK ?
  6044. "NO_ACK" : "FAILED"));
  6045. }
  6046. static int wpas_ctrl_iface_mgmt_tx(struct wpa_supplicant *wpa_s, char *cmd)
  6047. {
  6048. char *pos, *param;
  6049. size_t len;
  6050. u8 *buf, da[ETH_ALEN], bssid[ETH_ALEN];
  6051. int res, used;
  6052. int freq = 0, no_cck = 0, wait_time = 0;
  6053. /* <DA> <BSSID> [freq=<MHz>] [wait_time=<ms>] [no_cck=1]
  6054. * <action=Action frame payload> */
  6055. wpa_printf(MSG_DEBUG, "External MGMT TX: %s", cmd);
  6056. pos = cmd;
  6057. used = hwaddr_aton2(pos, da);
  6058. if (used < 0)
  6059. return -1;
  6060. pos += used;
  6061. while (*pos == ' ')
  6062. pos++;
  6063. used = hwaddr_aton2(pos, bssid);
  6064. if (used < 0)
  6065. return -1;
  6066. pos += used;
  6067. param = os_strstr(pos, " freq=");
  6068. if (param) {
  6069. param += 6;
  6070. freq = atoi(param);
  6071. }
  6072. param = os_strstr(pos, " no_cck=");
  6073. if (param) {
  6074. param += 8;
  6075. no_cck = atoi(param);
  6076. }
  6077. param = os_strstr(pos, " wait_time=");
  6078. if (param) {
  6079. param += 11;
  6080. wait_time = atoi(param);
  6081. }
  6082. param = os_strstr(pos, " action=");
  6083. if (param == NULL)
  6084. return -1;
  6085. param += 8;
  6086. len = os_strlen(param);
  6087. if (len & 1)
  6088. return -1;
  6089. len /= 2;
  6090. buf = os_malloc(len);
  6091. if (buf == NULL)
  6092. return -1;
  6093. if (hexstr2bin(param, buf, len) < 0) {
  6094. os_free(buf);
  6095. return -1;
  6096. }
  6097. res = offchannel_send_action(wpa_s, freq, da, wpa_s->own_addr, bssid,
  6098. buf, len, wait_time,
  6099. wpas_ctrl_iface_mgmt_tx_cb, no_cck);
  6100. os_free(buf);
  6101. return res;
  6102. }
  6103. static void wpas_ctrl_iface_mgmt_tx_done(struct wpa_supplicant *wpa_s)
  6104. {
  6105. wpa_printf(MSG_DEBUG, "External MGMT TX - done waiting");
  6106. offchannel_send_action_done(wpa_s);
  6107. }
  6108. static int wpas_ctrl_iface_driver_event(struct wpa_supplicant *wpa_s, char *cmd)
  6109. {
  6110. char *pos, *param;
  6111. union wpa_event_data event;
  6112. enum wpa_event_type ev;
  6113. /* <event name> [parameters..] */
  6114. wpa_dbg(wpa_s, MSG_DEBUG, "Testing - external driver event: %s", cmd);
  6115. pos = cmd;
  6116. param = os_strchr(pos, ' ');
  6117. if (param)
  6118. *param++ = '\0';
  6119. os_memset(&event, 0, sizeof(event));
  6120. if (os_strcmp(cmd, "INTERFACE_ENABLED") == 0) {
  6121. ev = EVENT_INTERFACE_ENABLED;
  6122. } else if (os_strcmp(cmd, "INTERFACE_DISABLED") == 0) {
  6123. ev = EVENT_INTERFACE_DISABLED;
  6124. } else if (os_strcmp(cmd, "AVOID_FREQUENCIES") == 0) {
  6125. ev = EVENT_AVOID_FREQUENCIES;
  6126. if (param == NULL)
  6127. param = "";
  6128. if (freq_range_list_parse(&event.freq_range, param) < 0)
  6129. return -1;
  6130. wpa_supplicant_event(wpa_s, ev, &event);
  6131. os_free(event.freq_range.range);
  6132. return 0;
  6133. } else {
  6134. wpa_dbg(wpa_s, MSG_DEBUG, "Testing - unknown driver event: %s",
  6135. cmd);
  6136. return -1;
  6137. }
  6138. wpa_supplicant_event(wpa_s, ev, &event);
  6139. return 0;
  6140. }
  6141. static int wpas_ctrl_iface_eapol_rx(struct wpa_supplicant *wpa_s, char *cmd)
  6142. {
  6143. char *pos;
  6144. u8 src[ETH_ALEN], *buf;
  6145. int used;
  6146. size_t len;
  6147. wpa_printf(MSG_DEBUG, "External EAPOL RX: %s", cmd);
  6148. pos = cmd;
  6149. used = hwaddr_aton2(pos, src);
  6150. if (used < 0)
  6151. return -1;
  6152. pos += used;
  6153. while (*pos == ' ')
  6154. pos++;
  6155. len = os_strlen(pos);
  6156. if (len & 1)
  6157. return -1;
  6158. len /= 2;
  6159. buf = os_malloc(len);
  6160. if (buf == NULL)
  6161. return -1;
  6162. if (hexstr2bin(pos, buf, len) < 0) {
  6163. os_free(buf);
  6164. return -1;
  6165. }
  6166. wpa_supplicant_rx_eapol(wpa_s, src, buf, len);
  6167. os_free(buf);
  6168. return 0;
  6169. }
  6170. static u16 ipv4_hdr_checksum(const void *buf, size_t len)
  6171. {
  6172. size_t i;
  6173. u32 sum = 0;
  6174. const u16 *pos = buf;
  6175. for (i = 0; i < len / 2; i++)
  6176. sum += *pos++;
  6177. while (sum >> 16)
  6178. sum = (sum & 0xffff) + (sum >> 16);
  6179. return sum ^ 0xffff;
  6180. }
  6181. #define HWSIM_PACKETLEN 1500
  6182. #define HWSIM_IP_LEN (HWSIM_PACKETLEN - sizeof(struct ether_header))
  6183. void wpas_data_test_rx(void *ctx, const u8 *src_addr, const u8 *buf, size_t len)
  6184. {
  6185. struct wpa_supplicant *wpa_s = ctx;
  6186. const struct ether_header *eth;
  6187. const struct iphdr *ip;
  6188. const u8 *pos;
  6189. unsigned int i;
  6190. if (len != HWSIM_PACKETLEN)
  6191. return;
  6192. eth = (const struct ether_header *) buf;
  6193. ip = (const struct iphdr *) (eth + 1);
  6194. pos = (const u8 *) (ip + 1);
  6195. if (ip->ihl != 5 || ip->version != 4 ||
  6196. ntohs(ip->tot_len) != HWSIM_IP_LEN)
  6197. return;
  6198. for (i = 0; i < HWSIM_IP_LEN - sizeof(*ip); i++) {
  6199. if (*pos != (u8) i)
  6200. return;
  6201. pos++;
  6202. }
  6203. wpa_msg(wpa_s, MSG_INFO, "DATA-TEST-RX " MACSTR " " MACSTR,
  6204. MAC2STR(eth->ether_dhost), MAC2STR(eth->ether_shost));
  6205. }
  6206. static int wpas_ctrl_iface_data_test_config(struct wpa_supplicant *wpa_s,
  6207. char *cmd)
  6208. {
  6209. int enabled = atoi(cmd);
  6210. if (!enabled) {
  6211. if (wpa_s->l2_test) {
  6212. l2_packet_deinit(wpa_s->l2_test);
  6213. wpa_s->l2_test = NULL;
  6214. wpa_dbg(wpa_s, MSG_DEBUG, "test data: Disabled");
  6215. }
  6216. return 0;
  6217. }
  6218. if (wpa_s->l2_test)
  6219. return 0;
  6220. wpa_s->l2_test = l2_packet_init(wpa_s->ifname, wpa_s->own_addr,
  6221. ETHERTYPE_IP, wpas_data_test_rx,
  6222. wpa_s, 1);
  6223. if (wpa_s->l2_test == NULL)
  6224. return -1;
  6225. wpa_dbg(wpa_s, MSG_DEBUG, "test data: Enabled");
  6226. return 0;
  6227. }
  6228. static int wpas_ctrl_iface_data_test_tx(struct wpa_supplicant *wpa_s, char *cmd)
  6229. {
  6230. u8 dst[ETH_ALEN], src[ETH_ALEN];
  6231. char *pos;
  6232. int used;
  6233. long int val;
  6234. u8 tos;
  6235. u8 buf[HWSIM_PACKETLEN];
  6236. struct ether_header *eth;
  6237. struct iphdr *ip;
  6238. u8 *dpos;
  6239. unsigned int i;
  6240. if (wpa_s->l2_test == NULL)
  6241. return -1;
  6242. /* format: <dst> <src> <tos> */
  6243. pos = cmd;
  6244. used = hwaddr_aton2(pos, dst);
  6245. if (used < 0)
  6246. return -1;
  6247. pos += used;
  6248. while (*pos == ' ')
  6249. pos++;
  6250. used = hwaddr_aton2(pos, src);
  6251. if (used < 0)
  6252. return -1;
  6253. pos += used;
  6254. val = strtol(pos, NULL, 0);
  6255. if (val < 0 || val > 0xff)
  6256. return -1;
  6257. tos = val;
  6258. eth = (struct ether_header *) buf;
  6259. os_memcpy(eth->ether_dhost, dst, ETH_ALEN);
  6260. os_memcpy(eth->ether_shost, src, ETH_ALEN);
  6261. eth->ether_type = htons(ETHERTYPE_IP);
  6262. ip = (struct iphdr *) (eth + 1);
  6263. os_memset(ip, 0, sizeof(*ip));
  6264. ip->ihl = 5;
  6265. ip->version = 4;
  6266. ip->ttl = 64;
  6267. ip->tos = tos;
  6268. ip->tot_len = htons(HWSIM_IP_LEN);
  6269. ip->protocol = 1;
  6270. ip->saddr = htonl(192 << 24 | 168 << 16 | 1 << 8 | 1);
  6271. ip->daddr = htonl(192 << 24 | 168 << 16 | 1 << 8 | 2);
  6272. ip->check = ipv4_hdr_checksum(ip, sizeof(*ip));
  6273. dpos = (u8 *) (ip + 1);
  6274. for (i = 0; i < HWSIM_IP_LEN - sizeof(*ip); i++)
  6275. *dpos++ = i;
  6276. if (l2_packet_send(wpa_s->l2_test, dst, ETHERTYPE_IP, buf,
  6277. HWSIM_PACKETLEN) < 0)
  6278. return -1;
  6279. wpa_dbg(wpa_s, MSG_DEBUG, "test data: TX dst=" MACSTR " src=" MACSTR
  6280. " tos=0x%x", MAC2STR(dst), MAC2STR(src), tos);
  6281. return 0;
  6282. }
  6283. static int wpas_ctrl_iface_data_test_frame(struct wpa_supplicant *wpa_s,
  6284. char *cmd)
  6285. {
  6286. u8 *buf;
  6287. struct ether_header *eth;
  6288. struct l2_packet_data *l2 = NULL;
  6289. size_t len;
  6290. u16 ethertype;
  6291. int res = -1;
  6292. len = os_strlen(cmd);
  6293. if (len & 1 || len < ETH_HLEN * 2)
  6294. return -1;
  6295. len /= 2;
  6296. buf = os_malloc(len);
  6297. if (buf == NULL)
  6298. return -1;
  6299. if (hexstr2bin(cmd, buf, len) < 0)
  6300. goto done;
  6301. eth = (struct ether_header *) buf;
  6302. ethertype = ntohs(eth->ether_type);
  6303. l2 = l2_packet_init(wpa_s->ifname, wpa_s->own_addr, ethertype,
  6304. wpas_data_test_rx, wpa_s, 1);
  6305. if (l2 == NULL)
  6306. goto done;
  6307. res = l2_packet_send(l2, eth->ether_dhost, ethertype, buf, len);
  6308. wpa_dbg(wpa_s, MSG_DEBUG, "test data: TX frame res=%d", res);
  6309. done:
  6310. if (l2)
  6311. l2_packet_deinit(l2);
  6312. os_free(buf);
  6313. return res < 0 ? -1 : 0;
  6314. }
  6315. static int wpas_ctrl_test_alloc_fail(struct wpa_supplicant *wpa_s, char *cmd)
  6316. {
  6317. #ifdef WPA_TRACE_BFD
  6318. extern char wpa_trace_fail_func[256];
  6319. extern unsigned int wpa_trace_fail_after;
  6320. char *pos;
  6321. wpa_trace_fail_after = atoi(cmd);
  6322. pos = os_strchr(cmd, ':');
  6323. if (pos) {
  6324. pos++;
  6325. os_strlcpy(wpa_trace_fail_func, pos,
  6326. sizeof(wpa_trace_fail_func));
  6327. } else {
  6328. wpa_trace_fail_after = 0;
  6329. }
  6330. return 0;
  6331. #else /* WPA_TRACE_BFD */
  6332. return -1;
  6333. #endif /* WPA_TRACE_BFD */
  6334. }
  6335. static int wpas_ctrl_get_alloc_fail(struct wpa_supplicant *wpa_s,
  6336. char *buf, size_t buflen)
  6337. {
  6338. #ifdef WPA_TRACE_BFD
  6339. extern char wpa_trace_fail_func[256];
  6340. extern unsigned int wpa_trace_fail_after;
  6341. return os_snprintf(buf, buflen, "%u:%s", wpa_trace_fail_after,
  6342. wpa_trace_fail_func);
  6343. #else /* WPA_TRACE_BFD */
  6344. return -1;
  6345. #endif /* WPA_TRACE_BFD */
  6346. }
  6347. #endif /* CONFIG_TESTING_OPTIONS */
  6348. static void wpas_ctrl_vendor_elem_update(struct wpa_supplicant *wpa_s)
  6349. {
  6350. unsigned int i;
  6351. char buf[30];
  6352. wpa_printf(MSG_DEBUG, "Update vendor elements");
  6353. for (i = 0; i < NUM_VENDOR_ELEM_FRAMES; i++) {
  6354. if (wpa_s->vendor_elem[i]) {
  6355. int res;
  6356. res = os_snprintf(buf, sizeof(buf), "frame[%u]", i);
  6357. if (!os_snprintf_error(sizeof(buf), res)) {
  6358. wpa_hexdump_buf(MSG_DEBUG, buf,
  6359. wpa_s->vendor_elem[i]);
  6360. }
  6361. }
  6362. }
  6363. #ifdef CONFIG_P2P
  6364. if (wpa_s->parent == wpa_s &&
  6365. wpa_s->global->p2p &&
  6366. !wpa_s->global->p2p_disabled)
  6367. p2p_set_vendor_elems(wpa_s->global->p2p, wpa_s->vendor_elem);
  6368. #endif /* CONFIG_P2P */
  6369. }
  6370. static struct wpa_supplicant *
  6371. wpas_ctrl_vendor_elem_iface(struct wpa_supplicant *wpa_s,
  6372. enum wpa_vendor_elem_frame frame)
  6373. {
  6374. switch (frame) {
  6375. #ifdef CONFIG_P2P
  6376. case VENDOR_ELEM_PROBE_REQ_P2P:
  6377. case VENDOR_ELEM_PROBE_RESP_P2P:
  6378. case VENDOR_ELEM_PROBE_RESP_P2P_GO:
  6379. case VENDOR_ELEM_BEACON_P2P_GO:
  6380. case VENDOR_ELEM_P2P_PD_REQ:
  6381. case VENDOR_ELEM_P2P_PD_RESP:
  6382. case VENDOR_ELEM_P2P_GO_NEG_REQ:
  6383. case VENDOR_ELEM_P2P_GO_NEG_RESP:
  6384. case VENDOR_ELEM_P2P_GO_NEG_CONF:
  6385. case VENDOR_ELEM_P2P_INV_REQ:
  6386. case VENDOR_ELEM_P2P_INV_RESP:
  6387. case VENDOR_ELEM_P2P_ASSOC_REQ:
  6388. return wpa_s->parent;
  6389. #endif /* CONFIG_P2P */
  6390. default:
  6391. return wpa_s;
  6392. }
  6393. }
  6394. static int wpas_ctrl_vendor_elem_add(struct wpa_supplicant *wpa_s, char *cmd)
  6395. {
  6396. char *pos = cmd;
  6397. int frame;
  6398. size_t len;
  6399. struct wpabuf *buf;
  6400. struct ieee802_11_elems elems;
  6401. frame = atoi(pos);
  6402. if (frame < 0 || frame >= NUM_VENDOR_ELEM_FRAMES)
  6403. return -1;
  6404. wpa_s = wpas_ctrl_vendor_elem_iface(wpa_s, frame);
  6405. pos = os_strchr(pos, ' ');
  6406. if (pos == NULL)
  6407. return -1;
  6408. pos++;
  6409. len = os_strlen(pos);
  6410. if (len == 0)
  6411. return 0;
  6412. if (len & 1)
  6413. return -1;
  6414. len /= 2;
  6415. buf = wpabuf_alloc(len);
  6416. if (buf == NULL)
  6417. return -1;
  6418. if (hexstr2bin(pos, wpabuf_put(buf, len), len) < 0) {
  6419. wpabuf_free(buf);
  6420. return -1;
  6421. }
  6422. if (ieee802_11_parse_elems(wpabuf_head_u8(buf), len, &elems, 0) ==
  6423. ParseFailed) {
  6424. wpabuf_free(buf);
  6425. return -1;
  6426. }
  6427. if (wpa_s->vendor_elem[frame] == NULL) {
  6428. wpa_s->vendor_elem[frame] = buf;
  6429. wpas_ctrl_vendor_elem_update(wpa_s);
  6430. return 0;
  6431. }
  6432. if (wpabuf_resize(&wpa_s->vendor_elem[frame], len) < 0) {
  6433. wpabuf_free(buf);
  6434. return -1;
  6435. }
  6436. wpabuf_put_buf(wpa_s->vendor_elem[frame], buf);
  6437. wpabuf_free(buf);
  6438. wpas_ctrl_vendor_elem_update(wpa_s);
  6439. return 0;
  6440. }
  6441. static int wpas_ctrl_vendor_elem_get(struct wpa_supplicant *wpa_s, char *cmd,
  6442. char *buf, size_t buflen)
  6443. {
  6444. int frame = atoi(cmd);
  6445. if (frame < 0 || frame >= NUM_VENDOR_ELEM_FRAMES)
  6446. return -1;
  6447. wpa_s = wpas_ctrl_vendor_elem_iface(wpa_s, frame);
  6448. if (wpa_s->vendor_elem[frame] == NULL)
  6449. return 0;
  6450. return wpa_snprintf_hex(buf, buflen,
  6451. wpabuf_head_u8(wpa_s->vendor_elem[frame]),
  6452. wpabuf_len(wpa_s->vendor_elem[frame]));
  6453. }
  6454. static int wpas_ctrl_vendor_elem_remove(struct wpa_supplicant *wpa_s, char *cmd)
  6455. {
  6456. char *pos = cmd;
  6457. int frame;
  6458. size_t len;
  6459. u8 *buf;
  6460. struct ieee802_11_elems elems;
  6461. u8 *ie, *end;
  6462. frame = atoi(pos);
  6463. if (frame < 0 || frame >= NUM_VENDOR_ELEM_FRAMES)
  6464. return -1;
  6465. wpa_s = wpas_ctrl_vendor_elem_iface(wpa_s, frame);
  6466. pos = os_strchr(pos, ' ');
  6467. if (pos == NULL)
  6468. return -1;
  6469. pos++;
  6470. if (*pos == '*') {
  6471. wpabuf_free(wpa_s->vendor_elem[frame]);
  6472. wpa_s->vendor_elem[frame] = NULL;
  6473. wpas_ctrl_vendor_elem_update(wpa_s);
  6474. return 0;
  6475. }
  6476. if (wpa_s->vendor_elem[frame] == NULL)
  6477. return -1;
  6478. len = os_strlen(pos);
  6479. if (len == 0)
  6480. return 0;
  6481. if (len & 1)
  6482. return -1;
  6483. len /= 2;
  6484. buf = os_malloc(len);
  6485. if (buf == NULL)
  6486. return -1;
  6487. if (hexstr2bin(pos, buf, len) < 0) {
  6488. os_free(buf);
  6489. return -1;
  6490. }
  6491. if (ieee802_11_parse_elems(buf, len, &elems, 0) == ParseFailed) {
  6492. os_free(buf);
  6493. return -1;
  6494. }
  6495. ie = wpabuf_mhead_u8(wpa_s->vendor_elem[frame]);
  6496. end = ie + wpabuf_len(wpa_s->vendor_elem[frame]);
  6497. for (; ie + 1 < end; ie += 2 + ie[1]) {
  6498. if (ie + len > end)
  6499. break;
  6500. if (os_memcmp(ie, buf, len) != 0)
  6501. continue;
  6502. if (wpabuf_len(wpa_s->vendor_elem[frame]) == len) {
  6503. wpabuf_free(wpa_s->vendor_elem[frame]);
  6504. wpa_s->vendor_elem[frame] = NULL;
  6505. } else {
  6506. os_memmove(ie, ie + len,
  6507. end - (ie + len));
  6508. wpa_s->vendor_elem[frame]->used -= len;
  6509. }
  6510. os_free(buf);
  6511. wpas_ctrl_vendor_elem_update(wpa_s);
  6512. return 0;
  6513. }
  6514. os_free(buf);
  6515. return -1;
  6516. }
  6517. static void wpas_ctrl_neighbor_rep_cb(void *ctx, struct wpabuf *neighbor_rep)
  6518. {
  6519. struct wpa_supplicant *wpa_s = ctx;
  6520. if (neighbor_rep) {
  6521. wpa_msg_ctrl(wpa_s, MSG_INFO, RRM_EVENT_NEIGHBOR_REP_RXED
  6522. "length=%u",
  6523. (unsigned int) wpabuf_len(neighbor_rep));
  6524. wpabuf_free(neighbor_rep);
  6525. } else {
  6526. wpa_msg_ctrl(wpa_s, MSG_INFO, RRM_EVENT_NEIGHBOR_REP_FAILED);
  6527. }
  6528. }
  6529. static int wpas_ctrl_iface_send_neigbor_rep(struct wpa_supplicant *wpa_s,
  6530. char *cmd)
  6531. {
  6532. struct wpa_ssid ssid;
  6533. struct wpa_ssid *ssid_p = NULL;
  6534. int ret = 0;
  6535. if (os_strncmp(cmd, " ssid=", 6) == 0) {
  6536. ssid.ssid_len = os_strlen(cmd + 6);
  6537. if (ssid.ssid_len > SSID_MAX_LEN)
  6538. return -1;
  6539. ssid.ssid = (u8 *) (cmd + 6);
  6540. ssid_p = &ssid;
  6541. }
  6542. ret = wpas_rrm_send_neighbor_rep_request(wpa_s, ssid_p,
  6543. wpas_ctrl_neighbor_rep_cb,
  6544. wpa_s);
  6545. return ret;
  6546. }
  6547. static int wpas_ctrl_iface_erp_flush(struct wpa_supplicant *wpa_s)
  6548. {
  6549. eapol_sm_erp_flush(wpa_s->eapol);
  6550. return 0;
  6551. }
  6552. static int wpas_ctrl_iface_mac_rand_scan(struct wpa_supplicant *wpa_s,
  6553. char *cmd)
  6554. {
  6555. char *token, *context = NULL;
  6556. unsigned int enable = ~0, type = 0;
  6557. u8 _addr[ETH_ALEN], _mask[ETH_ALEN];
  6558. u8 *addr = NULL, *mask = NULL;
  6559. while ((token = str_token(cmd, " ", &context))) {
  6560. if (os_strcasecmp(token, "scan") == 0) {
  6561. type |= MAC_ADDR_RAND_SCAN;
  6562. } else if (os_strcasecmp(token, "sched") == 0) {
  6563. type |= MAC_ADDR_RAND_SCHED_SCAN;
  6564. } else if (os_strcasecmp(token, "pno") == 0) {
  6565. type |= MAC_ADDR_RAND_PNO;
  6566. } else if (os_strcasecmp(token, "all") == 0) {
  6567. type = wpa_s->mac_addr_rand_supported;
  6568. } else if (os_strncasecmp(token, "enable=", 7) == 0) {
  6569. enable = atoi(token + 7);
  6570. } else if (os_strncasecmp(token, "addr=", 5) == 0) {
  6571. addr = _addr;
  6572. if (hwaddr_aton(token + 5, addr)) {
  6573. wpa_printf(MSG_INFO,
  6574. "CTRL: Invalid MAC address: %s",
  6575. token);
  6576. return -1;
  6577. }
  6578. } else if (os_strncasecmp(token, "mask=", 5) == 0) {
  6579. mask = _mask;
  6580. if (hwaddr_aton(token + 5, mask)) {
  6581. wpa_printf(MSG_INFO,
  6582. "CTRL: Invalid MAC address mask: %s",
  6583. token);
  6584. return -1;
  6585. }
  6586. } else {
  6587. wpa_printf(MSG_INFO,
  6588. "CTRL: Invalid MAC_RAND_SCAN parameter: %s",
  6589. token);
  6590. return -1;
  6591. }
  6592. }
  6593. if (!type) {
  6594. wpa_printf(MSG_INFO, "CTRL: MAC_RAND_SCAN no type specified");
  6595. return -1;
  6596. }
  6597. if ((wpa_s->mac_addr_rand_supported & type) != type) {
  6598. wpa_printf(MSG_INFO,
  6599. "CTRL: MAC_RAND_SCAN types=%u != supported=%u",
  6600. type, wpa_s->mac_addr_rand_supported);
  6601. return -1;
  6602. }
  6603. if (enable > 1) {
  6604. wpa_printf(MSG_INFO,
  6605. "CTRL: MAC_RAND_SCAN enable=<0/1> not specified");
  6606. return -1;
  6607. }
  6608. if (!enable) {
  6609. wpas_mac_addr_rand_scan_clear(wpa_s, type);
  6610. if (wpa_s->pno) {
  6611. if (type & MAC_ADDR_RAND_PNO) {
  6612. wpas_stop_pno(wpa_s);
  6613. wpas_start_pno(wpa_s);
  6614. }
  6615. } else if (wpa_s->sched_scanning &&
  6616. (type & MAC_ADDR_RAND_SCHED_SCAN)) {
  6617. /* simulate timeout to restart the sched scan */
  6618. wpa_s->sched_scan_timed_out = 1;
  6619. wpa_s->prev_sched_ssid = NULL;
  6620. wpa_supplicant_cancel_sched_scan(wpa_s);
  6621. }
  6622. return 0;
  6623. }
  6624. if ((addr && !mask) || (!addr && mask)) {
  6625. wpa_printf(MSG_INFO,
  6626. "CTRL: MAC_RAND_SCAN invalid addr/mask combination");
  6627. return -1;
  6628. }
  6629. if (addr && mask && (!(mask[0] & 0x01) || (addr[0] & 0x01))) {
  6630. wpa_printf(MSG_INFO,
  6631. "CTRL: MAC_RAND_SCAN cannot allow multicast address");
  6632. return -1;
  6633. }
  6634. if (type & MAC_ADDR_RAND_SCAN) {
  6635. wpas_mac_addr_rand_scan_set(wpa_s, MAC_ADDR_RAND_SCAN,
  6636. addr, mask);
  6637. }
  6638. if (type & MAC_ADDR_RAND_SCHED_SCAN) {
  6639. wpas_mac_addr_rand_scan_set(wpa_s, MAC_ADDR_RAND_SCHED_SCAN,
  6640. addr, mask);
  6641. if (wpa_s->sched_scanning && !wpa_s->pno) {
  6642. /* simulate timeout to restart the sched scan */
  6643. wpa_s->sched_scan_timed_out = 1;
  6644. wpa_s->prev_sched_ssid = NULL;
  6645. wpa_supplicant_cancel_sched_scan(wpa_s);
  6646. }
  6647. }
  6648. if (type & MAC_ADDR_RAND_PNO) {
  6649. wpas_mac_addr_rand_scan_set(wpa_s, MAC_ADDR_RAND_PNO,
  6650. addr, mask);
  6651. if (wpa_s->pno) {
  6652. wpas_stop_pno(wpa_s);
  6653. wpas_start_pno(wpa_s);
  6654. }
  6655. }
  6656. return 0;
  6657. }
  6658. char * wpa_supplicant_ctrl_iface_process(struct wpa_supplicant *wpa_s,
  6659. char *buf, size_t *resp_len)
  6660. {
  6661. char *reply;
  6662. const int reply_size = 4096;
  6663. int reply_len;
  6664. if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0 ||
  6665. os_strncmp(buf, "SET_NETWORK ", 12) == 0) {
  6666. if (wpa_debug_show_keys)
  6667. wpa_dbg(wpa_s, MSG_DEBUG,
  6668. "Control interface command '%s'", buf);
  6669. else
  6670. wpa_dbg(wpa_s, MSG_DEBUG,
  6671. "Control interface command '%s [REMOVED]'",
  6672. os_strncmp(buf, WPA_CTRL_RSP,
  6673. os_strlen(WPA_CTRL_RSP)) == 0 ?
  6674. WPA_CTRL_RSP : "SET_NETWORK");
  6675. } else if (os_strncmp(buf, "WPS_NFC_TAG_READ", 16) == 0 ||
  6676. os_strncmp(buf, "NFC_REPORT_HANDOVER", 19) == 0) {
  6677. wpa_hexdump_ascii_key(MSG_DEBUG, "RX ctrl_iface",
  6678. (const u8 *) buf, os_strlen(buf));
  6679. } else {
  6680. int level = MSG_DEBUG;
  6681. if (os_strcmp(buf, "PING") == 0)
  6682. level = MSG_EXCESSIVE;
  6683. wpa_dbg(wpa_s, level, "Control interface command '%s'", buf);
  6684. }
  6685. reply = os_malloc(reply_size);
  6686. if (reply == NULL) {
  6687. *resp_len = 1;
  6688. return NULL;
  6689. }
  6690. os_memcpy(reply, "OK\n", 3);
  6691. reply_len = 3;
  6692. if (os_strcmp(buf, "PING") == 0) {
  6693. os_memcpy(reply, "PONG\n", 5);
  6694. reply_len = 5;
  6695. } else if (os_strcmp(buf, "IFNAME") == 0) {
  6696. reply_len = os_strlen(wpa_s->ifname);
  6697. os_memcpy(reply, wpa_s->ifname, reply_len);
  6698. } else if (os_strncmp(buf, "RELOG", 5) == 0) {
  6699. if (wpa_debug_reopen_file() < 0)
  6700. reply_len = -1;
  6701. } else if (os_strncmp(buf, "NOTE ", 5) == 0) {
  6702. wpa_printf(MSG_INFO, "NOTE: %s", buf + 5);
  6703. } else if (os_strcmp(buf, "MIB") == 0) {
  6704. reply_len = wpa_sm_get_mib(wpa_s->wpa, reply, reply_size);
  6705. if (reply_len >= 0) {
  6706. reply_len += eapol_sm_get_mib(wpa_s->eapol,
  6707. reply + reply_len,
  6708. reply_size - reply_len);
  6709. }
  6710. } else if (os_strncmp(buf, "STATUS", 6) == 0) {
  6711. reply_len = wpa_supplicant_ctrl_iface_status(
  6712. wpa_s, buf + 6, reply, reply_size);
  6713. } else if (os_strcmp(buf, "PMKSA") == 0) {
  6714. reply_len = wpa_sm_pmksa_cache_list(wpa_s->wpa, reply,
  6715. reply_size);
  6716. } else if (os_strcmp(buf, "PMKSA_FLUSH") == 0) {
  6717. wpa_sm_pmksa_cache_flush(wpa_s->wpa, NULL);
  6718. } else if (os_strncmp(buf, "SET ", 4) == 0) {
  6719. if (wpa_supplicant_ctrl_iface_set(wpa_s, buf + 4))
  6720. reply_len = -1;
  6721. } else if (os_strncmp(buf, "DUMP", 4) == 0) {
  6722. reply_len = wpa_config_dump_values(wpa_s->conf,
  6723. reply, reply_size);
  6724. } else if (os_strncmp(buf, "GET ", 4) == 0) {
  6725. reply_len = wpa_supplicant_ctrl_iface_get(wpa_s, buf + 4,
  6726. reply, reply_size);
  6727. } else if (os_strcmp(buf, "LOGON") == 0) {
  6728. eapol_sm_notify_logoff(wpa_s->eapol, FALSE);
  6729. } else if (os_strcmp(buf, "LOGOFF") == 0) {
  6730. eapol_sm_notify_logoff(wpa_s->eapol, TRUE);
  6731. } else if (os_strcmp(buf, "REASSOCIATE") == 0) {
  6732. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
  6733. reply_len = -1;
  6734. else
  6735. wpas_request_connection(wpa_s);
  6736. } else if (os_strcmp(buf, "REATTACH") == 0) {
  6737. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED ||
  6738. !wpa_s->current_ssid)
  6739. reply_len = -1;
  6740. else {
  6741. wpa_s->reattach = 1;
  6742. wpas_request_connection(wpa_s);
  6743. }
  6744. } else if (os_strcmp(buf, "RECONNECT") == 0) {
  6745. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
  6746. reply_len = -1;
  6747. else if (wpa_s->disconnected)
  6748. wpas_request_connection(wpa_s);
  6749. #ifdef IEEE8021X_EAPOL
  6750. } else if (os_strncmp(buf, "PREAUTH ", 8) == 0) {
  6751. if (wpa_supplicant_ctrl_iface_preauth(wpa_s, buf + 8))
  6752. reply_len = -1;
  6753. #endif /* IEEE8021X_EAPOL */
  6754. #ifdef CONFIG_PEERKEY
  6755. } else if (os_strncmp(buf, "STKSTART ", 9) == 0) {
  6756. if (wpa_supplicant_ctrl_iface_stkstart(wpa_s, buf + 9))
  6757. reply_len = -1;
  6758. #endif /* CONFIG_PEERKEY */
  6759. #ifdef CONFIG_IEEE80211R
  6760. } else if (os_strncmp(buf, "FT_DS ", 6) == 0) {
  6761. if (wpa_supplicant_ctrl_iface_ft_ds(wpa_s, buf + 6))
  6762. reply_len = -1;
  6763. #endif /* CONFIG_IEEE80211R */
  6764. #ifdef CONFIG_WPS
  6765. } else if (os_strcmp(buf, "WPS_PBC") == 0) {
  6766. int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, NULL);
  6767. if (res == -2) {
  6768. os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
  6769. reply_len = 17;
  6770. } else if (res)
  6771. reply_len = -1;
  6772. } else if (os_strncmp(buf, "WPS_PBC ", 8) == 0) {
  6773. int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, buf + 8);
  6774. if (res == -2) {
  6775. os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
  6776. reply_len = 17;
  6777. } else if (res)
  6778. reply_len = -1;
  6779. } else if (os_strncmp(buf, "WPS_PIN ", 8) == 0) {
  6780. reply_len = wpa_supplicant_ctrl_iface_wps_pin(wpa_s, buf + 8,
  6781. reply,
  6782. reply_size);
  6783. } else if (os_strncmp(buf, "WPS_CHECK_PIN ", 14) == 0) {
  6784. reply_len = wpa_supplicant_ctrl_iface_wps_check_pin(
  6785. wpa_s, buf + 14, reply, reply_size);
  6786. } else if (os_strcmp(buf, "WPS_CANCEL") == 0) {
  6787. if (wpas_wps_cancel(wpa_s))
  6788. reply_len = -1;
  6789. #ifdef CONFIG_WPS_NFC
  6790. } else if (os_strcmp(buf, "WPS_NFC") == 0) {
  6791. if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, NULL))
  6792. reply_len = -1;
  6793. } else if (os_strncmp(buf, "WPS_NFC ", 8) == 0) {
  6794. if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, buf + 8))
  6795. reply_len = -1;
  6796. } else if (os_strncmp(buf, "WPS_NFC_CONFIG_TOKEN ", 21) == 0) {
  6797. reply_len = wpa_supplicant_ctrl_iface_wps_nfc_config_token(
  6798. wpa_s, buf + 21, reply, reply_size);
  6799. } else if (os_strncmp(buf, "WPS_NFC_TOKEN ", 14) == 0) {
  6800. reply_len = wpa_supplicant_ctrl_iface_wps_nfc_token(
  6801. wpa_s, buf + 14, reply, reply_size);
  6802. } else if (os_strncmp(buf, "WPS_NFC_TAG_READ ", 17) == 0) {
  6803. if (wpa_supplicant_ctrl_iface_wps_nfc_tag_read(wpa_s,
  6804. buf + 17))
  6805. reply_len = -1;
  6806. } else if (os_strncmp(buf, "NFC_GET_HANDOVER_REQ ", 21) == 0) {
  6807. reply_len = wpas_ctrl_nfc_get_handover_req(
  6808. wpa_s, buf + 21, reply, reply_size);
  6809. } else if (os_strncmp(buf, "NFC_GET_HANDOVER_SEL ", 21) == 0) {
  6810. reply_len = wpas_ctrl_nfc_get_handover_sel(
  6811. wpa_s, buf + 21, reply, reply_size);
  6812. } else if (os_strncmp(buf, "NFC_REPORT_HANDOVER ", 20) == 0) {
  6813. if (wpas_ctrl_nfc_report_handover(wpa_s, buf + 20))
  6814. reply_len = -1;
  6815. #endif /* CONFIG_WPS_NFC */
  6816. } else if (os_strncmp(buf, "WPS_REG ", 8) == 0) {
  6817. if (wpa_supplicant_ctrl_iface_wps_reg(wpa_s, buf + 8))
  6818. reply_len = -1;
  6819. #ifdef CONFIG_AP
  6820. } else if (os_strncmp(buf, "WPS_AP_PIN ", 11) == 0) {
  6821. reply_len = wpa_supplicant_ctrl_iface_wps_ap_pin(
  6822. wpa_s, buf + 11, reply, reply_size);
  6823. #endif /* CONFIG_AP */
  6824. #ifdef CONFIG_WPS_ER
  6825. } else if (os_strcmp(buf, "WPS_ER_START") == 0) {
  6826. if (wpas_wps_er_start(wpa_s, NULL))
  6827. reply_len = -1;
  6828. } else if (os_strncmp(buf, "WPS_ER_START ", 13) == 0) {
  6829. if (wpas_wps_er_start(wpa_s, buf + 13))
  6830. reply_len = -1;
  6831. } else if (os_strcmp(buf, "WPS_ER_STOP") == 0) {
  6832. wpas_wps_er_stop(wpa_s);
  6833. } else if (os_strncmp(buf, "WPS_ER_PIN ", 11) == 0) {
  6834. if (wpa_supplicant_ctrl_iface_wps_er_pin(wpa_s, buf + 11))
  6835. reply_len = -1;
  6836. } else if (os_strncmp(buf, "WPS_ER_PBC ", 11) == 0) {
  6837. int ret = wpas_wps_er_pbc(wpa_s, buf + 11);
  6838. if (ret == -2) {
  6839. os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
  6840. reply_len = 17;
  6841. } else if (ret == -3) {
  6842. os_memcpy(reply, "FAIL-UNKNOWN-UUID\n", 18);
  6843. reply_len = 18;
  6844. } else if (ret == -4) {
  6845. os_memcpy(reply, "FAIL-NO-AP-SETTINGS\n", 20);
  6846. reply_len = 20;
  6847. } else if (ret)
  6848. reply_len = -1;
  6849. } else if (os_strncmp(buf, "WPS_ER_LEARN ", 13) == 0) {
  6850. if (wpa_supplicant_ctrl_iface_wps_er_learn(wpa_s, buf + 13))
  6851. reply_len = -1;
  6852. } else if (os_strncmp(buf, "WPS_ER_SET_CONFIG ", 18) == 0) {
  6853. if (wpa_supplicant_ctrl_iface_wps_er_set_config(wpa_s,
  6854. buf + 18))
  6855. reply_len = -1;
  6856. } else if (os_strncmp(buf, "WPS_ER_CONFIG ", 14) == 0) {
  6857. if (wpa_supplicant_ctrl_iface_wps_er_config(wpa_s, buf + 14))
  6858. reply_len = -1;
  6859. #ifdef CONFIG_WPS_NFC
  6860. } else if (os_strncmp(buf, "WPS_ER_NFC_CONFIG_TOKEN ", 24) == 0) {
  6861. reply_len = wpa_supplicant_ctrl_iface_wps_er_nfc_config_token(
  6862. wpa_s, buf + 24, reply, reply_size);
  6863. #endif /* CONFIG_WPS_NFC */
  6864. #endif /* CONFIG_WPS_ER */
  6865. #endif /* CONFIG_WPS */
  6866. #ifdef CONFIG_IBSS_RSN
  6867. } else if (os_strncmp(buf, "IBSS_RSN ", 9) == 0) {
  6868. if (wpa_supplicant_ctrl_iface_ibss_rsn(wpa_s, buf + 9))
  6869. reply_len = -1;
  6870. #endif /* CONFIG_IBSS_RSN */
  6871. #ifdef CONFIG_MESH
  6872. } else if (os_strncmp(buf, "MESH_INTERFACE_ADD ", 19) == 0) {
  6873. reply_len = wpa_supplicant_ctrl_iface_mesh_interface_add(
  6874. wpa_s, buf + 19, reply, reply_size);
  6875. } else if (os_strcmp(buf, "MESH_INTERFACE_ADD") == 0) {
  6876. reply_len = wpa_supplicant_ctrl_iface_mesh_interface_add(
  6877. wpa_s, "", reply, reply_size);
  6878. } else if (os_strncmp(buf, "MESH_GROUP_ADD ", 15) == 0) {
  6879. if (wpa_supplicant_ctrl_iface_mesh_group_add(wpa_s, buf + 15))
  6880. reply_len = -1;
  6881. } else if (os_strncmp(buf, "MESH_GROUP_REMOVE ", 18) == 0) {
  6882. if (wpa_supplicant_ctrl_iface_mesh_group_remove(wpa_s,
  6883. buf + 18))
  6884. reply_len = -1;
  6885. #endif /* CONFIG_MESH */
  6886. #ifdef CONFIG_P2P
  6887. } else if (os_strncmp(buf, "P2P_FIND ", 9) == 0) {
  6888. if (p2p_ctrl_find(wpa_s, buf + 8))
  6889. reply_len = -1;
  6890. } else if (os_strcmp(buf, "P2P_FIND") == 0) {
  6891. if (p2p_ctrl_find(wpa_s, ""))
  6892. reply_len = -1;
  6893. } else if (os_strcmp(buf, "P2P_STOP_FIND") == 0) {
  6894. wpas_p2p_stop_find(wpa_s);
  6895. } else if (os_strncmp(buf, "P2P_ASP_PROVISION ", 18) == 0) {
  6896. if (p2p_ctrl_asp_provision(wpa_s, buf + 18))
  6897. reply_len = -1;
  6898. } else if (os_strncmp(buf, "P2P_ASP_PROVISION_RESP ", 23) == 0) {
  6899. if (p2p_ctrl_asp_provision_resp(wpa_s, buf + 23))
  6900. reply_len = -1;
  6901. } else if (os_strncmp(buf, "P2P_CONNECT ", 12) == 0) {
  6902. reply_len = p2p_ctrl_connect(wpa_s, buf + 12, reply,
  6903. reply_size);
  6904. } else if (os_strncmp(buf, "P2P_LISTEN ", 11) == 0) {
  6905. if (p2p_ctrl_listen(wpa_s, buf + 11))
  6906. reply_len = -1;
  6907. } else if (os_strcmp(buf, "P2P_LISTEN") == 0) {
  6908. if (p2p_ctrl_listen(wpa_s, ""))
  6909. reply_len = -1;
  6910. } else if (os_strncmp(buf, "P2P_GROUP_REMOVE ", 17) == 0) {
  6911. if (wpas_p2p_group_remove(wpa_s, buf + 17))
  6912. reply_len = -1;
  6913. } else if (os_strcmp(buf, "P2P_GROUP_ADD") == 0) {
  6914. if (wpas_p2p_group_add(wpa_s, 0, 0, 0, 0))
  6915. reply_len = -1;
  6916. } else if (os_strncmp(buf, "P2P_GROUP_ADD ", 14) == 0) {
  6917. if (p2p_ctrl_group_add(wpa_s, buf + 14))
  6918. reply_len = -1;
  6919. } else if (os_strncmp(buf, "P2P_PROV_DISC ", 14) == 0) {
  6920. if (p2p_ctrl_prov_disc(wpa_s, buf + 14))
  6921. reply_len = -1;
  6922. } else if (os_strcmp(buf, "P2P_GET_PASSPHRASE") == 0) {
  6923. reply_len = p2p_get_passphrase(wpa_s, reply, reply_size);
  6924. } else if (os_strncmp(buf, "P2P_SERV_DISC_REQ ", 18) == 0) {
  6925. reply_len = p2p_ctrl_serv_disc_req(wpa_s, buf + 18, reply,
  6926. reply_size);
  6927. } else if (os_strncmp(buf, "P2P_SERV_DISC_CANCEL_REQ ", 25) == 0) {
  6928. if (p2p_ctrl_serv_disc_cancel_req(wpa_s, buf + 25) < 0)
  6929. reply_len = -1;
  6930. } else if (os_strncmp(buf, "P2P_SERV_DISC_RESP ", 19) == 0) {
  6931. if (p2p_ctrl_serv_disc_resp(wpa_s, buf + 19) < 0)
  6932. reply_len = -1;
  6933. } else if (os_strcmp(buf, "P2P_SERVICE_UPDATE") == 0) {
  6934. wpas_p2p_sd_service_update(wpa_s);
  6935. } else if (os_strncmp(buf, "P2P_SERV_DISC_EXTERNAL ", 23) == 0) {
  6936. if (p2p_ctrl_serv_disc_external(wpa_s, buf + 23) < 0)
  6937. reply_len = -1;
  6938. } else if (os_strcmp(buf, "P2P_SERVICE_FLUSH") == 0) {
  6939. wpas_p2p_service_flush(wpa_s);
  6940. } else if (os_strncmp(buf, "P2P_SERVICE_ADD ", 16) == 0) {
  6941. if (p2p_ctrl_service_add(wpa_s, buf + 16) < 0)
  6942. reply_len = -1;
  6943. } else if (os_strncmp(buf, "P2P_SERVICE_DEL ", 16) == 0) {
  6944. if (p2p_ctrl_service_del(wpa_s, buf + 16) < 0)
  6945. reply_len = -1;
  6946. } else if (os_strncmp(buf, "P2P_SERVICE_REP ", 16) == 0) {
  6947. if (p2p_ctrl_service_replace(wpa_s, buf + 16) < 0)
  6948. reply_len = -1;
  6949. } else if (os_strncmp(buf, "P2P_REJECT ", 11) == 0) {
  6950. if (p2p_ctrl_reject(wpa_s, buf + 11) < 0)
  6951. reply_len = -1;
  6952. } else if (os_strncmp(buf, "P2P_INVITE ", 11) == 0) {
  6953. if (p2p_ctrl_invite(wpa_s, buf + 11) < 0)
  6954. reply_len = -1;
  6955. } else if (os_strncmp(buf, "P2P_PEER ", 9) == 0) {
  6956. reply_len = p2p_ctrl_peer(wpa_s, buf + 9, reply,
  6957. reply_size);
  6958. } else if (os_strncmp(buf, "P2P_SET ", 8) == 0) {
  6959. if (p2p_ctrl_set(wpa_s, buf + 8) < 0)
  6960. reply_len = -1;
  6961. } else if (os_strcmp(buf, "P2P_FLUSH") == 0) {
  6962. p2p_ctrl_flush(wpa_s);
  6963. } else if (os_strncmp(buf, "P2P_UNAUTHORIZE ", 16) == 0) {
  6964. if (wpas_p2p_unauthorize(wpa_s, buf + 16) < 0)
  6965. reply_len = -1;
  6966. } else if (os_strcmp(buf, "P2P_CANCEL") == 0) {
  6967. if (wpas_p2p_cancel(wpa_s))
  6968. reply_len = -1;
  6969. } else if (os_strncmp(buf, "P2P_PRESENCE_REQ ", 17) == 0) {
  6970. if (p2p_ctrl_presence_req(wpa_s, buf + 17) < 0)
  6971. reply_len = -1;
  6972. } else if (os_strcmp(buf, "P2P_PRESENCE_REQ") == 0) {
  6973. if (p2p_ctrl_presence_req(wpa_s, "") < 0)
  6974. reply_len = -1;
  6975. } else if (os_strncmp(buf, "P2P_EXT_LISTEN ", 15) == 0) {
  6976. if (p2p_ctrl_ext_listen(wpa_s, buf + 15) < 0)
  6977. reply_len = -1;
  6978. } else if (os_strcmp(buf, "P2P_EXT_LISTEN") == 0) {
  6979. if (p2p_ctrl_ext_listen(wpa_s, "") < 0)
  6980. reply_len = -1;
  6981. } else if (os_strncmp(buf, "P2P_REMOVE_CLIENT ", 18) == 0) {
  6982. if (p2p_ctrl_remove_client(wpa_s, buf + 18) < 0)
  6983. reply_len = -1;
  6984. #endif /* CONFIG_P2P */
  6985. #ifdef CONFIG_WIFI_DISPLAY
  6986. } else if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0) {
  6987. if (wifi_display_subelem_set(wpa_s->global, buf + 16) < 0)
  6988. reply_len = -1;
  6989. } else if (os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0) {
  6990. reply_len = wifi_display_subelem_get(wpa_s->global, buf + 16,
  6991. reply, reply_size);
  6992. #endif /* CONFIG_WIFI_DISPLAY */
  6993. #ifdef CONFIG_INTERWORKING
  6994. } else if (os_strcmp(buf, "FETCH_ANQP") == 0) {
  6995. if (interworking_fetch_anqp(wpa_s) < 0)
  6996. reply_len = -1;
  6997. } else if (os_strcmp(buf, "STOP_FETCH_ANQP") == 0) {
  6998. interworking_stop_fetch_anqp(wpa_s);
  6999. } else if (os_strcmp(buf, "INTERWORKING_SELECT") == 0) {
  7000. if (ctrl_interworking_select(wpa_s, NULL) < 0)
  7001. reply_len = -1;
  7002. } else if (os_strncmp(buf, "INTERWORKING_SELECT ", 20) == 0) {
  7003. if (ctrl_interworking_select(wpa_s, buf + 20) < 0)
  7004. reply_len = -1;
  7005. } else if (os_strncmp(buf, "INTERWORKING_CONNECT ", 21) == 0) {
  7006. if (ctrl_interworking_connect(wpa_s, buf + 21, 0) < 0)
  7007. reply_len = -1;
  7008. } else if (os_strncmp(buf, "INTERWORKING_ADD_NETWORK ", 25) == 0) {
  7009. int id;
  7010. id = ctrl_interworking_connect(wpa_s, buf + 25, 1);
  7011. if (id < 0)
  7012. reply_len = -1;
  7013. else {
  7014. reply_len = os_snprintf(reply, reply_size, "%d\n", id);
  7015. if (os_snprintf_error(reply_size, reply_len))
  7016. reply_len = -1;
  7017. }
  7018. } else if (os_strncmp(buf, "ANQP_GET ", 9) == 0) {
  7019. if (get_anqp(wpa_s, buf + 9) < 0)
  7020. reply_len = -1;
  7021. } else if (os_strncmp(buf, "GAS_REQUEST ", 12) == 0) {
  7022. if (gas_request(wpa_s, buf + 12) < 0)
  7023. reply_len = -1;
  7024. } else if (os_strncmp(buf, "GAS_RESPONSE_GET ", 17) == 0) {
  7025. reply_len = gas_response_get(wpa_s, buf + 17, reply,
  7026. reply_size);
  7027. #endif /* CONFIG_INTERWORKING */
  7028. #ifdef CONFIG_HS20
  7029. } else if (os_strncmp(buf, "HS20_ANQP_GET ", 14) == 0) {
  7030. if (get_hs20_anqp(wpa_s, buf + 14) < 0)
  7031. reply_len = -1;
  7032. } else if (os_strncmp(buf, "HS20_GET_NAI_HOME_REALM_LIST ", 29) == 0) {
  7033. if (hs20_get_nai_home_realm_list(wpa_s, buf + 29) < 0)
  7034. reply_len = -1;
  7035. } else if (os_strncmp(buf, "HS20_ICON_REQUEST ", 18) == 0) {
  7036. if (hs20_icon_request(wpa_s, buf + 18) < 0)
  7037. reply_len = -1;
  7038. } else if (os_strcmp(buf, "FETCH_OSU") == 0) {
  7039. if (hs20_fetch_osu(wpa_s) < 0)
  7040. reply_len = -1;
  7041. } else if (os_strcmp(buf, "CANCEL_FETCH_OSU") == 0) {
  7042. hs20_cancel_fetch_osu(wpa_s);
  7043. #endif /* CONFIG_HS20 */
  7044. } else if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0)
  7045. {
  7046. if (wpa_supplicant_ctrl_iface_ctrl_rsp(
  7047. wpa_s, buf + os_strlen(WPA_CTRL_RSP)))
  7048. reply_len = -1;
  7049. else {
  7050. /*
  7051. * Notify response from timeout to allow the control
  7052. * interface response to be sent first.
  7053. */
  7054. eloop_register_timeout(0, 0, wpas_ctrl_eapol_response,
  7055. wpa_s, NULL);
  7056. }
  7057. } else if (os_strcmp(buf, "RECONFIGURE") == 0) {
  7058. if (wpa_supplicant_reload_configuration(wpa_s))
  7059. reply_len = -1;
  7060. } else if (os_strcmp(buf, "TERMINATE") == 0) {
  7061. wpa_supplicant_terminate_proc(wpa_s->global);
  7062. } else if (os_strncmp(buf, "BSSID ", 6) == 0) {
  7063. if (wpa_supplicant_ctrl_iface_bssid(wpa_s, buf + 6))
  7064. reply_len = -1;
  7065. } else if (os_strncmp(buf, "BLACKLIST", 9) == 0) {
  7066. reply_len = wpa_supplicant_ctrl_iface_blacklist(
  7067. wpa_s, buf + 9, reply, reply_size);
  7068. } else if (os_strncmp(buf, "LOG_LEVEL", 9) == 0) {
  7069. reply_len = wpa_supplicant_ctrl_iface_log_level(
  7070. wpa_s, buf + 9, reply, reply_size);
  7071. } else if (os_strncmp(buf, "LIST_NETWORKS ", 14) == 0) {
  7072. reply_len = wpa_supplicant_ctrl_iface_list_networks(
  7073. wpa_s, buf + 14, reply, reply_size);
  7074. } else if (os_strcmp(buf, "LIST_NETWORKS") == 0) {
  7075. reply_len = wpa_supplicant_ctrl_iface_list_networks(
  7076. wpa_s, NULL, reply, reply_size);
  7077. } else if (os_strcmp(buf, "DISCONNECT") == 0) {
  7078. #ifdef CONFIG_SME
  7079. wpa_s->sme.prev_bssid_set = 0;
  7080. #endif /* CONFIG_SME */
  7081. wpa_s->reassociate = 0;
  7082. wpa_s->disconnected = 1;
  7083. wpa_supplicant_cancel_sched_scan(wpa_s);
  7084. wpa_supplicant_cancel_scan(wpa_s);
  7085. wpa_supplicant_deauthenticate(wpa_s,
  7086. WLAN_REASON_DEAUTH_LEAVING);
  7087. eloop_cancel_timeout(wpas_network_reenabled, wpa_s, NULL);
  7088. } else if (os_strcmp(buf, "SCAN") == 0) {
  7089. wpas_ctrl_scan(wpa_s, NULL, reply, reply_size, &reply_len);
  7090. } else if (os_strncmp(buf, "SCAN ", 5) == 0) {
  7091. wpas_ctrl_scan(wpa_s, buf + 5, reply, reply_size, &reply_len);
  7092. } else if (os_strcmp(buf, "SCAN_RESULTS") == 0) {
  7093. reply_len = wpa_supplicant_ctrl_iface_scan_results(
  7094. wpa_s, reply, reply_size);
  7095. } else if (os_strncmp(buf, "SELECT_NETWORK ", 15) == 0) {
  7096. if (wpa_supplicant_ctrl_iface_select_network(wpa_s, buf + 15))
  7097. reply_len = -1;
  7098. } else if (os_strncmp(buf, "ENABLE_NETWORK ", 15) == 0) {
  7099. if (wpa_supplicant_ctrl_iface_enable_network(wpa_s, buf + 15))
  7100. reply_len = -1;
  7101. } else if (os_strncmp(buf, "DISABLE_NETWORK ", 16) == 0) {
  7102. if (wpa_supplicant_ctrl_iface_disable_network(wpa_s, buf + 16))
  7103. reply_len = -1;
  7104. } else if (os_strcmp(buf, "ADD_NETWORK") == 0) {
  7105. reply_len = wpa_supplicant_ctrl_iface_add_network(
  7106. wpa_s, reply, reply_size);
  7107. } else if (os_strncmp(buf, "REMOVE_NETWORK ", 15) == 0) {
  7108. if (wpa_supplicant_ctrl_iface_remove_network(wpa_s, buf + 15))
  7109. reply_len = -1;
  7110. } else if (os_strncmp(buf, "SET_NETWORK ", 12) == 0) {
  7111. if (wpa_supplicant_ctrl_iface_set_network(wpa_s, buf + 12))
  7112. reply_len = -1;
  7113. } else if (os_strncmp(buf, "GET_NETWORK ", 12) == 0) {
  7114. reply_len = wpa_supplicant_ctrl_iface_get_network(
  7115. wpa_s, buf + 12, reply, reply_size);
  7116. } else if (os_strncmp(buf, "DUP_NETWORK ", 12) == 0) {
  7117. if (wpa_supplicant_ctrl_iface_dup_network(wpa_s, buf + 12))
  7118. reply_len = -1;
  7119. } else if (os_strcmp(buf, "LIST_CREDS") == 0) {
  7120. reply_len = wpa_supplicant_ctrl_iface_list_creds(
  7121. wpa_s, reply, reply_size);
  7122. } else if (os_strcmp(buf, "ADD_CRED") == 0) {
  7123. reply_len = wpa_supplicant_ctrl_iface_add_cred(
  7124. wpa_s, reply, reply_size);
  7125. } else if (os_strncmp(buf, "REMOVE_CRED ", 12) == 0) {
  7126. if (wpa_supplicant_ctrl_iface_remove_cred(wpa_s, buf + 12))
  7127. reply_len = -1;
  7128. } else if (os_strncmp(buf, "SET_CRED ", 9) == 0) {
  7129. if (wpa_supplicant_ctrl_iface_set_cred(wpa_s, buf + 9))
  7130. reply_len = -1;
  7131. } else if (os_strncmp(buf, "GET_CRED ", 9) == 0) {
  7132. reply_len = wpa_supplicant_ctrl_iface_get_cred(wpa_s, buf + 9,
  7133. reply,
  7134. reply_size);
  7135. #ifndef CONFIG_NO_CONFIG_WRITE
  7136. } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
  7137. if (wpa_supplicant_ctrl_iface_save_config(wpa_s))
  7138. reply_len = -1;
  7139. #endif /* CONFIG_NO_CONFIG_WRITE */
  7140. } else if (os_strncmp(buf, "GET_CAPABILITY ", 15) == 0) {
  7141. reply_len = wpa_supplicant_ctrl_iface_get_capability(
  7142. wpa_s, buf + 15, reply, reply_size);
  7143. } else if (os_strncmp(buf, "AP_SCAN ", 8) == 0) {
  7144. if (wpa_supplicant_ctrl_iface_ap_scan(wpa_s, buf + 8))
  7145. reply_len = -1;
  7146. } else if (os_strncmp(buf, "SCAN_INTERVAL ", 14) == 0) {
  7147. if (wpa_supplicant_ctrl_iface_scan_interval(wpa_s, buf + 14))
  7148. reply_len = -1;
  7149. } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
  7150. reply_len = wpa_supplicant_global_iface_list(
  7151. wpa_s->global, reply, reply_size);
  7152. } else if (os_strcmp(buf, "INTERFACES") == 0) {
  7153. reply_len = wpa_supplicant_global_iface_interfaces(
  7154. wpa_s->global, reply, reply_size);
  7155. } else if (os_strncmp(buf, "BSS ", 4) == 0) {
  7156. reply_len = wpa_supplicant_ctrl_iface_bss(
  7157. wpa_s, buf + 4, reply, reply_size);
  7158. #ifdef CONFIG_AP
  7159. } else if (os_strcmp(buf, "STA-FIRST") == 0) {
  7160. reply_len = ap_ctrl_iface_sta_first(wpa_s, reply, reply_size);
  7161. } else if (os_strncmp(buf, "STA ", 4) == 0) {
  7162. reply_len = ap_ctrl_iface_sta(wpa_s, buf + 4, reply,
  7163. reply_size);
  7164. } else if (os_strncmp(buf, "STA-NEXT ", 9) == 0) {
  7165. reply_len = ap_ctrl_iface_sta_next(wpa_s, buf + 9, reply,
  7166. reply_size);
  7167. } else if (os_strncmp(buf, "DEAUTHENTICATE ", 15) == 0) {
  7168. if (ap_ctrl_iface_sta_deauthenticate(wpa_s, buf + 15))
  7169. reply_len = -1;
  7170. } else if (os_strncmp(buf, "DISASSOCIATE ", 13) == 0) {
  7171. if (ap_ctrl_iface_sta_disassociate(wpa_s, buf + 13))
  7172. reply_len = -1;
  7173. } else if (os_strncmp(buf, "CHAN_SWITCH ", 12) == 0) {
  7174. if (ap_ctrl_iface_chanswitch(wpa_s, buf + 12))
  7175. reply_len = -1;
  7176. } else if (os_strcmp(buf, "STOP_AP") == 0) {
  7177. if (wpas_ap_stop_ap(wpa_s))
  7178. reply_len = -1;
  7179. #endif /* CONFIG_AP */
  7180. } else if (os_strcmp(buf, "SUSPEND") == 0) {
  7181. wpas_notify_suspend(wpa_s->global);
  7182. } else if (os_strcmp(buf, "RESUME") == 0) {
  7183. wpas_notify_resume(wpa_s->global);
  7184. #ifdef CONFIG_TESTING_OPTIONS
  7185. } else if (os_strcmp(buf, "DROP_SA") == 0) {
  7186. wpa_supplicant_ctrl_iface_drop_sa(wpa_s);
  7187. #endif /* CONFIG_TESTING_OPTIONS */
  7188. } else if (os_strncmp(buf, "ROAM ", 5) == 0) {
  7189. if (wpa_supplicant_ctrl_iface_roam(wpa_s, buf + 5))
  7190. reply_len = -1;
  7191. } else if (os_strncmp(buf, "STA_AUTOCONNECT ", 16) == 0) {
  7192. wpa_s->auto_reconnect_disabled = atoi(buf + 16) == 0;
  7193. } else if (os_strncmp(buf, "BSS_EXPIRE_AGE ", 15) == 0) {
  7194. if (wpa_supplicant_ctrl_iface_bss_expire_age(wpa_s, buf + 15))
  7195. reply_len = -1;
  7196. } else if (os_strncmp(buf, "BSS_EXPIRE_COUNT ", 17) == 0) {
  7197. if (wpa_supplicant_ctrl_iface_bss_expire_count(wpa_s,
  7198. buf + 17))
  7199. reply_len = -1;
  7200. } else if (os_strncmp(buf, "BSS_FLUSH ", 10) == 0) {
  7201. wpa_supplicant_ctrl_iface_bss_flush(wpa_s, buf + 10);
  7202. #ifdef CONFIG_TDLS
  7203. } else if (os_strncmp(buf, "TDLS_DISCOVER ", 14) == 0) {
  7204. if (wpa_supplicant_ctrl_iface_tdls_discover(wpa_s, buf + 14))
  7205. reply_len = -1;
  7206. } else if (os_strncmp(buf, "TDLS_SETUP ", 11) == 0) {
  7207. if (wpa_supplicant_ctrl_iface_tdls_setup(wpa_s, buf + 11))
  7208. reply_len = -1;
  7209. } else if (os_strncmp(buf, "TDLS_TEARDOWN ", 14) == 0) {
  7210. if (wpa_supplicant_ctrl_iface_tdls_teardown(wpa_s, buf + 14))
  7211. reply_len = -1;
  7212. } else if (os_strncmp(buf, "TDLS_CHAN_SWITCH ", 17) == 0) {
  7213. if (wpa_supplicant_ctrl_iface_tdls_chan_switch(wpa_s,
  7214. buf + 17))
  7215. reply_len = -1;
  7216. } else if (os_strncmp(buf, "TDLS_CANCEL_CHAN_SWITCH ", 24) == 0) {
  7217. if (wpa_supplicant_ctrl_iface_tdls_cancel_chan_switch(wpa_s,
  7218. buf + 24))
  7219. reply_len = -1;
  7220. } else if (os_strncmp(buf, "TDLS_LINK_STATUS ", 17) == 0) {
  7221. reply_len = wpa_supplicant_ctrl_iface_tdls_link_status(
  7222. wpa_s, buf + 17, reply, reply_size);
  7223. #endif /* CONFIG_TDLS */
  7224. } else if (os_strcmp(buf, "WMM_AC_STATUS") == 0) {
  7225. reply_len = wpas_wmm_ac_status(wpa_s, reply, reply_size);
  7226. } else if (os_strncmp(buf, "WMM_AC_ADDTS ", 13) == 0) {
  7227. if (wmm_ac_ctrl_addts(wpa_s, buf + 13))
  7228. reply_len = -1;
  7229. } else if (os_strncmp(buf, "WMM_AC_DELTS ", 13) == 0) {
  7230. if (wmm_ac_ctrl_delts(wpa_s, buf + 13))
  7231. reply_len = -1;
  7232. } else if (os_strncmp(buf, "SIGNAL_POLL", 11) == 0) {
  7233. reply_len = wpa_supplicant_signal_poll(wpa_s, reply,
  7234. reply_size);
  7235. } else if (os_strncmp(buf, "PKTCNT_POLL", 11) == 0) {
  7236. reply_len = wpa_supplicant_pktcnt_poll(wpa_s, reply,
  7237. reply_size);
  7238. #ifdef CONFIG_AUTOSCAN
  7239. } else if (os_strncmp(buf, "AUTOSCAN ", 9) == 0) {
  7240. if (wpa_supplicant_ctrl_iface_autoscan(wpa_s, buf + 9))
  7241. reply_len = -1;
  7242. #endif /* CONFIG_AUTOSCAN */
  7243. #ifdef ANDROID
  7244. } else if (os_strncmp(buf, "DRIVER ", 7) == 0) {
  7245. reply_len = wpa_supplicant_driver_cmd(wpa_s, buf + 7, reply,
  7246. reply_size);
  7247. #endif /* ANDROID */
  7248. } else if (os_strncmp(buf, "VENDOR ", 7) == 0) {
  7249. reply_len = wpa_supplicant_vendor_cmd(wpa_s, buf + 7, reply,
  7250. reply_size);
  7251. } else if (os_strcmp(buf, "REAUTHENTICATE") == 0) {
  7252. pmksa_cache_clear_current(wpa_s->wpa);
  7253. eapol_sm_request_reauth(wpa_s->eapol);
  7254. #ifdef CONFIG_WNM
  7255. } else if (os_strncmp(buf, "WNM_SLEEP ", 10) == 0) {
  7256. if (wpas_ctrl_iface_wnm_sleep(wpa_s, buf + 10))
  7257. reply_len = -1;
  7258. } else if (os_strncmp(buf, "WNM_BSS_QUERY ", 14) == 0) {
  7259. if (wpas_ctrl_iface_wnm_bss_query(wpa_s, buf + 14))
  7260. reply_len = -1;
  7261. #endif /* CONFIG_WNM */
  7262. } else if (os_strcmp(buf, "FLUSH") == 0) {
  7263. wpa_supplicant_ctrl_iface_flush(wpa_s);
  7264. } else if (os_strncmp(buf, "RADIO_WORK ", 11) == 0) {
  7265. reply_len = wpas_ctrl_radio_work(wpa_s, buf + 11, reply,
  7266. reply_size);
  7267. #ifdef CONFIG_TESTING_OPTIONS
  7268. } else if (os_strncmp(buf, "MGMT_TX ", 8) == 0) {
  7269. if (wpas_ctrl_iface_mgmt_tx(wpa_s, buf + 8) < 0)
  7270. reply_len = -1;
  7271. } else if (os_strcmp(buf, "MGMT_TX_DONE") == 0) {
  7272. wpas_ctrl_iface_mgmt_tx_done(wpa_s);
  7273. } else if (os_strncmp(buf, "DRIVER_EVENT ", 13) == 0) {
  7274. if (wpas_ctrl_iface_driver_event(wpa_s, buf + 13) < 0)
  7275. reply_len = -1;
  7276. } else if (os_strncmp(buf, "EAPOL_RX ", 9) == 0) {
  7277. if (wpas_ctrl_iface_eapol_rx(wpa_s, buf + 9) < 0)
  7278. reply_len = -1;
  7279. } else if (os_strncmp(buf, "DATA_TEST_CONFIG ", 17) == 0) {
  7280. if (wpas_ctrl_iface_data_test_config(wpa_s, buf + 17) < 0)
  7281. reply_len = -1;
  7282. } else if (os_strncmp(buf, "DATA_TEST_TX ", 13) == 0) {
  7283. if (wpas_ctrl_iface_data_test_tx(wpa_s, buf + 13) < 0)
  7284. reply_len = -1;
  7285. } else if (os_strncmp(buf, "DATA_TEST_FRAME ", 16) == 0) {
  7286. if (wpas_ctrl_iface_data_test_frame(wpa_s, buf + 16) < 0)
  7287. reply_len = -1;
  7288. } else if (os_strncmp(buf, "TEST_ALLOC_FAIL ", 16) == 0) {
  7289. if (wpas_ctrl_test_alloc_fail(wpa_s, buf + 16) < 0)
  7290. reply_len = -1;
  7291. } else if (os_strcmp(buf, "GET_ALLOC_FAIL") == 0) {
  7292. reply_len = wpas_ctrl_get_alloc_fail(wpa_s, reply, reply_size);
  7293. #endif /* CONFIG_TESTING_OPTIONS */
  7294. } else if (os_strncmp(buf, "VENDOR_ELEM_ADD ", 16) == 0) {
  7295. if (wpas_ctrl_vendor_elem_add(wpa_s, buf + 16) < 0)
  7296. reply_len = -1;
  7297. } else if (os_strncmp(buf, "VENDOR_ELEM_GET ", 16) == 0) {
  7298. reply_len = wpas_ctrl_vendor_elem_get(wpa_s, buf + 16, reply,
  7299. reply_size);
  7300. } else if (os_strncmp(buf, "VENDOR_ELEM_REMOVE ", 19) == 0) {
  7301. if (wpas_ctrl_vendor_elem_remove(wpa_s, buf + 19) < 0)
  7302. reply_len = -1;
  7303. } else if (os_strncmp(buf, "NEIGHBOR_REP_REQUEST", 20) == 0) {
  7304. if (wpas_ctrl_iface_send_neigbor_rep(wpa_s, buf + 20))
  7305. reply_len = -1;
  7306. } else if (os_strcmp(buf, "ERP_FLUSH") == 0) {
  7307. wpas_ctrl_iface_erp_flush(wpa_s);
  7308. } else if (os_strncmp(buf, "MAC_RAND_SCAN ", 14) == 0) {
  7309. if (wpas_ctrl_iface_mac_rand_scan(wpa_s, buf + 14))
  7310. reply_len = -1;
  7311. } else {
  7312. os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
  7313. reply_len = 16;
  7314. }
  7315. if (reply_len < 0) {
  7316. os_memcpy(reply, "FAIL\n", 5);
  7317. reply_len = 5;
  7318. }
  7319. *resp_len = reply_len;
  7320. return reply;
  7321. }
  7322. static int wpa_supplicant_global_iface_add(struct wpa_global *global,
  7323. char *cmd)
  7324. {
  7325. struct wpa_interface iface;
  7326. char *pos, *extra;
  7327. struct wpa_supplicant *wpa_s;
  7328. unsigned int create_iface = 0;
  7329. u8 mac_addr[ETH_ALEN];
  7330. /*
  7331. * <ifname>TAB<confname>TAB<driver>TAB<ctrl_interface>TAB<driver_param>
  7332. * TAB<bridge_ifname>[TAB<create>]
  7333. */
  7334. wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_ADD '%s'", cmd);
  7335. os_memset(&iface, 0, sizeof(iface));
  7336. do {
  7337. iface.ifname = pos = cmd;
  7338. pos = os_strchr(pos, '\t');
  7339. if (pos)
  7340. *pos++ = '\0';
  7341. if (iface.ifname[0] == '\0')
  7342. return -1;
  7343. if (pos == NULL)
  7344. break;
  7345. iface.confname = pos;
  7346. pos = os_strchr(pos, '\t');
  7347. if (pos)
  7348. *pos++ = '\0';
  7349. if (iface.confname[0] == '\0')
  7350. iface.confname = NULL;
  7351. if (pos == NULL)
  7352. break;
  7353. iface.driver = pos;
  7354. pos = os_strchr(pos, '\t');
  7355. if (pos)
  7356. *pos++ = '\0';
  7357. if (iface.driver[0] == '\0')
  7358. iface.driver = NULL;
  7359. if (pos == NULL)
  7360. break;
  7361. iface.ctrl_interface = pos;
  7362. pos = os_strchr(pos, '\t');
  7363. if (pos)
  7364. *pos++ = '\0';
  7365. if (iface.ctrl_interface[0] == '\0')
  7366. iface.ctrl_interface = NULL;
  7367. if (pos == NULL)
  7368. break;
  7369. iface.driver_param = pos;
  7370. pos = os_strchr(pos, '\t');
  7371. if (pos)
  7372. *pos++ = '\0';
  7373. if (iface.driver_param[0] == '\0')
  7374. iface.driver_param = NULL;
  7375. if (pos == NULL)
  7376. break;
  7377. iface.bridge_ifname = pos;
  7378. pos = os_strchr(pos, '\t');
  7379. if (pos)
  7380. *pos++ = '\0';
  7381. if (iface.bridge_ifname[0] == '\0')
  7382. iface.bridge_ifname = NULL;
  7383. if (pos == NULL)
  7384. break;
  7385. extra = pos;
  7386. pos = os_strchr(pos, '\t');
  7387. if (pos)
  7388. *pos++ = '\0';
  7389. if (!extra[0])
  7390. break;
  7391. if (os_strcmp(extra, "create") == 0)
  7392. create_iface = 1;
  7393. else {
  7394. wpa_printf(MSG_DEBUG,
  7395. "INTERFACE_ADD unsupported extra parameter: '%s'",
  7396. extra);
  7397. return -1;
  7398. }
  7399. } while (0);
  7400. if (create_iface) {
  7401. wpa_printf(MSG_DEBUG, "CTRL_IFACE creating interface '%s'",
  7402. iface.ifname);
  7403. if (!global->ifaces)
  7404. return -1;
  7405. if (wpa_drv_if_add(global->ifaces, WPA_IF_STATION, iface.ifname,
  7406. NULL, NULL, NULL, mac_addr, NULL) < 0) {
  7407. wpa_printf(MSG_ERROR,
  7408. "CTRL_IFACE interface creation failed");
  7409. return -1;
  7410. }
  7411. wpa_printf(MSG_DEBUG,
  7412. "CTRL_IFACE interface '%s' created with MAC addr: "
  7413. MACSTR, iface.ifname, MAC2STR(mac_addr));
  7414. }
  7415. if (wpa_supplicant_get_iface(global, iface.ifname))
  7416. goto fail;
  7417. wpa_s = wpa_supplicant_add_iface(global, &iface, NULL);
  7418. if (!wpa_s)
  7419. goto fail;
  7420. wpa_s->added_vif = create_iface;
  7421. return 0;
  7422. fail:
  7423. if (create_iface)
  7424. wpa_drv_if_remove(global->ifaces, WPA_IF_STATION, iface.ifname);
  7425. return -1;
  7426. }
  7427. static int wpa_supplicant_global_iface_remove(struct wpa_global *global,
  7428. char *cmd)
  7429. {
  7430. struct wpa_supplicant *wpa_s;
  7431. int ret;
  7432. unsigned int delete_iface;
  7433. wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_REMOVE '%s'", cmd);
  7434. wpa_s = wpa_supplicant_get_iface(global, cmd);
  7435. if (wpa_s == NULL)
  7436. return -1;
  7437. delete_iface = wpa_s->added_vif;
  7438. ret = wpa_supplicant_remove_iface(global, wpa_s, 0);
  7439. if (!ret && delete_iface) {
  7440. wpa_printf(MSG_DEBUG, "CTRL_IFACE deleting the interface '%s'",
  7441. cmd);
  7442. ret = wpa_drv_if_remove(global->ifaces, WPA_IF_STATION, cmd);
  7443. }
  7444. return ret;
  7445. }
  7446. static void wpa_free_iface_info(struct wpa_interface_info *iface)
  7447. {
  7448. struct wpa_interface_info *prev;
  7449. while (iface) {
  7450. prev = iface;
  7451. iface = iface->next;
  7452. os_free(prev->ifname);
  7453. os_free(prev->desc);
  7454. os_free(prev);
  7455. }
  7456. }
  7457. static int wpa_supplicant_global_iface_list(struct wpa_global *global,
  7458. char *buf, int len)
  7459. {
  7460. int i, res;
  7461. struct wpa_interface_info *iface = NULL, *last = NULL, *tmp;
  7462. char *pos, *end;
  7463. for (i = 0; wpa_drivers[i]; i++) {
  7464. const struct wpa_driver_ops *drv = wpa_drivers[i];
  7465. if (drv->get_interfaces == NULL)
  7466. continue;
  7467. tmp = drv->get_interfaces(global->drv_priv[i]);
  7468. if (tmp == NULL)
  7469. continue;
  7470. if (last == NULL)
  7471. iface = last = tmp;
  7472. else
  7473. last->next = tmp;
  7474. while (last->next)
  7475. last = last->next;
  7476. }
  7477. pos = buf;
  7478. end = buf + len;
  7479. for (tmp = iface; tmp; tmp = tmp->next) {
  7480. res = os_snprintf(pos, end - pos, "%s\t%s\t%s\n",
  7481. tmp->drv_name, tmp->ifname,
  7482. tmp->desc ? tmp->desc : "");
  7483. if (os_snprintf_error(end - pos, res)) {
  7484. *pos = '\0';
  7485. break;
  7486. }
  7487. pos += res;
  7488. }
  7489. wpa_free_iface_info(iface);
  7490. return pos - buf;
  7491. }
  7492. static int wpa_supplicant_global_iface_interfaces(struct wpa_global *global,
  7493. char *buf, int len)
  7494. {
  7495. int res;
  7496. char *pos, *end;
  7497. struct wpa_supplicant *wpa_s;
  7498. wpa_s = global->ifaces;
  7499. pos = buf;
  7500. end = buf + len;
  7501. while (wpa_s) {
  7502. res = os_snprintf(pos, end - pos, "%s\n", wpa_s->ifname);
  7503. if (os_snprintf_error(end - pos, res)) {
  7504. *pos = '\0';
  7505. break;
  7506. }
  7507. pos += res;
  7508. wpa_s = wpa_s->next;
  7509. }
  7510. return pos - buf;
  7511. }
  7512. static char * wpas_global_ctrl_iface_ifname(struct wpa_global *global,
  7513. const char *ifname,
  7514. char *cmd, size_t *resp_len)
  7515. {
  7516. struct wpa_supplicant *wpa_s;
  7517. for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
  7518. if (os_strcmp(ifname, wpa_s->ifname) == 0)
  7519. break;
  7520. }
  7521. if (wpa_s == NULL) {
  7522. char *resp = os_strdup("FAIL-NO-IFNAME-MATCH\n");
  7523. if (resp)
  7524. *resp_len = os_strlen(resp);
  7525. else
  7526. *resp_len = 1;
  7527. return resp;
  7528. }
  7529. return wpa_supplicant_ctrl_iface_process(wpa_s, cmd, resp_len);
  7530. }
  7531. static char * wpas_global_ctrl_iface_redir_p2p(struct wpa_global *global,
  7532. char *buf, size_t *resp_len)
  7533. {
  7534. #ifdef CONFIG_P2P
  7535. static const char * cmd[] = {
  7536. "LIST_NETWORKS",
  7537. "P2P_FIND",
  7538. "P2P_STOP_FIND",
  7539. "P2P_LISTEN",
  7540. "P2P_GROUP_ADD",
  7541. "P2P_GET_PASSPHRASE",
  7542. "P2P_SERVICE_UPDATE",
  7543. "P2P_SERVICE_FLUSH",
  7544. "P2P_FLUSH",
  7545. "P2P_CANCEL",
  7546. "P2P_PRESENCE_REQ",
  7547. "P2P_EXT_LISTEN",
  7548. NULL
  7549. };
  7550. static const char * prefix[] = {
  7551. #ifdef ANDROID
  7552. "DRIVER ",
  7553. #endif /* ANDROID */
  7554. "GET_NETWORK ",
  7555. "REMOVE_NETWORK ",
  7556. "P2P_FIND ",
  7557. "P2P_CONNECT ",
  7558. "P2P_LISTEN ",
  7559. "P2P_GROUP_REMOVE ",
  7560. "P2P_GROUP_ADD ",
  7561. "P2P_PROV_DISC ",
  7562. "P2P_SERV_DISC_REQ ",
  7563. "P2P_SERV_DISC_CANCEL_REQ ",
  7564. "P2P_SERV_DISC_RESP ",
  7565. "P2P_SERV_DISC_EXTERNAL ",
  7566. "P2P_SERVICE_ADD ",
  7567. "P2P_SERVICE_DEL ",
  7568. "P2P_SERVICE_REP ",
  7569. "P2P_REJECT ",
  7570. "P2P_INVITE ",
  7571. "P2P_PEER ",
  7572. "P2P_SET ",
  7573. "P2P_UNAUTHORIZE ",
  7574. "P2P_PRESENCE_REQ ",
  7575. "P2P_EXT_LISTEN ",
  7576. "P2P_REMOVE_CLIENT ",
  7577. "WPS_NFC_TOKEN ",
  7578. "WPS_NFC_TAG_READ ",
  7579. "NFC_GET_HANDOVER_SEL ",
  7580. "NFC_GET_HANDOVER_REQ ",
  7581. "NFC_REPORT_HANDOVER ",
  7582. "P2P_ASP_PROVISION ",
  7583. "P2P_ASP_PROVISION_RESP ",
  7584. NULL
  7585. };
  7586. int found = 0;
  7587. int i;
  7588. if (global->p2p_init_wpa_s == NULL)
  7589. return NULL;
  7590. for (i = 0; !found && cmd[i]; i++) {
  7591. if (os_strcmp(buf, cmd[i]) == 0)
  7592. found = 1;
  7593. }
  7594. for (i = 0; !found && prefix[i]; i++) {
  7595. if (os_strncmp(buf, prefix[i], os_strlen(prefix[i])) == 0)
  7596. found = 1;
  7597. }
  7598. if (found)
  7599. return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
  7600. buf, resp_len);
  7601. #endif /* CONFIG_P2P */
  7602. return NULL;
  7603. }
  7604. static char * wpas_global_ctrl_iface_redir_wfd(struct wpa_global *global,
  7605. char *buf, size_t *resp_len)
  7606. {
  7607. #ifdef CONFIG_WIFI_DISPLAY
  7608. if (global->p2p_init_wpa_s == NULL)
  7609. return NULL;
  7610. if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0 ||
  7611. os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0)
  7612. return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
  7613. buf, resp_len);
  7614. #endif /* CONFIG_WIFI_DISPLAY */
  7615. return NULL;
  7616. }
  7617. static char * wpas_global_ctrl_iface_redir(struct wpa_global *global,
  7618. char *buf, size_t *resp_len)
  7619. {
  7620. char *ret;
  7621. ret = wpas_global_ctrl_iface_redir_p2p(global, buf, resp_len);
  7622. if (ret)
  7623. return ret;
  7624. ret = wpas_global_ctrl_iface_redir_wfd(global, buf, resp_len);
  7625. if (ret)
  7626. return ret;
  7627. return NULL;
  7628. }
  7629. static int wpas_global_ctrl_iface_set(struct wpa_global *global, char *cmd)
  7630. {
  7631. char *value;
  7632. value = os_strchr(cmd, ' ');
  7633. if (value == NULL)
  7634. return -1;
  7635. *value++ = '\0';
  7636. wpa_printf(MSG_DEBUG, "GLOBAL_CTRL_IFACE SET '%s'='%s'", cmd, value);
  7637. #ifdef CONFIG_WIFI_DISPLAY
  7638. if (os_strcasecmp(cmd, "wifi_display") == 0) {
  7639. wifi_display_enable(global, !!atoi(value));
  7640. return 0;
  7641. }
  7642. #endif /* CONFIG_WIFI_DISPLAY */
  7643. /* Restore cmd to its original value to allow redirection */
  7644. value[-1] = ' ';
  7645. return -1;
  7646. }
  7647. #ifndef CONFIG_NO_CONFIG_WRITE
  7648. static int wpas_global_ctrl_iface_save_config(struct wpa_global *global)
  7649. {
  7650. int ret = 0, saved = 0;
  7651. struct wpa_supplicant *wpa_s;
  7652. for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
  7653. if (!wpa_s->conf->update_config) {
  7654. wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Not allowed to update configuration (update_config=0)");
  7655. continue;
  7656. }
  7657. if (wpa_config_write(wpa_s->confname, wpa_s->conf)) {
  7658. wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Failed to update configuration");
  7659. ret = 1;
  7660. } else {
  7661. wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Configuration updated");
  7662. saved++;
  7663. }
  7664. }
  7665. if (!saved && !ret) {
  7666. wpa_dbg(wpa_s, MSG_DEBUG,
  7667. "CTRL_IFACE: SAVE_CONFIG - No configuration files could be updated");
  7668. ret = 1;
  7669. }
  7670. return ret;
  7671. }
  7672. #endif /* CONFIG_NO_CONFIG_WRITE */
  7673. static int wpas_global_ctrl_iface_status(struct wpa_global *global,
  7674. char *buf, size_t buflen)
  7675. {
  7676. char *pos, *end;
  7677. int ret;
  7678. struct wpa_supplicant *wpa_s;
  7679. pos = buf;
  7680. end = buf + buflen;
  7681. #ifdef CONFIG_P2P
  7682. if (global->p2p && !global->p2p_disabled) {
  7683. ret = os_snprintf(pos, end - pos, "p2p_device_address=" MACSTR
  7684. "\n"
  7685. "p2p_state=%s\n",
  7686. MAC2STR(global->p2p_dev_addr),
  7687. p2p_get_state_txt(global->p2p));
  7688. if (os_snprintf_error(end - pos, ret))
  7689. return pos - buf;
  7690. pos += ret;
  7691. } else if (global->p2p) {
  7692. ret = os_snprintf(pos, end - pos, "p2p_state=DISABLED\n");
  7693. if (os_snprintf_error(end - pos, ret))
  7694. return pos - buf;
  7695. pos += ret;
  7696. }
  7697. #endif /* CONFIG_P2P */
  7698. #ifdef CONFIG_WIFI_DISPLAY
  7699. ret = os_snprintf(pos, end - pos, "wifi_display=%d\n",
  7700. !!global->wifi_display);
  7701. if (os_snprintf_error(end - pos, ret))
  7702. return pos - buf;
  7703. pos += ret;
  7704. #endif /* CONFIG_WIFI_DISPLAY */
  7705. for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
  7706. ret = os_snprintf(pos, end - pos, "ifname=%s\n"
  7707. "address=" MACSTR "\n",
  7708. wpa_s->ifname, MAC2STR(wpa_s->own_addr));
  7709. if (os_snprintf_error(end - pos, ret))
  7710. return pos - buf;
  7711. pos += ret;
  7712. }
  7713. return pos - buf;
  7714. }
  7715. char * wpa_supplicant_global_ctrl_iface_process(struct wpa_global *global,
  7716. char *buf, size_t *resp_len)
  7717. {
  7718. char *reply;
  7719. const int reply_size = 2048;
  7720. int reply_len;
  7721. int level = MSG_DEBUG;
  7722. if (os_strncmp(buf, "IFNAME=", 7) == 0) {
  7723. char *pos = os_strchr(buf + 7, ' ');
  7724. if (pos) {
  7725. *pos++ = '\0';
  7726. return wpas_global_ctrl_iface_ifname(global,
  7727. buf + 7, pos,
  7728. resp_len);
  7729. }
  7730. }
  7731. reply = wpas_global_ctrl_iface_redir(global, buf, resp_len);
  7732. if (reply)
  7733. return reply;
  7734. if (os_strcmp(buf, "PING") == 0)
  7735. level = MSG_EXCESSIVE;
  7736. wpa_hexdump_ascii(level, "RX global ctrl_iface",
  7737. (const u8 *) buf, os_strlen(buf));
  7738. reply = os_malloc(reply_size);
  7739. if (reply == NULL) {
  7740. *resp_len = 1;
  7741. return NULL;
  7742. }
  7743. os_memcpy(reply, "OK\n", 3);
  7744. reply_len = 3;
  7745. if (os_strcmp(buf, "PING") == 0) {
  7746. os_memcpy(reply, "PONG\n", 5);
  7747. reply_len = 5;
  7748. } else if (os_strncmp(buf, "INTERFACE_ADD ", 14) == 0) {
  7749. if (wpa_supplicant_global_iface_add(global, buf + 14))
  7750. reply_len = -1;
  7751. } else if (os_strncmp(buf, "INTERFACE_REMOVE ", 17) == 0) {
  7752. if (wpa_supplicant_global_iface_remove(global, buf + 17))
  7753. reply_len = -1;
  7754. } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
  7755. reply_len = wpa_supplicant_global_iface_list(
  7756. global, reply, reply_size);
  7757. } else if (os_strcmp(buf, "INTERFACES") == 0) {
  7758. reply_len = wpa_supplicant_global_iface_interfaces(
  7759. global, reply, reply_size);
  7760. } else if (os_strcmp(buf, "TERMINATE") == 0) {
  7761. wpa_supplicant_terminate_proc(global);
  7762. } else if (os_strcmp(buf, "SUSPEND") == 0) {
  7763. wpas_notify_suspend(global);
  7764. } else if (os_strcmp(buf, "RESUME") == 0) {
  7765. wpas_notify_resume(global);
  7766. } else if (os_strncmp(buf, "SET ", 4) == 0) {
  7767. if (wpas_global_ctrl_iface_set(global, buf + 4)) {
  7768. #ifdef CONFIG_P2P
  7769. if (global->p2p_init_wpa_s) {
  7770. os_free(reply);
  7771. /* Check if P2P redirection would work for this
  7772. * command. */
  7773. return wpa_supplicant_ctrl_iface_process(
  7774. global->p2p_init_wpa_s,
  7775. buf, resp_len);
  7776. }
  7777. #endif /* CONFIG_P2P */
  7778. reply_len = -1;
  7779. }
  7780. #ifndef CONFIG_NO_CONFIG_WRITE
  7781. } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
  7782. if (wpas_global_ctrl_iface_save_config(global))
  7783. reply_len = -1;
  7784. #endif /* CONFIG_NO_CONFIG_WRITE */
  7785. } else if (os_strcmp(buf, "STATUS") == 0) {
  7786. reply_len = wpas_global_ctrl_iface_status(global, reply,
  7787. reply_size);
  7788. #ifdef CONFIG_MODULE_TESTS
  7789. } else if (os_strcmp(buf, "MODULE_TESTS") == 0) {
  7790. int wpas_module_tests(void);
  7791. if (wpas_module_tests() < 0)
  7792. reply_len = -1;
  7793. #endif /* CONFIG_MODULE_TESTS */
  7794. } else if (os_strncmp(buf, "RELOG", 5) == 0) {
  7795. if (wpa_debug_reopen_file() < 0)
  7796. reply_len = -1;
  7797. } else {
  7798. os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
  7799. reply_len = 16;
  7800. }
  7801. if (reply_len < 0) {
  7802. os_memcpy(reply, "FAIL\n", 5);
  7803. reply_len = 5;
  7804. }
  7805. *resp_len = reply_len;
  7806. return reply;
  7807. }