12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095 |
- /* SPDX-License-Identifier: BSD-3-Clause */
- /**
- * Copyright 2019-2024 NXP
- *
- * KEYWORDS: micro-power uPower driver API
- */
- #include <string.h>
- #include "upower_api.h"
- #include "upower_soc_defs.h"
- /* ---------------------------------------------------------------
- * Common Macros
- * ---------------------------------------------------------------
- */
- /* tests Service Group busy */
- #define UPWR_SG_BUSY(sg) ((sg_busy & (1U << (sg))) == 1U)
- /* install user callback for the Service Group */
- #define UPWR_USR_CALLB(sg, cb) { user_callback[(sg)] = (cb); }
- /* fills up common message header info */
- #define UPWR_MSG_HDR(hdr, sg, fn) { \
- (hdr).domain = (uint32_t)pwr_domain; \
- (hdr).srvgrp = (sg); \
- (hdr).function = (fn); }
- /* ---------------------------------------------------------------
- * Common Data Structures
- * ---------------------------------------------------------------
- */
- static soc_domain_t pwr_domain;
- static upwr_code_vers_t fw_rom_version;
- static upwr_code_vers_t fw_ram_version;
- static uint32_t fw_launch_option;
- /* shared memory buffers */
- #define UPWR_API_BUFFER_SIZE (MAX_SG_EXCEPT_MEM_SIZE + \
- MAX_SG_PWRMGMT_MEM_SIZE + MAX_SG_VOLTM_MEM_SIZE)
- /* service group shared mem buffer pointers */
- static void *sh_buffer[UPWR_SG_COUNT];
- /* Callbacks registered for each service group :
- *
- * NULL means no callback is registered;
- * for sgrp_callback, it also means the service group is
- * free to receive a new request.
- */
- static upwr_callb user_callback[UPWR_SG_COUNT];
- static UPWR_RX_CALLB_FUNC_T sgrp_callback[UPWR_SG_COUNT];
- /* request data structures for each service group */
- /* message waiting for TX */
- static upwr_down_max_msg sg_req_msg[UPWR_SG_COUNT];
- /* waiting message size */
- static unsigned int sg_req_siz[UPWR_SG_COUNT];
- /* response msg */
- static upwr_up_max_msg sg_rsp_msg[UPWR_SG_COUNT];
- /* response msg size */
- static unsigned int sg_rsp_siz[UPWR_SG_COUNT];
- /* tx pending status for each (1 bit per service group) */
- static volatile uint32_t sg_tx_pend;
- /* serv.group of current ongoing Tx, if any */
- static volatile upwr_sg_t sg_tx_curr;
- /* service group busy status, only for this domain (MU index 0) */
- /* SG bit = 1 if group is busy with a request */
- static volatile uint32_t sg_busy;
- /* OS-dependent memory allocation function */
- static upwr_malloc_ptr_t os_malloc;
- /* OS-dependent pointer->physical address conversion function */
- static upwr_phyadr_ptr_t os_ptr2phy;
- /* OS-dependent function to lock critical code */
- static upwr_lock_ptr_t os_lock;
- /* pointer to MU structure */
- static struct MU_t *mu;
- /*
- * indicates that a transmission was done and is pending; this
- * bit is necessary because the Tx and Rx interrupts are ORed
- * together, and there is no way of telling if only Rx interrupt
- * or both occurred just by looking at the MU status registers
- */
- static uint32_t mu_tx_pend;
- static UPWR_TX_CALLB_FUNC_T mu_tx_callb;
- static UPWR_RX_CALLB_FUNC_T mu_rx_callb;
- #define UPWR_API_INIT_WAIT (0U) /* waiting for ROM firmware initialization */
- #define UPWR_API_INITLZED (1U) /* ROM firmware initialized */
- #define UPWR_API_START_WAIT (2U) /* waiting for start services */
- #define UPWR_API_SHUTDOWN_WAIT (3U) /* waiting for shutdown */
- #define UPWR_API_READY (4U) /* ready to receive service requests */
- volatile upwr_api_state_t api_state;
- /* default pointer->physical address conversion, returns the same address */
- static void *ptr2phys(const void *ptr)
- {
- return (void *)ptr;
- }
- /* ---------------------------------------------------------------
- * SHARED MEMORY MANAGEMENT
- * --------------------------------------------------------------
- */
- /*
- * upwr_ptr2offset() - converts a pointer (casted to uint64_t) to an
- * address offset from the shared memory start. If it does not point
- * to a shared memory location, the structure pointed is copied to a
- * buffer in the shared memory, and the buffer offset is returned.
- * The 2nd argument is the service group to which the buffer belongs;
- * The 3rd argument is the size of structure to be copied. The 4th argument
- * is an offset to apply to the copy destination address. The 5th argument
- * is ptr before the conversion to physical address. 2nd, 3rd. 4th and 5th
- * arguments are not used if the 1st one points to a location inside the
- * shared memory.
- */
- static uint32_t upwr_ptr2offset(unsigned long ptr,
- upwr_sg_t sg,
- size_t siz,
- size_t offset,
- const void *vptr)
- {
- if ((ptr >= UPWR_DRAM_SHARED_BASE_ADDR) &&
- ((ptr - UPWR_DRAM_SHARED_BASE_ADDR) < UPWR_DRAM_SHARED_SIZE)) {
- return (uint32_t)(ptr - UPWR_DRAM_SHARED_BASE_ADDR);
- }
- /* pointer is outside the shared memory, copy the struct to buffer */
- (void)memcpy((void *)(offset + (char *)sh_buffer[sg]), (void *)vptr, siz);
- return (uint32_t)((unsigned long)sh_buffer[sg] + offset - UPWR_DRAM_SHARED_BASE_ADDR);
- }
- /*
- * ---------------------------------------------------------------
- * INTERRUPTS AND CALLBACKS
- * Service-group specific callbacks are in their own sections
- * --------------------------------------------------------------
- */
- /*
- * upwr_lock()- locks (lock=1) or unlocks (lock=0) a critical code section;
- * for now it only needs to protect a portion of the code from being
- * interrupted by the MU.
- */
- static void upwr_lock(int lock)
- {
- if (os_lock != NULL) {
- os_lock(lock);
- }
- }
- /* upwr_exp_isr()- handles the exception interrupt from uPower */
- static void upwr_exp_isr(void)
- {
- }
- /* upwr_copy2tr prototype; function definition in auxiliary function section */
- void upwr_copy2tr(struct MU_t *local_mu, const uint32_t *msg, unsigned int size);
- #define UPWR_MU_TSR_EMPTY ((uint32_t)((1UL << UPWR_MU_MSG_SIZE) - 1UL))
- /* upwr_txrx_isr()- handles both the Tx and Rx MU interrupts */
- void upwr_txrx_isr(void)
- {
- /* Tx pending and TX register empty */
- if ((mu_tx_pend != 0UL) && (mu->TSR.R == UPWR_MU_TSR_EMPTY)) {
- mu_tx_pend = 0UL;
- /* disable the tx interrupts */
- mu->TCR.R = 0U;
- /* urgency flag off, in case it was set */
- mu->FCR.B.F0 = 0U;
- if (mu_tx_callb != NULL) {
- mu_tx_callb();
- }
- }
- /* RX ISR occurred */
- if (mu->RSR.R != 0UL) {
- /* disable the interrupt until data is read */
- mu->RCR.R = 0U;
- if (mu_rx_callb != NULL) {
- mu_rx_callb();
- }
- }
- }
- /**
- * upwr_next_req() - sends the next pending service request message, if any.
- *
- * Called upon MU Tx interrupts, it checks if there is any service request
- * pending amongst the service groups, and sends the request if needed.
- *
- * Context: no sleep, no locks taken/released.
- * Return: none (void).
- */
- static void upwr_next_req(void)
- {
- upwr_sg_t sg = (upwr_sg_t)0U;
- /* no lock needed here, this is called from an MU ISR */
- sg_tx_pend &= ~((uint32_t)1UL << sg_tx_curr); /* no longer pending */
- if (sg_tx_pend == 0U) {
- return; /* no other pending */
- }
- /* find the next one pending */
- for (uint32_t mask = 1UL; mask < (1UL << UPWR_SG_COUNT); mask = mask << 1UL) {
- if ((sg_tx_pend & mask) != 0U) {
- break;
- }
- sg = (upwr_sg_t)(sg + 1U);
- }
- sg_tx_curr = sg;
- if (upwr_tx((uint32_t *)&sg_req_msg[sg], sg_req_siz[sg], upwr_next_req) < 0) {
- return; /* leave the Tx pending */
- }
- }
- /**
- * upwr_mu_int_callback() - general MU interrupt callback.
- *
- * Called upon MU Rx interrupts, it calls the Service Group-specific callback,
- * if any registered, based on the service group field in the received message.
- * Otherwise, calls the user callback, if any registered.
- *
- * Context: no sleep, no locks taken/released.
- * Return: none (void).
- */
- static void upwr_mu_int_callback(void)
- {
- upwr_sg_t sg; /* service group number */
- UPWR_RX_CALLB_FUNC_T sg_callb; /* service group callback */
- upwr_up_max_msg rxmsg = {0};
- unsigned int size; /* in words */
- if (upwr_rx((char *)&rxmsg, &size) < 0) {
- return;
- }
- sg = (upwr_sg_t)rxmsg.hdr.srvgrp;
- /* copy msg to the service group buffer */
- msg_copy((char *)&sg_rsp_msg[sg], (char *)&rxmsg, size);
- sg_rsp_siz[sg] = size;
- /* clear the service group busy status */
- sg_busy &= ~(1UL << sg); /* no lock needed here, we're in the MU ISR */
- sg_callb = sgrp_callback[sg];
- if (sg_callb == NULL) {
- upwr_callb user_callb = user_callback[sg];
- /* no service group callback; call the user callback if any */
- if (user_callb == NULL) {
- goto done; /* no user callback */
- }
- /* make the user callback */
- user_callb(sg, rxmsg.hdr.function,
- (upwr_resp_t)rxmsg.hdr.errcode,
- (size == 2U) ? rxmsg.word2 : rxmsg.hdr.ret);
- goto done;
- }
- /*
- * finally make the group callback. don't uninstall the group
- * callback, it is permanent.
- */
- sg_callb();
- done:
- if (rxmsg.hdr.errcode == UPWR_RESP_SHUTDOWN) { /* shutdown error: */
- /*
- * change the API state automatically. so new requests
- * are rejected by the API immediately
- */
- api_state = UPWR_API_INITLZED;
- }
- }
- /**
- * upwr_srv_req() - sends a service request message.
- * @sg: message service group.
- * @msg: pointer to the message
- * @size: message size in 32-bit words.
- *
- * The message is sent right away if possible, or gets pending to be sent later.
- * If pending, the message is stored in sg_req_msg and will be sent when the
- * MU transmission buffer is clear and there are no other pending messages
- * from higher priority service groups.
- *
- * This is an auxiliary function used by the rest of the API calls.
- * It is normally not called by the driver code, unless maybe for test purposes.
- *
- * Context: no sleep, no locks taken/released.
- * Return: none (void)
- */
- static void upwr_srv_req(upwr_sg_t sg,
- uint32_t *msg,
- unsigned int size)
- {
- int rc;
- upwr_lock(1);
- sg_busy |= (uint32_t)1U << sg;
- upwr_lock(0);
- rc = upwr_tx(msg, size, upwr_next_req);
- if (rc < 0) {
- /* queue full, make the transmission pending */
- msg_copy((char *)&sg_req_msg[sg], (char *)msg, size);
- sg_req_siz[sg] = size;
- upwr_lock(1);
- sg_tx_curr = sg;
- sg_tx_pend |= (uint32_t)1U << sg;
- upwr_lock(0);
- return;
- }
- }
- /**---------------------------------------------------------------
- * INITIALIZATION, CONFIGURATION
- *
- * A reference uPower initialization sequence goes as follows:
- *
- * 1. host CPU calls upwr_init.
- * 2. (optional) host checks the ROM version and SoC code calling upwr_vers(...)
- * and optionally performs any configuration or workaround accordingly.
- * 3. host CPU calls upwr_start to start the uPower services, passing a
- * service option number.
- * If no RAM code is loaded or it has no service options, the launch option
- * number passed must be 0, which will start the services available in ROM.
- * upwr_start also receives a pointer to a callback called by the API
- * when the firmware is ready to receive service requests.
- * The callback may be replaced by polling, calling upwr_req_status in a loop
- * or upwr_poll_req_status; in this case the callback pointer may be NULL.
- * A host may call upwr_start even if the services were already started by
- * any host: if the launch option is the same, the response will be ok,
- * but will indicate error if the services were already started with a
- * different launch option.
- * 4. host waits for the callback calling, or polling finishing;
- * if no error is returned, it can start making service calls using the API.
- *
- * Variations on that reference sequence are possible:
- * - the uPower services can be started using the ROM code only, which includes
- * the basic Power Management services, among others, with launch option
- * number = 0.
- * The code RAM can be loaded while these services are running and,
- * when the loading is done, the services can be re-started with these 2
- * requests executed in order: upwr_xcp_shutdown and upwr_start,
- * using the newly loaded RAM code (launch option > 0).
- *
- * NOTE: the initialization call upwr_init is not effective and
- * returns error when called after the uPower services are started.
- */
- /**
- * upwr_start_callb() - internal callback for the Rx message from uPower
- * that indicates the firmware is ready to receive the start commands.
- * It calls the user callbacks registered in the upwr_start_boot and upwr_start
- * call.
- */
- void upwr_start_callb(void)
- {
- switch (api_state) {
- case UPWR_API_START_WAIT: {
- upwr_rdy_callb start_callb = (upwr_rdy_callb)user_callback[UPWR_SG_EXCEPT];
- upwr_ready_msg *msg = (upwr_ready_msg *)&sg_rsp_msg[UPWR_SG_EXCEPT];
- fw_ram_version.soc_id = fw_rom_version.soc_id;
- fw_ram_version.vmajor = msg->args.vmajor;
- fw_ram_version.vminor = msg->args.vminor;
- fw_ram_version.vfixes = msg->args.vfixes;
- /*
- * vmajor == vminor == vfixes == 0 indicates start error
- * in this case, go back to the INITLZED state
- */
- if ((fw_ram_version.vmajor != 0U) ||
- (fw_ram_version.vminor != 0U) ||
- (fw_ram_version.vfixes != 0U)) {
- api_state = UPWR_API_READY;
- /*
- * initialization is over:
- * uninstall the user callback just in case
- */
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, NULL);
- if (fw_launch_option == 0U) {
- /*
- * launched ROM firmware:
- * RAM fw versions must be all 0s
- */
- fw_ram_version.vmajor = 0U;
- fw_ram_version.vminor = 0U;
- fw_ram_version.vfixes = 0U;
- }
- } else {
- api_state = UPWR_API_INITLZED;
- }
- start_callb(msg->args.vmajor, msg->args.vminor, msg->args.vfixes);
- }
- break;
- case UPWR_API_SHUTDOWN_WAIT: {
- upwr_callb user_callb = (upwr_callb)user_callback[UPWR_SG_EXCEPT];
- upwr_shutdown_msg *msg = (upwr_shutdown_msg *)&sg_rsp_msg[UPWR_SG_EXCEPT];
- if ((upwr_resp_t)msg->hdr.errcode == UPWR_RESP_OK) {
- api_state = UPWR_API_INITLZED;
- }
- if (user_callb != NULL) {
- user_callb(UPWR_SG_EXCEPT, UPWR_XCP_SHUTDOWN,
- (upwr_resp_t)msg->hdr.errcode, 0U);
- }
- }
- break;
- case UPWR_API_READY:
- {
- upwr_callb user_callb = (upwr_callb)user_callback[UPWR_SG_EXCEPT];
- upwr_up_max_msg *msg = (upwr_up_max_msg *)&sg_rsp_msg[UPWR_SG_EXCEPT];
- if (user_callb != NULL) {
- user_callb(UPWR_SG_EXCEPT, msg->hdr.function,
- (upwr_resp_t)msg->hdr.errcode,
- (int)((sg_rsp_siz[UPWR_SG_EXCEPT] == 2U) ?
- msg->word2 : msg->hdr.ret));
- }
- }
- break;
- default:
- break;
- }
- }
- /**
- * upwr_init() - API initialization; must be the first API call after reset.
- * @domain: SoC-dependent CPU domain id; identifier used by the firmware in
- * many services. Defined by SoC-dependent type soc_domain_t found in
- * upower_soc_defs.h.
- * @muptr: pointer to the MU instance.
- * @mallocptr: pointer to the memory allocation function
- * @physaddrptr: pointer to the function to convert pointers to
- * physical addresses. If NULL, no conversion is made (pointer=physical address)
- * @isrinstptr: pointer to the function to install the uPower ISR callbacks;
- * the function receives the pointers to the MU tx/rx and Exception ISRs
- * callbacks, which must be called from the actual system ISRs.
- * The function pointed by isrinstptr must also enable the interrupt at the
- * core/interrupt controller, but must not enable the interrupt at the MU IP.
- * The system ISRs are responsible for dealing with the interrupt controller,
- * performing any other context save/restore, and any other housekeeping.
- * @lockptr: pointer to a function that prevents MU interrupts (if argrument=1)
- * or allows it (if argument=0). The API calls this function to make small
- * specific code portions thread safe. Only MU interrupts must be avoided,
- * the code may be suspended for other reasons.
- * If no MU interrupts can happen during the execution of an API call or
- * callback, even if enabled, for some other reason (e.g. interrupt priority),
- * then this argument may be NULL.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if failed to allocate memory, or use some other resource.
- * -2 if any argument is invalid.
- * -3 if failed to send the ping message.
- * -4 if failed to receive the initialization message, or was invalid
- */
- int upwr_init(soc_domain_t domain, struct MU_t *muptr,
- const upwr_malloc_ptr_t mallocptr,
- const upwr_phyadr_ptr_t phyadrptr,
- const upwr_inst_isr_ptr_t isrinstptr,
- const upwr_lock_ptr_t lockptr)
- {
- uint32_t j;
- upwr_sg_t sg; /* service group number */
- unsigned int size;
- unsigned long dom_buffer_base = (domain == RTD_DOMAIN) ? UPWR_API_BUFFER_BASE :
- ((UPWR_API_BUFFER_ENDPLUS + UPWR_API_BUFFER_BASE) / 2U);
- upwr_init_msg *msg = (upwr_init_msg *)&sg_rsp_msg[UPWR_SG_EXCEPT];
- mu = muptr;
- /*
- * Disable tx and rx interrupts in case not called
- * 1st time after reset
- */
- mu->TCR.R = mu->RCR.R = 0U;
- os_malloc = mallocptr;
- os_ptr2phy = (phyadrptr == (upwr_phyadr_ptr_t)NULL) ? ptr2phys : phyadrptr;
- os_lock = lockptr;
- api_state = UPWR_API_INIT_WAIT;
- sg_busy = 0UL;
- pwr_domain = domain;
- /* initialize the versions, in case they are polled */
- fw_rom_version.soc_id = 0U;
- fw_rom_version.vmajor = 0U;
- fw_rom_version.vminor = 0U;
- fw_rom_version.vfixes = 0U;
- fw_ram_version.soc_id = 0U;
- fw_ram_version.vmajor = 0U;
- fw_ram_version.vminor = 0U;
- fw_ram_version.vfixes = 0U;
- mu_tx_pend = (uint32_t)0U;
- sg_tx_pend = (uint32_t)0U;
- sg_tx_curr = UPWR_SG_COUNT; /* means none here */
- sh_buffer[UPWR_SG_EXCEPT] = (void *)(unsigned long)dom_buffer_base;
- sh_buffer[UPWR_SG_PWRMGMT] = (void *)(unsigned long)(dom_buffer_base +
- MAX_SG_EXCEPT_MEM_SIZE);
- sh_buffer[UPWR_SG_DELAYM] = NULL;
- sh_buffer[UPWR_SG_VOLTM] = (void *)(unsigned long)(dom_buffer_base +
- MAX_SG_EXCEPT_MEM_SIZE + MAX_SG_PWRMGMT_MEM_SIZE);
- sh_buffer[UPWR_SG_CURRM] = NULL;
- sh_buffer[UPWR_SG_TEMPM] = NULL;
- sh_buffer[UPWR_SG_DIAG] = NULL;
- /* (no buffers service groups other than xcp and pwm for now) */
- for (j = 0; j < UPWR_SG_COUNT; j++) {
- user_callback[j] = NULL;
- /* service group Exception gets the initialization callbacks */
- sgrp_callback[j] = (j == UPWR_SG_EXCEPT) ? upwr_start_callb : NULL;
- /* response messages with an initial consistent content */
- sg_rsp_msg[j].hdr.errcode = UPWR_RESP_SHUTDOWN;
- }
- /* init message already received, assume takss are running on upower */
- if (mu->FSR.B.F0 != 0U) {
- /* send a ping message down to get the ROM version back */
- upwr_xcp_ping_msg ping_msg = {0};
- ping_msg.hdr.domain = pwr_domain;
- ping_msg.hdr.srvgrp = UPWR_SG_EXCEPT;
- ping_msg.hdr.function = UPWR_XCP_PING;
- if (mu->RSR.B.RF0 != 0U) { /* first clean any Rx message left over */
- (void)upwr_rx((char *)msg, &size);
- }
- /* wait any TX left over to be sent */
- while (mu->TSR.R != UPWR_MU_TSR_EMPTY) {
- }
- /*
- * now send the ping message;
- * do not use upwr_tx, which needs API initialized;
- * just write to the MU TR register(s)
- */
- mu->FCR.B.F0 = 1U; /* flag urgency status */
- upwr_copy2tr(mu, (uint32_t *)&ping_msg, sizeof(ping_msg) / 4U);
- }
- do {
- /*
- * poll for the MU Rx status: wait for an init message, either
- * 1st sent from uPower after reset or as a response to a ping
- */
- while (mu->RSR.B.RF0 == 0U) {
- }
- /* urgency status off, in case it was set */
- mu->FCR.B.F0 = 0U;
- if (upwr_rx((char *)msg, &size) < 0) {
- return -4;
- }
- if (size != (sizeof(upwr_init_msg) / 4U)) {
- if (mu->FSR.B.F0 != 0U) {
- continue; /* discard left over msg */
- } else {
- return -4;
- }
- }
- sg = (upwr_sg_t)msg->hdr.srvgrp;
- if (sg != UPWR_SG_EXCEPT) {
- if (mu->FSR.B.F0 != 0U) {
- continue; /* discard left over msg */
- } else {
- return -4;
- }
- }
- if ((upwr_xcp_f_t)msg->hdr.function != UPWR_XCP_INIT) {
- if (mu->FSR.B.F0 != 0U) {
- continue; /* discard left over msg */
- } else {
- return -4;
- }
- }
- break;
- } while (true);
- fw_rom_version.soc_id = msg->args.soc;
- fw_rom_version.vmajor = msg->args.vmajor;
- fw_rom_version.vminor = msg->args.vminor;
- fw_rom_version.vfixes = msg->args.vfixes;
- if (upwr_rx_callback(upwr_mu_int_callback) < 0) {
- /* catastrophic error, but is it possible to happen? */
- return -1;
- }
- mu_tx_callb = NULL; /* assigned on upwr_tx */
- /* install the ISRs and enable the interrupts */
- isrinstptr(upwr_txrx_isr, upwr_exp_isr);
- /* enable only RR[0] receive interrupt */
- mu->RCR.R = 1U;
- api_state = UPWR_API_INITLZED;
- return 0;
- }
- /**
- * upwr_start() - Starts the uPower services.
- * @launchopt: a number to select between multiple launch options,
- * that may define, among other things, which services will be started,
- * or which services implementations, features etc.
- * launchopt = 0 selects a subset of services implemented in ROM;
- * any other number selects service sets implemented in RAM, launched
- * by the firmware function ram_launch; if an invalid launchopt value is passed,
- * no services are started, and the callback returns error (see below).
- * @rdycallb: pointer to the callback to be called when the uPower is ready
- * to receive service requests. NULL if no callback needed.
- * The callback receives as arguments the RAM firmware version numbers.
- * If all 3 numbers (vmajor, vminor, vfixes) are 0, that means the
- * service launching failed.
- * Firmware version numbers will be the same as ROM if launchopt = 0,
- * selecting the ROM services.
- *
- * upwr_start can be called by any domain even if the services are already
- * started: it has no effect, returning success, if the launch option is the
- * same as the one that actually started the service, and returns error if
- * called with a different option.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if a resource failed,
- * -2 if the domain passed is the same as the caller,
- * -3 if called in an invalid API state
- */
- int upwr_start(uint32_t launchopt, const upwr_rdy_callb rdycallb)
- {
- upwr_start_msg txmsg = {0};
- if (api_state != UPWR_API_INITLZED) {
- return -3;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, (upwr_callb)rdycallb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_START);
- txmsg.hdr.arg = fw_launch_option = launchopt;
- if (upwr_tx((uint32_t *)&txmsg, sizeof(txmsg) / 4U, NULL) < 0) {
- /* catastrophic error, but is it possible to happen? */
- return -1;
- }
- api_state = UPWR_API_START_WAIT;
- return 0;
- }
- /**---------------------------------------------------------------
- * EXCEPTION SERVICE GROUP
- */
- /**
- * upwr_xcp_config() - Applies general uPower configurations.
- * @config: pointer to the uPower SoC-dependent configuration struct
- * upwr_xcp_config_t defined in upower_soc_defs.h. NULL may be passed, meaning
- * a request to read the configuration, in which case it appears in the callback
- * argument ret, or can be pointed by argument retptr in the upwr_req_status and
- * upwr_poll_req_status calls, casted to upwr_xcp_config_t.
- * @callb: pointer to the callback to be called when the uPower has finished
- * the configuration, or NULL if no callback needed (polling used instead).
- *
- * Some configurations are targeted for a specific domain (see the struct
- * upwr_xcp_config_t definition in upower_soc_defs.h); this call has implicit
- * domain target (the same domain from which is called).
- *
- * The return value is always the current configuration value, either in a
- * read-only request (config = NULL) or after setting a new configuration
- * (non-NULL config).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_config(const upwr_xcp_config_t *config, const upwr_callb callb)
- {
- upwr_xcp_config_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- if (config == NULL) {
- txmsg.hdr.arg = 1U; /* 1= read, txmsg.word2 ignored */
- } else {
- txmsg.hdr.arg = 0U; /* 1= write */
- txmsg.word2 = config->R;
- }
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_CONFIG);
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_sw_alarm() - Makes uPower issue an alarm interrupt to given domain.
- * @domain: identifier of the domain to alarm. Defined by SoC-dependent type
- * soc_domain_t found in upower_soc_defs.h.
- * @code: alarm code. Defined by SoC-dependent type upwr_alarm_t found in
- * upower_soc_defs.h.
- * @callb: pointer to the callback to be called when the uPower has finished
- * the alarm, or NULL if no callback needed (polling used instead).
- *
- * The function requests the uPower to issue an alarm of the given code as if
- * it had originated internally. This service is useful mainly to test the
- * system response to such alarms, or to make the system handle a similar alarm
- * situation detected externally to uPower.
- *
- * The system ISR/code handling the alarm may retrieve the alarm code by calling
- * the auxiliary function upwr_alarm_code.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_sw_alarm(soc_domain_t domain,
- upwr_alarm_t code,
- const upwr_callb callb)
- {
- upwr_xcp_swalarm_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_SW_ALARM);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = (uint32_t)code;
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_set_ddr_retention() - M33/A35 can use this API to set/clear ddr retention
- * @domain: identifier of the caller domain.
- * soc_domain_t found in upower_soc_defs.h.
- * @enable: true, means that set ddr retention, false clear ddr retention.
- * @callb: NULL
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_set_ddr_retention(soc_domain_t domain,
- uint32_t enable,
- const upwr_callb callb)
- {
- upwr_xcp_ddr_retn_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_SET_DDR_RETN);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = (uint32_t)enable;
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_set_mipi_dsi_ena() - M33/A35 can use this API to set/clear mipi dsi ena
- * @domain: identifier of the caller domain.
- * soc_domain_t found in upower_soc_defs.h.
- * @enable: true, means that set ddr retention, false clear ddr retention.
- * @callb: NULL
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_set_mipi_dsi_ena(soc_domain_t domain,
- uint32_t enable,
- const upwr_callb callb)
- {
- upwr_xcp_set_mipi_dsi_ena_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_SET_MIPI_DSI_ENA);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = (uint32_t)enable;
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_get_mipi_dsi_ena() - M33/A35 can use this API to get mipi dsi ena status
- * @domain: identifier of the caller domain.
- * soc_domain_t found in upower_soc_defs.h.
- * @callb: NULL
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_get_mipi_dsi_ena(soc_domain_t domain, const upwr_callb callb)
- {
- upwr_xcp_get_mipi_dsi_ena_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_GET_MIPI_DSI_ENA);
- txmsg.hdr.domain = (uint32_t)domain;
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_set_osc_mode() - M33/A35 can use this API to set uPower OSC mode
- * @domain: identifier of the caller domain.
- * soc_domain_t found in upower_soc_defs.h.
- * @osc_mode, 0 means low frequency, not 0 means high frequency.
- * @callb: NULL
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_set_osc_mode(soc_domain_t domain,
- uint32_t osc_mode,
- const upwr_callb callb)
- {
- upwr_xcp_set_osc_mode_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_SET_OSC_MODE);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = (uint32_t)osc_mode;
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_set_rtd_use_ddr() - M33 call this API to inform uPower, M33 is using ddr
- * @domain: identifier of the caller domain.
- * soc_domain_t found in upower_soc_defs.h.
- * @is_use_ddr: not 0, true, means that RTD is using ddr. 0, false, means that, RTD
- * is not using ddr.
- * @callb: NULL
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_set_rtd_use_ddr(soc_domain_t domain,
- uint32_t is_use_ddr,
- const upwr_callb callb)
- {
- upwr_xcp_rtd_use_ddr_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_SET_RTD_USE_DDR);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = (uint32_t)is_use_ddr;
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_set_rtd_apd_llwu() - M33/A35 can use this API to set/clear rtd_llwu apd_llwu
- * @domain: set which domain (RTD_DOMAIN, APD_DOMAIN) LLWU.
- * soc_domain_t found in upower_soc_defs.h.
- * @enable: true, means that set rtd_llwu or apd_llwu, false clear rtd_llwu or apd_llwu.
- * @callb: NULL
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_set_rtd_apd_llwu(soc_domain_t domain,
- uint32_t enable,
- const upwr_callb callb)
- {
- upwr_xcp_rtd_apd_llwu_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_SET_RTD_APD_LLWU);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = (uint32_t)enable;
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_xcp_shutdown() - Shuts down all uPower services and power mode tasks.
- * @callb: pointer to the callback to be called when the uPower has finished
- * the shutdown, or NULL if no callback needed
- * (polling used instead).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * At the callback the uPower/API is back to initialization/start-up phase,
- * so service request calls return error.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_shutdown(const upwr_callb callb)
- {
- upwr_xcp_shutdown_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_SHUTDOWN);
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- api_state = UPWR_API_SHUTDOWN_WAIT;
- return 0;
- }
- /**
- * upwr_xcp_i2c_access() - Performs an access through the uPower I2C interface.
- * @addr: I2C slave address, up to 10 bits.
- * @data_size: determines the access direction and data size in bytes, up to 4;
- * negetive data_size determines a read access with size -data_size;
- * positive data_size determines a write access with size data_size;
- * data_size=0 is invalid, making the service return error UPWR_RESP_BAD_REQ.
- * @subaddr_size: size of the sub-address in bytes, up to 4; if subaddr_size=0,
- * no subaddress is used.
- * @subaddr: sub-address, only used if subaddr_size > 0.
- * @wdata: write data, up to 4 bytes; ignored if data_size < 0 (read)
- * @callb: pointer to the callback to be called when the uPower has finished
- * the access, or NULL if no callback needed
- * (polling used instead).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_EXCEPT as the service group argument.
- *
- * The service performs a read (data_size < 0) or a write (data_size > 0) of
- * up to 4 bytes on the uPower I2C interface. The data read from I2C comes via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- *
- * Sub-addressing is supported, with sub-address size determined by the argument
- * subaddr_size, up to 4 bytes. Sub-addressing is not used if subaddr_size=0.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_xcp_i2c_access(uint16_t addr,
- int8_t data_size,
- uint8_t subaddr_size,
- uint32_t subaddr,
- uint32_t wdata,
- const upwr_callb callb)
- {
- unsigned long ptrval = (unsigned long)sh_buffer[UPWR_SG_EXCEPT];
- upwr_i2c_access *i2c_acc_ptr = (upwr_i2c_access *)ptrval;
- upwr_pwm_pmiccfg_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_EXCEPT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_EXCEPT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_EXCEPT, UPWR_XCP_I2C);
- i2c_acc_ptr->addr = addr;
- i2c_acc_ptr->subaddr = subaddr;
- i2c_acc_ptr->subaddr_size = subaddr_size;
- i2c_acc_ptr->data = wdata;
- i2c_acc_ptr->data_size = data_size;
- txmsg.ptr = upwr_ptr2offset(ptrval,
- UPWR_SG_EXCEPT,
- (size_t)sizeof(upwr_i2c_access),
- 0U,
- i2c_acc_ptr);
- upwr_srv_req(UPWR_SG_EXCEPT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**---------------------------------------------------------------
- * VOLTAGE MANAGERMENT SERVICE GROUP
- */
- /**
- * upwr_vtm_pmic_cold_reset() -request cold reset the pmic.
- * pmic will power cycle all the regulators
- * @callb: response callback pointer; NULL if no callback needed.
- *
- * The function requests uPower to cold reset the pmic.
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_VOLTM as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_vtm_pmic_cold_reset(upwr_callb callb)
- {
- upwr_volt_pmic_cold_reset_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_VOLTM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_VOLTM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_VOLTM, UPWR_VTM_PMIC_COLD_RESET);
- upwr_srv_req(UPWR_SG_VOLTM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_vtm_set_pmic_mode() -request uPower set pmic mode
- * @pmic_mode: the target mode need to be set
- * @callb: response callback pointer; NULL if no callback needed.
- *
- * The function requests uPower to set pmic mode
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_VOLTM as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_vtm_set_pmic_mode(uint32_t pmic_mode, upwr_callb callb)
- {
- upwr_volt_pmic_set_mode_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_VOLTM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_VOLTM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_VOLTM, UPWR_VTM_SET_PMIC_MODE);
- txmsg.hdr.arg = pmic_mode;
- upwr_srv_req(UPWR_SG_VOLTM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_vtm_chng_pmic_voltage() - Changes the voltage of a given rail.
- * @rail: pmic rail id.
- * @volt: the target voltage of the given rail, accurate to uV
- * If pass volt value 0, means that power off this rail.
- * @callb: response callback pointer; NULL if no callback needed.
- *
- * The function requests uPower to change the voltage of the given rail.
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_VOLTM as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_vtm_chng_pmic_voltage(uint32_t rail, uint32_t volt, upwr_callb callb)
- {
- upwr_volt_pmic_set_volt_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_VOLTM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_VOLTM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_VOLTM, UPWR_VTM_CHNG_PMIC_RAIL_VOLT);
- txmsg.args.rail = rail;
- txmsg.args.volt = (volt + PMIC_VOLTAGE_MIN_STEP - 1U) / PMIC_VOLTAGE_MIN_STEP;
- upwr_srv_req(UPWR_SG_VOLTM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_vtm_get_pmic_voltage() - Get the voltage of a given rail.
- * @rail: pmic rail id.
- * @callb: response callback pointer; NULL if no callback needed.
- * (polling used instead)
- *
- * The function requests uPower to get the voltage of the given rail.
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_VOLTM as the service group argument.
- *
- * The voltage data read from uPower via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_vtm_get_pmic_voltage(uint32_t rail, upwr_callb callb)
- {
- upwr_volt_pmic_get_volt_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_VOLTM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_VOLTM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_VOLTM, UPWR_VTM_GET_PMIC_RAIL_VOLT);
- txmsg.args.rail = rail;
- upwr_srv_req(UPWR_SG_VOLTM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_vtm_power_measure() - request uPower to measure power consumption
- * @ssel: This field determines which power switches will have their currents
- * sampled to be accounted for a
- * current/power measurement. Support 0~7
- * SSEL bit # Power Switch
- * 0 M33 core complex/platform/peripherals
- * 1 Fusion Core and Peripherals
- * 2 A35[0] core complex
- * 3 A35[1] core complex
- * 4 3DGPU
- * 5 HiFi4
- * 6 DDR Controller (PHY and PLL NOT included)
- * 7 PXP, EPDC
- *
- * @callb: response callback pointer; NULL if no callback needed.
- * (polling used instead)
- *
- * The function requests uPower to measure power consumption
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_VOLTM as the service group argument.
- *
- * The power consumption data read from uPower via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- * upower fw needs support cocurrent request from M33 and A35.
- *
- * Accurate to uA
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_vtm_power_measure(uint32_t ssel, upwr_callb callb)
- {
- upwr_volt_pmeter_meas_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_VOLTM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_VOLTM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_VOLTM, UPWR_VTM_PMETER_MEAS);
- txmsg.hdr.arg = ssel;
- upwr_srv_req(UPWR_SG_VOLTM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_vtm_vmeter_measure() - request uPower to measure voltage
- * @vdetsel: Voltage Detector Selector, support 0~3
- * 00b - RTD sense point
- 01b - LDO output
- 10b - APD domain sense point
- 11b - AVD domain sense point
- Refer to upower_defs.h
- * @callb: response callback pointer; NULL if no callback needed.
- * (polling used instead)
- *
- * The function requests uPower to use vmeter to measure voltage
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_VOLTM as the service group argument.
- *
- * The voltage data read from uPower via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- * upower fw needs support cocurrent request from M33 and A35.
- *
- * Refer to RM COREREGVL (Core Regulator Voltage Level)
- * uPower return VDETLVL to user, user can calculate the real voltage:
- *
- 0b000000(0x00) - 0.595833V
- 0b100110(0x26) - 1.007498V
- <value> - 0.595833V + <value>x10.8333mV
- 0b110010(0x32) - 1.138V
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_vtm_vmeter_measure(uint32_t vdetsel, upwr_callb callb)
- {
- upwr_volt_vmeter_meas_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_VOLTM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_VOLTM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_VOLTM, UPWR_VTM_VMETER_MEAS);
- txmsg.hdr.arg = vdetsel;
- upwr_srv_req(UPWR_SG_VOLTM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_vtm_pmic_config() - Configures the SoC PMIC (Power Management IC).
- * @config: pointer to a PMIC-dependent struct defining the PMIC configuration.
- * @size: size of the struct pointed by config, in bytes.
- * @callb: pointer to the callback called when configurations are applied.
- * NULL if no callback is required.
- *
- * The function requests uPower to change/define the PMIC configuration.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -2 if the pointer conversion to physical address failed,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_vtm_pmic_config(const void *config, uint32_t size, upwr_callb callb)
- {
- upwr_pwm_pmiccfg_msg txmsg = {0};
- unsigned long ptrval = 0UL; /* needed for X86, ARM64 */
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_VOLTM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_VOLTM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_VOLTM, UPWR_VTM_PMIC_CONFIG);
- ptrval = (unsigned long)os_ptr2phy(config);
- if (ptrval == 0UL) {
- return -2; /* pointer conversion failed */
- }
- txmsg.ptr = upwr_ptr2offset(ptrval,
- UPWR_SG_VOLTM,
- (size_t)size,
- 0U,
- config);
- upwr_srv_req(UPWR_SG_VOLTM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**---------------------------------------------------------------
- * TEMPERATURE MANAGEMENT SERVICE GROUP
- */
- /**
- * upwr_tpm_get_temperature() - request uPower to get temperature of one temperature sensor
- * @sensor_id: temperature sensor ID, support 0~2
- * @callb: response callback pointer; NULL if no callback needed.
- * (polling used instead)
- *
- * The function requests uPower to measure temperature
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_TEMPM as the service group argument.
- *
- * The temperature data read from uPower via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- *
- * uPower return TSEL to the caller (M33 or A35), caller calculate the real temperature
- * Tsh = 0.000002673049*TSEL[7:0]^3 + 0.0003734262*TSEL[7:0]^2 +
- 0.4487042*TSEL[7:0] - 46.98694
- *
- * upower fw needs support cocurrent request from M33 and A35.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_tpm_get_temperature(uint32_t sensor_id, upwr_callb callb)
- {
- upwr_temp_get_cur_temp_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_TEMPM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_TEMPM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_TEMPM, UPWR_TEMP_GET_CUR_TEMP);
- txmsg.args.sensor_id = sensor_id;
- upwr_srv_req(UPWR_SG_TEMPM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**---------------------------------------------------------------
- * DELAY MANAGEMENT SERVICE GROUP
- */
- /**
- * upwr_dlm_get_delay_margin() - request uPower to get delay margin
- * @path: The critical path
- * @index: Use whitch delay meter
- * @callb: response callback pointer; NULL if no callback needed.
- * (polling used instead)
- *
- * The function requests uPower to get delay margin
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_DELAYM as the service group argument.
- *
- * The delay margin data read from uPower via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- * upower fw needs support cocurrent request from M33 and A35.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_dlm_get_delay_margin(uint32_t path, uint32_t index, upwr_callb callb)
- {
- upwr_dmeter_get_delay_margin_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_DELAYM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_DELAYM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_DELAYM, UPWR_DMETER_GET_DELAY_MARGIN);
- txmsg.args.path = path;
- txmsg.args.index = index;
- upwr_srv_req(UPWR_SG_DELAYM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_dlm_set_delay_margin() - request uPower to set delay margin
- * @path: The critical path
- * @index: Use whitch delay meter
- * @delay_margin: the value of delay margin
- * @callb: response callback pointer; NULL if no callback needed.
- * (polling used instead)
- *
- * The function requests uPower to set delay margin
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_DELAYM as the service group argument.
- *
- * The result of the corresponding critical path, failed or not read from uPower via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- * upower fw needs support cocurrent request from M33 and A35.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_dlm_set_delay_margin(uint32_t path, uint32_t index, uint32_t delay_margin,
- upwr_callb callb)
- {
- upwr_dmeter_set_delay_margin_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_DELAYM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_DELAYM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_DELAYM, UPWR_DMETER_SET_DELAY_MARGIN);
- txmsg.args.path = path;
- txmsg.args.index = index;
- txmsg.args.dm = delay_margin;
- upwr_srv_req(UPWR_SG_DELAYM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_dlm_process_monitor() - request uPower to do process monitor
- * @chain_sel: Chain Cell Type Selection
- * Select the chain to be used for the clock signal generation.
- * Support two types chain cell, 0~1
- 0b - P4 type delay cells selected
- 1b - P16 type delay cells selected
- * @callb: response callback pointer; NULL if no callback needed.
- * (polling used instead)
- *
- * The function requests uPower to do process monitor
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_DELAYM as the service group argument.
- *
- * The result of process monitor, failed or not read from uPower via
- * the callback argument ret, or written to the variable pointed by retptr,
- * if polling is used (calls upwr_req_status or upwr_poll_req_status).
- * ret (or *retptr) also returns the data written on writes.
- * upower fw needs support cocurrent request from M33 and A35.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_dlm_process_monitor(uint32_t chain_sel, upwr_callb callb)
- {
- upwr_pmon_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_DELAYM)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_DELAYM, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_DELAYM, UPWR_PMON_REQ);
- txmsg.args.chain_sel = chain_sel;
- upwr_srv_req(UPWR_SG_DELAYM, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**---------------------------------------------------------------
- * POWER MANAGEMENT SERVICE GROUP
- */
- /**
- * upwr_pwm_dom_power_on() - Commands uPower to power on the platform of other
- * domain (not necessarily its core(s)); does not release the core reset.
- * @domain: identifier of the domain to power on. Defined by SoC-dependent type
- * soc_domain_t found in upower_soc_defs.h.
- * @boot_start: must be 1 to start the domain core(s) boot(s), releasing
- * its (their) resets, or 0 otherwise.
- * @pwroncallb: pointer to the callback to be called when the uPower has
- * finished the power on procedure, or NULL if no callback needed
- * (polling used instead).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -2 if the domain passed is the same as the caller,
- * -3 if called in an invalid API state
- */
- int upwr_pwm_dom_power_on(soc_domain_t domain,
- int boot_start,
- const upwr_callb pwroncallb)
- {
- upwr_pwm_dom_pwron_msg txmsg = {0};
- if (pwr_domain == domain) {
- return -2;
- }
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, (upwr_callb)pwroncallb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_DOM_PWRON);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = (uint32_t)boot_start;
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_boot_start() - Commands uPower to release the reset of other CPU(s),
- * starting their boots.
- * @domain: identifier of the domain to release the reset. Defined by
- * SoC-dependent type soc_domain_t found in upower_soc_defs.h.
- * @bootcallb: pointer to the callback to be called when the uPower has finished
- * the boot start procedure, or NULL if no callback needed
- * (polling used instead).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * The callback calling doesn't mean the CPUs boots have finished:
- * it only indicates that uPower released the CPUs resets, and can receive
- * other power management service group requests.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -2 if the domain passed is the same as the caller,
- * -3 if called in an invalid API state
- */
- int upwr_pwm_boot_start(soc_domain_t domain, const upwr_callb bootcallb)
- {
- upwr_pwm_boot_start_msg txmsg = {0};
- if (pwr_domain == domain) {
- return -2;
- }
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, (upwr_callb)bootcallb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_BOOT);
- txmsg.hdr.domain = (uint32_t)domain;
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_param() - Changes Power Management parameters.
- * @param: pointer to a parameter structure upwr_pwm_param_t, SoC-dependent,
- * defined in upwr_soc_defines.h. NULL may be passed, meaning
- * a request to read the parameter set, in which case it appears in the callback
- * argument ret, or can be pointed by argument retptr in the upwr_req_status and
- * upwr_poll_req_status calls, casted to upwr_pwm_param_t.
- * @callb: response callback pointer; NULL if no callback needed.
- *
- * The return value is always the current parameter set value, either in a
- * read-only request (param = NULL) or after setting a new parameter
- * (non-NULL param).
- *
- * Some parameters may be targeted for a specific domain (see the struct
- * upwr_pwm_param_t definition in upower_soc_defs.h); this call has implicit
- * domain target (the same domain from which is called).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded or
- * not.
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_pwm_param(upwr_pwm_param_t *param, const upwr_callb callb)
- {
- upwr_pwm_param_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_PARAM);
- if (param == NULL) {
- txmsg.hdr.arg = 1U; /* 1= read, txmsg.word2 ignored */
- } else {
- txmsg.hdr.arg = 0U; /* 1= write */
- txmsg.word2 = param->R; /* just 1 word, so that's ok */
- }
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_chng_reg_voltage() - Changes the voltage at a given regulator.
- * @reg: regulator id.
- * @volt: voltage value; value unit is SoC-dependent, converted from mV by the
- * macro UPWR_VTM_MILIV, or from micro-Volts by the macro UPWR_VTM_MICROV,
- * both macros in upower_soc_defs.h
- * @callb: response callback pointer; NULL if no callback needed.
- *
- * The function requests uPower to change the voltage of the given regulator.
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate voltage value for the given domain process,
- * temperature and frequency.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_chng_reg_voltage(uint32_t reg, uint32_t volt, upwr_callb callb)
- {
- upwr_pwm_volt_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_VOLT);
- txmsg.args.reg = reg;
- txmsg.args.volt = volt;
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_freq_setup() - Determines the next frequency target for a given
- * domain and current frequency.
- * @domain: identifier of the domain to change frequency. Defined by
- * SoC-dependent type soc_domain_t found in upower_soc_defs.h.
- * @rail: the pmic regulator number for the target domain.
- * @stage: DVA adjust stage
- * refer to upower_defs.h "DVA adjust stage"
- * @target_freq: the target adjust frequency, accurate to MHz
- *
- * refer to upower_defs.h structure definition upwr_pwm_freq_msg
- *
- * @callb: response callback pointer; NULL if no callback needed.
- *
- * The DVA algorithm is broken down into two phases.
- * The first phase uses a look up table to get a safe operating voltage
- * for the requested frequency.
- * This voltage is guaranteed to work over process and temperature.
- *
- * The second step of the second phase is to measure the temperature
- * using the uPower Temperature Sensor module.
- * This is accomplished by doing a binary search of the TSEL bit field
- * in the Temperature Measurement Register (TMR).
- * The search is repeated until the THIGH bit fields in the same register change value.
- * There are 3 temperature sensors in 8ULP (APD, AVD, and RTD).
- *
- *
- * The second phase is the fine adjust of the voltage.
- * This stage is entered only when the new frequency requested
- * by application was already set as well as the voltage for that frequency.
- * The first step of the fine adjust is to find what is the current margins
- * for the monitored critical paths, or, in other words,
- * how many delay cells will be necessary to generate a setup-timing violation.
- * The function informs uPower that the given domain frequency has changed or
- * will change to the given value. uPower firmware will then adjust voltage and
- * bias to cope with the new frequency (if decreasing) or prepare for it
- * (if increasing). The function must be called after decreasing the frequency,
- * and before increasing it. The actual increase in frequency must not occur
- * before the service returns its response.
- *
- * So, for increase clock frequency case, user need to call this API twice,
- * the first stage gross adjust and the second stage fine adjust.
- *
- * for reduce clock frequency case, user can only call this API once,
- * full stage (combine gross stage and fine adjust)
- *
- * The request is executed if arguments are within range.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_freq_setup(soc_domain_t domain, uint32_t rail, uint32_t stage, uint32_t target_freq,
- upwr_callb callb)
- {
- upwr_pwm_freq_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_FREQ);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.args.rail = rail;
- txmsg.args.stage = stage;
- txmsg.args.target_freq = target_freq;
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_power_on()- Powers on (not off) one or more switches and ROM/RAMs.
- * @swton: pointer to an array of words that tells which power switches to
- * turn on. Each word in the array has 1 bit for each switch.
- * A bit=1 means the respective switch must be turned on,
- * bit = 0 means it will stay unchanged (on or off).
- * The pointer may be set to NULL, in which case no switch will be changed,
- * unless a memory that it feeds must be turned on.
- * WARNING: swton must not point to the first shared memory address.
- * @memon: pointer to an array of words that tells which memories to turn on.
- * Each word in the array has 1 bit for each switch.
- * A bit=1 means the respective memory must be turned on, both array and
- * periphery logic;
- * bit = 0 means it will stay unchanged (on or off).
- * The pointer may be set to NULL, in which case no memory will be changed.
- * WARNING: memon must not point to the first shared memory address.
- * @callb: pointer to the callback called when configurations are applyed.
- * NULL if no callback is required.
- *
- * The function requests uPower to turn on the PMC and memory array/peripheral
- * switches that control their power, as specified above.
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate memory power state related to overall system state.
- *
- * If a memory is requested to turn on, but the power switch that feeds that
- * memory is not, the power switch will be turned on anyway, if the pwron
- * array is not provided (that is, if pwron is NULL).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Callback or polling may return error if the service contends for a resource
- * already being used by a power mode transition or an ongoing service in
- * another domain.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -2 if a pointer conversion to physical address failed,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_power_on(const uint32_t swton[],
- const uint32_t memon[],
- upwr_callb callb)
- {
- upwr_pwm_pwron_msg txmsg = {0};
- unsigned long ptrval = 0UL; /* needed for X86, ARM64 */
- size_t stsize = 0U;
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_PWR_ON);
- ptrval = (unsigned long)os_ptr2phy((void *)swton);
- if (swton == NULL) {
- txmsg.ptrs.ptr0 = 0; /* NULL pointer -> 0 offset */
- } else if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- } else {
- txmsg.ptrs.ptr0 = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- (stsize = UPWR_PMC_SWT_WORDS * 4U),
- 0U,
- swton);
- }
- ptrval = (unsigned long)os_ptr2phy((void *)memon);
- if (memon == NULL) {
- txmsg.ptrs.ptr1 = 0; /* NULL pointer -> 0 offset */
- } else if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- } else {
- txmsg.ptrs.ptr1 = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- UPWR_PMC_MEM_WORDS * 4U,
- stsize,
- memon);
- }
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_power_off()- Powers off (not on) one or more switches and ROM/RAMs.
- * @swtoff: pointer to an array of words that tells which power switches to
- * turn off. Each word in the array has 1 bit for each switch.
- * A bit=1 means the respective switch must be turned off,
- * bit = 0 means it will stay unchanged (on or off).
- * The pointer may be set to NULL, in which case no switch will be changed.
- * WARNING: swtoff must not point to the first shared memory address.
- * @memoff: pointer to an array of words that tells which memories to turn off.
- * Each word in the array has 1 bit for each switch.
- * A bit=1 means the respective memory must be turned off, both array and
- * periphery logic;
- * bit = 0 means it will stay unchanged (on or off).
- * The pointer may be set to NULL, in which case no memory will be changed,
- * but notice it may be turned off if the switch that feeds it is powered off.
- * WARNING: memoff must not point to the first shared memory address.
- * @callb: pointer to the callback called when configurations are applyed.
- * NULL if no callback is required.
- *
- * The function requests uPower to turn off the PMC and memory array/peripheral
- * switches that control their power, as specified above.
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate memory power state related to overall system state.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Callback or polling may return error if the service contends for a resource
- * already being used by a power mode transition or an ongoing service in
- * another domain.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -2 if a pointer conversion to physical address failed,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_power_off(const uint32_t swtoff[],
- const uint32_t memoff[],
- upwr_callb callb)
- {
- upwr_pwm_pwroff_msg txmsg = {0};
- unsigned long ptrval = 0UL; /* needed for X86, ARM64 */
- size_t stsize = 0;
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_PWR_OFF);
- ptrval = (unsigned long)os_ptr2phy((void *)swtoff);
- if (swtoff == NULL) {
- txmsg.ptrs.ptr0 = 0; /* NULL pointer -> 0 offset */
- } else if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- } else {
- txmsg.ptrs.ptr0 = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- (stsize = UPWR_PMC_SWT_WORDS * 4U),
- 0U,
- swtoff);
- }
- ptrval = (unsigned long)os_ptr2phy((void *)memoff);
- if (memoff == NULL) {
- txmsg.ptrs.ptr1 = 0; /* NULL pointer -> 0 offset */
- } else if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- } else {
- txmsg.ptrs.ptr1 = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- UPWR_PMC_MEM_WORDS * 4U,
- stsize,
- memoff);
- }
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_mem_retain()- Configures one or more memory power switches to
- * retain its contents, having the power array on, while its peripheral logic
- * is turned off.
- * @mem: pointer to an array of words that tells which memories to put in a
- * retention state. Each word in the array has 1 bit for each memory.
- * A bit=1 means the respective memory must be put in retention state,
- * bit = 0 means it will stay unchanged (retention, fully on or off).
- * @callb: pointer to the callback called when configurations are applyed.
- * NULL if no callback is required.
- *
- * The function requests uPower to turn off the memory peripheral and leave
- * its array on, as specified above.
- * The request is executed if arguments are within range.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Callback or polling may return error if the service contends for a resource
- * already being used by a power mode transition or an ongoing service in
- * another domain.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -2 if a pointer conversion to physical address failed,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_mem_retain(const uint32_t mem[], upwr_callb callb)
- {
- upwr_pwm_retain_msg txmsg = {0};
- unsigned long ptrval = 0UL; /* needed for X86, ARM64 */
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_RETAIN);
- ptrval = (unsigned long)os_ptr2phy((void *)mem);
- if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- }
- txmsg.ptr = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- UPWR_PMC_MEM_WORDS * 4U,
- 0U,
- mem);
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_chng_switch_mem() - Turns on/off power on one or more PMC switches
- * and memories, including their array and peripheral logic.
- * @swt: pointer to a list of PMC switches to be opened/closed.
- * The list is structured as an array of struct upwr_switch_board_t
- * (see upower_defs.h), each one containing a word for up to 32 switches,
- * one per bit. A bit = 1 means switch closed, bit = 0 means switch open.
- * struct upwr_switch_board_t also specifies a mask with 1 bit for each
- * respective switch: mask bit = 1 means the open/close action is applied,
- * mask bit = 0 means the switch stays unchanged.
- * The pointer may be set to NULL, in which case no switch will be changed,
- * unless a memory that it feeds must be turned on.
- * WARNING: swt must not point to the first shared memory address.
- * @mem: pointer to a list of switches to be turned on/off.
- * The list is structured as an array of struct upwr_mem_switches_t
- * (see upower_defs.h), each one containing 2 word for up to 32 switches,
- * one per bit, one word for the RAM array power switch, other for the
- * RAM peripheral logic power switch. A bit = 1 means switch closed,
- * bit = 0 means switch open.
- * struct upwr_mem_switches_t also specifies a mask with 1 bit for each
- * respective switch: mask bit = 1 means the open/close action is applied,
- * mask bit = 0 means the switch stays unchanged.
- * The pointer may be set to NULL, in which case no memory switch will be
- * changed, but notice it may be turned off if the switch that feeds it is
- * powered off.
- * WARNING: mem must not point to the first shared memory address.
- * @callb: pointer to the callback called when the configurations are applied.
- * NULL if no callback is required.
- *
- * The function requests uPower to change the PMC switches and/or memory power
- * as specified above.
- * The request is executed if arguments are within range, with no protections
- * regarding the adequate switch combinations and overall system state.
- *
- * If a memory is requested to turn on, but the power switch that feeds that
- * memory is not, the power switch will be turned on anyway, if the swt
- * array is not provided (that is, if swt is NULL).
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Callback or polling may return error if the service contends for a resource
- * already being used by a power mode transition or an ongoing service in
- * another domain.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy.
- * -2 if a pointer conversion to physical address failed,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_chng_switch_mem(const struct upwr_switch_board_t swt[],
- const struct upwr_mem_switches_t mem[],
- upwr_callb callb)
- {
- upwr_pwm_switch_msg txmsg = {0};
- unsigned long ptrval = 0UL; /* needed for X86, ARM64 */
- size_t stsize = 0U;
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_SWITCH);
- ptrval = (unsigned long)os_ptr2phy((void *)swt);
- if (swt == NULL) {
- txmsg.ptrs.ptr0 = 0; /* NULL pointer -> 0 offset */
- } else if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- } else {
- txmsg.ptrs.ptr0 = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- (stsize = UPWR_PMC_SWT_WORDS * sizeof(struct upwr_switch_board_t)),
- 0U,
- swt);
- }
- ptrval = (unsigned long)os_ptr2phy((void *)mem);
- if (mem == NULL) {
- txmsg.ptrs.ptr1 = 0; /* NULL pointer -> 0 offset */
- } else if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- } else {
- txmsg.ptrs.ptr1 = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- UPWR_PMC_MEM_WORDS * sizeof(struct upwr_mem_switches_t),
- stsize,
- mem);
- }
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_pmode_config() - Configures a given power mode in a given domain.
- * @domain: identifier of the domain to which the power mode belongs.
- * Defined by SoC-dependent type soc_domain_t found in upower_soc_defs.h.
- * @pmode: SoC-dependent power mode identifier defined by type abs_pwr_mode_t
- * found in upower_soc_defs.h.
- * @config: pointer to an SoC-dependent struct defining the power mode
- * configuration, found in upower_soc_defs.h.
- * @callb: pointer to the callback called when configurations are applied.
- * NULL if no callback is required.
- *
- * The function requests uPower to change the power mode configuration as
- * specified above. The request is executed if arguments are within range,
- * and complies with SoC-dependent restrictions on value combinations.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -2 if the pointer conversion to physical address failed,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_pmode_config(soc_domain_t domain,
- abs_pwr_mode_t pmode,
- const void *config,
- upwr_callb callb)
- {
- upwr_pwm_pmode_cfg_msg txmsg = {0};
- unsigned long ptrval = 0UL; /* needed for X86, ARM64 */
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_CONFIG);
- txmsg.hdr.domain = (uint32_t)domain;
- txmsg.hdr.arg = pmode;
- ptrval = (unsigned long)os_ptr2phy(config);
- if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- }
- /*
- * upwr_pwm_pmode_config is an exception: use the pointer
- * (physical addr) as is
- */
- txmsg.ptr = (uint32_t)ptrval;
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_reg_config() - Configures the uPower internal regulators.
- * @config: pointer to the struct defining the regulator configuration;
- * the struct upwr_reg_config_t is defined in the file upower_defs.h.
- * @callb: pointer to the callback called when configurations are applied.
- * NULL if no callback is required.
- *
- * The function requests uPower to change/define the configurations of the
- * internal regulators.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * The service may fail with error UPWR_RESP_RESOURCE if a power mode transition
- * or the same service (called from another domain) is executing simultaneously.
- * This error should be interpreted as a "try later" response, as the service
- * will succeed once those concurrent executions are done, and no other is
- * started.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -2 if the pointer conversion to physical address failed,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_reg_config(const struct upwr_reg_config_t *config,
- upwr_callb callb)
- {
- upwr_pwm_regcfg_msg txmsg = {0};
- unsigned long ptrval = 0UL; /* needed for X86, ARM64 */
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_REGCFG);
- ptrval = (unsigned long)os_ptr2phy(config);
- if (ptrval == 0U) {
- return -2; /* pointer conversion failed */
- }
- txmsg.ptr = upwr_ptr2offset(ptrval,
- UPWR_SG_PWRMGMT,
- sizeof(struct upwr_reg_config_t),
- 0U,
- config);
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_chng_dom_bias() - Changes the domain bias.
- * @bias: pointer to a domain bias configuration struct (see upower_soc_defs.h).
- * @callb: pointer to the callback called when configurations are applied.
- * NULL if no callback is required.
- *
- * The function requests uPower to change the domain bias configuration as
- * specified above. The request is executed if arguments are within range,
- * with no protections regarding the adequate value combinations and
- * overall system state.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_chng_dom_bias(const struct upwr_dom_bias_cfg_t *bias,
- upwr_callb callb)
- {
- upwr_pwm_dom_bias_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_DOM_BIAS);
- /* SoC-dependent argument filling, defined in upower_soc_defs.h */
- UPWR_FILL_DOMBIAS_ARGS(txmsg.hdr.domain, bias, txmsg.args);
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**
- * upwr_pwm_chng_mem_bias()- Changes a ROM/RAM power bias.
- * @domain: identifier of the domain upon which the bias is applied.
- * Defined by SoC-dependent type soc_domain_t found in upower_soc_defs.h.
- * @bias: pointer to a memory bias configuration struct (see upower_soc_defs.h).
- * @callb: pointer to the callback called when configurations are applied.
- * NULL if no callback is required.
- *
- * The function requests uPower to change the memory bias configuration as
- * specified above. The request is executed if arguments are within range,
- * with no protections regarding the adequate value combinations and
- * overall system state.
- *
- * A callback can be optionally registered, and will be called upon the arrival
- * of the request response from the uPower firmware, telling if it succeeded
- * or not.
- *
- * A callback may not be registered (NULL pointer), in which case polling has
- * to be used to check the response, by calling upwr_req_status or
- * upwr_poll_req_status, using UPWR_SG_PWRMGMT as the service group argument.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok, -1 if service group is busy,
- * -3 if called in an invalid API state.
- * Note that this is not the error response from the request itself:
- * it only tells if the request was successfully sent to the uPower.
- */
- int upwr_pwm_chng_mem_bias(soc_domain_t domain,
- const struct upwr_mem_bias_cfg_t *bias,
- upwr_callb callb)
- {
- upwr_pwm_mem_bias_msg txmsg = {0};
- if (api_state != UPWR_API_READY) {
- return -3;
- }
- if (UPWR_SG_BUSY(UPWR_SG_PWRMGMT)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_PWRMGMT, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_PWRMGMT, UPWR_PWM_MEM_BIAS);
- txmsg.hdr.domain = (uint32_t)domain;
- /* SoC-dependent argument filling, defined in upower_soc_defs.h */
- UPWR_FILL_MEMBIAS_ARGS(bias, txmsg.args);
- upwr_srv_req(UPWR_SG_PWRMGMT, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**---------------------------------------------------------------
- * DIAGNOSE SERVICE GROUP
- */
- /**
- * upwr_dgn_mode() - Sets the diagnostic mode.
- * @mode: diagnostic mode, which can be:
- * - UPWR_DGN_NONE: no diagnostic recorded
- * - UPWR_DGN_TRACE: warnings, errors, service, internal activity recorded
- * - UPWR_DGN_SRVREQ: warnings, errors, service activity recorded
- * - UPWR_DGN_WARN: warnings and errors recorded
- * - UPWR_DGN_ALL: trace, service, warnings, errors, task state recorded
- * - UPWR_DGN_ERROR: only errors recorded
- * - UPWR_DGN_ALL2ERR: record all until an error occurs,
- * freeze recording on error
- * - UPWR_DGN_ALL2HLT: record all until an error occurs,
- * executes an ebreak on error, which halts the core if enabled through
- * the debug interface
- * @callb: pointer to the callback called when mode is changed.
- * NULL if no callback is required.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok,
- * -1 if service group is busy,
- * -3 if called in an invalid API state
- */
- int upwr_dgn_mode(upwr_dgn_mode_t mode, const upwr_callb callb)
- {
- upwr_dgn_mode_msg txmsg = {0};
- if (UPWR_SG_BUSY(UPWR_SG_DIAG)) {
- return -1;
- }
- UPWR_USR_CALLB(UPWR_SG_DIAG, callb);
- UPWR_MSG_HDR(txmsg.hdr, UPWR_SG_DIAG, UPWR_DGN_MODE);
- txmsg.hdr.arg = mode;
- upwr_srv_req(UPWR_SG_DIAG, (uint32_t *)&txmsg, sizeof(txmsg) / 4U);
- return 0;
- }
- /**---------------------------------------------------------------
- * AUXILIARY CALLS
- */
- /**
- * upwr_rom_version() - informs the ROM firwmware version.
- * @vmajor: pointer to the variable to get the firmware major version number.
- * @vminor: pointer to the variable to get the firmware minor version number.
- * @vfixes: pointer to the variable to get the firmware fixes number.
- *
- * Context: no sleep, no locks taken/released.
- * Return: SoC id.
- */
- uint32_t upwr_rom_version(uint32_t *vmajor, uint32_t *vminor, uint32_t *vfixes)
- {
- uint32_t soc;
- upwr_lock(1);
- soc = fw_rom_version.soc_id;
- *vmajor = fw_rom_version.vmajor;
- *vminor = fw_rom_version.vminor;
- *vfixes = fw_rom_version.vfixes;
- upwr_lock(0);
- return soc;
- }
- /**
- * upwr_ram_version() - informs the RAM firwmware version.
- * @vminor: pointer to the variable to get the firmware minor version number.
- * @vfixes: pointer to the variable to get the firmware fixes number.
- *
- * The 3 values returned are 0 if no RAM firmwmare was loaded and initialized.
- *
- * Context: no sleep, no locks taken/released.
- * Return: firmware major version number.
- */
- uint32_t upwr_ram_version(uint32_t *vminor, uint32_t *vfixes)
- {
- uint32_t vmajor;
- upwr_lock(1);
- vmajor = fw_ram_version.vmajor;
- *vminor = fw_ram_version.vminor;
- *vfixes = fw_ram_version.vfixes;
- upwr_lock(0);
- return vmajor;
- }
- /**
- * upwr_req_status() - tells the status of the service group request, and
- * returns a request return value, if any.
- * @sg: service group of the request
- * @sgfptr: pointer to the variable that will hold the function id of
- * the last request completed; can be NULL, in which case it is not used.
- * @errptr: pointer to the variable that will hold the error code;
- * can be NULL, in which case it is not used.
- * @retptr: pointer to the variable that will hold the value returned
- * by the last request completed (invalid if the last request completed didn't
- * return any value); can be NULL, in which case it is not used.
- * Note that a request may return a value even if service error is returned
- * (*errptr != UPWR_RESP_OK): that is dependent on the specific service.
- *
- * This call can be used in a poll loop of a service request completion in case
- * a callback was not registered.
- *
- * Context: no sleep, no locks taken/released.
- * Return: service request status: succeeded, failed, or ongoing (busy)
- */
- upwr_req_status_t upwr_req_status(upwr_sg_t sg,
- uint32_t *sgfptr,
- upwr_resp_t *errptr,
- int *retptr)
- {
- upwr_req_status_t status;
- upwr_lock(1);
- if (sgfptr != NULL) {
- *sgfptr = (uint32_t)sg_rsp_msg[sg].hdr.function;
- }
- if (errptr != NULL) {
- *errptr = (upwr_resp_t)sg_rsp_msg[sg].hdr.errcode;
- }
- if (retptr != NULL) {
- *retptr = (int)((sg_rsp_siz[sg] == 2U) ?
- sg_rsp_msg[sg].word2 : sg_rsp_msg[sg].hdr.ret);
- }
- status = ((sg_busy & (1UL << sg)) == 1U) ? UPWR_REQ_BUSY :
- (sg_rsp_msg[sg].hdr.errcode == UPWR_RESP_OK) ? UPWR_REQ_OK :
- UPWR_REQ_ERR;
- upwr_lock(0);
- return status;
- }
- /**
- * upwr_poll_req_status() - polls the status of the service group request, and
- * returns a request return value, if any.
- * @sg: service group of the request
- * @sgfptr: pointer to the variable that will hold the function id of
- * the last request completed; can be NULL, in which case it is not used.
- * @errptr: pointer to the variable that will hold the error code;
- * can be NULL, in which case it is not used.
- * @retptr: pointer to the variable that will hold the value returned
- * by the last request completed (invalid if the last request completed didn't
- * return any value); can be NULL, in which case it is not used.
- * Note that a request may return a value even if service error is returned
- * (*errptr != UPWR_RESP_OK): that is dependent on the specific service.
- * @attempts: maximum number of polling attempts; if attempts > 0 and is
- * reached with no service response received, upwr_poll_req_status returns
- * UPWR_REQ_BUSY and variables pointed by sgfptr, retptr and errptr are not
- * updated; if attempts = 0, upwr_poll_req_status waits "forever".
- *
- * This call can be used to poll a service request completion in case a
- * callback was not registered.
- *
- * Context: no sleep, no locks taken/released.
- * Return: service request status: succeeded, failed, or ongoing (busy)
- */
- upwr_req_status_t upwr_poll_req_status(upwr_sg_t sg,
- uint32_t *sgfptr,
- upwr_resp_t *errptr,
- int *retptr,
- uint32_t attempts)
- {
- uint32_t i;
- upwr_req_status_t ret;
- if (attempts == 0U) {
- while ((ret = upwr_req_status(sg, sgfptr, errptr, retptr)) == UPWR_REQ_BUSY) {
- };
- return ret;
- }
- for (i = 0U; i < attempts; i++) {
- ret = upwr_req_status(sg, sgfptr, errptr, retptr);
- if (ret != UPWR_REQ_BUSY) {
- break;
- }
- }
- return ret;
- }
- /**
- * upwr_alarm_code() - returns the alarm code of the last alarm occurrence.
- *
- * The value returned is not meaningful if no alarm was issued by uPower.
- *
- * Context: no sleep, no locks taken/released.
- * Return: alarm code, as defined by the type upwr_alarm_t in upwr_soc_defines.h
- */
- upwr_alarm_t upwr_alarm_code(void)
- {
- return (upwr_alarm_t)(3U & (mu->FSR.R >> 1U)); /* FSR[2:1] */
- }
- /**---------------------------------------------------------------
- * TRANSMIT/RECEIVE PRIMITIVES
- * ---------------------------------------------------------------
- */
- /*
- * upwr_copy2tr() - copies a message to the MU TR registers;
- * fill the TR registers before writing TIEN to avoid early interrupts;
- * also, fill them from the higher index to the lowest, so the receive
- * interrupt flag RF[0] will be the last to set, regardless of message size;
- */
- void upwr_copy2tr(struct MU_t *local_mu, const uint32_t *msg, unsigned int size)
- {
- for (int i = (int)size - 1; i > -1; i--) {
- local_mu->TR[i].R = msg[i];
- }
- }
- /**
- * upwr_tx() - queues a message for transmission.
- * @msg : pointer to the message sent.
- * @size: message size in 32-bit words
- * @callback: pointer to a function to be called when transmission done;
- * can be NULL, in which case no callback is done.
- *
- * This is an auxiliary function used by the rest of the API calls.
- * It is normally not called by the driver code, unless maybe for test purposes.
- *
- * Context: no sleep, no locks taken/released.
- * Return: number of vacant positions left in the transmission queue, or
- * -1 if the queue was already full when upwr_tx was called, or
- * -2 if any argument is invalid (like size off-range)
- */
- int upwr_tx(const uint32_t *msg,
- unsigned int size,
- UPWR_TX_CALLB_FUNC_T callback)
- {
- if (size > UPWR_MU_MSG_SIZE) {
- return -2;
- }
- if (size == 0U) {
- return -2;
- }
- if (mu->TSR.R != UPWR_MU_TSR_EMPTY) {
- return -1; /* not all TE bits in 1: some data to send still */
- }
- mu_tx_callb = callback;
- upwr_copy2tr(mu, msg, size);
- mu->TCR.R = 1UL << (size - 1UL);
- mu_tx_pend = 1UL;
- return 0;
- }
- /**
- * upwr_rx() - unqueues a received message from the reception queue.
- * @msg: pointer to the message destination buffer.
- * @size: pointer to variable to hold message size in 32-bit words.
- *
- * This is an auxiliary function used by the rest of the API calls.
- * It is normally not called by the driver code, unless maybe for test purposes.
- *
- * Context: no sleep, no locks taken/released.
- * Return: number of messages remaining in the reception queue, or
- * -1 if the queue was already empty when upwr_rx was called, or
- * -2 if any argument is invalid (like mu off-range)
- */
- int upwr_rx(char *msg, unsigned int *size)
- {
- unsigned int len = mu->RSR.R;
- len = (len == 0x0U) ? 0U :
- (len == 0x1U) ? 1U :
- #if UPWR_MU_MSG_SIZE > 1
- (len == 0x3U) ? 2U :
- #if UPWR_MU_MSG_SIZE > 2
- (len == 0x7U) ? 3U :
- #if UPWR_MU_MSG_SIZE > 3
- (len == 0xFU) ? 4U :
- #endif
- #endif
- #endif
- 0xFFFFFFFFU; /* something wrong */
- if (len == 0xFFFFFFFFU) {
- return -3;
- }
- if (len == 0U) {
- return -1;
- }
- *size = len;
- /*
- * copy the received message to the rx queue,
- * so the interrupts are cleared.
- */
- msg_copy(msg, (char *)&mu->RR[0], len);
- mu->RCR.R = 1U; /* enable only RR[0] receive interrupt */
- return 0;
- }
- /**
- * upwr_rx_callback() - sets up a callback for a message receiving event.
- * @callback: pointer to a function to be called when a message arrives;
- * can be NULL, in which case no callback is done.
- *
- * This is an auxiliary function used by the rest of the API calls.
- * It is normally not called by the driver code, unless maybe for test purposes.
- *
- * Context: no sleep, no locks taken/released.
- * Return: 0 if ok; -2 if any argument is invalid (mu off-range).
- */
- int upwr_rx_callback(UPWR_RX_CALLB_FUNC_T callback)
- {
- mu_rx_callb = callback;
- return 0;
- }
- /**
- * msg_copy() - copies a message.
- * @dest: pointer to the destination message.
- * @src : pointer to the source message.
- * @size: message size in words.
- *
- * This is an auxiliary function used by the rest of the API calls.
- * It is normally not called by the driver code, unless maybe for test purposes.
- *
- * Context: no sleep, no locks taken/released.
- * Return: none (void)
- */
- void msg_copy(char *dest, char *src, unsigned int size)
- {
- for (uint32_t i = 0U; i < size * sizeof(uint32_t); i++) {
- dest[i] = src[i];
- }
- }
|