1c7fdb240SAbhyuday Godhasara // SPDX-License-Identifier: GPL-2.0 2c7fdb240SAbhyuday Godhasara /* 3c7fdb240SAbhyuday Godhasara * Xilinx Event Management Driver 4c7fdb240SAbhyuday Godhasara * 5c7fdb240SAbhyuday Godhasara * Copyright (C) 2021 Xilinx, Inc. 6c7fdb240SAbhyuday Godhasara * 7c7fdb240SAbhyuday Godhasara * Abhyuday Godhasara <abhyuday.godhasara@xilinx.com> 8c7fdb240SAbhyuday Godhasara */ 9c7fdb240SAbhyuday Godhasara 10c7fdb240SAbhyuday Godhasara #include <linux/cpuhotplug.h> 11c7fdb240SAbhyuday Godhasara #include <linux/firmware/xlnx-event-manager.h> 12c7fdb240SAbhyuday Godhasara #include <linux/firmware/xlnx-zynqmp.h> 13c7fdb240SAbhyuday Godhasara #include <linux/hashtable.h> 14c7fdb240SAbhyuday Godhasara #include <linux/interrupt.h> 15c7fdb240SAbhyuday Godhasara #include <linux/irq.h> 16c7fdb240SAbhyuday Godhasara #include <linux/irqdomain.h> 17c7fdb240SAbhyuday Godhasara #include <linux/module.h> 18c7fdb240SAbhyuday Godhasara #include <linux/of_irq.h> 19c7fdb240SAbhyuday Godhasara #include <linux/platform_device.h> 20c7fdb240SAbhyuday Godhasara #include <linux/slab.h> 21c7fdb240SAbhyuday Godhasara 22c7fdb240SAbhyuday Godhasara static DEFINE_PER_CPU_READ_MOSTLY(int, cpu_number1); 23c7fdb240SAbhyuday Godhasara 24c7fdb240SAbhyuday Godhasara static int virq_sgi; 25c7fdb240SAbhyuday Godhasara static int event_manager_availability = -EACCES; 26c7fdb240SAbhyuday Godhasara 27c7fdb240SAbhyuday Godhasara /* SGI number used for Event management driver */ 28c7fdb240SAbhyuday Godhasara #define XLNX_EVENT_SGI_NUM (15) 29c7fdb240SAbhyuday Godhasara 30c7fdb240SAbhyuday Godhasara /* Max number of driver can register for same event */ 31c7fdb240SAbhyuday Godhasara #define MAX_DRIVER_PER_EVENT (10U) 32c7fdb240SAbhyuday Godhasara 33c7fdb240SAbhyuday Godhasara /* Max HashMap Order for PM API feature check (1<<7 = 128) */ 34c7fdb240SAbhyuday Godhasara #define REGISTERED_DRIVER_MAX_ORDER (7) 35c7fdb240SAbhyuday Godhasara 36c7fdb240SAbhyuday Godhasara #define MAX_BITS (32U) /* Number of bits available for error mask */ 37c7fdb240SAbhyuday Godhasara 38c7fdb240SAbhyuday Godhasara #define FIRMWARE_VERSION_MASK (0xFFFFU) 39c7fdb240SAbhyuday Godhasara #define REGISTER_NOTIFIER_FIRMWARE_VERSION (2U) 40c7fdb240SAbhyuday Godhasara 41c7fdb240SAbhyuday Godhasara static DEFINE_HASHTABLE(reg_driver_map, REGISTERED_DRIVER_MAX_ORDER); 42c7fdb240SAbhyuday Godhasara static int sgi_num = XLNX_EVENT_SGI_NUM; 43c7fdb240SAbhyuday Godhasara 44c7fdb240SAbhyuday Godhasara /** 45*05e5ba40SAbhyuday Godhasara * struct agent_cb - Registered callback function and private data. 46*05e5ba40SAbhyuday Godhasara * @agent_data: Data passed back to handler function. 47*05e5ba40SAbhyuday Godhasara * @eve_cb: Function pointer to store the callback function. 48*05e5ba40SAbhyuday Godhasara * @list: member to create list. 49*05e5ba40SAbhyuday Godhasara */ 50*05e5ba40SAbhyuday Godhasara struct agent_cb { 51*05e5ba40SAbhyuday Godhasara void *agent_data; 52*05e5ba40SAbhyuday Godhasara event_cb_func_t eve_cb; 53*05e5ba40SAbhyuday Godhasara struct list_head list; 54*05e5ba40SAbhyuday Godhasara }; 55*05e5ba40SAbhyuday Godhasara 56*05e5ba40SAbhyuday Godhasara /** 57c7fdb240SAbhyuday Godhasara * struct registered_event_data - Registered Event Data. 58c7fdb240SAbhyuday Godhasara * @key: key is the combine id(Node-Id | Event-Id) of type u64 59c7fdb240SAbhyuday Godhasara * where upper u32 for Node-Id and lower u32 for Event-Id, 60c7fdb240SAbhyuday Godhasara * And this used as key to index into hashmap. 61c7fdb240SAbhyuday Godhasara * @cb_type: Type of Api callback, like PM_NOTIFY_CB, etc. 62c7fdb240SAbhyuday Godhasara * @wake: If this flag set, firmware will wake up processor if is 63c7fdb240SAbhyuday Godhasara * in sleep or power down state. 64*05e5ba40SAbhyuday Godhasara * @cb_list_head: Head of call back data list which contain the information 65*05e5ba40SAbhyuday Godhasara * about registered handler and private data. 66c7fdb240SAbhyuday Godhasara * @hentry: hlist_node that hooks this entry into hashtable. 67c7fdb240SAbhyuday Godhasara */ 68c7fdb240SAbhyuday Godhasara struct registered_event_data { 69c7fdb240SAbhyuday Godhasara u64 key; 70c7fdb240SAbhyuday Godhasara enum pm_api_cb_id cb_type; 71c7fdb240SAbhyuday Godhasara bool wake; 72*05e5ba40SAbhyuday Godhasara struct list_head cb_list_head; 73c7fdb240SAbhyuday Godhasara struct hlist_node hentry; 74c7fdb240SAbhyuday Godhasara }; 75c7fdb240SAbhyuday Godhasara 76c7fdb240SAbhyuday Godhasara static bool xlnx_is_error_event(const u32 node_id) 77c7fdb240SAbhyuday Godhasara { 78c7fdb240SAbhyuday Godhasara if (node_id == EVENT_ERROR_PMC_ERR1 || 79c7fdb240SAbhyuday Godhasara node_id == EVENT_ERROR_PMC_ERR2 || 80c7fdb240SAbhyuday Godhasara node_id == EVENT_ERROR_PSM_ERR1 || 81c7fdb240SAbhyuday Godhasara node_id == EVENT_ERROR_PSM_ERR2) 82c7fdb240SAbhyuday Godhasara return true; 83c7fdb240SAbhyuday Godhasara 84c7fdb240SAbhyuday Godhasara return false; 85c7fdb240SAbhyuday Godhasara } 86c7fdb240SAbhyuday Godhasara 87c7fdb240SAbhyuday Godhasara static int xlnx_add_cb_for_notify_event(const u32 node_id, const u32 event, const bool wake, 88c7fdb240SAbhyuday Godhasara event_cb_func_t cb_fun, void *data) 89c7fdb240SAbhyuday Godhasara { 90c7fdb240SAbhyuday Godhasara u64 key = 0; 91*05e5ba40SAbhyuday Godhasara bool present_in_hash = false; 92c7fdb240SAbhyuday Godhasara struct registered_event_data *eve_data; 93*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_data; 94*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_pos; 95*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_next; 96c7fdb240SAbhyuday Godhasara 97c7fdb240SAbhyuday Godhasara key = ((u64)node_id << 32U) | (u64)event; 98c7fdb240SAbhyuday Godhasara /* Check for existing entry in hash table for given key id */ 99c7fdb240SAbhyuday Godhasara hash_for_each_possible(reg_driver_map, eve_data, hentry, key) { 100c7fdb240SAbhyuday Godhasara if (eve_data->key == key) { 101*05e5ba40SAbhyuday Godhasara present_in_hash = true; 102*05e5ba40SAbhyuday Godhasara break; 103c7fdb240SAbhyuday Godhasara } 104c7fdb240SAbhyuday Godhasara } 105c7fdb240SAbhyuday Godhasara 106*05e5ba40SAbhyuday Godhasara if (!present_in_hash) { 107*05e5ba40SAbhyuday Godhasara /* Add new entry if not present in HASH table */ 108c7fdb240SAbhyuday Godhasara eve_data = kmalloc(sizeof(*eve_data), GFP_KERNEL); 109c7fdb240SAbhyuday Godhasara if (!eve_data) 110c7fdb240SAbhyuday Godhasara return -ENOMEM; 111c7fdb240SAbhyuday Godhasara eve_data->key = key; 112c7fdb240SAbhyuday Godhasara eve_data->cb_type = PM_NOTIFY_CB; 113c7fdb240SAbhyuday Godhasara eve_data->wake = wake; 114*05e5ba40SAbhyuday Godhasara INIT_LIST_HEAD(&eve_data->cb_list_head); 115c7fdb240SAbhyuday Godhasara 116*05e5ba40SAbhyuday Godhasara cb_data = kmalloc(sizeof(*cb_data), GFP_KERNEL); 117*05e5ba40SAbhyuday Godhasara if (!cb_data) 118*05e5ba40SAbhyuday Godhasara return -ENOMEM; 119*05e5ba40SAbhyuday Godhasara cb_data->eve_cb = cb_fun; 120*05e5ba40SAbhyuday Godhasara cb_data->agent_data = data; 121*05e5ba40SAbhyuday Godhasara 122*05e5ba40SAbhyuday Godhasara /* Add into callback list */ 123*05e5ba40SAbhyuday Godhasara list_add(&cb_data->list, &eve_data->cb_list_head); 124*05e5ba40SAbhyuday Godhasara 125*05e5ba40SAbhyuday Godhasara /* Add into HASH table */ 126c7fdb240SAbhyuday Godhasara hash_add(reg_driver_map, &eve_data->hentry, key); 127*05e5ba40SAbhyuday Godhasara } else { 128*05e5ba40SAbhyuday Godhasara /* Search for callback function and private data in list */ 129*05e5ba40SAbhyuday Godhasara list_for_each_entry_safe(cb_pos, cb_next, &eve_data->cb_list_head, list) { 130*05e5ba40SAbhyuday Godhasara if (cb_pos->eve_cb == cb_fun && 131*05e5ba40SAbhyuday Godhasara cb_pos->agent_data == data) { 132*05e5ba40SAbhyuday Godhasara return 0; 133*05e5ba40SAbhyuday Godhasara } 134*05e5ba40SAbhyuday Godhasara } 135*05e5ba40SAbhyuday Godhasara 136*05e5ba40SAbhyuday Godhasara /* Add multiple handler and private data in list */ 137*05e5ba40SAbhyuday Godhasara cb_data = kmalloc(sizeof(*cb_data), GFP_KERNEL); 138*05e5ba40SAbhyuday Godhasara if (!cb_data) 139*05e5ba40SAbhyuday Godhasara return -ENOMEM; 140*05e5ba40SAbhyuday Godhasara cb_data->eve_cb = cb_fun; 141*05e5ba40SAbhyuday Godhasara cb_data->agent_data = data; 142*05e5ba40SAbhyuday Godhasara 143*05e5ba40SAbhyuday Godhasara list_add(&cb_data->list, &eve_data->cb_list_head); 144*05e5ba40SAbhyuday Godhasara } 145c7fdb240SAbhyuday Godhasara 146c7fdb240SAbhyuday Godhasara return 0; 147c7fdb240SAbhyuday Godhasara } 148c7fdb240SAbhyuday Godhasara 149c7fdb240SAbhyuday Godhasara static int xlnx_add_cb_for_suspend(event_cb_func_t cb_fun, void *data) 150c7fdb240SAbhyuday Godhasara { 151c7fdb240SAbhyuday Godhasara struct registered_event_data *eve_data; 152*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_data; 153c7fdb240SAbhyuday Godhasara 154c7fdb240SAbhyuday Godhasara /* Check for existing entry in hash table for given cb_type */ 155c7fdb240SAbhyuday Godhasara hash_for_each_possible(reg_driver_map, eve_data, hentry, PM_INIT_SUSPEND_CB) { 156c7fdb240SAbhyuday Godhasara if (eve_data->cb_type == PM_INIT_SUSPEND_CB) { 157c7fdb240SAbhyuday Godhasara pr_err("Found as already registered\n"); 158c7fdb240SAbhyuday Godhasara return -EINVAL; 159c7fdb240SAbhyuday Godhasara } 160c7fdb240SAbhyuday Godhasara } 161c7fdb240SAbhyuday Godhasara 162c7fdb240SAbhyuday Godhasara /* Add new entry if not present */ 163c7fdb240SAbhyuday Godhasara eve_data = kmalloc(sizeof(*eve_data), GFP_KERNEL); 164c7fdb240SAbhyuday Godhasara if (!eve_data) 165c7fdb240SAbhyuday Godhasara return -ENOMEM; 166c7fdb240SAbhyuday Godhasara 167c7fdb240SAbhyuday Godhasara eve_data->key = 0; 168c7fdb240SAbhyuday Godhasara eve_data->cb_type = PM_INIT_SUSPEND_CB; 169*05e5ba40SAbhyuday Godhasara INIT_LIST_HEAD(&eve_data->cb_list_head); 170*05e5ba40SAbhyuday Godhasara 171*05e5ba40SAbhyuday Godhasara cb_data = kmalloc(sizeof(*cb_data), GFP_KERNEL); 172*05e5ba40SAbhyuday Godhasara if (!cb_data) 173*05e5ba40SAbhyuday Godhasara return -ENOMEM; 174*05e5ba40SAbhyuday Godhasara cb_data->eve_cb = cb_fun; 175*05e5ba40SAbhyuday Godhasara cb_data->agent_data = data; 176*05e5ba40SAbhyuday Godhasara 177*05e5ba40SAbhyuday Godhasara /* Add into callback list */ 178*05e5ba40SAbhyuday Godhasara list_add(&cb_data->list, &eve_data->cb_list_head); 179c7fdb240SAbhyuday Godhasara 180c7fdb240SAbhyuday Godhasara hash_add(reg_driver_map, &eve_data->hentry, PM_INIT_SUSPEND_CB); 181c7fdb240SAbhyuday Godhasara 182c7fdb240SAbhyuday Godhasara return 0; 183c7fdb240SAbhyuday Godhasara } 184c7fdb240SAbhyuday Godhasara 185c7fdb240SAbhyuday Godhasara static int xlnx_remove_cb_for_suspend(event_cb_func_t cb_fun) 186c7fdb240SAbhyuday Godhasara { 187c7fdb240SAbhyuday Godhasara bool is_callback_found = false; 188c7fdb240SAbhyuday Godhasara struct registered_event_data *eve_data; 189*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_pos; 190*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_next; 191c7fdb240SAbhyuday Godhasara 192c7fdb240SAbhyuday Godhasara /* Check for existing entry in hash table for given cb_type */ 193c7fdb240SAbhyuday Godhasara hash_for_each_possible(reg_driver_map, eve_data, hentry, PM_INIT_SUSPEND_CB) { 194*05e5ba40SAbhyuday Godhasara if (eve_data->cb_type == PM_INIT_SUSPEND_CB) { 195*05e5ba40SAbhyuday Godhasara /* Delete the list of callback */ 196*05e5ba40SAbhyuday Godhasara list_for_each_entry_safe(cb_pos, cb_next, &eve_data->cb_list_head, list) { 197*05e5ba40SAbhyuday Godhasara if (cb_pos->eve_cb == cb_fun) { 198c7fdb240SAbhyuday Godhasara is_callback_found = true; 199*05e5ba40SAbhyuday Godhasara list_del_init(&cb_pos->list); 200*05e5ba40SAbhyuday Godhasara kfree(cb_pos); 201*05e5ba40SAbhyuday Godhasara } 202*05e5ba40SAbhyuday Godhasara } 203c7fdb240SAbhyuday Godhasara /* remove an object from a hashtable */ 204c7fdb240SAbhyuday Godhasara hash_del(&eve_data->hentry); 205c7fdb240SAbhyuday Godhasara kfree(eve_data); 206c7fdb240SAbhyuday Godhasara } 207c7fdb240SAbhyuday Godhasara } 208c7fdb240SAbhyuday Godhasara if (!is_callback_found) { 209c7fdb240SAbhyuday Godhasara pr_warn("Didn't find any registered callback for suspend event\n"); 210c7fdb240SAbhyuday Godhasara return -EINVAL; 211c7fdb240SAbhyuday Godhasara } 212c7fdb240SAbhyuday Godhasara 213c7fdb240SAbhyuday Godhasara return 0; 214c7fdb240SAbhyuday Godhasara } 215c7fdb240SAbhyuday Godhasara 216c7fdb240SAbhyuday Godhasara static int xlnx_remove_cb_for_notify_event(const u32 node_id, const u32 event, 217c7fdb240SAbhyuday Godhasara event_cb_func_t cb_fun) 218c7fdb240SAbhyuday Godhasara { 219c7fdb240SAbhyuday Godhasara bool is_callback_found = false; 220c7fdb240SAbhyuday Godhasara struct registered_event_data *eve_data; 221c7fdb240SAbhyuday Godhasara u64 key = ((u64)node_id << 32U) | (u64)event; 222*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_pos; 223*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_next; 224c7fdb240SAbhyuday Godhasara 225c7fdb240SAbhyuday Godhasara /* Check for existing entry in hash table for given key id */ 226c7fdb240SAbhyuday Godhasara hash_for_each_possible(reg_driver_map, eve_data, hentry, key) { 227*05e5ba40SAbhyuday Godhasara if (eve_data->key == key) { 228*05e5ba40SAbhyuday Godhasara /* Delete the list of callback */ 229*05e5ba40SAbhyuday Godhasara list_for_each_entry_safe(cb_pos, cb_next, &eve_data->cb_list_head, list) { 230*05e5ba40SAbhyuday Godhasara if (cb_pos->eve_cb == cb_fun) { 231c7fdb240SAbhyuday Godhasara is_callback_found = true; 232*05e5ba40SAbhyuday Godhasara list_del_init(&cb_pos->list); 233*05e5ba40SAbhyuday Godhasara kfree(cb_pos); 234*05e5ba40SAbhyuday Godhasara } 235*05e5ba40SAbhyuday Godhasara } 236*05e5ba40SAbhyuday Godhasara /* remove an object from a HASH table */ 237c7fdb240SAbhyuday Godhasara hash_del(&eve_data->hentry); 238c7fdb240SAbhyuday Godhasara kfree(eve_data); 239c7fdb240SAbhyuday Godhasara } 240c7fdb240SAbhyuday Godhasara } 241c7fdb240SAbhyuday Godhasara if (!is_callback_found) { 242c7fdb240SAbhyuday Godhasara pr_warn("Didn't find any registered callback for 0x%x 0x%x\n", 243c7fdb240SAbhyuday Godhasara node_id, event); 244c7fdb240SAbhyuday Godhasara return -EINVAL; 245c7fdb240SAbhyuday Godhasara } 246c7fdb240SAbhyuday Godhasara 247c7fdb240SAbhyuday Godhasara return 0; 248c7fdb240SAbhyuday Godhasara } 249c7fdb240SAbhyuday Godhasara 250c7fdb240SAbhyuday Godhasara /** 251c7fdb240SAbhyuday Godhasara * xlnx_register_event() - Register for the event. 252c7fdb240SAbhyuday Godhasara * @cb_type: Type of callback from pm_api_cb_id, 253c7fdb240SAbhyuday Godhasara * PM_NOTIFY_CB - for Error Events, 254c7fdb240SAbhyuday Godhasara * PM_INIT_SUSPEND_CB - for suspend callback. 255c7fdb240SAbhyuday Godhasara * @node_id: Node-Id related to event. 256c7fdb240SAbhyuday Godhasara * @event: Event Mask for the Error Event. 257c7fdb240SAbhyuday Godhasara * @wake: Flag specifying whether the subsystem should be woken upon 258c7fdb240SAbhyuday Godhasara * event notification. 259c7fdb240SAbhyuday Godhasara * @cb_fun: Function pointer to store the callback function. 260c7fdb240SAbhyuday Godhasara * @data: Pointer for the driver instance. 261c7fdb240SAbhyuday Godhasara * 262c7fdb240SAbhyuday Godhasara * Return: Returns 0 on successful registration else error code. 263c7fdb240SAbhyuday Godhasara */ 264c7fdb240SAbhyuday Godhasara int xlnx_register_event(const enum pm_api_cb_id cb_type, const u32 node_id, const u32 event, 265c7fdb240SAbhyuday Godhasara const bool wake, event_cb_func_t cb_fun, void *data) 266c7fdb240SAbhyuday Godhasara { 267c7fdb240SAbhyuday Godhasara int ret = 0; 268c7fdb240SAbhyuday Godhasara u32 eve; 269c7fdb240SAbhyuday Godhasara int pos; 270c7fdb240SAbhyuday Godhasara 271c7fdb240SAbhyuday Godhasara if (event_manager_availability) 272c7fdb240SAbhyuday Godhasara return event_manager_availability; 273c7fdb240SAbhyuday Godhasara 274c7fdb240SAbhyuday Godhasara if (cb_type != PM_NOTIFY_CB && cb_type != PM_INIT_SUSPEND_CB) { 275c7fdb240SAbhyuday Godhasara pr_err("%s() Unsupported Callback 0x%x\n", __func__, cb_type); 276c7fdb240SAbhyuday Godhasara return -EINVAL; 277c7fdb240SAbhyuday Godhasara } 278c7fdb240SAbhyuday Godhasara 279c7fdb240SAbhyuday Godhasara if (!cb_fun) 280c7fdb240SAbhyuday Godhasara return -EFAULT; 281c7fdb240SAbhyuday Godhasara 282c7fdb240SAbhyuday Godhasara if (cb_type == PM_INIT_SUSPEND_CB) { 283c7fdb240SAbhyuday Godhasara ret = xlnx_add_cb_for_suspend(cb_fun, data); 284c7fdb240SAbhyuday Godhasara } else { 285c7fdb240SAbhyuday Godhasara if (!xlnx_is_error_event(node_id)) { 286c7fdb240SAbhyuday Godhasara /* Add entry for Node-Id/Event in hash table */ 287c7fdb240SAbhyuday Godhasara ret = xlnx_add_cb_for_notify_event(node_id, event, wake, cb_fun, data); 288c7fdb240SAbhyuday Godhasara } else { 289c7fdb240SAbhyuday Godhasara /* Add into Hash table */ 290c7fdb240SAbhyuday Godhasara for (pos = 0; pos < MAX_BITS; pos++) { 291c7fdb240SAbhyuday Godhasara eve = event & (1 << pos); 292c7fdb240SAbhyuday Godhasara if (!eve) 293c7fdb240SAbhyuday Godhasara continue; 294c7fdb240SAbhyuday Godhasara 295c7fdb240SAbhyuday Godhasara /* Add entry for Node-Id/Eve in hash table */ 296c7fdb240SAbhyuday Godhasara ret = xlnx_add_cb_for_notify_event(node_id, eve, wake, cb_fun, 297c7fdb240SAbhyuday Godhasara data); 298c7fdb240SAbhyuday Godhasara /* Break the loop if got error */ 299c7fdb240SAbhyuday Godhasara if (ret) 300c7fdb240SAbhyuday Godhasara break; 301c7fdb240SAbhyuday Godhasara } 302c7fdb240SAbhyuday Godhasara if (ret) { 303c7fdb240SAbhyuday Godhasara /* Skip the Event for which got the error */ 304c7fdb240SAbhyuday Godhasara pos--; 305c7fdb240SAbhyuday Godhasara /* Remove registered(during this call) event from hash table */ 306c7fdb240SAbhyuday Godhasara for ( ; pos >= 0; pos--) { 307c7fdb240SAbhyuday Godhasara eve = event & (1 << pos); 308c7fdb240SAbhyuday Godhasara if (!eve) 309c7fdb240SAbhyuday Godhasara continue; 310c7fdb240SAbhyuday Godhasara xlnx_remove_cb_for_notify_event(node_id, eve, cb_fun); 311c7fdb240SAbhyuday Godhasara } 312c7fdb240SAbhyuday Godhasara } 313c7fdb240SAbhyuday Godhasara } 314c7fdb240SAbhyuday Godhasara 315c7fdb240SAbhyuday Godhasara if (ret) { 316c7fdb240SAbhyuday Godhasara pr_err("%s() failed for 0x%x and 0x%x: %d\r\n", __func__, node_id, 317c7fdb240SAbhyuday Godhasara event, ret); 318c7fdb240SAbhyuday Godhasara return ret; 319c7fdb240SAbhyuday Godhasara } 320c7fdb240SAbhyuday Godhasara 321c7fdb240SAbhyuday Godhasara /* Register for Node-Id/Event combination in firmware */ 322c7fdb240SAbhyuday Godhasara ret = zynqmp_pm_register_notifier(node_id, event, wake, true); 323c7fdb240SAbhyuday Godhasara if (ret) { 324c7fdb240SAbhyuday Godhasara pr_err("%s() failed for 0x%x and 0x%x: %d\r\n", __func__, node_id, 325c7fdb240SAbhyuday Godhasara event, ret); 326c7fdb240SAbhyuday Godhasara /* Remove already registered event from hash table */ 327c7fdb240SAbhyuday Godhasara if (xlnx_is_error_event(node_id)) { 328c7fdb240SAbhyuday Godhasara for (pos = 0; pos < MAX_BITS; pos++) { 329c7fdb240SAbhyuday Godhasara eve = event & (1 << pos); 330c7fdb240SAbhyuday Godhasara if (!eve) 331c7fdb240SAbhyuday Godhasara continue; 332c7fdb240SAbhyuday Godhasara xlnx_remove_cb_for_notify_event(node_id, eve, cb_fun); 333c7fdb240SAbhyuday Godhasara } 334c7fdb240SAbhyuday Godhasara } else { 335c7fdb240SAbhyuday Godhasara xlnx_remove_cb_for_notify_event(node_id, event, cb_fun); 336c7fdb240SAbhyuday Godhasara } 337c7fdb240SAbhyuday Godhasara return ret; 338c7fdb240SAbhyuday Godhasara } 339c7fdb240SAbhyuday Godhasara } 340c7fdb240SAbhyuday Godhasara 341c7fdb240SAbhyuday Godhasara return ret; 342c7fdb240SAbhyuday Godhasara } 343c7fdb240SAbhyuday Godhasara EXPORT_SYMBOL_GPL(xlnx_register_event); 344c7fdb240SAbhyuday Godhasara 345c7fdb240SAbhyuday Godhasara /** 346c7fdb240SAbhyuday Godhasara * xlnx_unregister_event() - Unregister for the event. 347c7fdb240SAbhyuday Godhasara * @cb_type: Type of callback from pm_api_cb_id, 348c7fdb240SAbhyuday Godhasara * PM_NOTIFY_CB - for Error Events, 349c7fdb240SAbhyuday Godhasara * PM_INIT_SUSPEND_CB - for suspend callback. 350c7fdb240SAbhyuday Godhasara * @node_id: Node-Id related to event. 351c7fdb240SAbhyuday Godhasara * @event: Event Mask for the Error Event. 352c7fdb240SAbhyuday Godhasara * @cb_fun: Function pointer of callback function. 353c7fdb240SAbhyuday Godhasara * 354c7fdb240SAbhyuday Godhasara * Return: Returns 0 on successful unregistration else error code. 355c7fdb240SAbhyuday Godhasara */ 356c7fdb240SAbhyuday Godhasara int xlnx_unregister_event(const enum pm_api_cb_id cb_type, const u32 node_id, const u32 event, 357c7fdb240SAbhyuday Godhasara event_cb_func_t cb_fun) 358c7fdb240SAbhyuday Godhasara { 359c7fdb240SAbhyuday Godhasara int ret; 360c7fdb240SAbhyuday Godhasara u32 eve, pos; 361c7fdb240SAbhyuday Godhasara 362c7fdb240SAbhyuday Godhasara if (event_manager_availability) 363c7fdb240SAbhyuday Godhasara return event_manager_availability; 364c7fdb240SAbhyuday Godhasara 365c7fdb240SAbhyuday Godhasara if (cb_type != PM_NOTIFY_CB && cb_type != PM_INIT_SUSPEND_CB) { 366c7fdb240SAbhyuday Godhasara pr_err("%s() Unsupported Callback 0x%x\n", __func__, cb_type); 367c7fdb240SAbhyuday Godhasara return -EINVAL; 368c7fdb240SAbhyuday Godhasara } 369c7fdb240SAbhyuday Godhasara 370c7fdb240SAbhyuday Godhasara if (!cb_fun) 371c7fdb240SAbhyuday Godhasara return -EFAULT; 372c7fdb240SAbhyuday Godhasara 373c7fdb240SAbhyuday Godhasara if (cb_type == PM_INIT_SUSPEND_CB) { 374c7fdb240SAbhyuday Godhasara ret = xlnx_remove_cb_for_suspend(cb_fun); 375c7fdb240SAbhyuday Godhasara } else { 376c7fdb240SAbhyuday Godhasara /* Remove Node-Id/Event from hash table */ 377c7fdb240SAbhyuday Godhasara if (!xlnx_is_error_event(node_id)) { 378c7fdb240SAbhyuday Godhasara xlnx_remove_cb_for_notify_event(node_id, event, cb_fun); 379c7fdb240SAbhyuday Godhasara } else { 380c7fdb240SAbhyuday Godhasara for (pos = 0; pos < MAX_BITS; pos++) { 381c7fdb240SAbhyuday Godhasara eve = event & (1 << pos); 382c7fdb240SAbhyuday Godhasara if (!eve) 383c7fdb240SAbhyuday Godhasara continue; 384c7fdb240SAbhyuday Godhasara 385c7fdb240SAbhyuday Godhasara xlnx_remove_cb_for_notify_event(node_id, eve, cb_fun); 386c7fdb240SAbhyuday Godhasara } 387c7fdb240SAbhyuday Godhasara } 388c7fdb240SAbhyuday Godhasara 389c7fdb240SAbhyuday Godhasara /* Un-register for Node-Id/Event combination */ 390c7fdb240SAbhyuday Godhasara ret = zynqmp_pm_register_notifier(node_id, event, false, false); 391c7fdb240SAbhyuday Godhasara if (ret) { 392c7fdb240SAbhyuday Godhasara pr_err("%s() failed for 0x%x and 0x%x: %d\n", 393c7fdb240SAbhyuday Godhasara __func__, node_id, event, ret); 394c7fdb240SAbhyuday Godhasara return ret; 395c7fdb240SAbhyuday Godhasara } 396c7fdb240SAbhyuday Godhasara } 397c7fdb240SAbhyuday Godhasara 398c7fdb240SAbhyuday Godhasara return ret; 399c7fdb240SAbhyuday Godhasara } 400c7fdb240SAbhyuday Godhasara EXPORT_SYMBOL_GPL(xlnx_unregister_event); 401c7fdb240SAbhyuday Godhasara 402c7fdb240SAbhyuday Godhasara static void xlnx_call_suspend_cb_handler(const u32 *payload) 403c7fdb240SAbhyuday Godhasara { 404c7fdb240SAbhyuday Godhasara bool is_callback_found = false; 405c7fdb240SAbhyuday Godhasara struct registered_event_data *eve_data; 406c7fdb240SAbhyuday Godhasara u32 cb_type = payload[0]; 407*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_pos; 408*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_next; 409c7fdb240SAbhyuday Godhasara 410c7fdb240SAbhyuday Godhasara /* Check for existing entry in hash table for given cb_type */ 411c7fdb240SAbhyuday Godhasara hash_for_each_possible(reg_driver_map, eve_data, hentry, cb_type) { 412c7fdb240SAbhyuday Godhasara if (eve_data->cb_type == cb_type) { 413*05e5ba40SAbhyuday Godhasara list_for_each_entry_safe(cb_pos, cb_next, &eve_data->cb_list_head, list) { 414*05e5ba40SAbhyuday Godhasara cb_pos->eve_cb(&payload[0], cb_pos->agent_data); 415c7fdb240SAbhyuday Godhasara is_callback_found = true; 416c7fdb240SAbhyuday Godhasara } 417c7fdb240SAbhyuday Godhasara } 418*05e5ba40SAbhyuday Godhasara } 419c7fdb240SAbhyuday Godhasara if (!is_callback_found) 420c7fdb240SAbhyuday Godhasara pr_warn("Didn't find any registered callback for suspend event\n"); 421c7fdb240SAbhyuday Godhasara } 422c7fdb240SAbhyuday Godhasara 423c7fdb240SAbhyuday Godhasara static void xlnx_call_notify_cb_handler(const u32 *payload) 424c7fdb240SAbhyuday Godhasara { 425c7fdb240SAbhyuday Godhasara bool is_callback_found = false; 426c7fdb240SAbhyuday Godhasara struct registered_event_data *eve_data; 427c7fdb240SAbhyuday Godhasara u64 key = ((u64)payload[1] << 32U) | (u64)payload[2]; 428c7fdb240SAbhyuday Godhasara int ret; 429*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_pos; 430*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_next; 431c7fdb240SAbhyuday Godhasara 432c7fdb240SAbhyuday Godhasara /* Check for existing entry in hash table for given key id */ 433c7fdb240SAbhyuday Godhasara hash_for_each_possible(reg_driver_map, eve_data, hentry, key) { 434c7fdb240SAbhyuday Godhasara if (eve_data->key == key) { 435*05e5ba40SAbhyuday Godhasara list_for_each_entry_safe(cb_pos, cb_next, &eve_data->cb_list_head, list) { 436*05e5ba40SAbhyuday Godhasara cb_pos->eve_cb(&payload[0], cb_pos->agent_data); 437c7fdb240SAbhyuday Godhasara is_callback_found = true; 438*05e5ba40SAbhyuday Godhasara } 439c7fdb240SAbhyuday Godhasara 440c7fdb240SAbhyuday Godhasara /* re register with firmware to get future events */ 441c7fdb240SAbhyuday Godhasara ret = zynqmp_pm_register_notifier(payload[1], payload[2], 442c7fdb240SAbhyuday Godhasara eve_data->wake, true); 443c7fdb240SAbhyuday Godhasara if (ret) { 444c7fdb240SAbhyuday Godhasara pr_err("%s() failed for 0x%x and 0x%x: %d\r\n", __func__, 445c7fdb240SAbhyuday Godhasara payload[1], payload[2], ret); 446*05e5ba40SAbhyuday Godhasara list_for_each_entry_safe(cb_pos, cb_next, &eve_data->cb_list_head, 447*05e5ba40SAbhyuday Godhasara list) { 448c7fdb240SAbhyuday Godhasara /* Remove already registered event from hash table */ 449c7fdb240SAbhyuday Godhasara xlnx_remove_cb_for_notify_event(payload[1], payload[2], 450*05e5ba40SAbhyuday Godhasara cb_pos->eve_cb); 451*05e5ba40SAbhyuday Godhasara } 452c7fdb240SAbhyuday Godhasara } 453c7fdb240SAbhyuday Godhasara } 454c7fdb240SAbhyuday Godhasara } 455c7fdb240SAbhyuday Godhasara if (!is_callback_found) 456c7fdb240SAbhyuday Godhasara pr_warn("Didn't find any registered callback for 0x%x 0x%x\n", 457c7fdb240SAbhyuday Godhasara payload[1], payload[2]); 458c7fdb240SAbhyuday Godhasara } 459c7fdb240SAbhyuday Godhasara 460c7fdb240SAbhyuday Godhasara static void xlnx_get_event_callback_data(u32 *buf) 461c7fdb240SAbhyuday Godhasara { 462c7fdb240SAbhyuday Godhasara zynqmp_pm_invoke_fn(GET_CALLBACK_DATA, 0, 0, 0, 0, buf); 463c7fdb240SAbhyuday Godhasara } 464c7fdb240SAbhyuday Godhasara 465c7fdb240SAbhyuday Godhasara static irqreturn_t xlnx_event_handler(int irq, void *dev_id) 466c7fdb240SAbhyuday Godhasara { 467c7fdb240SAbhyuday Godhasara u32 cb_type, node_id, event, pos; 468c7fdb240SAbhyuday Godhasara u32 payload[CB_MAX_PAYLOAD_SIZE] = {0}; 469c7fdb240SAbhyuday Godhasara u32 event_data[CB_MAX_PAYLOAD_SIZE] = {0}; 470c7fdb240SAbhyuday Godhasara 471c7fdb240SAbhyuday Godhasara /* Get event data */ 472c7fdb240SAbhyuday Godhasara xlnx_get_event_callback_data(payload); 473c7fdb240SAbhyuday Godhasara 474c7fdb240SAbhyuday Godhasara /* First element is callback type, others are callback arguments */ 475c7fdb240SAbhyuday Godhasara cb_type = payload[0]; 476c7fdb240SAbhyuday Godhasara 477c7fdb240SAbhyuday Godhasara if (cb_type == PM_NOTIFY_CB) { 478c7fdb240SAbhyuday Godhasara node_id = payload[1]; 479c7fdb240SAbhyuday Godhasara event = payload[2]; 480c7fdb240SAbhyuday Godhasara if (!xlnx_is_error_event(node_id)) { 481c7fdb240SAbhyuday Godhasara xlnx_call_notify_cb_handler(payload); 482c7fdb240SAbhyuday Godhasara } else { 483c7fdb240SAbhyuday Godhasara /* 484c7fdb240SAbhyuday Godhasara * Each call back function expecting payload as an input arguments. 485c7fdb240SAbhyuday Godhasara * We can get multiple error events as in one call back through error 486c7fdb240SAbhyuday Godhasara * mask. So payload[2] may can contain multiple error events. 487c7fdb240SAbhyuday Godhasara * In reg_driver_map database we store data in the combination of single 488c7fdb240SAbhyuday Godhasara * node_id-error combination. 489c7fdb240SAbhyuday Godhasara * So coping the payload message into event_data and update the 490c7fdb240SAbhyuday Godhasara * event_data[2] with Error Mask for single error event and use 491c7fdb240SAbhyuday Godhasara * event_data as input argument for registered call back function. 492c7fdb240SAbhyuday Godhasara * 493c7fdb240SAbhyuday Godhasara */ 494c7fdb240SAbhyuday Godhasara memcpy(event_data, payload, (4 * CB_MAX_PAYLOAD_SIZE)); 495c7fdb240SAbhyuday Godhasara /* Support Multiple Error Event */ 496c7fdb240SAbhyuday Godhasara for (pos = 0; pos < MAX_BITS; pos++) { 497c7fdb240SAbhyuday Godhasara if ((0 == (event & (1 << pos)))) 498c7fdb240SAbhyuday Godhasara continue; 499c7fdb240SAbhyuday Godhasara event_data[2] = (event & (1 << pos)); 500c7fdb240SAbhyuday Godhasara xlnx_call_notify_cb_handler(event_data); 501c7fdb240SAbhyuday Godhasara } 502c7fdb240SAbhyuday Godhasara } 503c7fdb240SAbhyuday Godhasara } else if (cb_type == PM_INIT_SUSPEND_CB) { 504c7fdb240SAbhyuday Godhasara xlnx_call_suspend_cb_handler(payload); 505c7fdb240SAbhyuday Godhasara } else { 506c7fdb240SAbhyuday Godhasara pr_err("%s() Unsupported Callback %d\n", __func__, cb_type); 507c7fdb240SAbhyuday Godhasara } 508c7fdb240SAbhyuday Godhasara 509c7fdb240SAbhyuday Godhasara return IRQ_HANDLED; 510c7fdb240SAbhyuday Godhasara } 511c7fdb240SAbhyuday Godhasara 512c7fdb240SAbhyuday Godhasara static int xlnx_event_cpuhp_start(unsigned int cpu) 513c7fdb240SAbhyuday Godhasara { 514c7fdb240SAbhyuday Godhasara enable_percpu_irq(virq_sgi, IRQ_TYPE_NONE); 515c7fdb240SAbhyuday Godhasara 516c7fdb240SAbhyuday Godhasara return 0; 517c7fdb240SAbhyuday Godhasara } 518c7fdb240SAbhyuday Godhasara 519c7fdb240SAbhyuday Godhasara static int xlnx_event_cpuhp_down(unsigned int cpu) 520c7fdb240SAbhyuday Godhasara { 521c7fdb240SAbhyuday Godhasara disable_percpu_irq(virq_sgi); 522c7fdb240SAbhyuday Godhasara 523c7fdb240SAbhyuday Godhasara return 0; 524c7fdb240SAbhyuday Godhasara } 525c7fdb240SAbhyuday Godhasara 526c7fdb240SAbhyuday Godhasara static void xlnx_disable_percpu_irq(void *data) 527c7fdb240SAbhyuday Godhasara { 528c7fdb240SAbhyuday Godhasara disable_percpu_irq(virq_sgi); 529c7fdb240SAbhyuday Godhasara } 530c7fdb240SAbhyuday Godhasara 531c7fdb240SAbhyuday Godhasara static int xlnx_event_init_sgi(struct platform_device *pdev) 532c7fdb240SAbhyuday Godhasara { 533c7fdb240SAbhyuday Godhasara int ret = 0; 534c7fdb240SAbhyuday Godhasara int cpu = smp_processor_id(); 535c7fdb240SAbhyuday Godhasara /* 536c7fdb240SAbhyuday Godhasara * IRQ related structures are used for the following: 537c7fdb240SAbhyuday Godhasara * for each SGI interrupt ensure its mapped by GIC IRQ domain 538c7fdb240SAbhyuday Godhasara * and that each corresponding linux IRQ for the HW IRQ has 539c7fdb240SAbhyuday Godhasara * a handler for when receiving an interrupt from the remote 540c7fdb240SAbhyuday Godhasara * processor. 541c7fdb240SAbhyuday Godhasara */ 542c7fdb240SAbhyuday Godhasara struct irq_domain *domain; 543c7fdb240SAbhyuday Godhasara struct irq_fwspec sgi_fwspec; 544c7fdb240SAbhyuday Godhasara struct device_node *interrupt_parent = NULL; 545c7fdb240SAbhyuday Godhasara struct device *parent = pdev->dev.parent; 546c7fdb240SAbhyuday Godhasara 547c7fdb240SAbhyuday Godhasara /* Find GIC controller to map SGIs. */ 548c7fdb240SAbhyuday Godhasara interrupt_parent = of_irq_find_parent(parent->of_node); 549c7fdb240SAbhyuday Godhasara if (!interrupt_parent) { 550c7fdb240SAbhyuday Godhasara dev_err(&pdev->dev, "Failed to find property for Interrupt parent\n"); 551c7fdb240SAbhyuday Godhasara return -EINVAL; 552c7fdb240SAbhyuday Godhasara } 553c7fdb240SAbhyuday Godhasara 554c7fdb240SAbhyuday Godhasara /* Each SGI needs to be associated with GIC's IRQ domain. */ 555c7fdb240SAbhyuday Godhasara domain = irq_find_host(interrupt_parent); 556c7fdb240SAbhyuday Godhasara of_node_put(interrupt_parent); 557c7fdb240SAbhyuday Godhasara 558c7fdb240SAbhyuday Godhasara /* Each mapping needs GIC domain when finding IRQ mapping. */ 559c7fdb240SAbhyuday Godhasara sgi_fwspec.fwnode = domain->fwnode; 560c7fdb240SAbhyuday Godhasara 561c7fdb240SAbhyuday Godhasara /* 562c7fdb240SAbhyuday Godhasara * When irq domain looks at mapping each arg is as follows: 563c7fdb240SAbhyuday Godhasara * 3 args for: interrupt type (SGI), interrupt # (set later), type 564c7fdb240SAbhyuday Godhasara */ 565c7fdb240SAbhyuday Godhasara sgi_fwspec.param_count = 1; 566c7fdb240SAbhyuday Godhasara 567c7fdb240SAbhyuday Godhasara /* Set SGI's hwirq */ 568c7fdb240SAbhyuday Godhasara sgi_fwspec.param[0] = sgi_num; 569c7fdb240SAbhyuday Godhasara virq_sgi = irq_create_fwspec_mapping(&sgi_fwspec); 570c7fdb240SAbhyuday Godhasara 571c7fdb240SAbhyuday Godhasara per_cpu(cpu_number1, cpu) = cpu; 572c7fdb240SAbhyuday Godhasara ret = request_percpu_irq(virq_sgi, xlnx_event_handler, "xlnx_event_mgmt", 573c7fdb240SAbhyuday Godhasara &cpu_number1); 574c7fdb240SAbhyuday Godhasara WARN_ON(ret); 575c7fdb240SAbhyuday Godhasara if (ret) { 576c7fdb240SAbhyuday Godhasara irq_dispose_mapping(virq_sgi); 577c7fdb240SAbhyuday Godhasara return ret; 578c7fdb240SAbhyuday Godhasara } 579c7fdb240SAbhyuday Godhasara 580c7fdb240SAbhyuday Godhasara irq_to_desc(virq_sgi); 581c7fdb240SAbhyuday Godhasara irq_set_status_flags(virq_sgi, IRQ_PER_CPU); 582c7fdb240SAbhyuday Godhasara 583c7fdb240SAbhyuday Godhasara return ret; 584c7fdb240SAbhyuday Godhasara } 585c7fdb240SAbhyuday Godhasara 586c7fdb240SAbhyuday Godhasara static void xlnx_event_cleanup_sgi(struct platform_device *pdev) 587c7fdb240SAbhyuday Godhasara { 588c7fdb240SAbhyuday Godhasara int cpu = smp_processor_id(); 589c7fdb240SAbhyuday Godhasara 590c7fdb240SAbhyuday Godhasara per_cpu(cpu_number1, cpu) = cpu; 591c7fdb240SAbhyuday Godhasara 592c7fdb240SAbhyuday Godhasara cpuhp_remove_state(CPUHP_AP_ONLINE_DYN); 593c7fdb240SAbhyuday Godhasara 594c7fdb240SAbhyuday Godhasara on_each_cpu(xlnx_disable_percpu_irq, NULL, 1); 595c7fdb240SAbhyuday Godhasara 596c7fdb240SAbhyuday Godhasara irq_clear_status_flags(virq_sgi, IRQ_PER_CPU); 597c7fdb240SAbhyuday Godhasara free_percpu_irq(virq_sgi, &cpu_number1); 598c7fdb240SAbhyuday Godhasara irq_dispose_mapping(virq_sgi); 599c7fdb240SAbhyuday Godhasara } 600c7fdb240SAbhyuday Godhasara 601c7fdb240SAbhyuday Godhasara static int xlnx_event_manager_probe(struct platform_device *pdev) 602c7fdb240SAbhyuday Godhasara { 603c7fdb240SAbhyuday Godhasara int ret; 604c7fdb240SAbhyuday Godhasara 605c7fdb240SAbhyuday Godhasara ret = zynqmp_pm_feature(PM_REGISTER_NOTIFIER); 606c7fdb240SAbhyuday Godhasara if (ret < 0) { 607c7fdb240SAbhyuday Godhasara dev_err(&pdev->dev, "Feature check failed with %d\n", ret); 608c7fdb240SAbhyuday Godhasara return ret; 609c7fdb240SAbhyuday Godhasara } 610c7fdb240SAbhyuday Godhasara 611c7fdb240SAbhyuday Godhasara if ((ret & FIRMWARE_VERSION_MASK) < 612c7fdb240SAbhyuday Godhasara REGISTER_NOTIFIER_FIRMWARE_VERSION) { 613c7fdb240SAbhyuday Godhasara dev_err(&pdev->dev, "Register notifier version error. Expected Firmware: v%d - Found: v%d\n", 614c7fdb240SAbhyuday Godhasara REGISTER_NOTIFIER_FIRMWARE_VERSION, 615c7fdb240SAbhyuday Godhasara ret & FIRMWARE_VERSION_MASK); 616c7fdb240SAbhyuday Godhasara return -EOPNOTSUPP; 617c7fdb240SAbhyuday Godhasara } 618c7fdb240SAbhyuday Godhasara 619c7fdb240SAbhyuday Godhasara /* Initialize the SGI */ 620c7fdb240SAbhyuday Godhasara ret = xlnx_event_init_sgi(pdev); 621c7fdb240SAbhyuday Godhasara if (ret) { 622c7fdb240SAbhyuday Godhasara dev_err(&pdev->dev, "SGI Init has been failed with %d\n", ret); 623c7fdb240SAbhyuday Godhasara return ret; 624c7fdb240SAbhyuday Godhasara } 625c7fdb240SAbhyuday Godhasara 626c7fdb240SAbhyuday Godhasara /* Setup function for the CPU hot-plug cases */ 627c7fdb240SAbhyuday Godhasara cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "soc/event:starting", 628c7fdb240SAbhyuday Godhasara xlnx_event_cpuhp_start, xlnx_event_cpuhp_down); 629c7fdb240SAbhyuday Godhasara 630c7fdb240SAbhyuday Godhasara ret = zynqmp_pm_invoke_fn(PM_IOCTL, 0, IOCTL_REGISTER_SGI, sgi_num, 631c7fdb240SAbhyuday Godhasara 0, NULL); 632c7fdb240SAbhyuday Godhasara if (ret) { 633c7fdb240SAbhyuday Godhasara dev_err(&pdev->dev, "SGI %d Registration over TF-A failed with %d\n", sgi_num, ret); 634c7fdb240SAbhyuday Godhasara xlnx_event_cleanup_sgi(pdev); 635c7fdb240SAbhyuday Godhasara return ret; 636c7fdb240SAbhyuday Godhasara } 637c7fdb240SAbhyuday Godhasara 638c7fdb240SAbhyuday Godhasara event_manager_availability = 0; 639c7fdb240SAbhyuday Godhasara 640c7fdb240SAbhyuday Godhasara dev_info(&pdev->dev, "SGI %d Registered over TF-A\n", sgi_num); 641c7fdb240SAbhyuday Godhasara dev_info(&pdev->dev, "Xilinx Event Management driver probed\n"); 642c7fdb240SAbhyuday Godhasara 643c7fdb240SAbhyuday Godhasara return ret; 644c7fdb240SAbhyuday Godhasara } 645c7fdb240SAbhyuday Godhasara 646c7fdb240SAbhyuday Godhasara static int xlnx_event_manager_remove(struct platform_device *pdev) 647c7fdb240SAbhyuday Godhasara { 648c7fdb240SAbhyuday Godhasara int i; 649c7fdb240SAbhyuday Godhasara struct registered_event_data *eve_data; 650c7fdb240SAbhyuday Godhasara struct hlist_node *tmp; 651c7fdb240SAbhyuday Godhasara int ret; 652*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_pos; 653*05e5ba40SAbhyuday Godhasara struct agent_cb *cb_next; 654c7fdb240SAbhyuday Godhasara 655c7fdb240SAbhyuday Godhasara hash_for_each_safe(reg_driver_map, i, tmp, eve_data, hentry) { 656*05e5ba40SAbhyuday Godhasara list_for_each_entry_safe(cb_pos, cb_next, &eve_data->cb_list_head, list) { 657*05e5ba40SAbhyuday Godhasara list_del_init(&cb_pos->list); 658*05e5ba40SAbhyuday Godhasara kfree(cb_pos); 659*05e5ba40SAbhyuday Godhasara } 660c7fdb240SAbhyuday Godhasara hash_del(&eve_data->hentry); 661c7fdb240SAbhyuday Godhasara kfree(eve_data); 662c7fdb240SAbhyuday Godhasara } 663c7fdb240SAbhyuday Godhasara 664c7fdb240SAbhyuday Godhasara ret = zynqmp_pm_invoke_fn(PM_IOCTL, 0, IOCTL_REGISTER_SGI, 0, 1, NULL); 665c7fdb240SAbhyuday Godhasara if (ret) 666c7fdb240SAbhyuday Godhasara dev_err(&pdev->dev, "SGI unregistration over TF-A failed with %d\n", ret); 667c7fdb240SAbhyuday Godhasara 668c7fdb240SAbhyuday Godhasara xlnx_event_cleanup_sgi(pdev); 669c7fdb240SAbhyuday Godhasara 670c7fdb240SAbhyuday Godhasara event_manager_availability = -EACCES; 671c7fdb240SAbhyuday Godhasara 672c7fdb240SAbhyuday Godhasara return ret; 673c7fdb240SAbhyuday Godhasara } 674c7fdb240SAbhyuday Godhasara 675c7fdb240SAbhyuday Godhasara static struct platform_driver xlnx_event_manager_driver = { 676c7fdb240SAbhyuday Godhasara .probe = xlnx_event_manager_probe, 677c7fdb240SAbhyuday Godhasara .remove = xlnx_event_manager_remove, 678c7fdb240SAbhyuday Godhasara .driver = { 679c7fdb240SAbhyuday Godhasara .name = "xlnx_event_manager", 680c7fdb240SAbhyuday Godhasara }, 681c7fdb240SAbhyuday Godhasara }; 682c7fdb240SAbhyuday Godhasara module_param(sgi_num, uint, 0); 683c7fdb240SAbhyuday Godhasara module_platform_driver(xlnx_event_manager_driver); 684