| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Xilinx Zynq MPSoC Firmware layer
- *
- * Copyright (C) 2014-2022 Xilinx, Inc.
- * Copyright (C) 2022 - 2025 Advanced Micro Devices, Inc.
- *
- * Michal Simek <michal.simek@amd.com>
- * Davorin Mista <davorin.mista@aggios.com>
- * Jolly Shah <jollys@xilinx.com>
- * Rajan Vaja <rajanv@xilinx.com>
- */
- #include <linux/arm-smccc.h>
- #include <linux/compiler.h>
- #include <linux/device.h>
- #include <linux/init.h>
- #include <linux/mfd/core.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/of_platform.h>
- #include <linux/platform_device.h>
- #include <linux/pm_domain.h>
- #include <linux/slab.h>
- #include <linux/uaccess.h>
- #include <linux/hashtable.h>
- #include <linux/firmware/xlnx-zynqmp.h>
- #include <linux/firmware/xlnx-event-manager.h>
- #include "zynqmp-debug.h"
- /* Max HashMap Order for PM API feature check (1<<7 = 128) */
- #define PM_API_FEATURE_CHECK_MAX_ORDER 7
- /* CRL registers and bitfields */
- #define CRL_APB_BASE 0xFF5E0000U
- /* BOOT_PIN_CTRL- Used to control the mode pins after boot */
- #define CRL_APB_BOOT_PIN_CTRL (CRL_APB_BASE + (0x250U))
- /* BOOT_PIN_CTRL_MASK- out_val[11:8], out_en[3:0] */
- #define CRL_APB_BOOTPIN_CTRL_MASK 0xF0FU
- /* IOCTL/QUERY feature payload size */
- #define FEATURE_PAYLOAD_SIZE 2
- static bool feature_check_enabled;
- static DEFINE_HASHTABLE(pm_api_features_map, PM_API_FEATURE_CHECK_MAX_ORDER);
- static u32 ioctl_features[FEATURE_PAYLOAD_SIZE];
- static u32 query_features[FEATURE_PAYLOAD_SIZE];
- static u32 sip_svc_version;
- static struct platform_device *em_dev;
- /**
- * struct zynqmp_devinfo - Structure for Zynqmp device instance
- * @dev: Device Pointer
- * @feature_conf_id: Feature conf id
- */
- struct zynqmp_devinfo {
- struct device *dev;
- u32 feature_conf_id;
- };
- /**
- * struct pm_api_feature_data - PM API Feature data
- * @pm_api_id: PM API Id, used as key to index into hashmap
- * @feature_status: status of PM API feature: valid, invalid
- * @hentry: hlist_node that hooks this entry into hashtable
- */
- struct pm_api_feature_data {
- u32 pm_api_id;
- int feature_status;
- struct hlist_node hentry;
- };
- struct platform_fw_data {
- /*
- * Family code for platform.
- */
- const u32 family_code;
- };
- static struct platform_fw_data *active_platform_fw_data;
- static const struct mfd_cell firmware_devs[] = {
- {
- .name = "zynqmp_power_controller",
- },
- };
- /**
- * zynqmp_pm_ret_code() - Convert PMU-FW error codes to Linux error codes
- * @ret_status: PMUFW return code
- *
- * Return: corresponding Linux error code
- */
- static int zynqmp_pm_ret_code(u32 ret_status)
- {
- switch (ret_status) {
- case XST_PM_SUCCESS:
- case XST_PM_DOUBLE_REQ:
- return 0;
- case XST_PM_NO_FEATURE:
- return -ENOTSUPP;
- case XST_PM_INVALID_VERSION:
- return -EOPNOTSUPP;
- case XST_PM_NO_ACCESS:
- return -EACCES;
- case XST_PM_ABORT_SUSPEND:
- return -ECANCELED;
- case XST_PM_MULT_USER:
- return -EUSERS;
- case XST_PM_INTERNAL:
- case XST_PM_CONFLICT:
- case XST_PM_INVALID_NODE:
- case XST_PM_INVALID_CRC:
- default:
- return -EINVAL;
- }
- }
- static noinline int do_fw_call_fail(u32 *ret_payload, u32 num_args, ...)
- {
- return -ENODEV;
- }
- /*
- * PM function call wrapper
- * Invoke do_fw_call_smc or do_fw_call_hvc, depending on the configuration
- */
- static int (*do_fw_call)(u32 *ret_payload, u32, ...) = do_fw_call_fail;
- /**
- * do_fw_call_smc() - Call system-level platform management layer (SMC)
- * @num_args: Number of variable arguments should be <= 8
- * @ret_payload: Returned value array
- *
- * Invoke platform management function via SMC call (no hypervisor present).
- *
- * Return: Returns status, either success or error+reason
- */
- static noinline int do_fw_call_smc(u32 *ret_payload, u32 num_args, ...)
- {
- struct arm_smccc_res res;
- u64 args[8] = {0};
- va_list arg_list;
- u8 i;
- if (num_args > 8)
- return -EINVAL;
- va_start(arg_list, num_args);
- for (i = 0; i < num_args; i++)
- args[i] = va_arg(arg_list, u64);
- va_end(arg_list);
- arm_smccc_smc(args[0], args[1], args[2], args[3], args[4], args[5], args[6], args[7], &res);
- if (ret_payload) {
- ret_payload[0] = lower_32_bits(res.a0);
- ret_payload[1] = upper_32_bits(res.a0);
- ret_payload[2] = lower_32_bits(res.a1);
- ret_payload[3] = upper_32_bits(res.a1);
- ret_payload[4] = lower_32_bits(res.a2);
- ret_payload[5] = upper_32_bits(res.a2);
- ret_payload[6] = lower_32_bits(res.a3);
- }
- return zynqmp_pm_ret_code((enum pm_ret_status)res.a0);
- }
- /**
- * do_fw_call_hvc() - Call system-level platform management layer (HVC)
- * @num_args: Number of variable arguments should be <= 8
- * @ret_payload: Returned value array
- *
- * Invoke platform management function via HVC
- * HVC-based for communication through hypervisor
- * (no direct communication with ATF).
- *
- * Return: Returns status, either success or error+reason
- */
- static noinline int do_fw_call_hvc(u32 *ret_payload, u32 num_args, ...)
- {
- struct arm_smccc_res res;
- u64 args[8] = {0};
- va_list arg_list;
- u8 i;
- if (num_args > 8)
- return -EINVAL;
- va_start(arg_list, num_args);
- for (i = 0; i < num_args; i++)
- args[i] = va_arg(arg_list, u64);
- va_end(arg_list);
- arm_smccc_hvc(args[0], args[1], args[2], args[3], args[4], args[5], args[6], args[7], &res);
- if (ret_payload) {
- ret_payload[0] = lower_32_bits(res.a0);
- ret_payload[1] = upper_32_bits(res.a0);
- ret_payload[2] = lower_32_bits(res.a1);
- ret_payload[3] = upper_32_bits(res.a1);
- ret_payload[4] = lower_32_bits(res.a2);
- ret_payload[5] = upper_32_bits(res.a2);
- ret_payload[6] = lower_32_bits(res.a3);
- }
- return zynqmp_pm_ret_code((enum pm_ret_status)res.a0);
- }
- static int __do_feature_check_call(const u32 api_id, u32 *ret_payload)
- {
- int ret;
- u64 smc_arg[2];
- u32 module_id;
- u32 feature_check_api_id;
- module_id = FIELD_GET(MODULE_ID_MASK, api_id);
- /*
- * Feature check of APIs belonging to PM, XSEM, and TF-A are handled by calling
- * PM_FEATURE_CHECK API. For other modules, call PM_API_FEATURES API.
- */
- if (module_id == PM_MODULE_ID || module_id == XSEM_MODULE_ID || module_id == TF_A_MODULE_ID)
- feature_check_api_id = PM_FEATURE_CHECK;
- else
- feature_check_api_id = PM_API_FEATURES;
- /*
- * Feature check of TF-A APIs is done in the TF-A layer and it expects for
- * MODULE_ID_MASK bits of SMC's arg[0] to be the same as PM_MODULE_ID.
- */
- if (module_id == TF_A_MODULE_ID) {
- module_id = PM_MODULE_ID;
- smc_arg[1] = api_id;
- } else {
- smc_arg[1] = (api_id & API_ID_MASK);
- }
- smc_arg[0] = PM_SIP_SVC | FIELD_PREP(MODULE_ID_MASK, module_id) | feature_check_api_id;
- ret = do_fw_call(ret_payload, 2, smc_arg[0], smc_arg[1]);
- if (ret)
- ret = -EOPNOTSUPP;
- else
- ret = ret_payload[1];
- return ret;
- }
- static int do_feature_check_call(const u32 api_id)
- {
- int ret;
- u32 ret_payload[PAYLOAD_ARG_CNT];
- struct pm_api_feature_data *feature_data;
- /* Check for existing entry in hash table for given api */
- hash_for_each_possible(pm_api_features_map, feature_data, hentry,
- api_id) {
- if (feature_data->pm_api_id == api_id)
- return feature_data->feature_status;
- }
- /* Add new entry if not present */
- feature_data = kmalloc_obj(*feature_data, GFP_ATOMIC);
- if (!feature_data)
- return -ENOMEM;
- feature_data->pm_api_id = api_id;
- ret = __do_feature_check_call(api_id, ret_payload);
- feature_data->feature_status = ret;
- hash_add(pm_api_features_map, &feature_data->hentry, api_id);
- if (api_id == PM_IOCTL)
- /* Store supported IOCTL IDs mask */
- memcpy(ioctl_features, &ret_payload[2], FEATURE_PAYLOAD_SIZE * 4);
- else if (api_id == PM_QUERY_DATA)
- /* Store supported QUERY IDs mask */
- memcpy(query_features, &ret_payload[2], FEATURE_PAYLOAD_SIZE * 4);
- return ret;
- }
- /**
- * zynqmp_pm_feature() - Check whether given feature is supported or not and
- * store supported IOCTL/QUERY ID mask
- * @api_id: API ID to check
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_feature(const u32 api_id)
- {
- int ret;
- if (!feature_check_enabled)
- return 0;
- ret = do_feature_check_call(api_id);
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_feature);
- /**
- * zynqmp_pm_is_function_supported() - Check whether given IOCTL/QUERY function
- * is supported or not
- * @api_id: PM_IOCTL or PM_QUERY_DATA
- * @id: IOCTL or QUERY function IDs
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_is_function_supported(const u32 api_id, const u32 id)
- {
- int ret;
- u32 *bit_mask;
- /* Input arguments validation */
- if (id >= 64 || (api_id != PM_IOCTL && api_id != PM_QUERY_DATA))
- return -EINVAL;
- /* Check feature check API version */
- ret = do_feature_check_call(PM_FEATURE_CHECK);
- if (ret < 0)
- return ret;
- /* Check if feature check version 2 is supported or not */
- if ((ret & FIRMWARE_VERSION_MASK) == PM_API_VERSION_2) {
- /*
- * Call feature check for IOCTL/QUERY API to get IOCTL ID or
- * QUERY ID feature status.
- */
- ret = do_feature_check_call(api_id);
- if (ret < 0)
- return ret;
- bit_mask = (api_id == PM_IOCTL) ? ioctl_features : query_features;
- if ((bit_mask[(id / 32)] & BIT((id % 32))) == 0U)
- return -EOPNOTSUPP;
- } else {
- return -ENODATA;
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_is_function_supported);
- /**
- * zynqmp_pm_invoke_fw_fn() - Invoke the system-level platform management layer
- * caller function depending on the configuration
- * @pm_api_id: Requested PM-API call
- * @ret_payload: Returned value array
- * @num_args: Number of arguments to requested PM-API call
- *
- * Invoke platform management function for SMC or HVC call, depending on
- * configuration.
- * Following SMC Calling Convention (SMCCC) for SMC64:
- * Pm Function Identifier,
- * PM_SIP_SVC + PASS_THROUGH_FW_CMD_ID =
- * ((SMC_TYPE_FAST << FUNCID_TYPE_SHIFT)
- * ((SMC_64) << FUNCID_CC_SHIFT)
- * ((SIP_START) << FUNCID_OEN_SHIFT)
- * (PASS_THROUGH_FW_CMD_ID))
- *
- * PM_SIP_SVC - Registered ZynqMP SIP Service Call.
- * PASS_THROUGH_FW_CMD_ID - Fixed SiP SVC call ID for FW specific calls.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_invoke_fw_fn(u32 pm_api_id, u32 *ret_payload, u32 num_args, ...)
- {
- /*
- * Added SIP service call Function Identifier
- * Make sure to stay in x0 register
- */
- u64 smc_arg[SMC_ARG_CNT_64];
- int ret, i;
- va_list arg_list;
- u32 args[SMC_ARG_CNT_32] = {0};
- u32 module_id;
- if (num_args > SMC_ARG_CNT_32)
- return -EINVAL;
- va_start(arg_list, num_args);
- /* Check if feature is supported or not */
- ret = zynqmp_pm_feature(pm_api_id);
- if (ret < 0)
- return ret;
- for (i = 0; i < num_args; i++)
- args[i] = va_arg(arg_list, u32);
- va_end(arg_list);
- module_id = FIELD_GET(PLM_MODULE_ID_MASK, pm_api_id);
- if (module_id == 0)
- module_id = XPM_MODULE_ID;
- smc_arg[0] = PM_SIP_SVC | PASS_THROUGH_FW_CMD_ID;
- smc_arg[1] = ((u64)args[0] << 32U) | FIELD_PREP(PLM_MODULE_ID_MASK, module_id) |
- (pm_api_id & API_ID_MASK);
- for (i = 1; i < (SMC_ARG_CNT_64 - 1); i++)
- smc_arg[i + 1] = ((u64)args[(i * 2)] << 32U) | args[(i * 2) - 1];
- return do_fw_call(ret_payload, 8, smc_arg[0], smc_arg[1], smc_arg[2], smc_arg[3],
- smc_arg[4], smc_arg[5], smc_arg[6], smc_arg[7]);
- }
- /**
- * zynqmp_pm_invoke_fn() - Invoke the system-level platform management layer
- * caller function depending on the configuration
- * @pm_api_id: Requested PM-API call
- * @ret_payload: Returned value array
- * @num_args: Number of arguments to requested PM-API call
- *
- * Invoke platform management function for SMC or HVC call, depending on
- * configuration.
- * Following SMC Calling Convention (SMCCC) for SMC64:
- * Pm Function Identifier,
- * PM_SIP_SVC + PM_API_ID =
- * ((SMC_TYPE_FAST << FUNCID_TYPE_SHIFT)
- * ((SMC_64) << FUNCID_CC_SHIFT)
- * ((SIP_START) << FUNCID_OEN_SHIFT)
- * ((PM_API_ID) & FUNCID_NUM_MASK))
- *
- * PM_SIP_SVC - Registered ZynqMP SIP Service Call.
- * PM_API_ID - Platform Management API ID.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_invoke_fn(u32 pm_api_id, u32 *ret_payload, u32 num_args, ...)
- {
- /*
- * Added SIP service call Function Identifier
- * Make sure to stay in x0 register
- */
- u64 smc_arg[8];
- int ret, i;
- va_list arg_list;
- u32 args[14] = {0};
- if (num_args > 14)
- return -EINVAL;
- va_start(arg_list, num_args);
- /* Check if feature is supported or not */
- ret = zynqmp_pm_feature(pm_api_id);
- if (ret < 0)
- return ret;
- for (i = 0; i < num_args; i++)
- args[i] = va_arg(arg_list, u32);
- va_end(arg_list);
- smc_arg[0] = PM_SIP_SVC | pm_api_id;
- for (i = 0; i < 7; i++)
- smc_arg[i + 1] = ((u64)args[(i * 2) + 1] << 32) | args[i * 2];
- return do_fw_call(ret_payload, 8, smc_arg[0], smc_arg[1], smc_arg[2], smc_arg[3],
- smc_arg[4], smc_arg[5], smc_arg[6], smc_arg[7]);
- }
- static u32 pm_api_version;
- static u32 pm_tz_version;
- int zynqmp_pm_register_sgi(u32 sgi_num, u32 reset)
- {
- int ret;
- ret = zynqmp_pm_invoke_fn(TF_A_PM_REGISTER_SGI, NULL, 2, sgi_num, reset);
- if (ret != -EOPNOTSUPP && !ret)
- return ret;
- /* try old implementation as fallback strategy if above fails */
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 3, IOCTL_REGISTER_SGI, sgi_num, reset);
- }
- /**
- * zynqmp_pm_get_api_version() - Get version number of PMU PM firmware
- * @version: Returned version value
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_get_api_version(u32 *version)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!version)
- return -EINVAL;
- /* Check is PM API version already verified */
- if (pm_api_version > 0) {
- *version = pm_api_version;
- return 0;
- }
- ret = zynqmp_pm_invoke_fn(PM_GET_API_VERSION, ret_payload, 0);
- *version = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_get_api_version);
- /**
- * zynqmp_pm_get_chipid - Get silicon ID registers
- * @idcode: IDCODE register
- * @version: version register
- *
- * Return: Returns the status of the operation and the idcode and version
- * registers in @idcode and @version.
- */
- int zynqmp_pm_get_chipid(u32 *idcode, u32 *version)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!idcode || !version)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_GET_CHIPID, ret_payload, 0);
- *idcode = ret_payload[1];
- *version = ret_payload[2];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_get_chipid);
- /**
- * zynqmp_pm_get_family_info() - Get family info of platform
- * @family: Returned family code value
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_get_family_info(u32 *family)
- {
- if (!active_platform_fw_data)
- return -ENODEV;
- if (!family)
- return -EINVAL;
- *family = active_platform_fw_data->family_code;
- return 0;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_get_family_info);
- /**
- * zynqmp_pm_get_sip_svc_version() - Get SiP service call version
- * @version: Returned version value
- *
- * Return: Returns status, either success or error+reason
- */
- static int zynqmp_pm_get_sip_svc_version(u32 *version)
- {
- struct arm_smccc_res res;
- u64 args[SMC_ARG_CNT_64] = {0};
- if (!version)
- return -EINVAL;
- /* Check if SiP SVC version already verified */
- if (sip_svc_version > 0) {
- *version = sip_svc_version;
- return 0;
- }
- args[0] = GET_SIP_SVC_VERSION;
- arm_smccc_smc(args[0], args[1], args[2], args[3], args[4], args[5], args[6], args[7], &res);
- *version = ((lower_32_bits(res.a0) << 16U) | lower_32_bits(res.a1));
- return zynqmp_pm_ret_code(XST_PM_SUCCESS);
- }
- /**
- * zynqmp_pm_get_trustzone_version() - Get secure trustzone firmware version
- * @version: Returned version value
- *
- * Return: Returns status, either success or error+reason
- */
- static int zynqmp_pm_get_trustzone_version(u32 *version)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!version)
- return -EINVAL;
- /* Check is PM trustzone version already verified */
- if (pm_tz_version > 0) {
- *version = pm_tz_version;
- return 0;
- }
- ret = zynqmp_pm_invoke_fn(PM_GET_TRUSTZONE_VERSION, ret_payload, 0);
- *version = ret_payload[1];
- return ret;
- }
- /**
- * get_set_conduit_method() - Choose SMC or HVC based communication
- * @np: Pointer to the device_node structure
- *
- * Use SMC or HVC-based functions to communicate with EL2/EL3.
- *
- * Return: Returns 0 on success or error code
- */
- static int get_set_conduit_method(struct device_node *np)
- {
- const char *method;
- if (of_property_read_string(np, "method", &method)) {
- pr_warn("%s missing \"method\" property\n", __func__);
- return -ENXIO;
- }
- if (!strcmp("hvc", method)) {
- do_fw_call = do_fw_call_hvc;
- } else if (!strcmp("smc", method)) {
- do_fw_call = do_fw_call_smc;
- } else {
- pr_warn("%s Invalid \"method\" property: %s\n",
- __func__, method);
- return -EINVAL;
- }
- return 0;
- }
- /**
- * zynqmp_pm_query_data() - Get query data from firmware
- * @qdata: Variable to the zynqmp_pm_query_data structure
- * @out: Returned output value
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_query_data(struct zynqmp_pm_query_data qdata, u32 *out)
- {
- int ret, i = 0;
- u32 ret_payload[PAYLOAD_ARG_CNT] = {0};
- if (sip_svc_version >= SIP_SVC_PASSTHROUGH_VERSION) {
- ret = zynqmp_pm_invoke_fw_fn(PM_QUERY_DATA, ret_payload, 4,
- qdata.qid, qdata.arg1,
- qdata.arg2, qdata.arg3);
- /* To support backward compatibility */
- if (!ret && !ret_payload[0]) {
- /*
- * TF-A passes return status on 0th index but
- * api to get clock name reads data from 0th
- * index so pass data at 0th index instead of
- * return status
- */
- if (qdata.qid == PM_QID_CLOCK_GET_NAME ||
- qdata.qid == PM_QID_PINCTRL_GET_FUNCTION_NAME)
- i = 1;
- for (; i < PAYLOAD_ARG_CNT; i++, out++)
- *out = ret_payload[i];
- return ret;
- }
- }
- ret = zynqmp_pm_invoke_fn(PM_QUERY_DATA, out, 4, qdata.qid,
- qdata.arg1, qdata.arg2, qdata.arg3);
- /*
- * For clock name query, all bytes in SMC response are clock name
- * characters and return code is always success. For invalid clocks,
- * clock name bytes would be zeros.
- */
- return qdata.qid == PM_QID_CLOCK_GET_NAME ? 0 : ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_query_data);
- /**
- * zynqmp_pm_clock_enable() - Enable the clock for given id
- * @clock_id: ID of the clock to be enabled
- *
- * This function is used by master to enable the clock
- * including peripherals and PLL clocks.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_clock_enable(u32 clock_id)
- {
- return zynqmp_pm_invoke_fn(PM_CLOCK_ENABLE, NULL, 1, clock_id);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_clock_enable);
- /**
- * zynqmp_pm_clock_disable() - Disable the clock for given id
- * @clock_id: ID of the clock to be disable
- *
- * This function is used by master to disable the clock
- * including peripherals and PLL clocks.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_clock_disable(u32 clock_id)
- {
- return zynqmp_pm_invoke_fn(PM_CLOCK_DISABLE, NULL, 1, clock_id);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_clock_disable);
- /**
- * zynqmp_pm_clock_getstate() - Get the clock state for given id
- * @clock_id: ID of the clock to be queried
- * @state: 1/0 (Enabled/Disabled)
- *
- * This function is used by master to get the state of clock
- * including peripherals and PLL clocks.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_clock_getstate(u32 clock_id, u32 *state)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- ret = zynqmp_pm_invoke_fn(PM_CLOCK_GETSTATE, ret_payload, 1, clock_id);
- *state = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_clock_getstate);
- /**
- * zynqmp_pm_clock_setdivider() - Set the clock divider for given id
- * @clock_id: ID of the clock
- * @divider: divider value
- *
- * This function is used by master to set divider for any clock
- * to achieve desired rate.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_clock_setdivider(u32 clock_id, u32 divider)
- {
- return zynqmp_pm_invoke_fn(PM_CLOCK_SETDIVIDER, NULL, 2, clock_id, divider);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_clock_setdivider);
- /**
- * zynqmp_pm_clock_getdivider() - Get the clock divider for given id
- * @clock_id: ID of the clock
- * @divider: divider value
- *
- * This function is used by master to get divider values
- * for any clock.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_clock_getdivider(u32 clock_id, u32 *divider)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- ret = zynqmp_pm_invoke_fn(PM_CLOCK_GETDIVIDER, ret_payload, 1, clock_id);
- *divider = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_clock_getdivider);
- /**
- * zynqmp_pm_clock_setparent() - Set the clock parent for given id
- * @clock_id: ID of the clock
- * @parent_id: parent id
- *
- * This function is used by master to set parent for any clock.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_clock_setparent(u32 clock_id, u32 parent_id)
- {
- return zynqmp_pm_invoke_fn(PM_CLOCK_SETPARENT, NULL, 2, clock_id, parent_id);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_clock_setparent);
- /**
- * zynqmp_pm_clock_getparent() - Get the clock parent for given id
- * @clock_id: ID of the clock
- * @parent_id: parent id
- *
- * This function is used by master to get parent index
- * for any clock.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_clock_getparent(u32 clock_id, u32 *parent_id)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- ret = zynqmp_pm_invoke_fn(PM_CLOCK_GETPARENT, ret_payload, 1, clock_id);
- *parent_id = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_clock_getparent);
- /**
- * zynqmp_pm_set_pll_frac_mode() - PM API for set PLL mode
- *
- * @clk_id: PLL clock ID
- * @mode: PLL mode (PLL_MODE_FRAC/PLL_MODE_INT)
- *
- * This function sets PLL mode
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_set_pll_frac_mode(u32 clk_id, u32 mode)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, 0, IOCTL_SET_PLL_FRAC_MODE, clk_id, mode);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_pll_frac_mode);
- /**
- * zynqmp_pm_get_pll_frac_mode() - PM API for get PLL mode
- *
- * @clk_id: PLL clock ID
- * @mode: PLL mode
- *
- * This function return current PLL mode
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_get_pll_frac_mode(u32 clk_id, u32 *mode)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, mode, 3, 0, IOCTL_GET_PLL_FRAC_MODE, clk_id);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_get_pll_frac_mode);
- /**
- * zynqmp_pm_set_pll_frac_data() - PM API for setting pll fraction data
- *
- * @clk_id: PLL clock ID
- * @data: fraction data
- *
- * This function sets fraction data.
- * It is valid for fraction mode only.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_set_pll_frac_data(u32 clk_id, u32 data)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, 0, IOCTL_SET_PLL_FRAC_DATA, clk_id, data);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_pll_frac_data);
- /**
- * zynqmp_pm_get_pll_frac_data() - PM API for getting pll fraction data
- *
- * @clk_id: PLL clock ID
- * @data: fraction data
- *
- * This function returns fraction data value.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_get_pll_frac_data(u32 clk_id, u32 *data)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, data, 3, 0, IOCTL_GET_PLL_FRAC_DATA, clk_id);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_get_pll_frac_data);
- /**
- * zynqmp_pm_set_sd_tapdelay() - Set tap delay for the SD device
- *
- * @node_id: Node ID of the device
- * @type: Type of tap delay to set (input/output)
- * @value: Value to set fot the tap delay
- *
- * This function sets input/output tap delay for the SD device.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_set_sd_tapdelay(u32 node_id, u32 type, u32 value)
- {
- u32 reg = (type == PM_TAPDELAY_INPUT) ? SD_ITAPDLY : SD_OTAPDLYSEL;
- u32 mask = (node_id == NODE_SD_0) ? GENMASK(15, 0) : GENMASK(31, 16);
- if (value) {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, node_id, IOCTL_SET_SD_TAPDELAY, type,
- value);
- }
- /*
- * Work around completely misdesigned firmware API on Xilinx ZynqMP.
- * The IOCTL_SET_SD_TAPDELAY firmware call allows the caller to only
- * ever set IOU_SLCR SD_ITAPDLY Register SD0_ITAPDLYENA/SD1_ITAPDLYENA
- * bits, but there is no matching call to clear those bits. If those
- * bits are not cleared, SDMMC tuning may fail.
- *
- * Luckily, there are PM_MMIO_READ/PM_MMIO_WRITE calls which seem to
- * allow complete unrestricted access to all address space, including
- * IOU_SLCR SD_ITAPDLY Register and all the other registers, access
- * to which was supposed to be protected by the current firmware API.
- *
- * Use PM_MMIO_READ/PM_MMIO_WRITE to re-implement the missing counter
- * part of IOCTL_SET_SD_TAPDELAY which clears SDx_ITAPDLYENA bits.
- */
- return zynqmp_pm_invoke_fn(PM_MMIO_WRITE, NULL, 2, reg, mask);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_sd_tapdelay);
- /**
- * zynqmp_pm_sd_dll_reset() - Reset DLL logic
- *
- * @node_id: Node ID of the device
- * @type: Reset type
- *
- * This function resets DLL logic for the SD device.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_sd_dll_reset(u32 node_id, u32 type)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 3, node_id, IOCTL_SD_DLL_RESET, type);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_sd_dll_reset);
- /**
- * zynqmp_pm_ospi_mux_select() - OSPI Mux selection
- *
- * @dev_id: Device Id of the OSPI device.
- * @select: OSPI Mux select value.
- *
- * This function select the OSPI Mux.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_ospi_mux_select(u32 dev_id, u32 select)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 3, dev_id, IOCTL_OSPI_MUX_SELECT, select);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_ospi_mux_select);
- /**
- * zynqmp_pm_write_ggs() - PM API for writing global general storage (ggs)
- * @index: GGS register index
- * @value: Register value to be written
- *
- * This function writes value to GGS register.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_write_ggs(u32 index, u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, 0, IOCTL_WRITE_GGS, index, value);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_write_ggs);
- /**
- * zynqmp_pm_read_ggs() - PM API for reading global general storage (ggs)
- * @index: GGS register index
- * @value: Register value to be written
- *
- * This function returns GGS register value.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_read_ggs(u32 index, u32 *value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, value, 3, 0, IOCTL_READ_GGS, index);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_read_ggs);
- /**
- * zynqmp_pm_write_pggs() - PM API for writing persistent global general
- * storage (pggs)
- * @index: PGGS register index
- * @value: Register value to be written
- *
- * This function writes value to PGGS register.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_write_pggs(u32 index, u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, 0, IOCTL_WRITE_PGGS, index, value);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_write_pggs);
- /**
- * zynqmp_pm_read_pggs() - PM API for reading persistent global general
- * storage (pggs)
- * @index: PGGS register index
- * @value: Register value to be written
- *
- * This function returns PGGS register value.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_read_pggs(u32 index, u32 *value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, value, 3, 0, IOCTL_READ_PGGS, index);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_read_pggs);
- int zynqmp_pm_set_tapdelay_bypass(u32 index, u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, 0, IOCTL_SET_TAPDELAY_BYPASS, index, value);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_tapdelay_bypass);
- /**
- * zynqmp_pm_set_boot_health_status() - PM API for setting healthy boot status
- * @value: Status value to be written
- *
- * This function sets healthy bit value to indicate boot health status
- * to firmware.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_set_boot_health_status(u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 3, 0, IOCTL_SET_BOOT_HEALTH_STATUS, value);
- }
- /**
- * zynqmp_pm_reset_assert - Request setting of reset (1 - assert, 0 - release)
- * @reset: Reset to be configured
- * @assert_flag: Flag stating should reset be asserted (1) or
- * released (0)
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_reset_assert(const u32 reset,
- const enum zynqmp_pm_reset_action assert_flag)
- {
- return zynqmp_pm_invoke_fn(PM_RESET_ASSERT, NULL, 2, reset, assert_flag);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_reset_assert);
- /**
- * zynqmp_pm_reset_get_status - Get status of the reset
- * @reset: Reset whose status should be returned
- * @status: Returned status
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_reset_get_status(const u32 reset, u32 *status)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!status)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_RESET_GET_STATUS, ret_payload, 1, reset);
- *status = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_reset_get_status);
- /**
- * zynqmp_pm_fpga_load - Perform the fpga load
- * @address: Address to write to
- * @size: pl bitstream size
- * @flags: Bitstream type
- * -XILINX_ZYNQMP_PM_FPGA_FULL: FPGA full reconfiguration
- * -XILINX_ZYNQMP_PM_FPGA_PARTIAL: FPGA partial reconfiguration
- *
- * This function provides access to pmufw. To transfer
- * the required bitstream into PL.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_fpga_load(const u64 address, const u32 size, const u32 flags)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- ret = zynqmp_pm_invoke_fn(PM_FPGA_LOAD, ret_payload, 4, lower_32_bits(address),
- upper_32_bits(address), size, flags);
- if (ret_payload[0])
- return -ret_payload[0];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_fpga_load);
- /**
- * zynqmp_pm_fpga_get_status - Read value from PCAP status register
- * @value: Value to read
- *
- * This function provides access to the pmufw to get the PCAP
- * status
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_fpga_get_status(u32 *value)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!value)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_FPGA_GET_STATUS, ret_payload, 0);
- *value = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_fpga_get_status);
- /**
- * zynqmp_pm_fpga_get_config_status - Get the FPGA configuration status.
- * @value: Buffer to store FPGA configuration status.
- *
- * This function provides access to the pmufw to get the FPGA configuration
- * status
- *
- * Return: 0 on success, a negative value on error
- */
- int zynqmp_pm_fpga_get_config_status(u32 *value)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!value)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_FPGA_READ, ret_payload, 4,
- XILINX_ZYNQMP_PM_FPGA_CONFIG_STAT_OFFSET, 0, 0,
- XILINX_ZYNQMP_PM_FPGA_READ_CONFIG_REG);
- *value = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_fpga_get_config_status);
- /**
- * zynqmp_pm_pinctrl_request - Request Pin from firmware
- * @pin: Pin number to request
- *
- * This function requests pin from firmware.
- *
- * Return: Returns status, either success or error+reason.
- */
- int zynqmp_pm_pinctrl_request(const u32 pin)
- {
- return zynqmp_pm_invoke_fn(PM_PINCTRL_REQUEST, NULL, 1, pin);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_pinctrl_request);
- /**
- * zynqmp_pm_pinctrl_release - Inform firmware that Pin control is released
- * @pin: Pin number to release
- *
- * This function release pin from firmware.
- *
- * Return: Returns status, either success or error+reason.
- */
- int zynqmp_pm_pinctrl_release(const u32 pin)
- {
- return zynqmp_pm_invoke_fn(PM_PINCTRL_RELEASE, NULL, 1, pin);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_pinctrl_release);
- /**
- * zynqmp_pm_pinctrl_set_function - Set requested function for the pin
- * @pin: Pin number
- * @id: Function ID to set
- *
- * This function sets requested function for the given pin.
- *
- * Return: Returns status, either success or error+reason.
- */
- int zynqmp_pm_pinctrl_set_function(const u32 pin, const u32 id)
- {
- return zynqmp_pm_invoke_fn(PM_PINCTRL_SET_FUNCTION, NULL, 2, pin, id);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_pinctrl_set_function);
- /**
- * zynqmp_pm_pinctrl_get_config - Get configuration parameter for the pin
- * @pin: Pin number
- * @param: Parameter to get
- * @value: Buffer to store parameter value
- *
- * This function gets requested configuration parameter for the given pin.
- *
- * Return: Returns status, either success or error+reason.
- */
- int zynqmp_pm_pinctrl_get_config(const u32 pin, const u32 param,
- u32 *value)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!value)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_PINCTRL_CONFIG_PARAM_GET, ret_payload, 2, pin, param);
- *value = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_pinctrl_get_config);
- /**
- * zynqmp_pm_pinctrl_set_config - Set configuration parameter for the pin
- * @pin: Pin number
- * @param: Parameter to set
- * @value: Parameter value to set
- *
- * This function sets requested configuration parameter for the given pin.
- *
- * Return: Returns status, either success or error+reason.
- */
- int zynqmp_pm_pinctrl_set_config(const u32 pin, const u32 param,
- u32 value)
- {
- int ret;
- u32 pm_family_code;
- ret = zynqmp_pm_get_family_info(&pm_family_code);
- if (ret)
- return ret;
- if (pm_family_code == PM_ZYNQMP_FAMILY_CODE &&
- param == PM_PINCTRL_CONFIG_TRI_STATE) {
- ret = zynqmp_pm_feature(PM_PINCTRL_CONFIG_PARAM_SET);
- if (ret < PM_PINCTRL_PARAM_SET_VERSION) {
- pr_warn("The requested pinctrl feature is not supported in the current firmware.\n"
- "Expected firmware version is 2023.1 and above for this feature to work.\r\n");
- return -EOPNOTSUPP;
- }
- }
- return zynqmp_pm_invoke_fn(PM_PINCTRL_CONFIG_PARAM_SET, NULL, 3, pin, param, value);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_pinctrl_set_config);
- /**
- * zynqmp_pm_bootmode_read() - PM Config API for read bootpin status
- * @ps_mode: Returned output value of ps_mode
- *
- * This API function is to be used for notify the power management controller
- * to read bootpin status.
- *
- * Return: status, either success or error+reason
- */
- unsigned int zynqmp_pm_bootmode_read(u32 *ps_mode)
- {
- unsigned int ret;
- u32 ret_payload[PAYLOAD_ARG_CNT];
- ret = zynqmp_pm_invoke_fn(PM_MMIO_READ, ret_payload, 1, CRL_APB_BOOT_PIN_CTRL);
- *ps_mode = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_bootmode_read);
- /**
- * zynqmp_pm_bootmode_write() - PM Config API for Configure bootpin
- * @ps_mode: Value to be written to the bootpin ctrl register
- *
- * This API function is to be used for notify the power management controller
- * to configure bootpin.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_bootmode_write(u32 ps_mode)
- {
- return zynqmp_pm_invoke_fn(PM_MMIO_WRITE, NULL, 3, CRL_APB_BOOT_PIN_CTRL,
- CRL_APB_BOOTPIN_CTRL_MASK, ps_mode);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_bootmode_write);
- /**
- * zynqmp_pm_init_finalize() - PM call to inform firmware that the caller
- * master has initialized its own power management
- *
- * Return: Returns status, either success or error+reason
- *
- * This API function is to be used for notify the power management controller
- * about the completed power management initialization.
- */
- static int zynqmp_pm_init_finalize(void)
- {
- return zynqmp_pm_invoke_fn(PM_PM_INIT_FINALIZE, NULL, 0);
- }
- /**
- * zynqmp_pm_set_suspend_mode() - Set system suspend mode
- * @mode: Mode to set for system suspend
- *
- * This API function is used to set mode of system suspend.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_set_suspend_mode(u32 mode)
- {
- return zynqmp_pm_invoke_fn(PM_SET_SUSPEND_MODE, NULL, 1, mode);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_suspend_mode);
- /**
- * zynqmp_pm_request_node() - Request a node with specific capabilities
- * @node: Node ID of the slave
- * @capabilities: Requested capabilities of the slave
- * @qos: Quality of service (not supported)
- * @ack: Flag to specify whether acknowledge is requested
- *
- * This function is used by master to request particular node from firmware.
- * Every master must request node before using it.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_request_node(const u32 node, const u32 capabilities,
- const u32 qos, const enum zynqmp_pm_request_ack ack)
- {
- return zynqmp_pm_invoke_fn(PM_REQUEST_NODE, NULL, 4, node, capabilities, qos, ack);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_request_node);
- /**
- * zynqmp_pm_release_node() - Release a node
- * @node: Node ID of the slave
- *
- * This function is used by master to inform firmware that master
- * has released node. Once released, master must not use that node
- * without re-request.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_release_node(const u32 node)
- {
- return zynqmp_pm_invoke_fn(PM_RELEASE_NODE, NULL, 1, node);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_release_node);
- /**
- * zynqmp_pm_get_rpu_mode() - Get RPU mode
- * @node_id: Node ID of the device
- * @rpu_mode: return by reference value
- * either split or lockstep
- *
- * Return: return 0 on success or error+reason.
- * if success, then rpu_mode will be set
- * to current rpu mode.
- */
- int zynqmp_pm_get_rpu_mode(u32 node_id, enum rpu_oper_mode *rpu_mode)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- ret = zynqmp_pm_invoke_fn(PM_IOCTL, ret_payload, 2, node_id, IOCTL_GET_RPU_OPER_MODE);
- /* only set rpu_mode if no error */
- if (ret == XST_PM_SUCCESS)
- *rpu_mode = ret_payload[0];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_get_rpu_mode);
- /**
- * zynqmp_pm_set_rpu_mode() - Set RPU mode
- * @node_id: Node ID of the device
- * @rpu_mode: Argument 1 to requested IOCTL call. either split or lockstep
- *
- * This function is used to set RPU mode to split or
- * lockstep
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_set_rpu_mode(u32 node_id, enum rpu_oper_mode rpu_mode)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 3, node_id, IOCTL_SET_RPU_OPER_MODE,
- (u32)rpu_mode);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_rpu_mode);
- /**
- * zynqmp_pm_set_tcm_config - configure TCM
- * @node_id: Firmware specific TCM subsystem ID
- * @tcm_mode: Argument 1 to requested IOCTL call
- * either PM_RPU_TCM_COMB or PM_RPU_TCM_SPLIT
- *
- * This function is used to set RPU mode to split or combined
- *
- * Return: status: 0 for success, else failure
- */
- int zynqmp_pm_set_tcm_config(u32 node_id, enum rpu_tcm_comb tcm_mode)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 3, node_id, IOCTL_TCM_COMB_CONFIG,
- (u32)tcm_mode);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_tcm_config);
- /**
- * zynqmp_pm_get_node_status - PM call to request a node's current power state
- * @node: ID of the component or sub-system in question
- * @status: Current operating state of the requested node
- * @requirements: Current requirements asserted on the node,
- * used for slave nodes only.
- * @usage: Usage information, used for slave nodes only:
- * PM_USAGE_NO_MASTER - No master is currently using
- * the node
- * PM_USAGE_CURRENT_MASTER - Only requesting master is
- * currently using the node
- * PM_USAGE_OTHER_MASTER - Only other masters are
- * currently using the node
- * PM_USAGE_BOTH_MASTERS - Both the current and at least
- * one other master is currently
- * using the node
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_get_node_status(const u32 node, u32 *const status,
- u32 *const requirements, u32 *const usage)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!status || !requirements || !usage)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_GET_NODE_STATUS, ret_payload, 1, node);
- if (ret_payload[0] == XST_PM_SUCCESS) {
- *status = ret_payload[1];
- *requirements = ret_payload[2];
- *usage = ret_payload[3];
- }
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_get_node_status);
- /**
- * zynqmp_pm_force_pwrdwn - PM call to request for another PU or subsystem to
- * be powered down forcefully
- * @node: Node ID of the targeted PU or subsystem
- * @ack: Flag to specify whether acknowledge is requested
- *
- * Return: status, either success or error+reason
- */
- int zynqmp_pm_force_pwrdwn(const u32 node,
- const enum zynqmp_pm_request_ack ack)
- {
- return zynqmp_pm_invoke_fn(PM_FORCE_POWERDOWN, NULL, 2, node, ack);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_force_pwrdwn);
- /**
- * zynqmp_pm_request_wake - PM call to wake up selected master or subsystem
- * @node: Node ID of the master or subsystem
- * @set_addr: Specifies whether the address argument is relevant
- * @address: Address from which to resume when woken up
- * @ack: Flag to specify whether acknowledge requested
- *
- * Return: status, either success or error+reason
- */
- int zynqmp_pm_request_wake(const u32 node,
- const bool set_addr,
- const u64 address,
- const enum zynqmp_pm_request_ack ack)
- {
- /* set_addr flag is encoded into 1st bit of address */
- return zynqmp_pm_invoke_fn(PM_REQUEST_WAKEUP, NULL, 4, node, address | set_addr,
- address >> 32, ack);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_request_wake);
- /**
- * zynqmp_pm_set_requirement() - PM call to set requirement for PM slaves
- * @node: Node ID of the slave
- * @capabilities: Requested capabilities of the slave
- * @qos: Quality of service (not supported)
- * @ack: Flag to specify whether acknowledge is requested
- *
- * This API function is to be used for slaves a PU already has requested
- * to change its capabilities.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_set_requirement(const u32 node, const u32 capabilities,
- const u32 qos,
- const enum zynqmp_pm_request_ack ack)
- {
- return zynqmp_pm_invoke_fn(PM_SET_REQUIREMENT, NULL, 4, node, capabilities, qos, ack);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_requirement);
- /**
- * zynqmp_pm_load_pdi - Load and process PDI
- * @src: Source device where PDI is located
- * @address: PDI src address
- *
- * This function provides support to load PDI from linux
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_load_pdi(const u32 src, const u64 address)
- {
- return zynqmp_pm_invoke_fn(PM_LOAD_PDI, NULL, 3, src, lower_32_bits(address),
- upper_32_bits(address));
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_load_pdi);
- /**
- * zynqmp_pm_efuse_access - Provides access to efuse memory.
- * @address: Address of the efuse params structure
- * @out: Returned output value
- *
- * Return: Returns status, either success or error code.
- */
- int zynqmp_pm_efuse_access(const u64 address, u32 *out)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- int ret;
- if (!out)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_EFUSE_ACCESS, ret_payload, 2,
- upper_32_bits(address),
- lower_32_bits(address));
- *out = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_efuse_access);
- /**
- * zynqmp_pm_register_notifier() - PM API for register a subsystem
- * to be notified about specific
- * event/error.
- * @node: Node ID to which the event is related.
- * @event: Event Mask of Error events for which wants to get notified.
- * @wake: Wake subsystem upon capturing the event if value 1
- * @enable: Enable the registration for value 1, disable for value 0
- *
- * This function is used to register/un-register for particular node-event
- * combination in firmware.
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_register_notifier(const u32 node, const u32 event,
- const u32 wake, const u32 enable)
- {
- return zynqmp_pm_invoke_fn(PM_REGISTER_NOTIFIER, NULL, 4, node, event, wake, enable);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_register_notifier);
- /**
- * zynqmp_pm_system_shutdown - PM call to request a system shutdown or restart
- * @type: Shutdown or restart? 0 for shutdown, 1 for restart
- * @subtype: Specifies which system should be restarted or shut down
- *
- * Return: Returns status, either success or error+reason
- */
- int zynqmp_pm_system_shutdown(const u32 type, const u32 subtype)
- {
- return zynqmp_pm_invoke_fn(PM_SYSTEM_SHUTDOWN, NULL, 2, type, subtype);
- }
- /**
- * zynqmp_pm_set_feature_config - PM call to request IOCTL for feature config
- * @id: The config ID of the feature to be configured
- * @value: The config value of the feature to be configured
- *
- * Return: Returns 0 on success or error value on failure.
- */
- int zynqmp_pm_set_feature_config(enum pm_feature_config_id id, u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, 0, IOCTL_SET_FEATURE_CONFIG, id, value);
- }
- /**
- * zynqmp_pm_get_feature_config - PM call to get value of configured feature
- * @id: The config id of the feature to be queried
- * @payload: Returned value array
- *
- * Return: Returns 0 on success or error value on failure.
- */
- int zynqmp_pm_get_feature_config(enum pm_feature_config_id id,
- u32 *payload)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, payload, 3, 0, IOCTL_GET_FEATURE_CONFIG, id);
- }
- /**
- * zynqmp_pm_sec_read_reg - PM call to securely read from given offset
- * of the node
- * @node_id: Node Id of the device
- * @offset: Offset to be used (20-bit)
- * @ret_value: Output data read from the given offset after
- * firmware access policy is successfully enforced
- *
- * Return: Returns 0 on success or error value on failure
- */
- int zynqmp_pm_sec_read_reg(u32 node_id, u32 offset, u32 *ret_value)
- {
- u32 ret_payload[PAYLOAD_ARG_CNT];
- u32 count = 1;
- int ret;
- if (!ret_value)
- return -EINVAL;
- ret = zynqmp_pm_invoke_fn(PM_IOCTL, ret_payload, 4, node_id, IOCTL_READ_REG,
- offset, count);
- *ret_value = ret_payload[1];
- return ret;
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_sec_read_reg);
- /**
- * zynqmp_pm_sec_mask_write_reg - PM call to securely write to given offset
- * of the node
- * @node_id: Node Id of the device
- * @offset: Offset to be used (20-bit)
- * @mask: Mask to be used
- * @value: Value to be written
- *
- * Return: Returns 0 on success or error value on failure
- */
- int zynqmp_pm_sec_mask_write_reg(const u32 node_id, const u32 offset, u32 mask,
- u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 5, node_id, IOCTL_MASK_WRITE_REG,
- offset, mask, value);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_sec_mask_write_reg);
- /**
- * zynqmp_pm_set_sd_config - PM call to set value of SD config registers
- * @node: SD node ID
- * @config: The config type of SD registers
- * @value: Value to be set
- *
- * Return: Returns 0 on success or error value on failure.
- */
- int zynqmp_pm_set_sd_config(u32 node, enum pm_sd_config_type config, u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, node, IOCTL_SET_SD_CONFIG, config, value);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_sd_config);
- /**
- * zynqmp_pm_set_gem_config - PM call to set value of GEM config registers
- * @node: GEM node ID
- * @config: The config type of GEM registers
- * @value: Value to be set
- *
- * Return: Returns 0 on success or error value on failure.
- */
- int zynqmp_pm_set_gem_config(u32 node, enum pm_gem_config_type config,
- u32 value)
- {
- return zynqmp_pm_invoke_fn(PM_IOCTL, NULL, 4, node, IOCTL_SET_GEM_CONFIG, config, value);
- }
- EXPORT_SYMBOL_GPL(zynqmp_pm_set_gem_config);
- /**
- * struct zynqmp_pm_shutdown_scope - Struct for shutdown scope
- * @subtype: Shutdown subtype
- * @name: Matching string for scope argument
- *
- * This struct encapsulates mapping between shutdown scope ID and string.
- */
- struct zynqmp_pm_shutdown_scope {
- const enum zynqmp_pm_shutdown_subtype subtype;
- const char *name;
- };
- static struct zynqmp_pm_shutdown_scope shutdown_scopes[] = {
- [ZYNQMP_PM_SHUTDOWN_SUBTYPE_SUBSYSTEM] = {
- .subtype = ZYNQMP_PM_SHUTDOWN_SUBTYPE_SUBSYSTEM,
- .name = "subsystem",
- },
- [ZYNQMP_PM_SHUTDOWN_SUBTYPE_PS_ONLY] = {
- .subtype = ZYNQMP_PM_SHUTDOWN_SUBTYPE_PS_ONLY,
- .name = "ps_only",
- },
- [ZYNQMP_PM_SHUTDOWN_SUBTYPE_SYSTEM] = {
- .subtype = ZYNQMP_PM_SHUTDOWN_SUBTYPE_SYSTEM,
- .name = "system",
- },
- };
- static struct zynqmp_pm_shutdown_scope *selected_scope =
- &shutdown_scopes[ZYNQMP_PM_SHUTDOWN_SUBTYPE_SYSTEM];
- /**
- * zynqmp_pm_is_shutdown_scope_valid - Check if shutdown scope string is valid
- * @scope_string: Shutdown scope string
- *
- * Return: Return pointer to matching shutdown scope struct from
- * array of available options in system if string is valid,
- * otherwise returns NULL.
- */
- static struct zynqmp_pm_shutdown_scope*
- zynqmp_pm_is_shutdown_scope_valid(const char *scope_string)
- {
- int count;
- for (count = 0; count < ARRAY_SIZE(shutdown_scopes); count++)
- if (sysfs_streq(scope_string, shutdown_scopes[count].name))
- return &shutdown_scopes[count];
- return NULL;
- }
- static ssize_t shutdown_scope_show(struct device *device,
- struct device_attribute *attr,
- char *buf)
- {
- int i;
- for (i = 0; i < ARRAY_SIZE(shutdown_scopes); i++) {
- if (&shutdown_scopes[i] == selected_scope) {
- strcat(buf, "[");
- strcat(buf, shutdown_scopes[i].name);
- strcat(buf, "]");
- } else {
- strcat(buf, shutdown_scopes[i].name);
- }
- strcat(buf, " ");
- }
- strcat(buf, "\n");
- return strlen(buf);
- }
- static ssize_t shutdown_scope_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- struct zynqmp_pm_shutdown_scope *scope;
- scope = zynqmp_pm_is_shutdown_scope_valid(buf);
- if (!scope)
- return -EINVAL;
- ret = zynqmp_pm_system_shutdown(ZYNQMP_PM_SHUTDOWN_TYPE_SETSCOPE_ONLY,
- scope->subtype);
- if (ret) {
- pr_err("unable to set shutdown scope %s\n", buf);
- return ret;
- }
- selected_scope = scope;
- return count;
- }
- static DEVICE_ATTR_RW(shutdown_scope);
- static ssize_t health_status_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned int value;
- ret = kstrtouint(buf, 10, &value);
- if (ret)
- return ret;
- ret = zynqmp_pm_set_boot_health_status(value);
- if (ret) {
- dev_err(device, "unable to set healthy bit value to %u\n",
- value);
- return ret;
- }
- return count;
- }
- static DEVICE_ATTR_WO(health_status);
- static ssize_t ggs_show(struct device *device,
- struct device_attribute *attr,
- char *buf,
- u32 reg)
- {
- int ret;
- u32 ret_payload[PAYLOAD_ARG_CNT];
- ret = zynqmp_pm_read_ggs(reg, ret_payload);
- if (ret)
- return ret;
- return sprintf(buf, "0x%x\n", ret_payload[1]);
- }
- static ssize_t ggs_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count,
- u32 reg)
- {
- long value;
- int ret;
- if (reg >= GSS_NUM_REGS)
- return -EINVAL;
- ret = kstrtol(buf, 16, &value);
- if (ret) {
- count = -EFAULT;
- goto err;
- }
- ret = zynqmp_pm_write_ggs(reg, value);
- if (ret)
- count = -EFAULT;
- err:
- return count;
- }
- /* GGS register show functions */
- #define GGS0_SHOW(N) \
- ssize_t ggs##N##_show(struct device *device, \
- struct device_attribute *attr, \
- char *buf) \
- { \
- return ggs_show(device, attr, buf, N); \
- }
- static GGS0_SHOW(0);
- static GGS0_SHOW(1);
- static GGS0_SHOW(2);
- static GGS0_SHOW(3);
- /* GGS register store function */
- #define GGS0_STORE(N) \
- ssize_t ggs##N##_store(struct device *device, \
- struct device_attribute *attr, \
- const char *buf, \
- size_t count) \
- { \
- return ggs_store(device, attr, buf, count, N); \
- }
- static GGS0_STORE(0);
- static GGS0_STORE(1);
- static GGS0_STORE(2);
- static GGS0_STORE(3);
- static ssize_t pggs_show(struct device *device,
- struct device_attribute *attr,
- char *buf,
- u32 reg)
- {
- int ret;
- u32 ret_payload[PAYLOAD_ARG_CNT];
- ret = zynqmp_pm_read_pggs(reg, ret_payload);
- if (ret)
- return ret;
- return sprintf(buf, "0x%x\n", ret_payload[1]);
- }
- static ssize_t pggs_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count,
- u32 reg)
- {
- long value;
- int ret;
- if (reg >= GSS_NUM_REGS)
- return -EINVAL;
- ret = kstrtol(buf, 16, &value);
- if (ret) {
- count = -EFAULT;
- goto err;
- }
- ret = zynqmp_pm_write_pggs(reg, value);
- if (ret)
- count = -EFAULT;
- err:
- return count;
- }
- #define PGGS0_SHOW(N) \
- ssize_t pggs##N##_show(struct device *device, \
- struct device_attribute *attr, \
- char *buf) \
- { \
- return pggs_show(device, attr, buf, N); \
- }
- #define PGGS0_STORE(N) \
- ssize_t pggs##N##_store(struct device *device, \
- struct device_attribute *attr, \
- const char *buf, \
- size_t count) \
- { \
- return pggs_store(device, attr, buf, count, N); \
- }
- /* PGGS register show functions */
- static PGGS0_SHOW(0);
- static PGGS0_SHOW(1);
- static PGGS0_SHOW(2);
- static PGGS0_SHOW(3);
- /* PGGS register store functions */
- static PGGS0_STORE(0);
- static PGGS0_STORE(1);
- static PGGS0_STORE(2);
- static PGGS0_STORE(3);
- /* GGS register attributes */
- static DEVICE_ATTR_RW(ggs0);
- static DEVICE_ATTR_RW(ggs1);
- static DEVICE_ATTR_RW(ggs2);
- static DEVICE_ATTR_RW(ggs3);
- /* PGGS register attributes */
- static DEVICE_ATTR_RW(pggs0);
- static DEVICE_ATTR_RW(pggs1);
- static DEVICE_ATTR_RW(pggs2);
- static DEVICE_ATTR_RW(pggs3);
- static ssize_t feature_config_id_show(struct device *device,
- struct device_attribute *attr,
- char *buf)
- {
- struct zynqmp_devinfo *devinfo = dev_get_drvdata(device);
- return sysfs_emit(buf, "%d\n", devinfo->feature_conf_id);
- }
- static ssize_t feature_config_id_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- u32 config_id;
- int ret;
- struct zynqmp_devinfo *devinfo = dev_get_drvdata(device);
- if (!buf)
- return -EINVAL;
- ret = kstrtou32(buf, 10, &config_id);
- if (ret)
- return ret;
- devinfo->feature_conf_id = config_id;
- return count;
- }
- static DEVICE_ATTR_RW(feature_config_id);
- static ssize_t feature_config_value_show(struct device *device,
- struct device_attribute *attr,
- char *buf)
- {
- int ret;
- u32 ret_payload[PAYLOAD_ARG_CNT];
- struct zynqmp_devinfo *devinfo = dev_get_drvdata(device);
- ret = zynqmp_pm_get_feature_config(devinfo->feature_conf_id,
- ret_payload);
- if (ret)
- return ret;
- return sysfs_emit(buf, "%d\n", ret_payload[1]);
- }
- static ssize_t feature_config_value_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- u32 value;
- int ret;
- struct zynqmp_devinfo *devinfo = dev_get_drvdata(device);
- if (!buf)
- return -EINVAL;
- ret = kstrtou32(buf, 10, &value);
- if (ret)
- return ret;
- ret = zynqmp_pm_set_feature_config(devinfo->feature_conf_id,
- value);
- if (ret)
- return ret;
- return count;
- }
- static DEVICE_ATTR_RW(feature_config_value);
- static struct attribute *zynqmp_firmware_attrs[] = {
- &dev_attr_ggs0.attr,
- &dev_attr_ggs1.attr,
- &dev_attr_ggs2.attr,
- &dev_attr_ggs3.attr,
- &dev_attr_pggs0.attr,
- &dev_attr_pggs1.attr,
- &dev_attr_pggs2.attr,
- &dev_attr_pggs3.attr,
- &dev_attr_shutdown_scope.attr,
- &dev_attr_health_status.attr,
- &dev_attr_feature_config_id.attr,
- &dev_attr_feature_config_value.attr,
- NULL,
- };
- ATTRIBUTE_GROUPS(zynqmp_firmware);
- static int zynqmp_firmware_probe(struct platform_device *pdev)
- {
- struct device *dev = &pdev->dev;
- struct zynqmp_devinfo *devinfo;
- u32 pm_family_code;
- int ret;
- ret = get_set_conduit_method(dev->of_node);
- if (ret)
- return ret;
- /* Get platform-specific firmware data from device tree match */
- active_platform_fw_data = (struct platform_fw_data *)device_get_match_data(dev);
- if (!active_platform_fw_data)
- return -EINVAL;
- /* Get SiP SVC version number */
- ret = zynqmp_pm_get_sip_svc_version(&sip_svc_version);
- if (ret)
- return ret;
- ret = do_feature_check_call(PM_FEATURE_CHECK);
- if (ret >= 0 && ((ret & FIRMWARE_VERSION_MASK) >= PM_API_VERSION_1))
- feature_check_enabled = true;
- devinfo = devm_kzalloc(dev, sizeof(*devinfo), GFP_KERNEL);
- if (!devinfo)
- return -ENOMEM;
- devinfo->dev = dev;
- platform_set_drvdata(pdev, devinfo);
- /* Check PM API version number */
- ret = zynqmp_pm_get_api_version(&pm_api_version);
- if (ret)
- return ret;
- if (pm_api_version < ZYNQMP_PM_VERSION) {
- panic("%s Platform Management API version error. Expected: v%d.%d - Found: v%d.%d\n",
- __func__,
- ZYNQMP_PM_VERSION_MAJOR, ZYNQMP_PM_VERSION_MINOR,
- pm_api_version >> 16, pm_api_version & 0xFFFF);
- }
- pr_info("%s Platform Management API v%d.%d\n", __func__,
- pm_api_version >> 16, pm_api_version & 0xFFFF);
- /* Get the Family code of platform */
- ret = zynqmp_pm_get_family_info(&pm_family_code);
- if (ret < 0)
- return ret;
- /* Check trustzone version number */
- ret = zynqmp_pm_get_trustzone_version(&pm_tz_version);
- if (ret)
- panic("Legacy trustzone found without version support\n");
- if (pm_tz_version < ZYNQMP_TZ_VERSION)
- panic("%s Trustzone version error. Expected: v%d.%d - Found: v%d.%d\n",
- __func__,
- ZYNQMP_TZ_VERSION_MAJOR, ZYNQMP_TZ_VERSION_MINOR,
- pm_tz_version >> 16, pm_tz_version & 0xFFFF);
- pr_info("%s Trustzone version v%d.%d\n", __func__,
- pm_tz_version >> 16, pm_tz_version & 0xFFFF);
- ret = mfd_add_devices(&pdev->dev, PLATFORM_DEVID_NONE, firmware_devs,
- ARRAY_SIZE(firmware_devs), NULL, 0, NULL);
- if (ret) {
- dev_err(&pdev->dev, "failed to add MFD devices %d\n", ret);
- return ret;
- }
- zynqmp_pm_api_debugfs_init();
- if (pm_family_code != PM_ZYNQMP_FAMILY_CODE) {
- em_dev = platform_device_register_data(&pdev->dev, "xlnx_event_manager",
- -1, NULL, 0);
- if (IS_ERR(em_dev))
- dev_err_probe(&pdev->dev, PTR_ERR(em_dev), "EM register fail with error\n");
- }
- return of_platform_populate(dev->of_node, NULL, NULL, dev);
- }
- static void zynqmp_firmware_remove(struct platform_device *pdev)
- {
- struct pm_api_feature_data *feature_data;
- struct hlist_node *tmp;
- int i;
- mfd_remove_devices(&pdev->dev);
- zynqmp_pm_api_debugfs_exit();
- hash_for_each_safe(pm_api_features_map, i, tmp, feature_data, hentry) {
- hash_del(&feature_data->hentry);
- kfree(feature_data);
- }
- platform_device_unregister(em_dev);
- }
- static void zynqmp_firmware_sync_state(struct device *dev)
- {
- struct device_node *np = dev->of_node;
- if (!of_device_is_compatible(np, "xlnx,zynqmp-firmware"))
- return;
- of_genpd_sync_state(np);
- if (zynqmp_pm_init_finalize())
- dev_warn(dev, "failed to release power management to firmware\n");
- }
- static const struct platform_fw_data platform_fw_data_versal = {
- .family_code = PM_VERSAL_FAMILY_CODE,
- };
- static const struct platform_fw_data platform_fw_data_versal_net = {
- .family_code = PM_VERSAL_NET_FAMILY_CODE,
- };
- static const struct platform_fw_data platform_fw_data_zynqmp = {
- .family_code = PM_ZYNQMP_FAMILY_CODE,
- };
- static const struct of_device_id zynqmp_firmware_of_match[] = {
- {.compatible = "xlnx,zynqmp-firmware", .data = &platform_fw_data_zynqmp},
- {.compatible = "xlnx,versal-firmware", .data = &platform_fw_data_versal},
- {.compatible = "xlnx,versal-net-firmware", .data = &platform_fw_data_versal_net},
- {},
- };
- MODULE_DEVICE_TABLE(of, zynqmp_firmware_of_match);
- static struct platform_driver zynqmp_firmware_driver = {
- .driver = {
- .name = "zynqmp_firmware",
- .of_match_table = zynqmp_firmware_of_match,
- .dev_groups = zynqmp_firmware_groups,
- .sync_state = zynqmp_firmware_sync_state,
- },
- .probe = zynqmp_firmware_probe,
- .remove = zynqmp_firmware_remove,
- };
- module_platform_driver(zynqmp_firmware_driver);
|