11e0a6014SLokesh Vutla // SPDX-License-Identifier: GPL-2.0 2aa276781SNishanth Menon /* 3aa276781SNishanth Menon * Texas Instruments System Control Interface Protocol Driver 4aa276781SNishanth Menon * 5b9e8a7d9SDave Gerlach * Copyright (C) 2015-2022 Texas Instruments Incorporated - https://www.ti.com/ 6aa276781SNishanth Menon * Nishanth Menon 7aa276781SNishanth Menon */ 8aa276781SNishanth Menon 9aa276781SNishanth Menon #define pr_fmt(fmt) "%s: " fmt, __func__ 10aa276781SNishanth Menon 11aa276781SNishanth Menon #include <linux/bitmap.h> 12aa276781SNishanth Menon #include <linux/debugfs.h> 13aa276781SNishanth Menon #include <linux/export.h> 14aa276781SNishanth Menon #include <linux/io.h> 15b9e8a7d9SDave Gerlach #include <linux/iopoll.h> 16aa276781SNishanth Menon #include <linux/kernel.h> 17aa276781SNishanth Menon #include <linux/mailbox_client.h> 18aa276781SNishanth Menon #include <linux/module.h> 19aa276781SNishanth Menon #include <linux/of_device.h> 20aa276781SNishanth Menon #include <linux/semaphore.h> 21aa276781SNishanth Menon #include <linux/slab.h> 22aa276781SNishanth Menon #include <linux/soc/ti/ti-msgmgr.h> 23aa276781SNishanth Menon #include <linux/soc/ti/ti_sci_protocol.h> 24912cffb4SNishanth Menon #include <linux/reboot.h> 25aa276781SNishanth Menon 26aa276781SNishanth Menon #include "ti_sci.h" 27aa276781SNishanth Menon 28aa276781SNishanth Menon /* List of all TI SCI devices active in system */ 29aa276781SNishanth Menon static LIST_HEAD(ti_sci_list); 30aa276781SNishanth Menon /* Protection for the entire list */ 31aa276781SNishanth Menon static DEFINE_MUTEX(ti_sci_list_mutex); 32aa276781SNishanth Menon 33aa276781SNishanth Menon /** 34aa276781SNishanth Menon * struct ti_sci_xfer - Structure representing a message flow 35aa276781SNishanth Menon * @tx_message: Transmit message 36aa276781SNishanth Menon * @rx_len: Receive message length 37aa276781SNishanth Menon * @xfer_buf: Preallocated buffer to store receive message 38aa276781SNishanth Menon * Since we work with request-ACK protocol, we can 39aa276781SNishanth Menon * reuse the same buffer for the rx path as we 40aa276781SNishanth Menon * use for the tx path. 41aa276781SNishanth Menon * @done: completion event 42aa276781SNishanth Menon */ 43aa276781SNishanth Menon struct ti_sci_xfer { 44aa276781SNishanth Menon struct ti_msgmgr_message tx_message; 45aa276781SNishanth Menon u8 rx_len; 46aa276781SNishanth Menon u8 *xfer_buf; 47aa276781SNishanth Menon struct completion done; 48aa276781SNishanth Menon }; 49aa276781SNishanth Menon 50aa276781SNishanth Menon /** 51aa276781SNishanth Menon * struct ti_sci_xfers_info - Structure to manage transfer information 52aa276781SNishanth Menon * @sem_xfer_count: Counting Semaphore for managing max simultaneous 53aa276781SNishanth Menon * Messages. 54aa276781SNishanth Menon * @xfer_block: Preallocated Message array 55aa276781SNishanth Menon * @xfer_alloc_table: Bitmap table for allocated messages. 56aa276781SNishanth Menon * Index of this bitmap table is also used for message 57aa276781SNishanth Menon * sequence identifier. 58aa276781SNishanth Menon * @xfer_lock: Protection for message allocation 59aa276781SNishanth Menon */ 60aa276781SNishanth Menon struct ti_sci_xfers_info { 61aa276781SNishanth Menon struct semaphore sem_xfer_count; 62aa276781SNishanth Menon struct ti_sci_xfer *xfer_block; 63aa276781SNishanth Menon unsigned long *xfer_alloc_table; 64aa276781SNishanth Menon /* protect transfer allocation */ 65aa276781SNishanth Menon spinlock_t xfer_lock; 66aa276781SNishanth Menon }; 67aa276781SNishanth Menon 68aa276781SNishanth Menon /** 69aa276781SNishanth Menon * struct ti_sci_desc - Description of SoC integration 70e69a3553SNishanth Menon * @default_host_id: Host identifier representing the compute entity 71aa276781SNishanth Menon * @max_rx_timeout_ms: Timeout for communication with SoC (in Milliseconds) 72aa276781SNishanth Menon * @max_msgs: Maximum number of messages that can be pending 73aa276781SNishanth Menon * simultaneously in the system 74aa276781SNishanth Menon * @max_msg_size: Maximum size of data per message that can be handled. 75aa276781SNishanth Menon */ 76aa276781SNishanth Menon struct ti_sci_desc { 77e69a3553SNishanth Menon u8 default_host_id; 78aa276781SNishanth Menon int max_rx_timeout_ms; 79aa276781SNishanth Menon int max_msgs; 80aa276781SNishanth Menon int max_msg_size; 81aa276781SNishanth Menon }; 82aa276781SNishanth Menon 83aa276781SNishanth Menon /** 84aa276781SNishanth Menon * struct ti_sci_info - Structure representing a TI SCI instance 85aa276781SNishanth Menon * @dev: Device pointer 86aa276781SNishanth Menon * @desc: SoC description for this instance 87912cffb4SNishanth Menon * @nb: Reboot Notifier block 88aa276781SNishanth Menon * @d: Debugfs file entry 89aa276781SNishanth Menon * @debug_region: Memory region where the debug message are available 90aa276781SNishanth Menon * @debug_region_size: Debug region size 91aa276781SNishanth Menon * @debug_buffer: Buffer allocated to copy debug messages. 92aa276781SNishanth Menon * @handle: Instance of TI SCI handle to send to clients. 93aa276781SNishanth Menon * @cl: Mailbox Client 94aa276781SNishanth Menon * @chan_tx: Transmit mailbox channel 95aa276781SNishanth Menon * @chan_rx: Receive mailbox channel 96aa276781SNishanth Menon * @minfo: Message info 97aa276781SNishanth Menon * @node: list head 98e69a3553SNishanth Menon * @host_id: Host ID 99aa276781SNishanth Menon * @users: Number of users of this instance 100aa276781SNishanth Menon */ 101aa276781SNishanth Menon struct ti_sci_info { 102aa276781SNishanth Menon struct device *dev; 103912cffb4SNishanth Menon struct notifier_block nb; 104aa276781SNishanth Menon const struct ti_sci_desc *desc; 105aa276781SNishanth Menon struct dentry *d; 106aa276781SNishanth Menon void __iomem *debug_region; 107aa276781SNishanth Menon char *debug_buffer; 108aa276781SNishanth Menon size_t debug_region_size; 109aa276781SNishanth Menon struct ti_sci_handle handle; 110aa276781SNishanth Menon struct mbox_client cl; 111aa276781SNishanth Menon struct mbox_chan *chan_tx; 112aa276781SNishanth Menon struct mbox_chan *chan_rx; 113aa276781SNishanth Menon struct ti_sci_xfers_info minfo; 114aa276781SNishanth Menon struct list_head node; 115e69a3553SNishanth Menon u8 host_id; 116aa276781SNishanth Menon /* protected by ti_sci_list_mutex */ 117aa276781SNishanth Menon int users; 118aa276781SNishanth Menon }; 119aa276781SNishanth Menon 120aa276781SNishanth Menon #define cl_to_ti_sci_info(c) container_of(c, struct ti_sci_info, cl) 121aa276781SNishanth Menon #define handle_to_ti_sci_info(h) container_of(h, struct ti_sci_info, handle) 122912cffb4SNishanth Menon #define reboot_to_ti_sci_info(n) container_of(n, struct ti_sci_info, nb) 123aa276781SNishanth Menon 124aa276781SNishanth Menon #ifdef CONFIG_DEBUG_FS 125aa276781SNishanth Menon 126aa276781SNishanth Menon /** 127aa276781SNishanth Menon * ti_sci_debug_show() - Helper to dump the debug log 128aa276781SNishanth Menon * @s: sequence file pointer 129aa276781SNishanth Menon * @unused: unused. 130aa276781SNishanth Menon * 131aa276781SNishanth Menon * Return: 0 132aa276781SNishanth Menon */ 133aa276781SNishanth Menon static int ti_sci_debug_show(struct seq_file *s, void *unused) 134aa276781SNishanth Menon { 135aa276781SNishanth Menon struct ti_sci_info *info = s->private; 136aa276781SNishanth Menon 137aa276781SNishanth Menon memcpy_fromio(info->debug_buffer, info->debug_region, 138aa276781SNishanth Menon info->debug_region_size); 139aa276781SNishanth Menon /* 140aa276781SNishanth Menon * We don't trust firmware to leave NULL terminated last byte (hence 141aa276781SNishanth Menon * we have allocated 1 extra 0 byte). Since we cannot guarantee any 142aa276781SNishanth Menon * specific data format for debug messages, We just present the data 143aa276781SNishanth Menon * in the buffer as is - we expect the messages to be self explanatory. 144aa276781SNishanth Menon */ 145aa276781SNishanth Menon seq_puts(s, info->debug_buffer); 146aa276781SNishanth Menon return 0; 147aa276781SNishanth Menon } 148aa276781SNishanth Menon 1495953c887SYangtao Li /* Provide the log file operations interface*/ 1505953c887SYangtao Li DEFINE_SHOW_ATTRIBUTE(ti_sci_debug); 151aa276781SNishanth Menon 152aa276781SNishanth Menon /** 153aa276781SNishanth Menon * ti_sci_debugfs_create() - Create log debug file 154aa276781SNishanth Menon * @pdev: platform device pointer 155aa276781SNishanth Menon * @info: Pointer to SCI entity information 156aa276781SNishanth Menon * 157aa276781SNishanth Menon * Return: 0 if all went fine, else corresponding error. 158aa276781SNishanth Menon */ 159aa276781SNishanth Menon static int ti_sci_debugfs_create(struct platform_device *pdev, 160aa276781SNishanth Menon struct ti_sci_info *info) 161aa276781SNishanth Menon { 162aa276781SNishanth Menon struct device *dev = &pdev->dev; 163aa276781SNishanth Menon struct resource *res; 164aa276781SNishanth Menon char debug_name[50] = "ti_sci_debug@"; 165aa276781SNishanth Menon 166aa276781SNishanth Menon /* Debug region is optional */ 167aa276781SNishanth Menon res = platform_get_resource_byname(pdev, IORESOURCE_MEM, 168aa276781SNishanth Menon "debug_messages"); 169aa276781SNishanth Menon info->debug_region = devm_ioremap_resource(dev, res); 170aa276781SNishanth Menon if (IS_ERR(info->debug_region)) 171aa276781SNishanth Menon return 0; 172aa276781SNishanth Menon info->debug_region_size = resource_size(res); 173aa276781SNishanth Menon 174aa276781SNishanth Menon info->debug_buffer = devm_kcalloc(dev, info->debug_region_size + 1, 175aa276781SNishanth Menon sizeof(char), GFP_KERNEL); 176aa276781SNishanth Menon if (!info->debug_buffer) 177aa276781SNishanth Menon return -ENOMEM; 178aa276781SNishanth Menon /* Setup NULL termination */ 179aa276781SNishanth Menon info->debug_buffer[info->debug_region_size] = 0; 180aa276781SNishanth Menon 181aa276781SNishanth Menon info->d = debugfs_create_file(strncat(debug_name, dev_name(dev), 18276cefef8SArnd Bergmann sizeof(debug_name) - 18376cefef8SArnd Bergmann sizeof("ti_sci_debug@")), 184aa276781SNishanth Menon 0444, NULL, info, &ti_sci_debug_fops); 185aa276781SNishanth Menon if (IS_ERR(info->d)) 186aa276781SNishanth Menon return PTR_ERR(info->d); 187aa276781SNishanth Menon 188aa276781SNishanth Menon dev_dbg(dev, "Debug region => %p, size = %zu bytes, resource: %pr\n", 189aa276781SNishanth Menon info->debug_region, info->debug_region_size, res); 190aa276781SNishanth Menon return 0; 191aa276781SNishanth Menon } 192aa276781SNishanth Menon 193aa276781SNishanth Menon /** 194aa276781SNishanth Menon * ti_sci_debugfs_destroy() - clean up log debug file 195aa276781SNishanth Menon * @pdev: platform device pointer 196aa276781SNishanth Menon * @info: Pointer to SCI entity information 197aa276781SNishanth Menon */ 198aa276781SNishanth Menon static void ti_sci_debugfs_destroy(struct platform_device *pdev, 199aa276781SNishanth Menon struct ti_sci_info *info) 200aa276781SNishanth Menon { 201aa276781SNishanth Menon if (IS_ERR(info->debug_region)) 202aa276781SNishanth Menon return; 203aa276781SNishanth Menon 204aa276781SNishanth Menon debugfs_remove(info->d); 205aa276781SNishanth Menon } 206aa276781SNishanth Menon #else /* CONFIG_DEBUG_FS */ 207aa276781SNishanth Menon static inline int ti_sci_debugfs_create(struct platform_device *dev, 208aa276781SNishanth Menon struct ti_sci_info *info) 209aa276781SNishanth Menon { 210aa276781SNishanth Menon return 0; 211aa276781SNishanth Menon } 212aa276781SNishanth Menon 213aa276781SNishanth Menon static inline void ti_sci_debugfs_destroy(struct platform_device *dev, 214aa276781SNishanth Menon struct ti_sci_info *info) 215aa276781SNishanth Menon { 216aa276781SNishanth Menon } 217aa276781SNishanth Menon #endif /* CONFIG_DEBUG_FS */ 218aa276781SNishanth Menon 219aa276781SNishanth Menon /** 220aa276781SNishanth Menon * ti_sci_dump_header_dbg() - Helper to dump a message header. 221aa276781SNishanth Menon * @dev: Device pointer corresponding to the SCI entity 222aa276781SNishanth Menon * @hdr: pointer to header. 223aa276781SNishanth Menon */ 224aa276781SNishanth Menon static inline void ti_sci_dump_header_dbg(struct device *dev, 225aa276781SNishanth Menon struct ti_sci_msg_hdr *hdr) 226aa276781SNishanth Menon { 227aa276781SNishanth Menon dev_dbg(dev, "MSGHDR:type=0x%04x host=0x%02x seq=0x%02x flags=0x%08x\n", 228aa276781SNishanth Menon hdr->type, hdr->host, hdr->seq, hdr->flags); 229aa276781SNishanth Menon } 230aa276781SNishanth Menon 231aa276781SNishanth Menon /** 232aa276781SNishanth Menon * ti_sci_rx_callback() - mailbox client callback for receive messages 233aa276781SNishanth Menon * @cl: client pointer 234aa276781SNishanth Menon * @m: mailbox message 235aa276781SNishanth Menon * 236aa276781SNishanth Menon * Processes one received message to appropriate transfer information and 237aa276781SNishanth Menon * signals completion of the transfer. 238aa276781SNishanth Menon * 239aa276781SNishanth Menon * NOTE: This function will be invoked in IRQ context, hence should be 240aa276781SNishanth Menon * as optimal as possible. 241aa276781SNishanth Menon */ 242aa276781SNishanth Menon static void ti_sci_rx_callback(struct mbox_client *cl, void *m) 243aa276781SNishanth Menon { 244aa276781SNishanth Menon struct ti_sci_info *info = cl_to_ti_sci_info(cl); 245aa276781SNishanth Menon struct device *dev = info->dev; 246aa276781SNishanth Menon struct ti_sci_xfers_info *minfo = &info->minfo; 247aa276781SNishanth Menon struct ti_msgmgr_message *mbox_msg = m; 248aa276781SNishanth Menon struct ti_sci_msg_hdr *hdr = (struct ti_sci_msg_hdr *)mbox_msg->buf; 249aa276781SNishanth Menon struct ti_sci_xfer *xfer; 250aa276781SNishanth Menon u8 xfer_id; 251aa276781SNishanth Menon 252aa276781SNishanth Menon xfer_id = hdr->seq; 253aa276781SNishanth Menon 254aa276781SNishanth Menon /* 255aa276781SNishanth Menon * Are we even expecting this? 256aa276781SNishanth Menon * NOTE: barriers were implicit in locks used for modifying the bitmap 257aa276781SNishanth Menon */ 258aa276781SNishanth Menon if (!test_bit(xfer_id, minfo->xfer_alloc_table)) { 259aa276781SNishanth Menon dev_err(dev, "Message for %d is not expected!\n", xfer_id); 260aa276781SNishanth Menon return; 261aa276781SNishanth Menon } 262aa276781SNishanth Menon 263aa276781SNishanth Menon xfer = &minfo->xfer_block[xfer_id]; 264aa276781SNishanth Menon 265aa276781SNishanth Menon /* Is the message of valid length? */ 266aa276781SNishanth Menon if (mbox_msg->len > info->desc->max_msg_size) { 267bd0fa74eSNishanth Menon dev_err(dev, "Unable to handle %zu xfer(max %d)\n", 268aa276781SNishanth Menon mbox_msg->len, info->desc->max_msg_size); 269aa276781SNishanth Menon ti_sci_dump_header_dbg(dev, hdr); 270aa276781SNishanth Menon return; 271aa276781SNishanth Menon } 272aa276781SNishanth Menon if (mbox_msg->len < xfer->rx_len) { 273bd0fa74eSNishanth Menon dev_err(dev, "Recv xfer %zu < expected %d length\n", 274aa276781SNishanth Menon mbox_msg->len, xfer->rx_len); 275aa276781SNishanth Menon ti_sci_dump_header_dbg(dev, hdr); 276aa276781SNishanth Menon return; 277aa276781SNishanth Menon } 278aa276781SNishanth Menon 279aa276781SNishanth Menon ti_sci_dump_header_dbg(dev, hdr); 280aa276781SNishanth Menon /* Take a copy to the rx buffer.. */ 281aa276781SNishanth Menon memcpy(xfer->xfer_buf, mbox_msg->buf, xfer->rx_len); 282aa276781SNishanth Menon complete(&xfer->done); 283aa276781SNishanth Menon } 284aa276781SNishanth Menon 285aa276781SNishanth Menon /** 286aa276781SNishanth Menon * ti_sci_get_one_xfer() - Allocate one message 287aa276781SNishanth Menon * @info: Pointer to SCI entity information 288aa276781SNishanth Menon * @msg_type: Message type 289aa276781SNishanth Menon * @msg_flags: Flag to set for the message 290aa276781SNishanth Menon * @tx_message_size: transmit message size 291aa276781SNishanth Menon * @rx_message_size: receive message size 292aa276781SNishanth Menon * 293aa276781SNishanth Menon * Helper function which is used by various command functions that are 294aa276781SNishanth Menon * exposed to clients of this driver for allocating a message traffic event. 295aa276781SNishanth Menon * 296aa276781SNishanth Menon * This function can sleep depending on pending requests already in the system 297aa276781SNishanth Menon * for the SCI entity. Further, this also holds a spinlock to maintain integrity 298aa276781SNishanth Menon * of internal data structures. 299aa276781SNishanth Menon * 300aa276781SNishanth Menon * Return: 0 if all went fine, else corresponding error. 301aa276781SNishanth Menon */ 302aa276781SNishanth Menon static struct ti_sci_xfer *ti_sci_get_one_xfer(struct ti_sci_info *info, 303aa276781SNishanth Menon u16 msg_type, u32 msg_flags, 304aa276781SNishanth Menon size_t tx_message_size, 305aa276781SNishanth Menon size_t rx_message_size) 306aa276781SNishanth Menon { 307aa276781SNishanth Menon struct ti_sci_xfers_info *minfo = &info->minfo; 308aa276781SNishanth Menon struct ti_sci_xfer *xfer; 309aa276781SNishanth Menon struct ti_sci_msg_hdr *hdr; 310aa276781SNishanth Menon unsigned long flags; 311aa276781SNishanth Menon unsigned long bit_pos; 312aa276781SNishanth Menon u8 xfer_id; 313aa276781SNishanth Menon int ret; 314aa276781SNishanth Menon int timeout; 315aa276781SNishanth Menon 316aa276781SNishanth Menon /* Ensure we have sane transfer sizes */ 317aa276781SNishanth Menon if (rx_message_size > info->desc->max_msg_size || 318aa276781SNishanth Menon tx_message_size > info->desc->max_msg_size || 319aa276781SNishanth Menon rx_message_size < sizeof(*hdr) || tx_message_size < sizeof(*hdr)) 320aa276781SNishanth Menon return ERR_PTR(-ERANGE); 321aa276781SNishanth Menon 322aa276781SNishanth Menon /* 323aa276781SNishanth Menon * Ensure we have only controlled number of pending messages. 324aa276781SNishanth Menon * Ideally, we might just have to wait a single message, be 325aa276781SNishanth Menon * conservative and wait 5 times that.. 326aa276781SNishanth Menon */ 327aa276781SNishanth Menon timeout = msecs_to_jiffies(info->desc->max_rx_timeout_ms) * 5; 328aa276781SNishanth Menon ret = down_timeout(&minfo->sem_xfer_count, timeout); 329aa276781SNishanth Menon if (ret < 0) 330aa276781SNishanth Menon return ERR_PTR(ret); 331aa276781SNishanth Menon 332aa276781SNishanth Menon /* Keep the locked section as small as possible */ 333aa276781SNishanth Menon spin_lock_irqsave(&minfo->xfer_lock, flags); 334aa276781SNishanth Menon bit_pos = find_first_zero_bit(minfo->xfer_alloc_table, 335aa276781SNishanth Menon info->desc->max_msgs); 336aa276781SNishanth Menon set_bit(bit_pos, minfo->xfer_alloc_table); 337aa276781SNishanth Menon spin_unlock_irqrestore(&minfo->xfer_lock, flags); 338aa276781SNishanth Menon 339aa276781SNishanth Menon /* 340aa276781SNishanth Menon * We already ensured in probe that we can have max messages that can 341aa276781SNishanth Menon * fit in hdr.seq - NOTE: this improves access latencies 342aa276781SNishanth Menon * to predictable O(1) access, BUT, it opens us to risk if 343aa276781SNishanth Menon * remote misbehaves with corrupted message sequence responses. 344aa276781SNishanth Menon * If that happens, we are going to be messed up anyways.. 345aa276781SNishanth Menon */ 346aa276781SNishanth Menon xfer_id = (u8)bit_pos; 347aa276781SNishanth Menon 348aa276781SNishanth Menon xfer = &minfo->xfer_block[xfer_id]; 349aa276781SNishanth Menon 350aa276781SNishanth Menon hdr = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 351aa276781SNishanth Menon xfer->tx_message.len = tx_message_size; 352b9e8a7d9SDave Gerlach xfer->tx_message.chan_rx = info->chan_rx; 353b9e8a7d9SDave Gerlach xfer->tx_message.timeout_rx_ms = info->desc->max_rx_timeout_ms; 354aa276781SNishanth Menon xfer->rx_len = (u8)rx_message_size; 355aa276781SNishanth Menon 356aa276781SNishanth Menon reinit_completion(&xfer->done); 357aa276781SNishanth Menon 358aa276781SNishanth Menon hdr->seq = xfer_id; 359aa276781SNishanth Menon hdr->type = msg_type; 360e69a3553SNishanth Menon hdr->host = info->host_id; 361aa276781SNishanth Menon hdr->flags = msg_flags; 362aa276781SNishanth Menon 363aa276781SNishanth Menon return xfer; 364aa276781SNishanth Menon } 365aa276781SNishanth Menon 366aa276781SNishanth Menon /** 367aa276781SNishanth Menon * ti_sci_put_one_xfer() - Release a message 368aa276781SNishanth Menon * @minfo: transfer info pointer 369aa276781SNishanth Menon * @xfer: message that was reserved by ti_sci_get_one_xfer 370aa276781SNishanth Menon * 371aa276781SNishanth Menon * This holds a spinlock to maintain integrity of internal data structures. 372aa276781SNishanth Menon */ 373aa276781SNishanth Menon static void ti_sci_put_one_xfer(struct ti_sci_xfers_info *minfo, 374aa276781SNishanth Menon struct ti_sci_xfer *xfer) 375aa276781SNishanth Menon { 376aa276781SNishanth Menon unsigned long flags; 377aa276781SNishanth Menon struct ti_sci_msg_hdr *hdr; 378aa276781SNishanth Menon u8 xfer_id; 379aa276781SNishanth Menon 380aa276781SNishanth Menon hdr = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 381aa276781SNishanth Menon xfer_id = hdr->seq; 382aa276781SNishanth Menon 383aa276781SNishanth Menon /* 384aa276781SNishanth Menon * Keep the locked section as small as possible 385aa276781SNishanth Menon * NOTE: we might escape with smp_mb and no lock here.. 386aa276781SNishanth Menon * but just be conservative and symmetric. 387aa276781SNishanth Menon */ 388aa276781SNishanth Menon spin_lock_irqsave(&minfo->xfer_lock, flags); 389aa276781SNishanth Menon clear_bit(xfer_id, minfo->xfer_alloc_table); 390aa276781SNishanth Menon spin_unlock_irqrestore(&minfo->xfer_lock, flags); 391aa276781SNishanth Menon 392aa276781SNishanth Menon /* Increment the count for the next user to get through */ 393aa276781SNishanth Menon up(&minfo->sem_xfer_count); 394aa276781SNishanth Menon } 395aa276781SNishanth Menon 396aa276781SNishanth Menon /** 397aa276781SNishanth Menon * ti_sci_do_xfer() - Do one transfer 398aa276781SNishanth Menon * @info: Pointer to SCI entity information 399aa276781SNishanth Menon * @xfer: Transfer to initiate and wait for response 400aa276781SNishanth Menon * 401aa276781SNishanth Menon * Return: -ETIMEDOUT in case of no response, if transmit error, 402aa276781SNishanth Menon * return corresponding error, else if all goes well, 403aa276781SNishanth Menon * return 0. 404aa276781SNishanth Menon */ 405aa276781SNishanth Menon static inline int ti_sci_do_xfer(struct ti_sci_info *info, 406aa276781SNishanth Menon struct ti_sci_xfer *xfer) 407aa276781SNishanth Menon { 408aa276781SNishanth Menon int ret; 409aa276781SNishanth Menon int timeout; 410aa276781SNishanth Menon struct device *dev = info->dev; 411b9e8a7d9SDave Gerlach bool done_state = true; 412aa276781SNishanth Menon 413aa276781SNishanth Menon ret = mbox_send_message(info->chan_tx, &xfer->tx_message); 414aa276781SNishanth Menon if (ret < 0) 415aa276781SNishanth Menon return ret; 416aa276781SNishanth Menon 417aa276781SNishanth Menon ret = 0; 418aa276781SNishanth Menon 4199225bcdeSNishanth Menon if (system_state <= SYSTEM_RUNNING) { 420aa276781SNishanth Menon /* And we wait for the response. */ 421aa276781SNishanth Menon timeout = msecs_to_jiffies(info->desc->max_rx_timeout_ms); 422b9e8a7d9SDave Gerlach if (!wait_for_completion_timeout(&xfer->done, timeout)) 423b9e8a7d9SDave Gerlach ret = -ETIMEDOUT; 424b9e8a7d9SDave Gerlach } else { 425b9e8a7d9SDave Gerlach /* 4269225bcdeSNishanth Menon * If we are !running, we cannot use wait_for_completion_timeout 427b9e8a7d9SDave Gerlach * during noirq phase, so we must manually poll the completion. 428b9e8a7d9SDave Gerlach */ 429b9e8a7d9SDave Gerlach ret = read_poll_timeout_atomic(try_wait_for_completion, done_state, 430b13b2c3eSGeorgi Vlaev done_state, 1, 431b9e8a7d9SDave Gerlach info->desc->max_rx_timeout_ms * 1000, 432b9e8a7d9SDave Gerlach false, &xfer->done); 433b9e8a7d9SDave Gerlach } 434b9e8a7d9SDave Gerlach 435b13b2c3eSGeorgi Vlaev if (ret == -ETIMEDOUT) 436595f3a9dSHelge Deller dev_err(dev, "Mbox timedout in resp(caller: %pS)\n", 437aa276781SNishanth Menon (void *)_RET_IP_); 438b9e8a7d9SDave Gerlach 439aa276781SNishanth Menon /* 440aa276781SNishanth Menon * NOTE: we might prefer not to need the mailbox ticker to manage the 441aa276781SNishanth Menon * transfer queueing since the protocol layer queues things by itself. 442aa276781SNishanth Menon * Unfortunately, we have to kick the mailbox framework after we have 443aa276781SNishanth Menon * received our message. 444aa276781SNishanth Menon */ 445aa276781SNishanth Menon mbox_client_txdone(info->chan_tx, ret); 446aa276781SNishanth Menon 447aa276781SNishanth Menon return ret; 448aa276781SNishanth Menon } 449aa276781SNishanth Menon 450aa276781SNishanth Menon /** 451aa276781SNishanth Menon * ti_sci_cmd_get_revision() - command to get the revision of the SCI entity 452aa276781SNishanth Menon * @info: Pointer to SCI entity information 453aa276781SNishanth Menon * 454aa276781SNishanth Menon * Updates the SCI information in the internal data structure. 455aa276781SNishanth Menon * 456aa276781SNishanth Menon * Return: 0 if all went fine, else return appropriate error. 457aa276781SNishanth Menon */ 458aa276781SNishanth Menon static int ti_sci_cmd_get_revision(struct ti_sci_info *info) 459aa276781SNishanth Menon { 460aa276781SNishanth Menon struct device *dev = info->dev; 461aa276781SNishanth Menon struct ti_sci_handle *handle = &info->handle; 462aa276781SNishanth Menon struct ti_sci_version_info *ver = &handle->version; 463aa276781SNishanth Menon struct ti_sci_msg_resp_version *rev_info; 464aa276781SNishanth Menon struct ti_sci_xfer *xfer; 465aa276781SNishanth Menon int ret; 466aa276781SNishanth Menon 467aa276781SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_VERSION, 46866f030eaSAndrew F. Davis TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 46966f030eaSAndrew F. Davis sizeof(struct ti_sci_msg_hdr), 470aa276781SNishanth Menon sizeof(*rev_info)); 471aa276781SNishanth Menon if (IS_ERR(xfer)) { 472aa276781SNishanth Menon ret = PTR_ERR(xfer); 473aa276781SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 474aa276781SNishanth Menon return ret; 475aa276781SNishanth Menon } 476aa276781SNishanth Menon 477aa276781SNishanth Menon rev_info = (struct ti_sci_msg_resp_version *)xfer->xfer_buf; 478aa276781SNishanth Menon 479aa276781SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 480aa276781SNishanth Menon if (ret) { 481aa276781SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 482aa276781SNishanth Menon goto fail; 483aa276781SNishanth Menon } 484aa276781SNishanth Menon 485aa276781SNishanth Menon ver->abi_major = rev_info->abi_major; 486aa276781SNishanth Menon ver->abi_minor = rev_info->abi_minor; 487aa276781SNishanth Menon ver->firmware_revision = rev_info->firmware_revision; 488aa276781SNishanth Menon strncpy(ver->firmware_description, rev_info->firmware_description, 489aa276781SNishanth Menon sizeof(ver->firmware_description)); 490aa276781SNishanth Menon 491aa276781SNishanth Menon fail: 492aa276781SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 493aa276781SNishanth Menon return ret; 494aa276781SNishanth Menon } 495aa276781SNishanth Menon 496aa276781SNishanth Menon /** 4979e7d756dSNishanth Menon * ti_sci_is_response_ack() - Generic ACK/NACK message checkup 4989e7d756dSNishanth Menon * @r: pointer to response buffer 4999e7d756dSNishanth Menon * 5009e7d756dSNishanth Menon * Return: true if the response was an ACK, else returns false. 5019e7d756dSNishanth Menon */ 5029e7d756dSNishanth Menon static inline bool ti_sci_is_response_ack(void *r) 5039e7d756dSNishanth Menon { 5049e7d756dSNishanth Menon struct ti_sci_msg_hdr *hdr = r; 5059e7d756dSNishanth Menon 5069e7d756dSNishanth Menon return hdr->flags & TI_SCI_FLAG_RESP_GENERIC_ACK ? true : false; 5079e7d756dSNishanth Menon } 5089e7d756dSNishanth Menon 5099e7d756dSNishanth Menon /** 5109e7d756dSNishanth Menon * ti_sci_set_device_state() - Set device state helper 5119e7d756dSNishanth Menon * @handle: pointer to TI SCI handle 5129e7d756dSNishanth Menon * @id: Device identifier 5139e7d756dSNishanth Menon * @flags: flags to setup for the device 5149e7d756dSNishanth Menon * @state: State to move the device to 5159e7d756dSNishanth Menon * 5169e7d756dSNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 5179e7d756dSNishanth Menon */ 5189e7d756dSNishanth Menon static int ti_sci_set_device_state(const struct ti_sci_handle *handle, 5199e7d756dSNishanth Menon u32 id, u32 flags, u8 state) 5209e7d756dSNishanth Menon { 5219e7d756dSNishanth Menon struct ti_sci_info *info; 5229e7d756dSNishanth Menon struct ti_sci_msg_req_set_device_state *req; 5239e7d756dSNishanth Menon struct ti_sci_msg_hdr *resp; 5249e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 5259e7d756dSNishanth Menon struct device *dev; 5269e7d756dSNishanth Menon int ret = 0; 5279e7d756dSNishanth Menon 5289e7d756dSNishanth Menon if (IS_ERR(handle)) 5299e7d756dSNishanth Menon return PTR_ERR(handle); 5309e7d756dSNishanth Menon if (!handle) 5319e7d756dSNishanth Menon return -EINVAL; 5329e7d756dSNishanth Menon 5339e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 5349e7d756dSNishanth Menon dev = info->dev; 5359e7d756dSNishanth Menon 5369e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_STATE, 5379e7d756dSNishanth Menon flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 5389e7d756dSNishanth Menon sizeof(*req), sizeof(*resp)); 5399e7d756dSNishanth Menon if (IS_ERR(xfer)) { 5409e7d756dSNishanth Menon ret = PTR_ERR(xfer); 5419e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 5429e7d756dSNishanth Menon return ret; 5439e7d756dSNishanth Menon } 5449e7d756dSNishanth Menon req = (struct ti_sci_msg_req_set_device_state *)xfer->xfer_buf; 5459e7d756dSNishanth Menon req->id = id; 5469e7d756dSNishanth Menon req->state = state; 5479e7d756dSNishanth Menon 5489e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 5499e7d756dSNishanth Menon if (ret) { 5509e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 5519e7d756dSNishanth Menon goto fail; 5529e7d756dSNishanth Menon } 5539e7d756dSNishanth Menon 5549e7d756dSNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 5559e7d756dSNishanth Menon 5569e7d756dSNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 5579e7d756dSNishanth Menon 5589e7d756dSNishanth Menon fail: 5599e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 5609e7d756dSNishanth Menon 5619e7d756dSNishanth Menon return ret; 5629e7d756dSNishanth Menon } 5639e7d756dSNishanth Menon 5649e7d756dSNishanth Menon /** 5659e7d756dSNishanth Menon * ti_sci_get_device_state() - Get device state helper 5669e7d756dSNishanth Menon * @handle: Handle to the device 5679e7d756dSNishanth Menon * @id: Device Identifier 5689e7d756dSNishanth Menon * @clcnt: Pointer to Context Loss Count 5699e7d756dSNishanth Menon * @resets: pointer to resets 5709e7d756dSNishanth Menon * @p_state: pointer to p_state 5719e7d756dSNishanth Menon * @c_state: pointer to c_state 5729e7d756dSNishanth Menon * 5739e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 5749e7d756dSNishanth Menon */ 5759e7d756dSNishanth Menon static int ti_sci_get_device_state(const struct ti_sci_handle *handle, 5769e7d756dSNishanth Menon u32 id, u32 *clcnt, u32 *resets, 5779e7d756dSNishanth Menon u8 *p_state, u8 *c_state) 5789e7d756dSNishanth Menon { 5799e7d756dSNishanth Menon struct ti_sci_info *info; 5809e7d756dSNishanth Menon struct ti_sci_msg_req_get_device_state *req; 5819e7d756dSNishanth Menon struct ti_sci_msg_resp_get_device_state *resp; 5829e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 5839e7d756dSNishanth Menon struct device *dev; 5849e7d756dSNishanth Menon int ret = 0; 5859e7d756dSNishanth Menon 5869e7d756dSNishanth Menon if (IS_ERR(handle)) 5879e7d756dSNishanth Menon return PTR_ERR(handle); 5889e7d756dSNishanth Menon if (!handle) 5899e7d756dSNishanth Menon return -EINVAL; 5909e7d756dSNishanth Menon 5919e7d756dSNishanth Menon if (!clcnt && !resets && !p_state && !c_state) 5929e7d756dSNishanth Menon return -EINVAL; 5939e7d756dSNishanth Menon 5949e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 5959e7d756dSNishanth Menon dev = info->dev; 5969e7d756dSNishanth Menon 5979e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_DEVICE_STATE, 59866f030eaSAndrew F. Davis TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 59966f030eaSAndrew F. Davis sizeof(*req), sizeof(*resp)); 6009e7d756dSNishanth Menon if (IS_ERR(xfer)) { 6019e7d756dSNishanth Menon ret = PTR_ERR(xfer); 6029e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 6039e7d756dSNishanth Menon return ret; 6049e7d756dSNishanth Menon } 6059e7d756dSNishanth Menon req = (struct ti_sci_msg_req_get_device_state *)xfer->xfer_buf; 6069e7d756dSNishanth Menon req->id = id; 6079e7d756dSNishanth Menon 6089e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 6099e7d756dSNishanth Menon if (ret) { 6109e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 6119e7d756dSNishanth Menon goto fail; 6129e7d756dSNishanth Menon } 6139e7d756dSNishanth Menon 6149e7d756dSNishanth Menon resp = (struct ti_sci_msg_resp_get_device_state *)xfer->xfer_buf; 6159e7d756dSNishanth Menon if (!ti_sci_is_response_ack(resp)) { 6169e7d756dSNishanth Menon ret = -ENODEV; 6179e7d756dSNishanth Menon goto fail; 6189e7d756dSNishanth Menon } 6199e7d756dSNishanth Menon 6209e7d756dSNishanth Menon if (clcnt) 6219e7d756dSNishanth Menon *clcnt = resp->context_loss_count; 6229e7d756dSNishanth Menon if (resets) 6239e7d756dSNishanth Menon *resets = resp->resets; 6249e7d756dSNishanth Menon if (p_state) 6259e7d756dSNishanth Menon *p_state = resp->programmed_state; 6269e7d756dSNishanth Menon if (c_state) 6279e7d756dSNishanth Menon *c_state = resp->current_state; 6289e7d756dSNishanth Menon fail: 6299e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 6309e7d756dSNishanth Menon 6319e7d756dSNishanth Menon return ret; 6329e7d756dSNishanth Menon } 6339e7d756dSNishanth Menon 6349e7d756dSNishanth Menon /** 6359e7d756dSNishanth Menon * ti_sci_cmd_get_device() - command to request for device managed by TISCI 63645b659eeSLokesh Vutla * that can be shared with other hosts. 6379e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 6389e7d756dSNishanth Menon * @id: Device Identifier 6399e7d756dSNishanth Menon * 6409e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 6419e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 6429e7d756dSNishanth Menon * managed by driver for that purpose. 6439e7d756dSNishanth Menon * 6449e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 6459e7d756dSNishanth Menon */ 6469e7d756dSNishanth Menon static int ti_sci_cmd_get_device(const struct ti_sci_handle *handle, u32 id) 6479e7d756dSNishanth Menon { 64845b659eeSLokesh Vutla return ti_sci_set_device_state(handle, id, 0, 64945b659eeSLokesh Vutla MSG_DEVICE_SW_STATE_ON); 65045b659eeSLokesh Vutla } 65145b659eeSLokesh Vutla 65245b659eeSLokesh Vutla /** 65345b659eeSLokesh Vutla * ti_sci_cmd_get_device_exclusive() - command to request for device managed by 65445b659eeSLokesh Vutla * TISCI that is exclusively owned by the 65545b659eeSLokesh Vutla * requesting host. 65645b659eeSLokesh Vutla * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 65745b659eeSLokesh Vutla * @id: Device Identifier 65845b659eeSLokesh Vutla * 65945b659eeSLokesh Vutla * Request for the device - NOTE: the client MUST maintain integrity of 66045b659eeSLokesh Vutla * usage count by balancing get_device with put_device. No refcounting is 66145b659eeSLokesh Vutla * managed by driver for that purpose. 66245b659eeSLokesh Vutla * 66345b659eeSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 66445b659eeSLokesh Vutla */ 66545b659eeSLokesh Vutla static int ti_sci_cmd_get_device_exclusive(const struct ti_sci_handle *handle, 66645b659eeSLokesh Vutla u32 id) 66745b659eeSLokesh Vutla { 6689e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 6699e7d756dSNishanth Menon MSG_FLAG_DEVICE_EXCLUSIVE, 6709e7d756dSNishanth Menon MSG_DEVICE_SW_STATE_ON); 6719e7d756dSNishanth Menon } 6729e7d756dSNishanth Menon 6739e7d756dSNishanth Menon /** 6749e7d756dSNishanth Menon * ti_sci_cmd_idle_device() - Command to idle a device managed by TISCI 6759e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 6769e7d756dSNishanth Menon * @id: Device Identifier 6779e7d756dSNishanth Menon * 6789e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 6799e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 6809e7d756dSNishanth Menon * managed by driver for that purpose. 6819e7d756dSNishanth Menon * 6829e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 6839e7d756dSNishanth Menon */ 6849e7d756dSNishanth Menon static int ti_sci_cmd_idle_device(const struct ti_sci_handle *handle, u32 id) 6859e7d756dSNishanth Menon { 68645b659eeSLokesh Vutla return ti_sci_set_device_state(handle, id, 0, 68745b659eeSLokesh Vutla MSG_DEVICE_SW_STATE_RETENTION); 68845b659eeSLokesh Vutla } 68945b659eeSLokesh Vutla 69045b659eeSLokesh Vutla /** 69145b659eeSLokesh Vutla * ti_sci_cmd_idle_device_exclusive() - Command to idle a device managed by 69245b659eeSLokesh Vutla * TISCI that is exclusively owned by 69345b659eeSLokesh Vutla * requesting host. 69445b659eeSLokesh Vutla * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 69545b659eeSLokesh Vutla * @id: Device Identifier 69645b659eeSLokesh Vutla * 69745b659eeSLokesh Vutla * Request for the device - NOTE: the client MUST maintain integrity of 69845b659eeSLokesh Vutla * usage count by balancing get_device with put_device. No refcounting is 69945b659eeSLokesh Vutla * managed by driver for that purpose. 70045b659eeSLokesh Vutla * 70145b659eeSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 70245b659eeSLokesh Vutla */ 70345b659eeSLokesh Vutla static int ti_sci_cmd_idle_device_exclusive(const struct ti_sci_handle *handle, 70445b659eeSLokesh Vutla u32 id) 70545b659eeSLokesh Vutla { 7069e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 7079e7d756dSNishanth Menon MSG_FLAG_DEVICE_EXCLUSIVE, 7089e7d756dSNishanth Menon MSG_DEVICE_SW_STATE_RETENTION); 7099e7d756dSNishanth Menon } 7109e7d756dSNishanth Menon 7119e7d756dSNishanth Menon /** 7129e7d756dSNishanth Menon * ti_sci_cmd_put_device() - command to release a device managed by TISCI 7139e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 7149e7d756dSNishanth Menon * @id: Device Identifier 7159e7d756dSNishanth Menon * 7169e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 7179e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 7189e7d756dSNishanth Menon * managed by driver for that purpose. 7199e7d756dSNishanth Menon * 7209e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7219e7d756dSNishanth Menon */ 7229e7d756dSNishanth Menon static int ti_sci_cmd_put_device(const struct ti_sci_handle *handle, u32 id) 7239e7d756dSNishanth Menon { 7249e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 7259e7d756dSNishanth Menon 0, MSG_DEVICE_SW_STATE_AUTO_OFF); 7269e7d756dSNishanth Menon } 7279e7d756dSNishanth Menon 7289e7d756dSNishanth Menon /** 7299e7d756dSNishanth Menon * ti_sci_cmd_dev_is_valid() - Is the device valid 7309e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 7319e7d756dSNishanth Menon * @id: Device Identifier 7329e7d756dSNishanth Menon * 7339e7d756dSNishanth Menon * Return: 0 if all went fine and the device ID is valid, else return 7349e7d756dSNishanth Menon * appropriate error. 7359e7d756dSNishanth Menon */ 7369e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_valid(const struct ti_sci_handle *handle, u32 id) 7379e7d756dSNishanth Menon { 7389e7d756dSNishanth Menon u8 unused; 7399e7d756dSNishanth Menon 7409e7d756dSNishanth Menon /* check the device state which will also tell us if the ID is valid */ 7419e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &unused); 7429e7d756dSNishanth Menon } 7439e7d756dSNishanth Menon 7449e7d756dSNishanth Menon /** 7459e7d756dSNishanth Menon * ti_sci_cmd_dev_get_clcnt() - Get context loss counter 7469e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7479e7d756dSNishanth Menon * @id: Device Identifier 7489e7d756dSNishanth Menon * @count: Pointer to Context Loss counter to populate 7499e7d756dSNishanth Menon * 7509e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7519e7d756dSNishanth Menon */ 7529e7d756dSNishanth Menon static int ti_sci_cmd_dev_get_clcnt(const struct ti_sci_handle *handle, u32 id, 7539e7d756dSNishanth Menon u32 *count) 7549e7d756dSNishanth Menon { 7559e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, count, NULL, NULL, NULL); 7569e7d756dSNishanth Menon } 7579e7d756dSNishanth Menon 7589e7d756dSNishanth Menon /** 7599e7d756dSNishanth Menon * ti_sci_cmd_dev_is_idle() - Check if the device is requested to be idle 7609e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7619e7d756dSNishanth Menon * @id: Device Identifier 7629e7d756dSNishanth Menon * @r_state: true if requested to be idle 7639e7d756dSNishanth Menon * 7649e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7659e7d756dSNishanth Menon */ 7669e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_idle(const struct ti_sci_handle *handle, u32 id, 7679e7d756dSNishanth Menon bool *r_state) 7689e7d756dSNishanth Menon { 7699e7d756dSNishanth Menon int ret; 7709e7d756dSNishanth Menon u8 state; 7719e7d756dSNishanth Menon 7729e7d756dSNishanth Menon if (!r_state) 7739e7d756dSNishanth Menon return -EINVAL; 7749e7d756dSNishanth Menon 7759e7d756dSNishanth Menon ret = ti_sci_get_device_state(handle, id, NULL, NULL, &state, NULL); 7769e7d756dSNishanth Menon if (ret) 7779e7d756dSNishanth Menon return ret; 7789e7d756dSNishanth Menon 7799e7d756dSNishanth Menon *r_state = (state == MSG_DEVICE_SW_STATE_RETENTION); 7809e7d756dSNishanth Menon 7819e7d756dSNishanth Menon return 0; 7829e7d756dSNishanth Menon } 7839e7d756dSNishanth Menon 7849e7d756dSNishanth Menon /** 7859e7d756dSNishanth Menon * ti_sci_cmd_dev_is_stop() - Check if the device is requested to be stopped 7869e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7879e7d756dSNishanth Menon * @id: Device Identifier 7889e7d756dSNishanth Menon * @r_state: true if requested to be stopped 7899e7d756dSNishanth Menon * @curr_state: true if currently stopped. 7909e7d756dSNishanth Menon * 7919e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7929e7d756dSNishanth Menon */ 7939e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_stop(const struct ti_sci_handle *handle, u32 id, 7949e7d756dSNishanth Menon bool *r_state, bool *curr_state) 7959e7d756dSNishanth Menon { 7969e7d756dSNishanth Menon int ret; 7979e7d756dSNishanth Menon u8 p_state, c_state; 7989e7d756dSNishanth Menon 7999e7d756dSNishanth Menon if (!r_state && !curr_state) 8009e7d756dSNishanth Menon return -EINVAL; 8019e7d756dSNishanth Menon 8029e7d756dSNishanth Menon ret = 8039e7d756dSNishanth Menon ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state); 8049e7d756dSNishanth Menon if (ret) 8059e7d756dSNishanth Menon return ret; 8069e7d756dSNishanth Menon 8079e7d756dSNishanth Menon if (r_state) 8089e7d756dSNishanth Menon *r_state = (p_state == MSG_DEVICE_SW_STATE_AUTO_OFF); 8099e7d756dSNishanth Menon if (curr_state) 8109e7d756dSNishanth Menon *curr_state = (c_state == MSG_DEVICE_HW_STATE_OFF); 8119e7d756dSNishanth Menon 8129e7d756dSNishanth Menon return 0; 8139e7d756dSNishanth Menon } 8149e7d756dSNishanth Menon 8159e7d756dSNishanth Menon /** 8169e7d756dSNishanth Menon * ti_sci_cmd_dev_is_on() - Check if the device is requested to be ON 8179e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 8189e7d756dSNishanth Menon * @id: Device Identifier 8199e7d756dSNishanth Menon * @r_state: true if requested to be ON 8209e7d756dSNishanth Menon * @curr_state: true if currently ON and active 8219e7d756dSNishanth Menon * 8229e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8239e7d756dSNishanth Menon */ 8249e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_on(const struct ti_sci_handle *handle, u32 id, 8259e7d756dSNishanth Menon bool *r_state, bool *curr_state) 8269e7d756dSNishanth Menon { 8279e7d756dSNishanth Menon int ret; 8289e7d756dSNishanth Menon u8 p_state, c_state; 8299e7d756dSNishanth Menon 8309e7d756dSNishanth Menon if (!r_state && !curr_state) 8319e7d756dSNishanth Menon return -EINVAL; 8329e7d756dSNishanth Menon 8339e7d756dSNishanth Menon ret = 8349e7d756dSNishanth Menon ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state); 8359e7d756dSNishanth Menon if (ret) 8369e7d756dSNishanth Menon return ret; 8379e7d756dSNishanth Menon 8389e7d756dSNishanth Menon if (r_state) 8399e7d756dSNishanth Menon *r_state = (p_state == MSG_DEVICE_SW_STATE_ON); 8409e7d756dSNishanth Menon if (curr_state) 8419e7d756dSNishanth Menon *curr_state = (c_state == MSG_DEVICE_HW_STATE_ON); 8429e7d756dSNishanth Menon 8439e7d756dSNishanth Menon return 0; 8449e7d756dSNishanth Menon } 8459e7d756dSNishanth Menon 8469e7d756dSNishanth Menon /** 8479e7d756dSNishanth Menon * ti_sci_cmd_dev_is_trans() - Check if the device is currently transitioning 8489e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 8499e7d756dSNishanth Menon * @id: Device Identifier 8509e7d756dSNishanth Menon * @curr_state: true if currently transitioning. 8519e7d756dSNishanth Menon * 8529e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8539e7d756dSNishanth Menon */ 8549e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_trans(const struct ti_sci_handle *handle, u32 id, 8559e7d756dSNishanth Menon bool *curr_state) 8569e7d756dSNishanth Menon { 8579e7d756dSNishanth Menon int ret; 8589e7d756dSNishanth Menon u8 state; 8599e7d756dSNishanth Menon 8609e7d756dSNishanth Menon if (!curr_state) 8619e7d756dSNishanth Menon return -EINVAL; 8629e7d756dSNishanth Menon 8639e7d756dSNishanth Menon ret = ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &state); 8649e7d756dSNishanth Menon if (ret) 8659e7d756dSNishanth Menon return ret; 8669e7d756dSNishanth Menon 8679e7d756dSNishanth Menon *curr_state = (state == MSG_DEVICE_HW_STATE_TRANS); 8689e7d756dSNishanth Menon 8699e7d756dSNishanth Menon return 0; 8709e7d756dSNishanth Menon } 8719e7d756dSNishanth Menon 8729e7d756dSNishanth Menon /** 8739e7d756dSNishanth Menon * ti_sci_cmd_set_device_resets() - command to set resets for device managed 8749e7d756dSNishanth Menon * by TISCI 8759e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 8769e7d756dSNishanth Menon * @id: Device Identifier 8779e7d756dSNishanth Menon * @reset_state: Device specific reset bit field 8789e7d756dSNishanth Menon * 8799e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8809e7d756dSNishanth Menon */ 8819e7d756dSNishanth Menon static int ti_sci_cmd_set_device_resets(const struct ti_sci_handle *handle, 8829e7d756dSNishanth Menon u32 id, u32 reset_state) 8839e7d756dSNishanth Menon { 8849e7d756dSNishanth Menon struct ti_sci_info *info; 8859e7d756dSNishanth Menon struct ti_sci_msg_req_set_device_resets *req; 8869e7d756dSNishanth Menon struct ti_sci_msg_hdr *resp; 8879e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 8889e7d756dSNishanth Menon struct device *dev; 8899e7d756dSNishanth Menon int ret = 0; 8909e7d756dSNishanth Menon 8919e7d756dSNishanth Menon if (IS_ERR(handle)) 8929e7d756dSNishanth Menon return PTR_ERR(handle); 8939e7d756dSNishanth Menon if (!handle) 8949e7d756dSNishanth Menon return -EINVAL; 8959e7d756dSNishanth Menon 8969e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 8979e7d756dSNishanth Menon dev = info->dev; 8989e7d756dSNishanth Menon 8999e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_RESETS, 9009e7d756dSNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 9019e7d756dSNishanth Menon sizeof(*req), sizeof(*resp)); 9029e7d756dSNishanth Menon if (IS_ERR(xfer)) { 9039e7d756dSNishanth Menon ret = PTR_ERR(xfer); 9049e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 9059e7d756dSNishanth Menon return ret; 9069e7d756dSNishanth Menon } 9079e7d756dSNishanth Menon req = (struct ti_sci_msg_req_set_device_resets *)xfer->xfer_buf; 9089e7d756dSNishanth Menon req->id = id; 9099e7d756dSNishanth Menon req->resets = reset_state; 9109e7d756dSNishanth Menon 9119e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 9129e7d756dSNishanth Menon if (ret) { 9139e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 9149e7d756dSNishanth Menon goto fail; 9159e7d756dSNishanth Menon } 9169e7d756dSNishanth Menon 9179e7d756dSNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 9189e7d756dSNishanth Menon 9199e7d756dSNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 9209e7d756dSNishanth Menon 9219e7d756dSNishanth Menon fail: 9229e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 9239e7d756dSNishanth Menon 9249e7d756dSNishanth Menon return ret; 9259e7d756dSNishanth Menon } 9269e7d756dSNishanth Menon 9279e7d756dSNishanth Menon /** 9289e7d756dSNishanth Menon * ti_sci_cmd_get_device_resets() - Get reset state for device managed 9299e7d756dSNishanth Menon * by TISCI 9309e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 9319e7d756dSNishanth Menon * @id: Device Identifier 9329e7d756dSNishanth Menon * @reset_state: Pointer to reset state to populate 9339e7d756dSNishanth Menon * 9349e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 9359e7d756dSNishanth Menon */ 9369e7d756dSNishanth Menon static int ti_sci_cmd_get_device_resets(const struct ti_sci_handle *handle, 9379e7d756dSNishanth Menon u32 id, u32 *reset_state) 9389e7d756dSNishanth Menon { 9399e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, NULL, reset_state, NULL, 9409e7d756dSNishanth Menon NULL); 9419e7d756dSNishanth Menon } 9429e7d756dSNishanth Menon 9439f723220SNishanth Menon /** 9449f723220SNishanth Menon * ti_sci_set_clock_state() - Set clock state helper 9459f723220SNishanth Menon * @handle: pointer to TI SCI handle 9469f723220SNishanth Menon * @dev_id: Device identifier this request is for 9479f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 9489f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 9499f723220SNishanth Menon * which clock input to modify. 9509f723220SNishanth Menon * @flags: Header flags as needed 9519f723220SNishanth Menon * @state: State to request for the clock. 9529f723220SNishanth Menon * 9539f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 9549f723220SNishanth Menon */ 9559f723220SNishanth Menon static int ti_sci_set_clock_state(const struct ti_sci_handle *handle, 95681f4458cSTero Kristo u32 dev_id, u32 clk_id, 9579f723220SNishanth Menon u32 flags, u8 state) 9589f723220SNishanth Menon { 9599f723220SNishanth Menon struct ti_sci_info *info; 9609f723220SNishanth Menon struct ti_sci_msg_req_set_clock_state *req; 9619f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 9629f723220SNishanth Menon struct ti_sci_xfer *xfer; 9639f723220SNishanth Menon struct device *dev; 9649f723220SNishanth Menon int ret = 0; 9659f723220SNishanth Menon 9669f723220SNishanth Menon if (IS_ERR(handle)) 9679f723220SNishanth Menon return PTR_ERR(handle); 9689f723220SNishanth Menon if (!handle) 9699f723220SNishanth Menon return -EINVAL; 9709f723220SNishanth Menon 9719f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 9729f723220SNishanth Menon dev = info->dev; 9739f723220SNishanth Menon 9749f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_STATE, 9759f723220SNishanth Menon flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 9769f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 9779f723220SNishanth Menon if (IS_ERR(xfer)) { 9789f723220SNishanth Menon ret = PTR_ERR(xfer); 9799f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 9809f723220SNishanth Menon return ret; 9819f723220SNishanth Menon } 9829f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_state *)xfer->xfer_buf; 9839f723220SNishanth Menon req->dev_id = dev_id; 98481f4458cSTero Kristo if (clk_id < 255) { 9859f723220SNishanth Menon req->clk_id = clk_id; 98681f4458cSTero Kristo } else { 98781f4458cSTero Kristo req->clk_id = 255; 98881f4458cSTero Kristo req->clk_id_32 = clk_id; 98981f4458cSTero Kristo } 9909f723220SNishanth Menon req->request_state = state; 9919f723220SNishanth Menon 9929f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 9939f723220SNishanth Menon if (ret) { 9949f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 9959f723220SNishanth Menon goto fail; 9969f723220SNishanth Menon } 9979f723220SNishanth Menon 9989f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 9999f723220SNishanth Menon 10009f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 10019f723220SNishanth Menon 10029f723220SNishanth Menon fail: 10039f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 10049f723220SNishanth Menon 10059f723220SNishanth Menon return ret; 10069f723220SNishanth Menon } 10079f723220SNishanth Menon 10089f723220SNishanth Menon /** 10099f723220SNishanth Menon * ti_sci_cmd_get_clock_state() - Get clock state helper 10109f723220SNishanth Menon * @handle: pointer to TI SCI handle 10119f723220SNishanth Menon * @dev_id: Device identifier this request is for 10129f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 10139f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 10149f723220SNishanth Menon * which clock input to modify. 10159f723220SNishanth Menon * @programmed_state: State requested for clock to move to 10169f723220SNishanth Menon * @current_state: State that the clock is currently in 10179f723220SNishanth Menon * 10189f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 10199f723220SNishanth Menon */ 10209f723220SNishanth Menon static int ti_sci_cmd_get_clock_state(const struct ti_sci_handle *handle, 102181f4458cSTero Kristo u32 dev_id, u32 clk_id, 10229f723220SNishanth Menon u8 *programmed_state, u8 *current_state) 10239f723220SNishanth Menon { 10249f723220SNishanth Menon struct ti_sci_info *info; 10259f723220SNishanth Menon struct ti_sci_msg_req_get_clock_state *req; 10269f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_state *resp; 10279f723220SNishanth Menon struct ti_sci_xfer *xfer; 10289f723220SNishanth Menon struct device *dev; 10299f723220SNishanth Menon int ret = 0; 10309f723220SNishanth Menon 10319f723220SNishanth Menon if (IS_ERR(handle)) 10329f723220SNishanth Menon return PTR_ERR(handle); 10339f723220SNishanth Menon if (!handle) 10349f723220SNishanth Menon return -EINVAL; 10359f723220SNishanth Menon 10369f723220SNishanth Menon if (!programmed_state && !current_state) 10379f723220SNishanth Menon return -EINVAL; 10389f723220SNishanth Menon 10399f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 10409f723220SNishanth Menon dev = info->dev; 10419f723220SNishanth Menon 10429f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_STATE, 10439f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 10449f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 10459f723220SNishanth Menon if (IS_ERR(xfer)) { 10469f723220SNishanth Menon ret = PTR_ERR(xfer); 10479f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 10489f723220SNishanth Menon return ret; 10499f723220SNishanth Menon } 10509f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_state *)xfer->xfer_buf; 10519f723220SNishanth Menon req->dev_id = dev_id; 105281f4458cSTero Kristo if (clk_id < 255) { 10539f723220SNishanth Menon req->clk_id = clk_id; 105481f4458cSTero Kristo } else { 105581f4458cSTero Kristo req->clk_id = 255; 105681f4458cSTero Kristo req->clk_id_32 = clk_id; 105781f4458cSTero Kristo } 10589f723220SNishanth Menon 10599f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 10609f723220SNishanth Menon if (ret) { 10619f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 10629f723220SNishanth Menon goto fail; 10639f723220SNishanth Menon } 10649f723220SNishanth Menon 10659f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_state *)xfer->xfer_buf; 10669f723220SNishanth Menon 10679f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) { 10689f723220SNishanth Menon ret = -ENODEV; 10699f723220SNishanth Menon goto fail; 10709f723220SNishanth Menon } 10719f723220SNishanth Menon 10729f723220SNishanth Menon if (programmed_state) 10739f723220SNishanth Menon *programmed_state = resp->programmed_state; 10749f723220SNishanth Menon if (current_state) 10759f723220SNishanth Menon *current_state = resp->current_state; 10769f723220SNishanth Menon 10779f723220SNishanth Menon fail: 10789f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 10799f723220SNishanth Menon 10809f723220SNishanth Menon return ret; 10819f723220SNishanth Menon } 10829f723220SNishanth Menon 10839f723220SNishanth Menon /** 10849f723220SNishanth Menon * ti_sci_cmd_get_clock() - Get control of a clock from TI SCI 10859f723220SNishanth Menon * @handle: pointer to TI SCI handle 10869f723220SNishanth Menon * @dev_id: Device identifier this request is for 10879f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 10889f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 10899f723220SNishanth Menon * which clock input to modify. 10909f723220SNishanth Menon * @needs_ssc: 'true' if Spread Spectrum clock is desired, else 'false' 10919f723220SNishanth Menon * @can_change_freq: 'true' if frequency change is desired, else 'false' 10929f723220SNishanth Menon * @enable_input_term: 'true' if input termination is desired, else 'false' 10939f723220SNishanth Menon * 10949f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 10959f723220SNishanth Menon */ 10969f723220SNishanth Menon static int ti_sci_cmd_get_clock(const struct ti_sci_handle *handle, u32 dev_id, 109781f4458cSTero Kristo u32 clk_id, bool needs_ssc, 109881f4458cSTero Kristo bool can_change_freq, bool enable_input_term) 10999f723220SNishanth Menon { 11009f723220SNishanth Menon u32 flags = 0; 11019f723220SNishanth Menon 11029f723220SNishanth Menon flags |= needs_ssc ? MSG_FLAG_CLOCK_ALLOW_SSC : 0; 11039f723220SNishanth Menon flags |= can_change_freq ? MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE : 0; 11049f723220SNishanth Menon flags |= enable_input_term ? MSG_FLAG_CLOCK_INPUT_TERM : 0; 11059f723220SNishanth Menon 11069f723220SNishanth Menon return ti_sci_set_clock_state(handle, dev_id, clk_id, flags, 11079f723220SNishanth Menon MSG_CLOCK_SW_STATE_REQ); 11089f723220SNishanth Menon } 11099f723220SNishanth Menon 11109f723220SNishanth Menon /** 11119f723220SNishanth Menon * ti_sci_cmd_idle_clock() - Idle a clock which is in our control 11129f723220SNishanth Menon * @handle: pointer to TI SCI handle 11139f723220SNishanth Menon * @dev_id: Device identifier this request is for 11149f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11159f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11169f723220SNishanth Menon * which clock input to modify. 11179f723220SNishanth Menon * 11189f723220SNishanth Menon * NOTE: This clock must have been requested by get_clock previously. 11199f723220SNishanth Menon * 11209f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11219f723220SNishanth Menon */ 11229f723220SNishanth Menon static int ti_sci_cmd_idle_clock(const struct ti_sci_handle *handle, 112381f4458cSTero Kristo u32 dev_id, u32 clk_id) 11249f723220SNishanth Menon { 112571b61082STero Kristo return ti_sci_set_clock_state(handle, dev_id, clk_id, 112671b61082STero Kristo MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE, 11279f723220SNishanth Menon MSG_CLOCK_SW_STATE_UNREQ); 11289f723220SNishanth Menon } 11299f723220SNishanth Menon 11309f723220SNishanth Menon /** 11319f723220SNishanth Menon * ti_sci_cmd_put_clock() - Release a clock from our control back to TISCI 11329f723220SNishanth Menon * @handle: pointer to TI SCI handle 11339f723220SNishanth Menon * @dev_id: Device identifier this request is for 11349f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11359f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11369f723220SNishanth Menon * which clock input to modify. 11379f723220SNishanth Menon * 11389f723220SNishanth Menon * NOTE: This clock must have been requested by get_clock previously. 11399f723220SNishanth Menon * 11409f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11419f723220SNishanth Menon */ 11429f723220SNishanth Menon static int ti_sci_cmd_put_clock(const struct ti_sci_handle *handle, 114381f4458cSTero Kristo u32 dev_id, u32 clk_id) 11449f723220SNishanth Menon { 114571b61082STero Kristo return ti_sci_set_clock_state(handle, dev_id, clk_id, 114671b61082STero Kristo MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE, 11479f723220SNishanth Menon MSG_CLOCK_SW_STATE_AUTO); 11489f723220SNishanth Menon } 11499f723220SNishanth Menon 11509f723220SNishanth Menon /** 11519f723220SNishanth Menon * ti_sci_cmd_clk_is_auto() - Is the clock being auto managed 11529f723220SNishanth Menon * @handle: pointer to TI SCI handle 11539f723220SNishanth Menon * @dev_id: Device identifier this request is for 11549f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11559f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11569f723220SNishanth Menon * which clock input to modify. 11579f723220SNishanth Menon * @req_state: state indicating if the clock is auto managed 11589f723220SNishanth Menon * 11599f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11609f723220SNishanth Menon */ 11619f723220SNishanth Menon static int ti_sci_cmd_clk_is_auto(const struct ti_sci_handle *handle, 116281f4458cSTero Kristo u32 dev_id, u32 clk_id, bool *req_state) 11639f723220SNishanth Menon { 11649f723220SNishanth Menon u8 state = 0; 11659f723220SNishanth Menon int ret; 11669f723220SNishanth Menon 11679f723220SNishanth Menon if (!req_state) 11689f723220SNishanth Menon return -EINVAL; 11699f723220SNishanth Menon 11709f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, &state, NULL); 11719f723220SNishanth Menon if (ret) 11729f723220SNishanth Menon return ret; 11739f723220SNishanth Menon 11749f723220SNishanth Menon *req_state = (state == MSG_CLOCK_SW_STATE_AUTO); 11759f723220SNishanth Menon return 0; 11769f723220SNishanth Menon } 11779f723220SNishanth Menon 11789f723220SNishanth Menon /** 11799f723220SNishanth Menon * ti_sci_cmd_clk_is_on() - Is the clock ON 11809f723220SNishanth Menon * @handle: pointer to TI SCI handle 11819f723220SNishanth Menon * @dev_id: Device identifier this request is for 11829f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11839f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11849f723220SNishanth Menon * which clock input to modify. 11859f723220SNishanth Menon * @req_state: state indicating if the clock is managed by us and enabled 11869f723220SNishanth Menon * @curr_state: state indicating if the clock is ready for operation 11879f723220SNishanth Menon * 11889f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11899f723220SNishanth Menon */ 11909f723220SNishanth Menon static int ti_sci_cmd_clk_is_on(const struct ti_sci_handle *handle, u32 dev_id, 119181f4458cSTero Kristo u32 clk_id, bool *req_state, bool *curr_state) 11929f723220SNishanth Menon { 11939f723220SNishanth Menon u8 c_state = 0, r_state = 0; 11949f723220SNishanth Menon int ret; 11959f723220SNishanth Menon 11969f723220SNishanth Menon if (!req_state && !curr_state) 11979f723220SNishanth Menon return -EINVAL; 11989f723220SNishanth Menon 11999f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, 12009f723220SNishanth Menon &r_state, &c_state); 12019f723220SNishanth Menon if (ret) 12029f723220SNishanth Menon return ret; 12039f723220SNishanth Menon 12049f723220SNishanth Menon if (req_state) 12059f723220SNishanth Menon *req_state = (r_state == MSG_CLOCK_SW_STATE_REQ); 12069f723220SNishanth Menon if (curr_state) 12079f723220SNishanth Menon *curr_state = (c_state == MSG_CLOCK_HW_STATE_READY); 12089f723220SNishanth Menon return 0; 12099f723220SNishanth Menon } 12109f723220SNishanth Menon 12119f723220SNishanth Menon /** 12129f723220SNishanth Menon * ti_sci_cmd_clk_is_off() - Is the clock OFF 12139f723220SNishanth Menon * @handle: pointer to TI SCI handle 12149f723220SNishanth Menon * @dev_id: Device identifier this request is for 12159f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 12169f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 12179f723220SNishanth Menon * which clock input to modify. 12189f723220SNishanth Menon * @req_state: state indicating if the clock is managed by us and disabled 12199f723220SNishanth Menon * @curr_state: state indicating if the clock is NOT ready for operation 12209f723220SNishanth Menon * 12219f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 12229f723220SNishanth Menon */ 12239f723220SNishanth Menon static int ti_sci_cmd_clk_is_off(const struct ti_sci_handle *handle, u32 dev_id, 122481f4458cSTero Kristo u32 clk_id, bool *req_state, bool *curr_state) 12259f723220SNishanth Menon { 12269f723220SNishanth Menon u8 c_state = 0, r_state = 0; 12279f723220SNishanth Menon int ret; 12289f723220SNishanth Menon 12299f723220SNishanth Menon if (!req_state && !curr_state) 12309f723220SNishanth Menon return -EINVAL; 12319f723220SNishanth Menon 12329f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, 12339f723220SNishanth Menon &r_state, &c_state); 12349f723220SNishanth Menon if (ret) 12359f723220SNishanth Menon return ret; 12369f723220SNishanth Menon 12379f723220SNishanth Menon if (req_state) 12389f723220SNishanth Menon *req_state = (r_state == MSG_CLOCK_SW_STATE_UNREQ); 12399f723220SNishanth Menon if (curr_state) 12409f723220SNishanth Menon *curr_state = (c_state == MSG_CLOCK_HW_STATE_NOT_READY); 12419f723220SNishanth Menon return 0; 12429f723220SNishanth Menon } 12439f723220SNishanth Menon 12449f723220SNishanth Menon /** 12459f723220SNishanth Menon * ti_sci_cmd_clk_set_parent() - Set the clock source of a specific device clock 12469f723220SNishanth Menon * @handle: pointer to TI SCI handle 12479f723220SNishanth Menon * @dev_id: Device identifier this request is for 12489f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 12499f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 12509f723220SNishanth Menon * which clock input to modify. 12519f723220SNishanth Menon * @parent_id: Parent clock identifier to set 12529f723220SNishanth Menon * 12539f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 12549f723220SNishanth Menon */ 12559f723220SNishanth Menon static int ti_sci_cmd_clk_set_parent(const struct ti_sci_handle *handle, 125681f4458cSTero Kristo u32 dev_id, u32 clk_id, u32 parent_id) 12579f723220SNishanth Menon { 12589f723220SNishanth Menon struct ti_sci_info *info; 12599f723220SNishanth Menon struct ti_sci_msg_req_set_clock_parent *req; 12609f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 12619f723220SNishanth Menon struct ti_sci_xfer *xfer; 12629f723220SNishanth Menon struct device *dev; 12639f723220SNishanth Menon int ret = 0; 12649f723220SNishanth Menon 12659f723220SNishanth Menon if (IS_ERR(handle)) 12669f723220SNishanth Menon return PTR_ERR(handle); 12679f723220SNishanth Menon if (!handle) 12689f723220SNishanth Menon return -EINVAL; 12699f723220SNishanth Menon 12709f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 12719f723220SNishanth Menon dev = info->dev; 12729f723220SNishanth Menon 12739f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_PARENT, 12749f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 12759f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 12769f723220SNishanth Menon if (IS_ERR(xfer)) { 12779f723220SNishanth Menon ret = PTR_ERR(xfer); 12789f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 12799f723220SNishanth Menon return ret; 12809f723220SNishanth Menon } 12819f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_parent *)xfer->xfer_buf; 12829f723220SNishanth Menon req->dev_id = dev_id; 128381f4458cSTero Kristo if (clk_id < 255) { 12849f723220SNishanth Menon req->clk_id = clk_id; 128581f4458cSTero Kristo } else { 128681f4458cSTero Kristo req->clk_id = 255; 128781f4458cSTero Kristo req->clk_id_32 = clk_id; 128881f4458cSTero Kristo } 128981f4458cSTero Kristo if (parent_id < 255) { 12909f723220SNishanth Menon req->parent_id = parent_id; 129181f4458cSTero Kristo } else { 129281f4458cSTero Kristo req->parent_id = 255; 129381f4458cSTero Kristo req->parent_id_32 = parent_id; 129481f4458cSTero Kristo } 12959f723220SNishanth Menon 12969f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 12979f723220SNishanth Menon if (ret) { 12989f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 12999f723220SNishanth Menon goto fail; 13009f723220SNishanth Menon } 13019f723220SNishanth Menon 13029f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 13039f723220SNishanth Menon 13049f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 13059f723220SNishanth Menon 13069f723220SNishanth Menon fail: 13079f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 13089f723220SNishanth Menon 13099f723220SNishanth Menon return ret; 13109f723220SNishanth Menon } 13119f723220SNishanth Menon 13129f723220SNishanth Menon /** 13139f723220SNishanth Menon * ti_sci_cmd_clk_get_parent() - Get current parent clock source 13149f723220SNishanth Menon * @handle: pointer to TI SCI handle 13159f723220SNishanth Menon * @dev_id: Device identifier this request is for 13169f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 13179f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 13189f723220SNishanth Menon * which clock input to modify. 13199f723220SNishanth Menon * @parent_id: Current clock parent 13209f723220SNishanth Menon * 13219f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 13229f723220SNishanth Menon */ 13239f723220SNishanth Menon static int ti_sci_cmd_clk_get_parent(const struct ti_sci_handle *handle, 132481f4458cSTero Kristo u32 dev_id, u32 clk_id, u32 *parent_id) 13259f723220SNishanth Menon { 13269f723220SNishanth Menon struct ti_sci_info *info; 13279f723220SNishanth Menon struct ti_sci_msg_req_get_clock_parent *req; 13289f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_parent *resp; 13299f723220SNishanth Menon struct ti_sci_xfer *xfer; 13309f723220SNishanth Menon struct device *dev; 13319f723220SNishanth Menon int ret = 0; 13329f723220SNishanth Menon 13339f723220SNishanth Menon if (IS_ERR(handle)) 13349f723220SNishanth Menon return PTR_ERR(handle); 13359f723220SNishanth Menon if (!handle || !parent_id) 13369f723220SNishanth Menon return -EINVAL; 13379f723220SNishanth Menon 13389f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 13399f723220SNishanth Menon dev = info->dev; 13409f723220SNishanth Menon 13419f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_PARENT, 13429f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 13439f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 13449f723220SNishanth Menon if (IS_ERR(xfer)) { 13459f723220SNishanth Menon ret = PTR_ERR(xfer); 13469f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 13479f723220SNishanth Menon return ret; 13489f723220SNishanth Menon } 13499f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_parent *)xfer->xfer_buf; 13509f723220SNishanth Menon req->dev_id = dev_id; 135181f4458cSTero Kristo if (clk_id < 255) { 13529f723220SNishanth Menon req->clk_id = clk_id; 135381f4458cSTero Kristo } else { 135481f4458cSTero Kristo req->clk_id = 255; 135581f4458cSTero Kristo req->clk_id_32 = clk_id; 135681f4458cSTero Kristo } 13579f723220SNishanth Menon 13589f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 13599f723220SNishanth Menon if (ret) { 13609f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 13619f723220SNishanth Menon goto fail; 13629f723220SNishanth Menon } 13639f723220SNishanth Menon 13649f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_parent *)xfer->xfer_buf; 13659f723220SNishanth Menon 136681f4458cSTero Kristo if (!ti_sci_is_response_ack(resp)) { 13679f723220SNishanth Menon ret = -ENODEV; 136881f4458cSTero Kristo } else { 136981f4458cSTero Kristo if (resp->parent_id < 255) 13709f723220SNishanth Menon *parent_id = resp->parent_id; 137181f4458cSTero Kristo else 137281f4458cSTero Kristo *parent_id = resp->parent_id_32; 137381f4458cSTero Kristo } 13749f723220SNishanth Menon 13759f723220SNishanth Menon fail: 13769f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 13779f723220SNishanth Menon 13789f723220SNishanth Menon return ret; 13799f723220SNishanth Menon } 13809f723220SNishanth Menon 13819f723220SNishanth Menon /** 13829f723220SNishanth Menon * ti_sci_cmd_clk_get_num_parents() - Get num parents of the current clk source 13839f723220SNishanth Menon * @handle: pointer to TI SCI handle 13849f723220SNishanth Menon * @dev_id: Device identifier this request is for 13859f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 13869f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 13879f723220SNishanth Menon * which clock input to modify. 13889f723220SNishanth Menon * @num_parents: Returns he number of parents to the current clock. 13899f723220SNishanth Menon * 13909f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 13919f723220SNishanth Menon */ 13929f723220SNishanth Menon static int ti_sci_cmd_clk_get_num_parents(const struct ti_sci_handle *handle, 139381f4458cSTero Kristo u32 dev_id, u32 clk_id, 139481f4458cSTero Kristo u32 *num_parents) 13959f723220SNishanth Menon { 13969f723220SNishanth Menon struct ti_sci_info *info; 13979f723220SNishanth Menon struct ti_sci_msg_req_get_clock_num_parents *req; 13989f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_num_parents *resp; 13999f723220SNishanth Menon struct ti_sci_xfer *xfer; 14009f723220SNishanth Menon struct device *dev; 14019f723220SNishanth Menon int ret = 0; 14029f723220SNishanth Menon 14039f723220SNishanth Menon if (IS_ERR(handle)) 14049f723220SNishanth Menon return PTR_ERR(handle); 14059f723220SNishanth Menon if (!handle || !num_parents) 14069f723220SNishanth Menon return -EINVAL; 14079f723220SNishanth Menon 14089f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 14099f723220SNishanth Menon dev = info->dev; 14109f723220SNishanth Menon 14119f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_NUM_CLOCK_PARENTS, 14129f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 14139f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 14149f723220SNishanth Menon if (IS_ERR(xfer)) { 14159f723220SNishanth Menon ret = PTR_ERR(xfer); 14169f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 14179f723220SNishanth Menon return ret; 14189f723220SNishanth Menon } 14199f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_num_parents *)xfer->xfer_buf; 14209f723220SNishanth Menon req->dev_id = dev_id; 142181f4458cSTero Kristo if (clk_id < 255) { 14229f723220SNishanth Menon req->clk_id = clk_id; 142381f4458cSTero Kristo } else { 142481f4458cSTero Kristo req->clk_id = 255; 142581f4458cSTero Kristo req->clk_id_32 = clk_id; 142681f4458cSTero Kristo } 14279f723220SNishanth Menon 14289f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 14299f723220SNishanth Menon if (ret) { 14309f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 14319f723220SNishanth Menon goto fail; 14329f723220SNishanth Menon } 14339f723220SNishanth Menon 14349f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_num_parents *)xfer->xfer_buf; 14359f723220SNishanth Menon 143681f4458cSTero Kristo if (!ti_sci_is_response_ack(resp)) { 14379f723220SNishanth Menon ret = -ENODEV; 143881f4458cSTero Kristo } else { 143981f4458cSTero Kristo if (resp->num_parents < 255) 14409f723220SNishanth Menon *num_parents = resp->num_parents; 144181f4458cSTero Kristo else 144281f4458cSTero Kristo *num_parents = resp->num_parents_32; 144381f4458cSTero Kristo } 14449f723220SNishanth Menon 14459f723220SNishanth Menon fail: 14469f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 14479f723220SNishanth Menon 14489f723220SNishanth Menon return ret; 14499f723220SNishanth Menon } 14509f723220SNishanth Menon 14519f723220SNishanth Menon /** 14529f723220SNishanth Menon * ti_sci_cmd_clk_get_match_freq() - Find a good match for frequency 14539f723220SNishanth Menon * @handle: pointer to TI SCI handle 14549f723220SNishanth Menon * @dev_id: Device identifier this request is for 14559f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 14569f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 14579f723220SNishanth Menon * which clock input to modify. 14589f723220SNishanth Menon * @min_freq: The minimum allowable frequency in Hz. This is the minimum 14599f723220SNishanth Menon * allowable programmed frequency and does not account for clock 14609f723220SNishanth Menon * tolerances and jitter. 14619f723220SNishanth Menon * @target_freq: The target clock frequency in Hz. A frequency will be 14629f723220SNishanth Menon * processed as close to this target frequency as possible. 14639f723220SNishanth Menon * @max_freq: The maximum allowable frequency in Hz. This is the maximum 14649f723220SNishanth Menon * allowable programmed frequency and does not account for clock 14659f723220SNishanth Menon * tolerances and jitter. 14669f723220SNishanth Menon * @match_freq: Frequency match in Hz response. 14679f723220SNishanth Menon * 14689f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 14699f723220SNishanth Menon */ 14709f723220SNishanth Menon static int ti_sci_cmd_clk_get_match_freq(const struct ti_sci_handle *handle, 147181f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 min_freq, 14729f723220SNishanth Menon u64 target_freq, u64 max_freq, 14739f723220SNishanth Menon u64 *match_freq) 14749f723220SNishanth Menon { 14759f723220SNishanth Menon struct ti_sci_info *info; 14769f723220SNishanth Menon struct ti_sci_msg_req_query_clock_freq *req; 14779f723220SNishanth Menon struct ti_sci_msg_resp_query_clock_freq *resp; 14789f723220SNishanth Menon struct ti_sci_xfer *xfer; 14799f723220SNishanth Menon struct device *dev; 14809f723220SNishanth Menon int ret = 0; 14819f723220SNishanth Menon 14829f723220SNishanth Menon if (IS_ERR(handle)) 14839f723220SNishanth Menon return PTR_ERR(handle); 14849f723220SNishanth Menon if (!handle || !match_freq) 14859f723220SNishanth Menon return -EINVAL; 14869f723220SNishanth Menon 14879f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 14889f723220SNishanth Menon dev = info->dev; 14899f723220SNishanth Menon 14909f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_QUERY_CLOCK_FREQ, 14919f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 14929f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 14939f723220SNishanth Menon if (IS_ERR(xfer)) { 14949f723220SNishanth Menon ret = PTR_ERR(xfer); 14959f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 14969f723220SNishanth Menon return ret; 14979f723220SNishanth Menon } 14989f723220SNishanth Menon req = (struct ti_sci_msg_req_query_clock_freq *)xfer->xfer_buf; 14999f723220SNishanth Menon req->dev_id = dev_id; 150081f4458cSTero Kristo if (clk_id < 255) { 15019f723220SNishanth Menon req->clk_id = clk_id; 150281f4458cSTero Kristo } else { 150381f4458cSTero Kristo req->clk_id = 255; 150481f4458cSTero Kristo req->clk_id_32 = clk_id; 150581f4458cSTero Kristo } 15069f723220SNishanth Menon req->min_freq_hz = min_freq; 15079f723220SNishanth Menon req->target_freq_hz = target_freq; 15089f723220SNishanth Menon req->max_freq_hz = max_freq; 15099f723220SNishanth Menon 15109f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 15119f723220SNishanth Menon if (ret) { 15129f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 15139f723220SNishanth Menon goto fail; 15149f723220SNishanth Menon } 15159f723220SNishanth Menon 15169f723220SNishanth Menon resp = (struct ti_sci_msg_resp_query_clock_freq *)xfer->xfer_buf; 15179f723220SNishanth Menon 15189f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) 15199f723220SNishanth Menon ret = -ENODEV; 15209f723220SNishanth Menon else 15219f723220SNishanth Menon *match_freq = resp->freq_hz; 15229f723220SNishanth Menon 15239f723220SNishanth Menon fail: 15249f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 15259f723220SNishanth Menon 15269f723220SNishanth Menon return ret; 15279f723220SNishanth Menon } 15289f723220SNishanth Menon 15299f723220SNishanth Menon /** 15309f723220SNishanth Menon * ti_sci_cmd_clk_set_freq() - Set a frequency for clock 15319f723220SNishanth Menon * @handle: pointer to TI SCI handle 15329f723220SNishanth Menon * @dev_id: Device identifier this request is for 15339f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 15349f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 15359f723220SNishanth Menon * which clock input to modify. 15369f723220SNishanth Menon * @min_freq: The minimum allowable frequency in Hz. This is the minimum 15379f723220SNishanth Menon * allowable programmed frequency and does not account for clock 15389f723220SNishanth Menon * tolerances and jitter. 15399f723220SNishanth Menon * @target_freq: The target clock frequency in Hz. A frequency will be 15409f723220SNishanth Menon * processed as close to this target frequency as possible. 15419f723220SNishanth Menon * @max_freq: The maximum allowable frequency in Hz. This is the maximum 15429f723220SNishanth Menon * allowable programmed frequency and does not account for clock 15439f723220SNishanth Menon * tolerances and jitter. 15449f723220SNishanth Menon * 15459f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 15469f723220SNishanth Menon */ 15479f723220SNishanth Menon static int ti_sci_cmd_clk_set_freq(const struct ti_sci_handle *handle, 154881f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 min_freq, 15499f723220SNishanth Menon u64 target_freq, u64 max_freq) 15509f723220SNishanth Menon { 15519f723220SNishanth Menon struct ti_sci_info *info; 15529f723220SNishanth Menon struct ti_sci_msg_req_set_clock_freq *req; 15539f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 15549f723220SNishanth Menon struct ti_sci_xfer *xfer; 15559f723220SNishanth Menon struct device *dev; 15569f723220SNishanth Menon int ret = 0; 15579f723220SNishanth Menon 15589f723220SNishanth Menon if (IS_ERR(handle)) 15599f723220SNishanth Menon return PTR_ERR(handle); 15609f723220SNishanth Menon if (!handle) 15619f723220SNishanth Menon return -EINVAL; 15629f723220SNishanth Menon 15639f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 15649f723220SNishanth Menon dev = info->dev; 15659f723220SNishanth Menon 15669f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_FREQ, 15679f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 15689f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 15699f723220SNishanth Menon if (IS_ERR(xfer)) { 15709f723220SNishanth Menon ret = PTR_ERR(xfer); 15719f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 15729f723220SNishanth Menon return ret; 15739f723220SNishanth Menon } 15749f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_freq *)xfer->xfer_buf; 15759f723220SNishanth Menon req->dev_id = dev_id; 157681f4458cSTero Kristo if (clk_id < 255) { 15779f723220SNishanth Menon req->clk_id = clk_id; 157881f4458cSTero Kristo } else { 157981f4458cSTero Kristo req->clk_id = 255; 158081f4458cSTero Kristo req->clk_id_32 = clk_id; 158181f4458cSTero Kristo } 15829f723220SNishanth Menon req->min_freq_hz = min_freq; 15839f723220SNishanth Menon req->target_freq_hz = target_freq; 15849f723220SNishanth Menon req->max_freq_hz = max_freq; 15859f723220SNishanth Menon 15869f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 15879f723220SNishanth Menon if (ret) { 15889f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 15899f723220SNishanth Menon goto fail; 15909f723220SNishanth Menon } 15919f723220SNishanth Menon 15929f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 15939f723220SNishanth Menon 15949f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 15959f723220SNishanth Menon 15969f723220SNishanth Menon fail: 15979f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 15989f723220SNishanth Menon 15999f723220SNishanth Menon return ret; 16009f723220SNishanth Menon } 16019f723220SNishanth Menon 16029f723220SNishanth Menon /** 16039f723220SNishanth Menon * ti_sci_cmd_clk_get_freq() - Get current frequency 16049f723220SNishanth Menon * @handle: pointer to TI SCI handle 16059f723220SNishanth Menon * @dev_id: Device identifier this request is for 16069f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 16079f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 16089f723220SNishanth Menon * which clock input to modify. 16099f723220SNishanth Menon * @freq: Currently frequency in Hz 16109f723220SNishanth Menon * 16119f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 16129f723220SNishanth Menon */ 16139f723220SNishanth Menon static int ti_sci_cmd_clk_get_freq(const struct ti_sci_handle *handle, 161481f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 *freq) 16159f723220SNishanth Menon { 16169f723220SNishanth Menon struct ti_sci_info *info; 16179f723220SNishanth Menon struct ti_sci_msg_req_get_clock_freq *req; 16189f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_freq *resp; 16199f723220SNishanth Menon struct ti_sci_xfer *xfer; 16209f723220SNishanth Menon struct device *dev; 16219f723220SNishanth Menon int ret = 0; 16229f723220SNishanth Menon 16239f723220SNishanth Menon if (IS_ERR(handle)) 16249f723220SNishanth Menon return PTR_ERR(handle); 16259f723220SNishanth Menon if (!handle || !freq) 16269f723220SNishanth Menon return -EINVAL; 16279f723220SNishanth Menon 16289f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 16299f723220SNishanth Menon dev = info->dev; 16309f723220SNishanth Menon 16319f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_FREQ, 16329f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 16339f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 16349f723220SNishanth Menon if (IS_ERR(xfer)) { 16359f723220SNishanth Menon ret = PTR_ERR(xfer); 16369f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 16379f723220SNishanth Menon return ret; 16389f723220SNishanth Menon } 16399f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_freq *)xfer->xfer_buf; 16409f723220SNishanth Menon req->dev_id = dev_id; 164181f4458cSTero Kristo if (clk_id < 255) { 16429f723220SNishanth Menon req->clk_id = clk_id; 164381f4458cSTero Kristo } else { 164481f4458cSTero Kristo req->clk_id = 255; 164581f4458cSTero Kristo req->clk_id_32 = clk_id; 164681f4458cSTero Kristo } 16479f723220SNishanth Menon 16489f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 16499f723220SNishanth Menon if (ret) { 16509f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 16519f723220SNishanth Menon goto fail; 16529f723220SNishanth Menon } 16539f723220SNishanth Menon 16549f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_freq *)xfer->xfer_buf; 16559f723220SNishanth Menon 16569f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) 16579f723220SNishanth Menon ret = -ENODEV; 16589f723220SNishanth Menon else 16599f723220SNishanth Menon *freq = resp->freq_hz; 16609f723220SNishanth Menon 16619f723220SNishanth Menon fail: 16629f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 16639f723220SNishanth Menon 16649f723220SNishanth Menon return ret; 16659f723220SNishanth Menon } 16669f723220SNishanth Menon 1667912cffb4SNishanth Menon static int ti_sci_cmd_core_reboot(const struct ti_sci_handle *handle) 1668912cffb4SNishanth Menon { 1669912cffb4SNishanth Menon struct ti_sci_info *info; 1670912cffb4SNishanth Menon struct ti_sci_msg_req_reboot *req; 1671912cffb4SNishanth Menon struct ti_sci_msg_hdr *resp; 1672912cffb4SNishanth Menon struct ti_sci_xfer *xfer; 1673912cffb4SNishanth Menon struct device *dev; 1674912cffb4SNishanth Menon int ret = 0; 1675912cffb4SNishanth Menon 1676912cffb4SNishanth Menon if (IS_ERR(handle)) 1677912cffb4SNishanth Menon return PTR_ERR(handle); 1678912cffb4SNishanth Menon if (!handle) 1679912cffb4SNishanth Menon return -EINVAL; 1680912cffb4SNishanth Menon 1681912cffb4SNishanth Menon info = handle_to_ti_sci_info(handle); 1682912cffb4SNishanth Menon dev = info->dev; 1683912cffb4SNishanth Menon 1684912cffb4SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SYS_RESET, 1685912cffb4SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 1686912cffb4SNishanth Menon sizeof(*req), sizeof(*resp)); 1687912cffb4SNishanth Menon if (IS_ERR(xfer)) { 1688912cffb4SNishanth Menon ret = PTR_ERR(xfer); 1689912cffb4SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 1690912cffb4SNishanth Menon return ret; 1691912cffb4SNishanth Menon } 1692912cffb4SNishanth Menon req = (struct ti_sci_msg_req_reboot *)xfer->xfer_buf; 1693912cffb4SNishanth Menon 1694912cffb4SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 1695912cffb4SNishanth Menon if (ret) { 1696912cffb4SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 1697912cffb4SNishanth Menon goto fail; 1698912cffb4SNishanth Menon } 1699912cffb4SNishanth Menon 1700912cffb4SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 1701912cffb4SNishanth Menon 1702912cffb4SNishanth Menon if (!ti_sci_is_response_ack(resp)) 1703912cffb4SNishanth Menon ret = -ENODEV; 1704912cffb4SNishanth Menon else 1705912cffb4SNishanth Menon ret = 0; 1706912cffb4SNishanth Menon 1707912cffb4SNishanth Menon fail: 1708912cffb4SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 1709912cffb4SNishanth Menon 1710912cffb4SNishanth Menon return ret; 1711912cffb4SNishanth Menon } 1712912cffb4SNishanth Menon 17139c19fb68SLokesh Vutla /** 17149c19fb68SLokesh Vutla * ti_sci_get_resource_range - Helper to get a range of resources assigned 17159c19fb68SLokesh Vutla * to a host. Resource is uniquely identified by 17169c19fb68SLokesh Vutla * type and subtype. 17179c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 17189c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 17199c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 17209c19fb68SLokesh Vutla * from the given device. 17219c19fb68SLokesh Vutla * @s_host: Host processor ID to which the resources are allocated 1722967a020bSPeter Ujfalusi * @desc: Pointer to ti_sci_resource_desc to be updated with the 1723967a020bSPeter Ujfalusi * resource range start index and number of resources 17249c19fb68SLokesh Vutla * 17259c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 17269c19fb68SLokesh Vutla */ 17279c19fb68SLokesh Vutla static int ti_sci_get_resource_range(const struct ti_sci_handle *handle, 17289c19fb68SLokesh Vutla u32 dev_id, u8 subtype, u8 s_host, 1729967a020bSPeter Ujfalusi struct ti_sci_resource_desc *desc) 17309c19fb68SLokesh Vutla { 17319c19fb68SLokesh Vutla struct ti_sci_msg_resp_get_resource_range *resp; 17329c19fb68SLokesh Vutla struct ti_sci_msg_req_get_resource_range *req; 17339c19fb68SLokesh Vutla struct ti_sci_xfer *xfer; 17349c19fb68SLokesh Vutla struct ti_sci_info *info; 17359c19fb68SLokesh Vutla struct device *dev; 17369c19fb68SLokesh Vutla int ret = 0; 17379c19fb68SLokesh Vutla 17389c19fb68SLokesh Vutla if (IS_ERR(handle)) 17399c19fb68SLokesh Vutla return PTR_ERR(handle); 1740967a020bSPeter Ujfalusi if (!handle || !desc) 17419c19fb68SLokesh Vutla return -EINVAL; 17429c19fb68SLokesh Vutla 17439c19fb68SLokesh Vutla info = handle_to_ti_sci_info(handle); 17449c19fb68SLokesh Vutla dev = info->dev; 17459c19fb68SLokesh Vutla 17469c19fb68SLokesh Vutla xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_RESOURCE_RANGE, 17479c19fb68SLokesh Vutla TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 17489c19fb68SLokesh Vutla sizeof(*req), sizeof(*resp)); 17499c19fb68SLokesh Vutla if (IS_ERR(xfer)) { 17509c19fb68SLokesh Vutla ret = PTR_ERR(xfer); 17519c19fb68SLokesh Vutla dev_err(dev, "Message alloc failed(%d)\n", ret); 17529c19fb68SLokesh Vutla return ret; 17539c19fb68SLokesh Vutla } 17549c19fb68SLokesh Vutla 17559c19fb68SLokesh Vutla req = (struct ti_sci_msg_req_get_resource_range *)xfer->xfer_buf; 17569c19fb68SLokesh Vutla req->secondary_host = s_host; 17579b98e02aSLokesh Vutla req->type = dev_id & MSG_RM_RESOURCE_TYPE_MASK; 17589c19fb68SLokesh Vutla req->subtype = subtype & MSG_RM_RESOURCE_SUBTYPE_MASK; 17599c19fb68SLokesh Vutla 17609c19fb68SLokesh Vutla ret = ti_sci_do_xfer(info, xfer); 17619c19fb68SLokesh Vutla if (ret) { 17629c19fb68SLokesh Vutla dev_err(dev, "Mbox send fail %d\n", ret); 17639c19fb68SLokesh Vutla goto fail; 17649c19fb68SLokesh Vutla } 17659c19fb68SLokesh Vutla 17669c19fb68SLokesh Vutla resp = (struct ti_sci_msg_resp_get_resource_range *)xfer->xfer_buf; 17679c19fb68SLokesh Vutla 17689c19fb68SLokesh Vutla if (!ti_sci_is_response_ack(resp)) { 17699c19fb68SLokesh Vutla ret = -ENODEV; 1770519c5c0cSPeter Ujfalusi } else if (!resp->range_num && !resp->range_num_sec) { 1771519c5c0cSPeter Ujfalusi /* Neither of the two resource range is valid */ 17729c19fb68SLokesh Vutla ret = -ENODEV; 17739c19fb68SLokesh Vutla } else { 1774967a020bSPeter Ujfalusi desc->start = resp->range_start; 1775967a020bSPeter Ujfalusi desc->num = resp->range_num; 1776519c5c0cSPeter Ujfalusi desc->start_sec = resp->range_start_sec; 1777519c5c0cSPeter Ujfalusi desc->num_sec = resp->range_num_sec; 17787c1c1d36SJason Wang } 17799c19fb68SLokesh Vutla 17809c19fb68SLokesh Vutla fail: 17819c19fb68SLokesh Vutla ti_sci_put_one_xfer(&info->minfo, xfer); 17829c19fb68SLokesh Vutla 17839c19fb68SLokesh Vutla return ret; 17849c19fb68SLokesh Vutla } 17859c19fb68SLokesh Vutla 17869c19fb68SLokesh Vutla /** 17879c19fb68SLokesh Vutla * ti_sci_cmd_get_resource_range - Get a range of resources assigned to host 17889c19fb68SLokesh Vutla * that is same as ti sci interface host. 17899c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 17909c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 17919c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 17929c19fb68SLokesh Vutla * from the given device. 1793967a020bSPeter Ujfalusi * @desc: Pointer to ti_sci_resource_desc to be updated with the 1794967a020bSPeter Ujfalusi * resource range start index and number of resources 17959c19fb68SLokesh Vutla * 17969c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 17979c19fb68SLokesh Vutla */ 17989c19fb68SLokesh Vutla static int ti_sci_cmd_get_resource_range(const struct ti_sci_handle *handle, 17999c19fb68SLokesh Vutla u32 dev_id, u8 subtype, 1800967a020bSPeter Ujfalusi struct ti_sci_resource_desc *desc) 18019c19fb68SLokesh Vutla { 18029c19fb68SLokesh Vutla return ti_sci_get_resource_range(handle, dev_id, subtype, 18039c19fb68SLokesh Vutla TI_SCI_IRQ_SECONDARY_HOST_INVALID, 1804967a020bSPeter Ujfalusi desc); 18059c19fb68SLokesh Vutla } 18069c19fb68SLokesh Vutla 18079c19fb68SLokesh Vutla /** 18089c19fb68SLokesh Vutla * ti_sci_cmd_get_resource_range_from_shost - Get a range of resources 18099c19fb68SLokesh Vutla * assigned to a specified host. 18109c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 18119c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 18129c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 18139c19fb68SLokesh Vutla * from the given device. 18149c19fb68SLokesh Vutla * @s_host: Host processor ID to which the resources are allocated 1815967a020bSPeter Ujfalusi * @desc: Pointer to ti_sci_resource_desc to be updated with the 1816967a020bSPeter Ujfalusi * resource range start index and number of resources 18179c19fb68SLokesh Vutla * 18189c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 18199c19fb68SLokesh Vutla */ 18209c19fb68SLokesh Vutla static 18219c19fb68SLokesh Vutla int ti_sci_cmd_get_resource_range_from_shost(const struct ti_sci_handle *handle, 18229c19fb68SLokesh Vutla u32 dev_id, u8 subtype, u8 s_host, 1823967a020bSPeter Ujfalusi struct ti_sci_resource_desc *desc) 18249c19fb68SLokesh Vutla { 1825967a020bSPeter Ujfalusi return ti_sci_get_resource_range(handle, dev_id, subtype, s_host, desc); 18269c19fb68SLokesh Vutla } 18279c19fb68SLokesh Vutla 1828997b001fSLokesh Vutla /** 1829997b001fSLokesh Vutla * ti_sci_manage_irq() - Helper api to configure/release the irq route between 1830997b001fSLokesh Vutla * the requested source and destination 1831997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1832997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1833997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1834997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1835997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1836997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1837997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1838997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1839997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1840997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1841997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1842997b001fSLokesh Vutla * requested for. 1843997b001fSLokesh Vutla * @type: Request type irq set or release. 1844997b001fSLokesh Vutla * 1845997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1846997b001fSLokesh Vutla */ 1847997b001fSLokesh Vutla static int ti_sci_manage_irq(const struct ti_sci_handle *handle, 1848997b001fSLokesh Vutla u32 valid_params, u16 src_id, u16 src_index, 1849997b001fSLokesh Vutla u16 dst_id, u16 dst_host_irq, u16 ia_id, u16 vint, 1850997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host, 1851997b001fSLokesh Vutla u16 type) 1852997b001fSLokesh Vutla { 1853997b001fSLokesh Vutla struct ti_sci_msg_req_manage_irq *req; 1854997b001fSLokesh Vutla struct ti_sci_msg_hdr *resp; 1855997b001fSLokesh Vutla struct ti_sci_xfer *xfer; 1856997b001fSLokesh Vutla struct ti_sci_info *info; 1857997b001fSLokesh Vutla struct device *dev; 1858997b001fSLokesh Vutla int ret = 0; 1859997b001fSLokesh Vutla 1860997b001fSLokesh Vutla if (IS_ERR(handle)) 1861997b001fSLokesh Vutla return PTR_ERR(handle); 1862997b001fSLokesh Vutla if (!handle) 1863997b001fSLokesh Vutla return -EINVAL; 1864997b001fSLokesh Vutla 1865997b001fSLokesh Vutla info = handle_to_ti_sci_info(handle); 1866997b001fSLokesh Vutla dev = info->dev; 1867997b001fSLokesh Vutla 1868997b001fSLokesh Vutla xfer = ti_sci_get_one_xfer(info, type, TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 1869997b001fSLokesh Vutla sizeof(*req), sizeof(*resp)); 1870997b001fSLokesh Vutla if (IS_ERR(xfer)) { 1871997b001fSLokesh Vutla ret = PTR_ERR(xfer); 1872997b001fSLokesh Vutla dev_err(dev, "Message alloc failed(%d)\n", ret); 1873997b001fSLokesh Vutla return ret; 1874997b001fSLokesh Vutla } 1875997b001fSLokesh Vutla req = (struct ti_sci_msg_req_manage_irq *)xfer->xfer_buf; 1876997b001fSLokesh Vutla req->valid_params = valid_params; 1877997b001fSLokesh Vutla req->src_id = src_id; 1878997b001fSLokesh Vutla req->src_index = src_index; 1879997b001fSLokesh Vutla req->dst_id = dst_id; 1880997b001fSLokesh Vutla req->dst_host_irq = dst_host_irq; 1881997b001fSLokesh Vutla req->ia_id = ia_id; 1882997b001fSLokesh Vutla req->vint = vint; 1883997b001fSLokesh Vutla req->global_event = global_event; 1884997b001fSLokesh Vutla req->vint_status_bit = vint_status_bit; 1885997b001fSLokesh Vutla req->secondary_host = s_host; 1886997b001fSLokesh Vutla 1887997b001fSLokesh Vutla ret = ti_sci_do_xfer(info, xfer); 1888997b001fSLokesh Vutla if (ret) { 1889997b001fSLokesh Vutla dev_err(dev, "Mbox send fail %d\n", ret); 1890997b001fSLokesh Vutla goto fail; 1891997b001fSLokesh Vutla } 1892997b001fSLokesh Vutla 1893997b001fSLokesh Vutla resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 1894997b001fSLokesh Vutla 1895997b001fSLokesh Vutla ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 1896997b001fSLokesh Vutla 1897997b001fSLokesh Vutla fail: 1898997b001fSLokesh Vutla ti_sci_put_one_xfer(&info->minfo, xfer); 1899997b001fSLokesh Vutla 1900997b001fSLokesh Vutla return ret; 1901997b001fSLokesh Vutla } 1902997b001fSLokesh Vutla 1903997b001fSLokesh Vutla /** 1904997b001fSLokesh Vutla * ti_sci_set_irq() - Helper api to configure the irq route between the 1905997b001fSLokesh Vutla * requested source and destination 1906997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1907997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1908997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1909997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1910997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1911997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1912997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1913997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1914997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1915997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1916997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1917997b001fSLokesh Vutla * requested for. 1918997b001fSLokesh Vutla * 1919997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1920997b001fSLokesh Vutla */ 1921997b001fSLokesh Vutla static int ti_sci_set_irq(const struct ti_sci_handle *handle, u32 valid_params, 1922997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 dst_id, 1923997b001fSLokesh Vutla u16 dst_host_irq, u16 ia_id, u16 vint, 1924997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host) 1925997b001fSLokesh Vutla { 1926997b001fSLokesh Vutla pr_debug("%s: IRQ set with valid_params = 0x%x from src = %d, index = %d, to dst = %d, irq = %d,via ia_id = %d, vint = %d, global event = %d,status_bit = %d\n", 1927997b001fSLokesh Vutla __func__, valid_params, src_id, src_index, 1928997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, global_event, 1929997b001fSLokesh Vutla vint_status_bit); 1930997b001fSLokesh Vutla 1931997b001fSLokesh Vutla return ti_sci_manage_irq(handle, valid_params, src_id, src_index, 1932997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, 1933997b001fSLokesh Vutla global_event, vint_status_bit, s_host, 1934997b001fSLokesh Vutla TI_SCI_MSG_SET_IRQ); 1935997b001fSLokesh Vutla } 1936997b001fSLokesh Vutla 1937997b001fSLokesh Vutla /** 1938997b001fSLokesh Vutla * ti_sci_free_irq() - Helper api to free the irq route between the 1939997b001fSLokesh Vutla * requested source and destination 1940997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1941997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1942997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1943997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1944997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1945997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1946997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1947997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1948997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1949997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1950997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1951997b001fSLokesh Vutla * requested for. 1952997b001fSLokesh Vutla * 1953997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1954997b001fSLokesh Vutla */ 1955997b001fSLokesh Vutla static int ti_sci_free_irq(const struct ti_sci_handle *handle, u32 valid_params, 1956997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 dst_id, 1957997b001fSLokesh Vutla u16 dst_host_irq, u16 ia_id, u16 vint, 1958997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host) 1959997b001fSLokesh Vutla { 1960997b001fSLokesh Vutla pr_debug("%s: IRQ release with valid_params = 0x%x from src = %d, index = %d, to dst = %d, irq = %d,via ia_id = %d, vint = %d, global event = %d,status_bit = %d\n", 1961997b001fSLokesh Vutla __func__, valid_params, src_id, src_index, 1962997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, global_event, 1963997b001fSLokesh Vutla vint_status_bit); 1964997b001fSLokesh Vutla 1965997b001fSLokesh Vutla return ti_sci_manage_irq(handle, valid_params, src_id, src_index, 1966997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, 1967997b001fSLokesh Vutla global_event, vint_status_bit, s_host, 1968997b001fSLokesh Vutla TI_SCI_MSG_FREE_IRQ); 1969997b001fSLokesh Vutla } 1970997b001fSLokesh Vutla 1971997b001fSLokesh Vutla /** 1972997b001fSLokesh Vutla * ti_sci_cmd_set_irq() - Configure a host irq route between the requested 1973997b001fSLokesh Vutla * source and destination. 1974997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1975997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1976997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1977997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1978997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1979997b001fSLokesh Vutla * 1980997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1981997b001fSLokesh Vutla */ 1982997b001fSLokesh Vutla static int ti_sci_cmd_set_irq(const struct ti_sci_handle *handle, u16 src_id, 1983997b001fSLokesh Vutla u16 src_index, u16 dst_id, u16 dst_host_irq) 1984997b001fSLokesh Vutla { 1985997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID; 1986997b001fSLokesh Vutla 1987997b001fSLokesh Vutla return ti_sci_set_irq(handle, valid_params, src_id, src_index, dst_id, 1988997b001fSLokesh Vutla dst_host_irq, 0, 0, 0, 0, 0); 1989997b001fSLokesh Vutla } 1990997b001fSLokesh Vutla 1991997b001fSLokesh Vutla /** 1992997b001fSLokesh Vutla * ti_sci_cmd_set_event_map() - Configure an event based irq route between the 1993997b001fSLokesh Vutla * requested source and Interrupt Aggregator. 1994997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1995997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1996997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1997997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1998997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1999997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 2000997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 2001997b001fSLokesh Vutla * 2002997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2003997b001fSLokesh Vutla */ 2004997b001fSLokesh Vutla static int ti_sci_cmd_set_event_map(const struct ti_sci_handle *handle, 2005997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 ia_id, 2006997b001fSLokesh Vutla u16 vint, u16 global_event, 2007997b001fSLokesh Vutla u8 vint_status_bit) 2008997b001fSLokesh Vutla { 2009997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_IA_ID_VALID | MSG_FLAG_VINT_VALID | 2010997b001fSLokesh Vutla MSG_FLAG_GLB_EVNT_VALID | 2011997b001fSLokesh Vutla MSG_FLAG_VINT_STS_BIT_VALID; 2012997b001fSLokesh Vutla 2013997b001fSLokesh Vutla return ti_sci_set_irq(handle, valid_params, src_id, src_index, 0, 0, 2014997b001fSLokesh Vutla ia_id, vint, global_event, vint_status_bit, 0); 2015997b001fSLokesh Vutla } 2016997b001fSLokesh Vutla 2017997b001fSLokesh Vutla /** 2018997b001fSLokesh Vutla * ti_sci_cmd_free_irq() - Free a host irq route between the between the 2019997b001fSLokesh Vutla * requested source and destination. 2020997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 2021997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 2022997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 2023997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 2024997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 2025997b001fSLokesh Vutla * 2026997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2027997b001fSLokesh Vutla */ 2028997b001fSLokesh Vutla static int ti_sci_cmd_free_irq(const struct ti_sci_handle *handle, u16 src_id, 2029997b001fSLokesh Vutla u16 src_index, u16 dst_id, u16 dst_host_irq) 2030997b001fSLokesh Vutla { 2031997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID; 2032997b001fSLokesh Vutla 2033997b001fSLokesh Vutla return ti_sci_free_irq(handle, valid_params, src_id, src_index, dst_id, 2034997b001fSLokesh Vutla dst_host_irq, 0, 0, 0, 0, 0); 2035997b001fSLokesh Vutla } 2036997b001fSLokesh Vutla 2037997b001fSLokesh Vutla /** 2038997b001fSLokesh Vutla * ti_sci_cmd_free_event_map() - Free an event map between the requested source 2039997b001fSLokesh Vutla * and Interrupt Aggregator. 2040997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 2041997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 2042997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 2043997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 2044997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 2045997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 2046997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 2047997b001fSLokesh Vutla * 2048997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2049997b001fSLokesh Vutla */ 2050997b001fSLokesh Vutla static int ti_sci_cmd_free_event_map(const struct ti_sci_handle *handle, 2051997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 ia_id, 2052997b001fSLokesh Vutla u16 vint, u16 global_event, 2053997b001fSLokesh Vutla u8 vint_status_bit) 2054997b001fSLokesh Vutla { 2055997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_IA_ID_VALID | 2056997b001fSLokesh Vutla MSG_FLAG_VINT_VALID | MSG_FLAG_GLB_EVNT_VALID | 2057997b001fSLokesh Vutla MSG_FLAG_VINT_STS_BIT_VALID; 2058997b001fSLokesh Vutla 2059997b001fSLokesh Vutla return ti_sci_free_irq(handle, valid_params, src_id, src_index, 0, 0, 2060997b001fSLokesh Vutla ia_id, vint, global_event, vint_status_bit, 0); 2061997b001fSLokesh Vutla } 2062997b001fSLokesh Vutla 206368608b5eSPeter Ujfalusi /** 20643c201753SPeter Ujfalusi * ti_sci_cmd_rm_ring_cfg() - Configure a NAVSS ring 20653c201753SPeter Ujfalusi * @handle: Pointer to TI SCI handle. 20663c201753SPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_ring_cfg ring config structure 20673c201753SPeter Ujfalusi * 20683c201753SPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 20693c201753SPeter Ujfalusi * 20703c201753SPeter Ujfalusi * See @ti_sci_msg_rm_ring_cfg and @ti_sci_msg_rm_ring_cfg_req for 20713c201753SPeter Ujfalusi * more info. 20723c201753SPeter Ujfalusi */ 20733c201753SPeter Ujfalusi static int ti_sci_cmd_rm_ring_cfg(const struct ti_sci_handle *handle, 20743c201753SPeter Ujfalusi const struct ti_sci_msg_rm_ring_cfg *params) 20753c201753SPeter Ujfalusi { 20763c201753SPeter Ujfalusi struct ti_sci_msg_rm_ring_cfg_req *req; 20773c201753SPeter Ujfalusi struct ti_sci_msg_hdr *resp; 20783c201753SPeter Ujfalusi struct ti_sci_xfer *xfer; 20793c201753SPeter Ujfalusi struct ti_sci_info *info; 20803c201753SPeter Ujfalusi struct device *dev; 20813c201753SPeter Ujfalusi int ret = 0; 20823c201753SPeter Ujfalusi 20833c201753SPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 20843c201753SPeter Ujfalusi return -EINVAL; 20853c201753SPeter Ujfalusi 20863c201753SPeter Ujfalusi info = handle_to_ti_sci_info(handle); 20873c201753SPeter Ujfalusi dev = info->dev; 20883c201753SPeter Ujfalusi 20893c201753SPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_RING_CFG, 20903c201753SPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 20913c201753SPeter Ujfalusi sizeof(*req), sizeof(*resp)); 20923c201753SPeter Ujfalusi if (IS_ERR(xfer)) { 20933c201753SPeter Ujfalusi ret = PTR_ERR(xfer); 20943c201753SPeter Ujfalusi dev_err(dev, "RM_RA:Message config failed(%d)\n", ret); 20953c201753SPeter Ujfalusi return ret; 20963c201753SPeter Ujfalusi } 20973c201753SPeter Ujfalusi req = (struct ti_sci_msg_rm_ring_cfg_req *)xfer->xfer_buf; 20983c201753SPeter Ujfalusi req->valid_params = params->valid_params; 20993c201753SPeter Ujfalusi req->nav_id = params->nav_id; 21003c201753SPeter Ujfalusi req->index = params->index; 21013c201753SPeter Ujfalusi req->addr_lo = params->addr_lo; 21023c201753SPeter Ujfalusi req->addr_hi = params->addr_hi; 21033c201753SPeter Ujfalusi req->count = params->count; 21043c201753SPeter Ujfalusi req->mode = params->mode; 21053c201753SPeter Ujfalusi req->size = params->size; 21063c201753SPeter Ujfalusi req->order_id = params->order_id; 21073c201753SPeter Ujfalusi req->virtid = params->virtid; 21083c201753SPeter Ujfalusi req->asel = params->asel; 21093c201753SPeter Ujfalusi 21103c201753SPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 21113c201753SPeter Ujfalusi if (ret) { 21123c201753SPeter Ujfalusi dev_err(dev, "RM_RA:Mbox config send fail %d\n", ret); 21133c201753SPeter Ujfalusi goto fail; 21143c201753SPeter Ujfalusi } 21153c201753SPeter Ujfalusi 21163c201753SPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 21173c201753SPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 21183c201753SPeter Ujfalusi 21193c201753SPeter Ujfalusi fail: 21203c201753SPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 21213c201753SPeter Ujfalusi dev_dbg(dev, "RM_RA:config ring %u ret:%d\n", params->index, ret); 21223c201753SPeter Ujfalusi return ret; 21233c201753SPeter Ujfalusi } 21243c201753SPeter Ujfalusi 21253c201753SPeter Ujfalusi /** 212668608b5eSPeter Ujfalusi * ti_sci_cmd_rm_psil_pair() - Pair PSI-L source to destination thread 212768608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 212868608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem which should be used for 212968608b5eSPeter Ujfalusi * pairing 213068608b5eSPeter Ujfalusi * @src_thread: Source PSI-L thread ID 213168608b5eSPeter Ujfalusi * @dst_thread: Destination PSI-L thread ID 213268608b5eSPeter Ujfalusi * 213368608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 213468608b5eSPeter Ujfalusi */ 213568608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_psil_pair(const struct ti_sci_handle *handle, 213668608b5eSPeter Ujfalusi u32 nav_id, u32 src_thread, u32 dst_thread) 213768608b5eSPeter Ujfalusi { 213868608b5eSPeter Ujfalusi struct ti_sci_msg_psil_pair *req; 213968608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 214068608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 214168608b5eSPeter Ujfalusi struct ti_sci_info *info; 214268608b5eSPeter Ujfalusi struct device *dev; 214368608b5eSPeter Ujfalusi int ret = 0; 214468608b5eSPeter Ujfalusi 214568608b5eSPeter Ujfalusi if (IS_ERR(handle)) 214668608b5eSPeter Ujfalusi return PTR_ERR(handle); 214768608b5eSPeter Ujfalusi if (!handle) 214868608b5eSPeter Ujfalusi return -EINVAL; 214968608b5eSPeter Ujfalusi 215068608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 215168608b5eSPeter Ujfalusi dev = info->dev; 215268608b5eSPeter Ujfalusi 215368608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_PAIR, 215468608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 215568608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 215668608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 215768608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 215868608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret); 215968608b5eSPeter Ujfalusi return ret; 216068608b5eSPeter Ujfalusi } 216168608b5eSPeter Ujfalusi req = (struct ti_sci_msg_psil_pair *)xfer->xfer_buf; 216268608b5eSPeter Ujfalusi req->nav_id = nav_id; 216368608b5eSPeter Ujfalusi req->src_thread = src_thread; 216468608b5eSPeter Ujfalusi req->dst_thread = dst_thread; 216568608b5eSPeter Ujfalusi 216668608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 216768608b5eSPeter Ujfalusi if (ret) { 216868608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Mbox send fail %d\n", ret); 216968608b5eSPeter Ujfalusi goto fail; 217068608b5eSPeter Ujfalusi } 217168608b5eSPeter Ujfalusi 217268608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 217368608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 217468608b5eSPeter Ujfalusi 217568608b5eSPeter Ujfalusi fail: 217668608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 217768608b5eSPeter Ujfalusi 217868608b5eSPeter Ujfalusi return ret; 217968608b5eSPeter Ujfalusi } 218068608b5eSPeter Ujfalusi 218168608b5eSPeter Ujfalusi /** 218268608b5eSPeter Ujfalusi * ti_sci_cmd_rm_psil_unpair() - Unpair PSI-L source from destination thread 218368608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 218468608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem which should be used for 218568608b5eSPeter Ujfalusi * unpairing 218668608b5eSPeter Ujfalusi * @src_thread: Source PSI-L thread ID 218768608b5eSPeter Ujfalusi * @dst_thread: Destination PSI-L thread ID 218868608b5eSPeter Ujfalusi * 218968608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 219068608b5eSPeter Ujfalusi */ 219168608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_psil_unpair(const struct ti_sci_handle *handle, 219268608b5eSPeter Ujfalusi u32 nav_id, u32 src_thread, u32 dst_thread) 219368608b5eSPeter Ujfalusi { 219468608b5eSPeter Ujfalusi struct ti_sci_msg_psil_unpair *req; 219568608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 219668608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 219768608b5eSPeter Ujfalusi struct ti_sci_info *info; 219868608b5eSPeter Ujfalusi struct device *dev; 219968608b5eSPeter Ujfalusi int ret = 0; 220068608b5eSPeter Ujfalusi 220168608b5eSPeter Ujfalusi if (IS_ERR(handle)) 220268608b5eSPeter Ujfalusi return PTR_ERR(handle); 220368608b5eSPeter Ujfalusi if (!handle) 220468608b5eSPeter Ujfalusi return -EINVAL; 220568608b5eSPeter Ujfalusi 220668608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 220768608b5eSPeter Ujfalusi dev = info->dev; 220868608b5eSPeter Ujfalusi 220968608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_UNPAIR, 221068608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 221168608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 221268608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 221368608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 221468608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret); 221568608b5eSPeter Ujfalusi return ret; 221668608b5eSPeter Ujfalusi } 221768608b5eSPeter Ujfalusi req = (struct ti_sci_msg_psil_unpair *)xfer->xfer_buf; 221868608b5eSPeter Ujfalusi req->nav_id = nav_id; 221968608b5eSPeter Ujfalusi req->src_thread = src_thread; 222068608b5eSPeter Ujfalusi req->dst_thread = dst_thread; 222168608b5eSPeter Ujfalusi 222268608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 222368608b5eSPeter Ujfalusi if (ret) { 222468608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Mbox send fail %d\n", ret); 222568608b5eSPeter Ujfalusi goto fail; 222668608b5eSPeter Ujfalusi } 222768608b5eSPeter Ujfalusi 222868608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 222968608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 223068608b5eSPeter Ujfalusi 223168608b5eSPeter Ujfalusi fail: 223268608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 223368608b5eSPeter Ujfalusi 223468608b5eSPeter Ujfalusi return ret; 223568608b5eSPeter Ujfalusi } 223668608b5eSPeter Ujfalusi 223768608b5eSPeter Ujfalusi /** 223868608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_tx_ch_cfg() - Configure a UDMAP TX channel 223968608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 224068608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_tx_ch_cfg TX channel config 224168608b5eSPeter Ujfalusi * structure 224268608b5eSPeter Ujfalusi * 224368608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 224468608b5eSPeter Ujfalusi * 224568608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_tx_ch_cfg and @ti_sci_msg_rm_udmap_tx_ch_cfg_req for 224668608b5eSPeter Ujfalusi * more info. 224768608b5eSPeter Ujfalusi */ 224868608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_tx_ch_cfg(const struct ti_sci_handle *handle, 224968608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_tx_ch_cfg *params) 225068608b5eSPeter Ujfalusi { 225168608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_tx_ch_cfg_req *req; 225268608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 225368608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 225468608b5eSPeter Ujfalusi struct ti_sci_info *info; 225568608b5eSPeter Ujfalusi struct device *dev; 225668608b5eSPeter Ujfalusi int ret = 0; 225768608b5eSPeter Ujfalusi 225868608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 225968608b5eSPeter Ujfalusi return -EINVAL; 226068608b5eSPeter Ujfalusi 226168608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 226268608b5eSPeter Ujfalusi dev = info->dev; 226368608b5eSPeter Ujfalusi 226468608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_TX_CH_CFG, 226568608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 226668608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 226768608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 226868608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 22694c960505SYueHaibing dev_err(dev, "Message TX_CH_CFG alloc failed(%d)\n", ret); 227068608b5eSPeter Ujfalusi return ret; 227168608b5eSPeter Ujfalusi } 227268608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_tx_ch_cfg_req *)xfer->xfer_buf; 227368608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 227468608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 227568608b5eSPeter Ujfalusi req->index = params->index; 227668608b5eSPeter Ujfalusi req->tx_pause_on_err = params->tx_pause_on_err; 227768608b5eSPeter Ujfalusi req->tx_filt_einfo = params->tx_filt_einfo; 227868608b5eSPeter Ujfalusi req->tx_filt_pswords = params->tx_filt_pswords; 227968608b5eSPeter Ujfalusi req->tx_atype = params->tx_atype; 228068608b5eSPeter Ujfalusi req->tx_chan_type = params->tx_chan_type; 228168608b5eSPeter Ujfalusi req->tx_supr_tdpkt = params->tx_supr_tdpkt; 228268608b5eSPeter Ujfalusi req->tx_fetch_size = params->tx_fetch_size; 228368608b5eSPeter Ujfalusi req->tx_credit_count = params->tx_credit_count; 228468608b5eSPeter Ujfalusi req->txcq_qnum = params->txcq_qnum; 228568608b5eSPeter Ujfalusi req->tx_priority = params->tx_priority; 228668608b5eSPeter Ujfalusi req->tx_qos = params->tx_qos; 228768608b5eSPeter Ujfalusi req->tx_orderid = params->tx_orderid; 228868608b5eSPeter Ujfalusi req->fdepth = params->fdepth; 228968608b5eSPeter Ujfalusi req->tx_sched_priority = params->tx_sched_priority; 229068608b5eSPeter Ujfalusi req->tx_burst_size = params->tx_burst_size; 22911c552e08SPeter Ujfalusi req->tx_tdtype = params->tx_tdtype; 2292ce1feed5SPeter Ujfalusi req->extended_ch_type = params->extended_ch_type; 229368608b5eSPeter Ujfalusi 229468608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 229568608b5eSPeter Ujfalusi if (ret) { 22964c960505SYueHaibing dev_err(dev, "Mbox send TX_CH_CFG fail %d\n", ret); 229768608b5eSPeter Ujfalusi goto fail; 229868608b5eSPeter Ujfalusi } 229968608b5eSPeter Ujfalusi 230068608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 230168608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 230268608b5eSPeter Ujfalusi 230368608b5eSPeter Ujfalusi fail: 230468608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 23054c960505SYueHaibing dev_dbg(dev, "TX_CH_CFG: chn %u ret:%u\n", params->index, ret); 230668608b5eSPeter Ujfalusi return ret; 230768608b5eSPeter Ujfalusi } 230868608b5eSPeter Ujfalusi 230968608b5eSPeter Ujfalusi /** 231068608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_rx_ch_cfg() - Configure a UDMAP RX channel 231168608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 231268608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_rx_ch_cfg RX channel config 231368608b5eSPeter Ujfalusi * structure 231468608b5eSPeter Ujfalusi * 231568608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 231668608b5eSPeter Ujfalusi * 231768608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_rx_ch_cfg and @ti_sci_msg_rm_udmap_rx_ch_cfg_req for 231868608b5eSPeter Ujfalusi * more info. 231968608b5eSPeter Ujfalusi */ 232068608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_rx_ch_cfg(const struct ti_sci_handle *handle, 232168608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_rx_ch_cfg *params) 232268608b5eSPeter Ujfalusi { 232368608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *req; 232468608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 232568608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 232668608b5eSPeter Ujfalusi struct ti_sci_info *info; 232768608b5eSPeter Ujfalusi struct device *dev; 232868608b5eSPeter Ujfalusi int ret = 0; 232968608b5eSPeter Ujfalusi 233068608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 233168608b5eSPeter Ujfalusi return -EINVAL; 233268608b5eSPeter Ujfalusi 233368608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 233468608b5eSPeter Ujfalusi dev = info->dev; 233568608b5eSPeter Ujfalusi 233668608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_RX_CH_CFG, 233768608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 233868608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 233968608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 234068608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 23414c960505SYueHaibing dev_err(dev, "Message RX_CH_CFG alloc failed(%d)\n", ret); 234268608b5eSPeter Ujfalusi return ret; 234368608b5eSPeter Ujfalusi } 234468608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *)xfer->xfer_buf; 234568608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 234668608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 234768608b5eSPeter Ujfalusi req->index = params->index; 234868608b5eSPeter Ujfalusi req->rx_fetch_size = params->rx_fetch_size; 234968608b5eSPeter Ujfalusi req->rxcq_qnum = params->rxcq_qnum; 235068608b5eSPeter Ujfalusi req->rx_priority = params->rx_priority; 235168608b5eSPeter Ujfalusi req->rx_qos = params->rx_qos; 235268608b5eSPeter Ujfalusi req->rx_orderid = params->rx_orderid; 235368608b5eSPeter Ujfalusi req->rx_sched_priority = params->rx_sched_priority; 235468608b5eSPeter Ujfalusi req->flowid_start = params->flowid_start; 235568608b5eSPeter Ujfalusi req->flowid_cnt = params->flowid_cnt; 235668608b5eSPeter Ujfalusi req->rx_pause_on_err = params->rx_pause_on_err; 235768608b5eSPeter Ujfalusi req->rx_atype = params->rx_atype; 235868608b5eSPeter Ujfalusi req->rx_chan_type = params->rx_chan_type; 235968608b5eSPeter Ujfalusi req->rx_ignore_short = params->rx_ignore_short; 236068608b5eSPeter Ujfalusi req->rx_ignore_long = params->rx_ignore_long; 236168608b5eSPeter Ujfalusi req->rx_burst_size = params->rx_burst_size; 236268608b5eSPeter Ujfalusi 236368608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 236468608b5eSPeter Ujfalusi if (ret) { 23654c960505SYueHaibing dev_err(dev, "Mbox send RX_CH_CFG fail %d\n", ret); 236668608b5eSPeter Ujfalusi goto fail; 236768608b5eSPeter Ujfalusi } 236868608b5eSPeter Ujfalusi 236968608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 237068608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 237168608b5eSPeter Ujfalusi 237268608b5eSPeter Ujfalusi fail: 237368608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 23744c960505SYueHaibing dev_dbg(dev, "RX_CH_CFG: chn %u ret:%d\n", params->index, ret); 237568608b5eSPeter Ujfalusi return ret; 237668608b5eSPeter Ujfalusi } 237768608b5eSPeter Ujfalusi 237868608b5eSPeter Ujfalusi /** 237968608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_rx_flow_cfg() - Configure UDMAP RX FLOW 238068608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 238168608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_flow_cfg RX FLOW config 238268608b5eSPeter Ujfalusi * structure 238368608b5eSPeter Ujfalusi * 238468608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 238568608b5eSPeter Ujfalusi * 238668608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_flow_cfg and @ti_sci_msg_rm_udmap_flow_cfg_req for 238768608b5eSPeter Ujfalusi * more info. 238868608b5eSPeter Ujfalusi */ 238968608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_rx_flow_cfg(const struct ti_sci_handle *handle, 239068608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_flow_cfg *params) 239168608b5eSPeter Ujfalusi { 239268608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_flow_cfg_req *req; 239368608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 239468608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 239568608b5eSPeter Ujfalusi struct ti_sci_info *info; 239668608b5eSPeter Ujfalusi struct device *dev; 239768608b5eSPeter Ujfalusi int ret = 0; 239868608b5eSPeter Ujfalusi 239968608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 240068608b5eSPeter Ujfalusi return -EINVAL; 240168608b5eSPeter Ujfalusi 240268608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 240368608b5eSPeter Ujfalusi dev = info->dev; 240468608b5eSPeter Ujfalusi 240568608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_FLOW_CFG, 240668608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 240768608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 240868608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 240968608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 241068608b5eSPeter Ujfalusi dev_err(dev, "RX_FL_CFG: Message alloc failed(%d)\n", ret); 241168608b5eSPeter Ujfalusi return ret; 241268608b5eSPeter Ujfalusi } 241368608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_flow_cfg_req *)xfer->xfer_buf; 241468608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 241568608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 241668608b5eSPeter Ujfalusi req->flow_index = params->flow_index; 241768608b5eSPeter Ujfalusi req->rx_einfo_present = params->rx_einfo_present; 241868608b5eSPeter Ujfalusi req->rx_psinfo_present = params->rx_psinfo_present; 241968608b5eSPeter Ujfalusi req->rx_error_handling = params->rx_error_handling; 242068608b5eSPeter Ujfalusi req->rx_desc_type = params->rx_desc_type; 242168608b5eSPeter Ujfalusi req->rx_sop_offset = params->rx_sop_offset; 242268608b5eSPeter Ujfalusi req->rx_dest_qnum = params->rx_dest_qnum; 242368608b5eSPeter Ujfalusi req->rx_src_tag_hi = params->rx_src_tag_hi; 242468608b5eSPeter Ujfalusi req->rx_src_tag_lo = params->rx_src_tag_lo; 242568608b5eSPeter Ujfalusi req->rx_dest_tag_hi = params->rx_dest_tag_hi; 242668608b5eSPeter Ujfalusi req->rx_dest_tag_lo = params->rx_dest_tag_lo; 242768608b5eSPeter Ujfalusi req->rx_src_tag_hi_sel = params->rx_src_tag_hi_sel; 242868608b5eSPeter Ujfalusi req->rx_src_tag_lo_sel = params->rx_src_tag_lo_sel; 242968608b5eSPeter Ujfalusi req->rx_dest_tag_hi_sel = params->rx_dest_tag_hi_sel; 243068608b5eSPeter Ujfalusi req->rx_dest_tag_lo_sel = params->rx_dest_tag_lo_sel; 243168608b5eSPeter Ujfalusi req->rx_fdq0_sz0_qnum = params->rx_fdq0_sz0_qnum; 243268608b5eSPeter Ujfalusi req->rx_fdq1_qnum = params->rx_fdq1_qnum; 243368608b5eSPeter Ujfalusi req->rx_fdq2_qnum = params->rx_fdq2_qnum; 243468608b5eSPeter Ujfalusi req->rx_fdq3_qnum = params->rx_fdq3_qnum; 243568608b5eSPeter Ujfalusi req->rx_ps_location = params->rx_ps_location; 243668608b5eSPeter Ujfalusi 243768608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 243868608b5eSPeter Ujfalusi if (ret) { 243968608b5eSPeter Ujfalusi dev_err(dev, "RX_FL_CFG: Mbox send fail %d\n", ret); 244068608b5eSPeter Ujfalusi goto fail; 244168608b5eSPeter Ujfalusi } 244268608b5eSPeter Ujfalusi 244368608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 244468608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 244568608b5eSPeter Ujfalusi 244668608b5eSPeter Ujfalusi fail: 244768608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 244868608b5eSPeter Ujfalusi dev_dbg(info->dev, "RX_FL_CFG: %u ret:%d\n", params->flow_index, ret); 244968608b5eSPeter Ujfalusi return ret; 245068608b5eSPeter Ujfalusi } 245168608b5eSPeter Ujfalusi 24521e407f33SSuman Anna /** 24531e407f33SSuman Anna * ti_sci_cmd_proc_request() - Command to request a physical processor control 24541e407f33SSuman Anna * @handle: Pointer to TI SCI handle 24551e407f33SSuman Anna * @proc_id: Processor ID this request is for 24561e407f33SSuman Anna * 24571e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 24581e407f33SSuman Anna */ 24591e407f33SSuman Anna static int ti_sci_cmd_proc_request(const struct ti_sci_handle *handle, 24601e407f33SSuman Anna u8 proc_id) 24611e407f33SSuman Anna { 24621e407f33SSuman Anna struct ti_sci_msg_req_proc_request *req; 24631e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 24641e407f33SSuman Anna struct ti_sci_info *info; 24651e407f33SSuman Anna struct ti_sci_xfer *xfer; 24661e407f33SSuman Anna struct device *dev; 24671e407f33SSuman Anna int ret = 0; 24681e407f33SSuman Anna 24691e407f33SSuman Anna if (!handle) 24701e407f33SSuman Anna return -EINVAL; 24711e407f33SSuman Anna if (IS_ERR(handle)) 24721e407f33SSuman Anna return PTR_ERR(handle); 24731e407f33SSuman Anna 24741e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 24751e407f33SSuman Anna dev = info->dev; 24761e407f33SSuman Anna 24771e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_REQUEST, 24781e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 24791e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 24801e407f33SSuman Anna if (IS_ERR(xfer)) { 24811e407f33SSuman Anna ret = PTR_ERR(xfer); 24821e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 24831e407f33SSuman Anna return ret; 24841e407f33SSuman Anna } 24851e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_request *)xfer->xfer_buf; 24861e407f33SSuman Anna req->processor_id = proc_id; 24871e407f33SSuman Anna 24881e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 24891e407f33SSuman Anna if (ret) { 24901e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 24911e407f33SSuman Anna goto fail; 24921e407f33SSuman Anna } 24931e407f33SSuman Anna 24941e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 24951e407f33SSuman Anna 24961e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 24971e407f33SSuman Anna 24981e407f33SSuman Anna fail: 24991e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 25001e407f33SSuman Anna 25011e407f33SSuman Anna return ret; 25021e407f33SSuman Anna } 25031e407f33SSuman Anna 25041e407f33SSuman Anna /** 25051e407f33SSuman Anna * ti_sci_cmd_proc_release() - Command to release a physical processor control 25061e407f33SSuman Anna * @handle: Pointer to TI SCI handle 25071e407f33SSuman Anna * @proc_id: Processor ID this request is for 25081e407f33SSuman Anna * 25091e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 25101e407f33SSuman Anna */ 25111e407f33SSuman Anna static int ti_sci_cmd_proc_release(const struct ti_sci_handle *handle, 25121e407f33SSuman Anna u8 proc_id) 25131e407f33SSuman Anna { 25141e407f33SSuman Anna struct ti_sci_msg_req_proc_release *req; 25151e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 25161e407f33SSuman Anna struct ti_sci_info *info; 25171e407f33SSuman Anna struct ti_sci_xfer *xfer; 25181e407f33SSuman Anna struct device *dev; 25191e407f33SSuman Anna int ret = 0; 25201e407f33SSuman Anna 25211e407f33SSuman Anna if (!handle) 25221e407f33SSuman Anna return -EINVAL; 25231e407f33SSuman Anna if (IS_ERR(handle)) 25241e407f33SSuman Anna return PTR_ERR(handle); 25251e407f33SSuman Anna 25261e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 25271e407f33SSuman Anna dev = info->dev; 25281e407f33SSuman Anna 25291e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_RELEASE, 25301e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 25311e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 25321e407f33SSuman Anna if (IS_ERR(xfer)) { 25331e407f33SSuman Anna ret = PTR_ERR(xfer); 25341e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 25351e407f33SSuman Anna return ret; 25361e407f33SSuman Anna } 25371e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_release *)xfer->xfer_buf; 25381e407f33SSuman Anna req->processor_id = proc_id; 25391e407f33SSuman Anna 25401e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 25411e407f33SSuman Anna if (ret) { 25421e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 25431e407f33SSuman Anna goto fail; 25441e407f33SSuman Anna } 25451e407f33SSuman Anna 25461e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 25471e407f33SSuman Anna 25481e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 25491e407f33SSuman Anna 25501e407f33SSuman Anna fail: 25511e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 25521e407f33SSuman Anna 25531e407f33SSuman Anna return ret; 25541e407f33SSuman Anna } 25551e407f33SSuman Anna 25561e407f33SSuman Anna /** 25571e407f33SSuman Anna * ti_sci_cmd_proc_handover() - Command to handover a physical processor 25581e407f33SSuman Anna * control to a host in the processor's access 25591e407f33SSuman Anna * control list. 25601e407f33SSuman Anna * @handle: Pointer to TI SCI handle 25611e407f33SSuman Anna * @proc_id: Processor ID this request is for 25621e407f33SSuman Anna * @host_id: Host ID to get the control of the processor 25631e407f33SSuman Anna * 25641e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 25651e407f33SSuman Anna */ 25661e407f33SSuman Anna static int ti_sci_cmd_proc_handover(const struct ti_sci_handle *handle, 25671e407f33SSuman Anna u8 proc_id, u8 host_id) 25681e407f33SSuman Anna { 25691e407f33SSuman Anna struct ti_sci_msg_req_proc_handover *req; 25701e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 25711e407f33SSuman Anna struct ti_sci_info *info; 25721e407f33SSuman Anna struct ti_sci_xfer *xfer; 25731e407f33SSuman Anna struct device *dev; 25741e407f33SSuman Anna int ret = 0; 25751e407f33SSuman Anna 25761e407f33SSuman Anna if (!handle) 25771e407f33SSuman Anna return -EINVAL; 25781e407f33SSuman Anna if (IS_ERR(handle)) 25791e407f33SSuman Anna return PTR_ERR(handle); 25801e407f33SSuman Anna 25811e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 25821e407f33SSuman Anna dev = info->dev; 25831e407f33SSuman Anna 25841e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_HANDOVER, 25851e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 25861e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 25871e407f33SSuman Anna if (IS_ERR(xfer)) { 25881e407f33SSuman Anna ret = PTR_ERR(xfer); 25891e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 25901e407f33SSuman Anna return ret; 25911e407f33SSuman Anna } 25921e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_handover *)xfer->xfer_buf; 25931e407f33SSuman Anna req->processor_id = proc_id; 25941e407f33SSuman Anna req->host_id = host_id; 25951e407f33SSuman Anna 25961e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 25971e407f33SSuman Anna if (ret) { 25981e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 25991e407f33SSuman Anna goto fail; 26001e407f33SSuman Anna } 26011e407f33SSuman Anna 26021e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 26031e407f33SSuman Anna 26041e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 26051e407f33SSuman Anna 26061e407f33SSuman Anna fail: 26071e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 26081e407f33SSuman Anna 26091e407f33SSuman Anna return ret; 26101e407f33SSuman Anna } 26111e407f33SSuman Anna 26121e407f33SSuman Anna /** 26131e407f33SSuman Anna * ti_sci_cmd_proc_set_config() - Command to set the processor boot 26141e407f33SSuman Anna * configuration flags 26151e407f33SSuman Anna * @handle: Pointer to TI SCI handle 26161e407f33SSuman Anna * @proc_id: Processor ID this request is for 2617*3e67fd8dSNishanth Menon * @bootvector: Processor Boot vector (start address) 26181e407f33SSuman Anna * @config_flags_set: Configuration flags to be set 26191e407f33SSuman Anna * @config_flags_clear: Configuration flags to be cleared. 26201e407f33SSuman Anna * 26211e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 26221e407f33SSuman Anna */ 26231e407f33SSuman Anna static int ti_sci_cmd_proc_set_config(const struct ti_sci_handle *handle, 26241e407f33SSuman Anna u8 proc_id, u64 bootvector, 26251e407f33SSuman Anna u32 config_flags_set, 26261e407f33SSuman Anna u32 config_flags_clear) 26271e407f33SSuman Anna { 26281e407f33SSuman Anna struct ti_sci_msg_req_set_config *req; 26291e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 26301e407f33SSuman Anna struct ti_sci_info *info; 26311e407f33SSuman Anna struct ti_sci_xfer *xfer; 26321e407f33SSuman Anna struct device *dev; 26331e407f33SSuman Anna int ret = 0; 26341e407f33SSuman Anna 26351e407f33SSuman Anna if (!handle) 26361e407f33SSuman Anna return -EINVAL; 26371e407f33SSuman Anna if (IS_ERR(handle)) 26381e407f33SSuman Anna return PTR_ERR(handle); 26391e407f33SSuman Anna 26401e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 26411e407f33SSuman Anna dev = info->dev; 26421e407f33SSuman Anna 26431e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CONFIG, 26441e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 26451e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 26461e407f33SSuman Anna if (IS_ERR(xfer)) { 26471e407f33SSuman Anna ret = PTR_ERR(xfer); 26481e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 26491e407f33SSuman Anna return ret; 26501e407f33SSuman Anna } 26511e407f33SSuman Anna req = (struct ti_sci_msg_req_set_config *)xfer->xfer_buf; 26521e407f33SSuman Anna req->processor_id = proc_id; 26531e407f33SSuman Anna req->bootvector_low = bootvector & TI_SCI_ADDR_LOW_MASK; 26541e407f33SSuman Anna req->bootvector_high = (bootvector & TI_SCI_ADDR_HIGH_MASK) >> 26551e407f33SSuman Anna TI_SCI_ADDR_HIGH_SHIFT; 26561e407f33SSuman Anna req->config_flags_set = config_flags_set; 26571e407f33SSuman Anna req->config_flags_clear = config_flags_clear; 26581e407f33SSuman Anna 26591e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 26601e407f33SSuman Anna if (ret) { 26611e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 26621e407f33SSuman Anna goto fail; 26631e407f33SSuman Anna } 26641e407f33SSuman Anna 26651e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 26661e407f33SSuman Anna 26671e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 26681e407f33SSuman Anna 26691e407f33SSuman Anna fail: 26701e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 26711e407f33SSuman Anna 26721e407f33SSuman Anna return ret; 26731e407f33SSuman Anna } 26741e407f33SSuman Anna 26751e407f33SSuman Anna /** 26761e407f33SSuman Anna * ti_sci_cmd_proc_set_control() - Command to set the processor boot 26771e407f33SSuman Anna * control flags 26781e407f33SSuman Anna * @handle: Pointer to TI SCI handle 26791e407f33SSuman Anna * @proc_id: Processor ID this request is for 26801e407f33SSuman Anna * @control_flags_set: Control flags to be set 26811e407f33SSuman Anna * @control_flags_clear: Control flags to be cleared 26821e407f33SSuman Anna * 26831e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 26841e407f33SSuman Anna */ 26851e407f33SSuman Anna static int ti_sci_cmd_proc_set_control(const struct ti_sci_handle *handle, 26861e407f33SSuman Anna u8 proc_id, u32 control_flags_set, 26871e407f33SSuman Anna u32 control_flags_clear) 26881e407f33SSuman Anna { 26891e407f33SSuman Anna struct ti_sci_msg_req_set_ctrl *req; 26901e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 26911e407f33SSuman Anna struct ti_sci_info *info; 26921e407f33SSuman Anna struct ti_sci_xfer *xfer; 26931e407f33SSuman Anna struct device *dev; 26941e407f33SSuman Anna int ret = 0; 26951e407f33SSuman Anna 26961e407f33SSuman Anna if (!handle) 26971e407f33SSuman Anna return -EINVAL; 26981e407f33SSuman Anna if (IS_ERR(handle)) 26991e407f33SSuman Anna return PTR_ERR(handle); 27001e407f33SSuman Anna 27011e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 27021e407f33SSuman Anna dev = info->dev; 27031e407f33SSuman Anna 27041e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CTRL, 27051e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 27061e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 27071e407f33SSuman Anna if (IS_ERR(xfer)) { 27081e407f33SSuman Anna ret = PTR_ERR(xfer); 27091e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 27101e407f33SSuman Anna return ret; 27111e407f33SSuman Anna } 27121e407f33SSuman Anna req = (struct ti_sci_msg_req_set_ctrl *)xfer->xfer_buf; 27131e407f33SSuman Anna req->processor_id = proc_id; 27141e407f33SSuman Anna req->control_flags_set = control_flags_set; 27151e407f33SSuman Anna req->control_flags_clear = control_flags_clear; 27161e407f33SSuman Anna 27171e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 27181e407f33SSuman Anna if (ret) { 27191e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 27201e407f33SSuman Anna goto fail; 27211e407f33SSuman Anna } 27221e407f33SSuman Anna 27231e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 27241e407f33SSuman Anna 27251e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 27261e407f33SSuman Anna 27271e407f33SSuman Anna fail: 27281e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 27291e407f33SSuman Anna 27301e407f33SSuman Anna return ret; 27311e407f33SSuman Anna } 27321e407f33SSuman Anna 27331e407f33SSuman Anna /** 2734*3e67fd8dSNishanth Menon * ti_sci_cmd_proc_get_status() - Command to get the processor boot status 27351e407f33SSuman Anna * @handle: Pointer to TI SCI handle 27361e407f33SSuman Anna * @proc_id: Processor ID this request is for 2737*3e67fd8dSNishanth Menon * @bv: Processor Boot vector (start address) 2738*3e67fd8dSNishanth Menon * @cfg_flags: Processor specific configuration flags 2739*3e67fd8dSNishanth Menon * @ctrl_flags: Processor specific control flags 2740*3e67fd8dSNishanth Menon * @sts_flags: Processor specific status flags 27411e407f33SSuman Anna * 27421e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 27431e407f33SSuman Anna */ 27441e407f33SSuman Anna static int ti_sci_cmd_proc_get_status(const struct ti_sci_handle *handle, 27451e407f33SSuman Anna u8 proc_id, u64 *bv, u32 *cfg_flags, 27461e407f33SSuman Anna u32 *ctrl_flags, u32 *sts_flags) 27471e407f33SSuman Anna { 27481e407f33SSuman Anna struct ti_sci_msg_resp_get_status *resp; 27491e407f33SSuman Anna struct ti_sci_msg_req_get_status *req; 27501e407f33SSuman Anna struct ti_sci_info *info; 27511e407f33SSuman Anna struct ti_sci_xfer *xfer; 27521e407f33SSuman Anna struct device *dev; 27531e407f33SSuman Anna int ret = 0; 27541e407f33SSuman Anna 27551e407f33SSuman Anna if (!handle) 27561e407f33SSuman Anna return -EINVAL; 27571e407f33SSuman Anna if (IS_ERR(handle)) 27581e407f33SSuman Anna return PTR_ERR(handle); 27591e407f33SSuman Anna 27601e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 27611e407f33SSuman Anna dev = info->dev; 27621e407f33SSuman Anna 27631e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_STATUS, 27641e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 27651e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 27661e407f33SSuman Anna if (IS_ERR(xfer)) { 27671e407f33SSuman Anna ret = PTR_ERR(xfer); 27681e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 27691e407f33SSuman Anna return ret; 27701e407f33SSuman Anna } 27711e407f33SSuman Anna req = (struct ti_sci_msg_req_get_status *)xfer->xfer_buf; 27721e407f33SSuman Anna req->processor_id = proc_id; 27731e407f33SSuman Anna 27741e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 27751e407f33SSuman Anna if (ret) { 27761e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 27771e407f33SSuman Anna goto fail; 27781e407f33SSuman Anna } 27791e407f33SSuman Anna 27801e407f33SSuman Anna resp = (struct ti_sci_msg_resp_get_status *)xfer->tx_message.buf; 27811e407f33SSuman Anna 27821e407f33SSuman Anna if (!ti_sci_is_response_ack(resp)) { 27831e407f33SSuman Anna ret = -ENODEV; 27841e407f33SSuman Anna } else { 27851e407f33SSuman Anna *bv = (resp->bootvector_low & TI_SCI_ADDR_LOW_MASK) | 27861e407f33SSuman Anna (((u64)resp->bootvector_high << TI_SCI_ADDR_HIGH_SHIFT) & 27871e407f33SSuman Anna TI_SCI_ADDR_HIGH_MASK); 27881e407f33SSuman Anna *cfg_flags = resp->config_flags; 27891e407f33SSuman Anna *ctrl_flags = resp->control_flags; 27901e407f33SSuman Anna *sts_flags = resp->status_flags; 27911e407f33SSuman Anna } 27921e407f33SSuman Anna 27931e407f33SSuman Anna fail: 27941e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 27951e407f33SSuman Anna 27961e407f33SSuman Anna return ret; 27971e407f33SSuman Anna } 27981e407f33SSuman Anna 27999e7d756dSNishanth Menon /* 28009e7d756dSNishanth Menon * ti_sci_setup_ops() - Setup the operations structures 28019e7d756dSNishanth Menon * @info: pointer to TISCI pointer 28029e7d756dSNishanth Menon */ 28039e7d756dSNishanth Menon static void ti_sci_setup_ops(struct ti_sci_info *info) 28049e7d756dSNishanth Menon { 28059e7d756dSNishanth Menon struct ti_sci_ops *ops = &info->handle.ops; 2806912cffb4SNishanth Menon struct ti_sci_core_ops *core_ops = &ops->core_ops; 28079e7d756dSNishanth Menon struct ti_sci_dev_ops *dops = &ops->dev_ops; 28089f723220SNishanth Menon struct ti_sci_clk_ops *cops = &ops->clk_ops; 28099c19fb68SLokesh Vutla struct ti_sci_rm_core_ops *rm_core_ops = &ops->rm_core_ops; 2810997b001fSLokesh Vutla struct ti_sci_rm_irq_ops *iops = &ops->rm_irq_ops; 281168608b5eSPeter Ujfalusi struct ti_sci_rm_ringacc_ops *rops = &ops->rm_ring_ops; 281268608b5eSPeter Ujfalusi struct ti_sci_rm_psil_ops *psilops = &ops->rm_psil_ops; 281368608b5eSPeter Ujfalusi struct ti_sci_rm_udmap_ops *udmap_ops = &ops->rm_udmap_ops; 28141e407f33SSuman Anna struct ti_sci_proc_ops *pops = &ops->proc_ops; 28159e7d756dSNishanth Menon 2816912cffb4SNishanth Menon core_ops->reboot_device = ti_sci_cmd_core_reboot; 2817912cffb4SNishanth Menon 28189e7d756dSNishanth Menon dops->get_device = ti_sci_cmd_get_device; 281945b659eeSLokesh Vutla dops->get_device_exclusive = ti_sci_cmd_get_device_exclusive; 28209e7d756dSNishanth Menon dops->idle_device = ti_sci_cmd_idle_device; 282145b659eeSLokesh Vutla dops->idle_device_exclusive = ti_sci_cmd_idle_device_exclusive; 28229e7d756dSNishanth Menon dops->put_device = ti_sci_cmd_put_device; 28239e7d756dSNishanth Menon 28249e7d756dSNishanth Menon dops->is_valid = ti_sci_cmd_dev_is_valid; 28259e7d756dSNishanth Menon dops->get_context_loss_count = ti_sci_cmd_dev_get_clcnt; 28269e7d756dSNishanth Menon dops->is_idle = ti_sci_cmd_dev_is_idle; 28279e7d756dSNishanth Menon dops->is_stop = ti_sci_cmd_dev_is_stop; 28289e7d756dSNishanth Menon dops->is_on = ti_sci_cmd_dev_is_on; 28299e7d756dSNishanth Menon dops->is_transitioning = ti_sci_cmd_dev_is_trans; 28309e7d756dSNishanth Menon dops->set_device_resets = ti_sci_cmd_set_device_resets; 28319e7d756dSNishanth Menon dops->get_device_resets = ti_sci_cmd_get_device_resets; 28329f723220SNishanth Menon 28339f723220SNishanth Menon cops->get_clock = ti_sci_cmd_get_clock; 28349f723220SNishanth Menon cops->idle_clock = ti_sci_cmd_idle_clock; 28359f723220SNishanth Menon cops->put_clock = ti_sci_cmd_put_clock; 28369f723220SNishanth Menon cops->is_auto = ti_sci_cmd_clk_is_auto; 28379f723220SNishanth Menon cops->is_on = ti_sci_cmd_clk_is_on; 28389f723220SNishanth Menon cops->is_off = ti_sci_cmd_clk_is_off; 28399f723220SNishanth Menon 28409f723220SNishanth Menon cops->set_parent = ti_sci_cmd_clk_set_parent; 28419f723220SNishanth Menon cops->get_parent = ti_sci_cmd_clk_get_parent; 28429f723220SNishanth Menon cops->get_num_parents = ti_sci_cmd_clk_get_num_parents; 28439f723220SNishanth Menon 28449f723220SNishanth Menon cops->get_best_match_freq = ti_sci_cmd_clk_get_match_freq; 28459f723220SNishanth Menon cops->set_freq = ti_sci_cmd_clk_set_freq; 28469f723220SNishanth Menon cops->get_freq = ti_sci_cmd_clk_get_freq; 28479c19fb68SLokesh Vutla 28489c19fb68SLokesh Vutla rm_core_ops->get_range = ti_sci_cmd_get_resource_range; 28499c19fb68SLokesh Vutla rm_core_ops->get_range_from_shost = 28509c19fb68SLokesh Vutla ti_sci_cmd_get_resource_range_from_shost; 2851997b001fSLokesh Vutla 2852997b001fSLokesh Vutla iops->set_irq = ti_sci_cmd_set_irq; 2853997b001fSLokesh Vutla iops->set_event_map = ti_sci_cmd_set_event_map; 2854997b001fSLokesh Vutla iops->free_irq = ti_sci_cmd_free_irq; 2855997b001fSLokesh Vutla iops->free_event_map = ti_sci_cmd_free_event_map; 285668608b5eSPeter Ujfalusi 28573c201753SPeter Ujfalusi rops->set_cfg = ti_sci_cmd_rm_ring_cfg; 285868608b5eSPeter Ujfalusi 285968608b5eSPeter Ujfalusi psilops->pair = ti_sci_cmd_rm_psil_pair; 286068608b5eSPeter Ujfalusi psilops->unpair = ti_sci_cmd_rm_psil_unpair; 286168608b5eSPeter Ujfalusi 286268608b5eSPeter Ujfalusi udmap_ops->tx_ch_cfg = ti_sci_cmd_rm_udmap_tx_ch_cfg; 286368608b5eSPeter Ujfalusi udmap_ops->rx_ch_cfg = ti_sci_cmd_rm_udmap_rx_ch_cfg; 286468608b5eSPeter Ujfalusi udmap_ops->rx_flow_cfg = ti_sci_cmd_rm_udmap_rx_flow_cfg; 28651e407f33SSuman Anna 28661e407f33SSuman Anna pops->request = ti_sci_cmd_proc_request; 28671e407f33SSuman Anna pops->release = ti_sci_cmd_proc_release; 28681e407f33SSuman Anna pops->handover = ti_sci_cmd_proc_handover; 28691e407f33SSuman Anna pops->set_config = ti_sci_cmd_proc_set_config; 28701e407f33SSuman Anna pops->set_control = ti_sci_cmd_proc_set_control; 28711e407f33SSuman Anna pops->get_status = ti_sci_cmd_proc_get_status; 28729e7d756dSNishanth Menon } 28739e7d756dSNishanth Menon 28749e7d756dSNishanth Menon /** 2875aa276781SNishanth Menon * ti_sci_get_handle() - Get the TI SCI handle for a device 2876aa276781SNishanth Menon * @dev: Pointer to device for which we want SCI handle 2877aa276781SNishanth Menon * 2878aa276781SNishanth Menon * NOTE: The function does not track individual clients of the framework 2879aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2880aa276781SNishanth Menon * ti_sci_put_handle must be balanced with successful ti_sci_get_handle 2881aa276781SNishanth Menon * Return: pointer to handle if successful, else: 2882aa276781SNishanth Menon * -EPROBE_DEFER if the instance is not ready 2883aa276781SNishanth Menon * -ENODEV if the required node handler is missing 2884aa276781SNishanth Menon * -EINVAL if invalid conditions are encountered. 2885aa276781SNishanth Menon */ 2886aa276781SNishanth Menon const struct ti_sci_handle *ti_sci_get_handle(struct device *dev) 2887aa276781SNishanth Menon { 2888aa276781SNishanth Menon struct device_node *ti_sci_np; 2889aa276781SNishanth Menon struct list_head *p; 2890aa276781SNishanth Menon struct ti_sci_handle *handle = NULL; 2891aa276781SNishanth Menon struct ti_sci_info *info; 2892aa276781SNishanth Menon 2893aa276781SNishanth Menon if (!dev) { 2894aa276781SNishanth Menon pr_err("I need a device pointer\n"); 2895aa276781SNishanth Menon return ERR_PTR(-EINVAL); 2896aa276781SNishanth Menon } 2897aa276781SNishanth Menon ti_sci_np = of_get_parent(dev->of_node); 2898aa276781SNishanth Menon if (!ti_sci_np) { 2899aa276781SNishanth Menon dev_err(dev, "No OF information\n"); 2900aa276781SNishanth Menon return ERR_PTR(-EINVAL); 2901aa276781SNishanth Menon } 2902aa276781SNishanth Menon 2903aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 2904aa276781SNishanth Menon list_for_each(p, &ti_sci_list) { 2905aa276781SNishanth Menon info = list_entry(p, struct ti_sci_info, node); 2906aa276781SNishanth Menon if (ti_sci_np == info->dev->of_node) { 2907aa276781SNishanth Menon handle = &info->handle; 2908aa276781SNishanth Menon info->users++; 2909aa276781SNishanth Menon break; 2910aa276781SNishanth Menon } 2911aa276781SNishanth Menon } 2912aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 2913aa276781SNishanth Menon of_node_put(ti_sci_np); 2914aa276781SNishanth Menon 2915aa276781SNishanth Menon if (!handle) 2916aa276781SNishanth Menon return ERR_PTR(-EPROBE_DEFER); 2917aa276781SNishanth Menon 2918aa276781SNishanth Menon return handle; 2919aa276781SNishanth Menon } 2920aa276781SNishanth Menon EXPORT_SYMBOL_GPL(ti_sci_get_handle); 2921aa276781SNishanth Menon 2922aa276781SNishanth Menon /** 2923aa276781SNishanth Menon * ti_sci_put_handle() - Release the handle acquired by ti_sci_get_handle 2924aa276781SNishanth Menon * @handle: Handle acquired by ti_sci_get_handle 2925aa276781SNishanth Menon * 2926aa276781SNishanth Menon * NOTE: The function does not track individual clients of the framework 2927aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2928aa276781SNishanth Menon * ti_sci_put_handle must be balanced with successful ti_sci_get_handle 2929aa276781SNishanth Menon * 2930aa276781SNishanth Menon * Return: 0 is successfully released 2931aa276781SNishanth Menon * if an error pointer was passed, it returns the error value back, 2932aa276781SNishanth Menon * if null was passed, it returns -EINVAL; 2933aa276781SNishanth Menon */ 2934aa276781SNishanth Menon int ti_sci_put_handle(const struct ti_sci_handle *handle) 2935aa276781SNishanth Menon { 2936aa276781SNishanth Menon struct ti_sci_info *info; 2937aa276781SNishanth Menon 2938aa276781SNishanth Menon if (IS_ERR(handle)) 2939aa276781SNishanth Menon return PTR_ERR(handle); 2940aa276781SNishanth Menon if (!handle) 2941aa276781SNishanth Menon return -EINVAL; 2942aa276781SNishanth Menon 2943aa276781SNishanth Menon info = handle_to_ti_sci_info(handle); 2944aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 2945aa276781SNishanth Menon if (!WARN_ON(!info->users)) 2946aa276781SNishanth Menon info->users--; 2947aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 2948aa276781SNishanth Menon 2949aa276781SNishanth Menon return 0; 2950aa276781SNishanth Menon } 2951aa276781SNishanth Menon EXPORT_SYMBOL_GPL(ti_sci_put_handle); 2952aa276781SNishanth Menon 2953aa276781SNishanth Menon static void devm_ti_sci_release(struct device *dev, void *res) 2954aa276781SNishanth Menon { 2955aa276781SNishanth Menon const struct ti_sci_handle **ptr = res; 2956aa276781SNishanth Menon const struct ti_sci_handle *handle = *ptr; 2957aa276781SNishanth Menon int ret; 2958aa276781SNishanth Menon 2959aa276781SNishanth Menon ret = ti_sci_put_handle(handle); 2960aa276781SNishanth Menon if (ret) 2961aa276781SNishanth Menon dev_err(dev, "failed to put handle %d\n", ret); 2962aa276781SNishanth Menon } 2963aa276781SNishanth Menon 2964aa276781SNishanth Menon /** 2965aa276781SNishanth Menon * devm_ti_sci_get_handle() - Managed get handle 2966aa276781SNishanth Menon * @dev: device for which we want SCI handle for. 2967aa276781SNishanth Menon * 2968aa276781SNishanth Menon * NOTE: This releases the handle once the device resources are 2969aa276781SNishanth Menon * no longer needed. MUST NOT BE released with ti_sci_put_handle. 2970aa276781SNishanth Menon * The function does not track individual clients of the framework 2971aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2972aa276781SNishanth Menon * 2973aa276781SNishanth Menon * Return: 0 if all went fine, else corresponding error. 2974aa276781SNishanth Menon */ 2975aa276781SNishanth Menon const struct ti_sci_handle *devm_ti_sci_get_handle(struct device *dev) 2976aa276781SNishanth Menon { 2977aa276781SNishanth Menon const struct ti_sci_handle **ptr; 2978aa276781SNishanth Menon const struct ti_sci_handle *handle; 2979aa276781SNishanth Menon 2980aa276781SNishanth Menon ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL); 2981aa276781SNishanth Menon if (!ptr) 2982aa276781SNishanth Menon return ERR_PTR(-ENOMEM); 2983aa276781SNishanth Menon handle = ti_sci_get_handle(dev); 2984aa276781SNishanth Menon 2985aa276781SNishanth Menon if (!IS_ERR(handle)) { 2986aa276781SNishanth Menon *ptr = handle; 2987aa276781SNishanth Menon devres_add(dev, ptr); 2988aa276781SNishanth Menon } else { 2989aa276781SNishanth Menon devres_free(ptr); 2990aa276781SNishanth Menon } 2991aa276781SNishanth Menon 2992aa276781SNishanth Menon return handle; 2993aa276781SNishanth Menon } 2994aa276781SNishanth Menon EXPORT_SYMBOL_GPL(devm_ti_sci_get_handle); 2995aa276781SNishanth Menon 2996905c3047SGrygorii Strashko /** 2997905c3047SGrygorii Strashko * ti_sci_get_by_phandle() - Get the TI SCI handle using DT phandle 2998905c3047SGrygorii Strashko * @np: device node 2999905c3047SGrygorii Strashko * @property: property name containing phandle on TISCI node 3000905c3047SGrygorii Strashko * 3001905c3047SGrygorii Strashko * NOTE: The function does not track individual clients of the framework 3002905c3047SGrygorii Strashko * and is expected to be maintained by caller of TI SCI protocol library. 3003905c3047SGrygorii Strashko * ti_sci_put_handle must be balanced with successful ti_sci_get_by_phandle 3004905c3047SGrygorii Strashko * Return: pointer to handle if successful, else: 3005905c3047SGrygorii Strashko * -EPROBE_DEFER if the instance is not ready 3006905c3047SGrygorii Strashko * -ENODEV if the required node handler is missing 3007905c3047SGrygorii Strashko * -EINVAL if invalid conditions are encountered. 3008905c3047SGrygorii Strashko */ 3009905c3047SGrygorii Strashko const struct ti_sci_handle *ti_sci_get_by_phandle(struct device_node *np, 3010905c3047SGrygorii Strashko const char *property) 3011905c3047SGrygorii Strashko { 3012905c3047SGrygorii Strashko struct ti_sci_handle *handle = NULL; 3013905c3047SGrygorii Strashko struct device_node *ti_sci_np; 3014905c3047SGrygorii Strashko struct ti_sci_info *info; 3015905c3047SGrygorii Strashko struct list_head *p; 3016905c3047SGrygorii Strashko 3017905c3047SGrygorii Strashko if (!np) { 3018905c3047SGrygorii Strashko pr_err("I need a device pointer\n"); 3019905c3047SGrygorii Strashko return ERR_PTR(-EINVAL); 3020905c3047SGrygorii Strashko } 3021905c3047SGrygorii Strashko 3022905c3047SGrygorii Strashko ti_sci_np = of_parse_phandle(np, property, 0); 3023905c3047SGrygorii Strashko if (!ti_sci_np) 3024905c3047SGrygorii Strashko return ERR_PTR(-ENODEV); 3025905c3047SGrygorii Strashko 3026905c3047SGrygorii Strashko mutex_lock(&ti_sci_list_mutex); 3027905c3047SGrygorii Strashko list_for_each(p, &ti_sci_list) { 3028905c3047SGrygorii Strashko info = list_entry(p, struct ti_sci_info, node); 3029905c3047SGrygorii Strashko if (ti_sci_np == info->dev->of_node) { 3030905c3047SGrygorii Strashko handle = &info->handle; 3031905c3047SGrygorii Strashko info->users++; 3032905c3047SGrygorii Strashko break; 3033905c3047SGrygorii Strashko } 3034905c3047SGrygorii Strashko } 3035905c3047SGrygorii Strashko mutex_unlock(&ti_sci_list_mutex); 3036905c3047SGrygorii Strashko of_node_put(ti_sci_np); 3037905c3047SGrygorii Strashko 3038905c3047SGrygorii Strashko if (!handle) 3039905c3047SGrygorii Strashko return ERR_PTR(-EPROBE_DEFER); 3040905c3047SGrygorii Strashko 3041905c3047SGrygorii Strashko return handle; 3042905c3047SGrygorii Strashko } 3043905c3047SGrygorii Strashko EXPORT_SYMBOL_GPL(ti_sci_get_by_phandle); 3044905c3047SGrygorii Strashko 3045905c3047SGrygorii Strashko /** 3046905c3047SGrygorii Strashko * devm_ti_sci_get_by_phandle() - Managed get handle using phandle 3047905c3047SGrygorii Strashko * @dev: Device pointer requesting TISCI handle 3048905c3047SGrygorii Strashko * @property: property name containing phandle on TISCI node 3049905c3047SGrygorii Strashko * 3050905c3047SGrygorii Strashko * NOTE: This releases the handle once the device resources are 3051905c3047SGrygorii Strashko * no longer needed. MUST NOT BE released with ti_sci_put_handle. 3052905c3047SGrygorii Strashko * The function does not track individual clients of the framework 3053905c3047SGrygorii Strashko * and is expected to be maintained by caller of TI SCI protocol library. 3054905c3047SGrygorii Strashko * 3055905c3047SGrygorii Strashko * Return: 0 if all went fine, else corresponding error. 3056905c3047SGrygorii Strashko */ 3057905c3047SGrygorii Strashko const struct ti_sci_handle *devm_ti_sci_get_by_phandle(struct device *dev, 3058905c3047SGrygorii Strashko const char *property) 3059905c3047SGrygorii Strashko { 3060905c3047SGrygorii Strashko const struct ti_sci_handle *handle; 3061905c3047SGrygorii Strashko const struct ti_sci_handle **ptr; 3062905c3047SGrygorii Strashko 3063905c3047SGrygorii Strashko ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL); 3064905c3047SGrygorii Strashko if (!ptr) 3065905c3047SGrygorii Strashko return ERR_PTR(-ENOMEM); 3066905c3047SGrygorii Strashko handle = ti_sci_get_by_phandle(dev_of_node(dev), property); 3067905c3047SGrygorii Strashko 3068905c3047SGrygorii Strashko if (!IS_ERR(handle)) { 3069905c3047SGrygorii Strashko *ptr = handle; 3070905c3047SGrygorii Strashko devres_add(dev, ptr); 3071905c3047SGrygorii Strashko } else { 3072905c3047SGrygorii Strashko devres_free(ptr); 3073905c3047SGrygorii Strashko } 3074905c3047SGrygorii Strashko 3075905c3047SGrygorii Strashko return handle; 3076905c3047SGrygorii Strashko } 3077905c3047SGrygorii Strashko EXPORT_SYMBOL_GPL(devm_ti_sci_get_by_phandle); 3078905c3047SGrygorii Strashko 3079032a1ec5SLokesh Vutla /** 3080032a1ec5SLokesh Vutla * ti_sci_get_free_resource() - Get a free resource from TISCI resource. 3081032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3082032a1ec5SLokesh Vutla * 3083032a1ec5SLokesh Vutla * Return: resource num if all went ok else TI_SCI_RESOURCE_NULL. 3084032a1ec5SLokesh Vutla */ 3085032a1ec5SLokesh Vutla u16 ti_sci_get_free_resource(struct ti_sci_resource *res) 3086032a1ec5SLokesh Vutla { 3087032a1ec5SLokesh Vutla unsigned long flags; 3088032a1ec5SLokesh Vutla u16 set, free_bit; 3089032a1ec5SLokesh Vutla 3090032a1ec5SLokesh Vutla raw_spin_lock_irqsave(&res->lock, flags); 3091032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) { 3092519c5c0cSPeter Ujfalusi struct ti_sci_resource_desc *desc = &res->desc[set]; 3093519c5c0cSPeter Ujfalusi int res_count = desc->num + desc->num_sec; 3094519c5c0cSPeter Ujfalusi 3095519c5c0cSPeter Ujfalusi free_bit = find_first_zero_bit(desc->res_map, res_count); 3096519c5c0cSPeter Ujfalusi if (free_bit != res_count) { 30974dc38832SChristophe JAILLET __set_bit(free_bit, desc->res_map); 3098032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3099519c5c0cSPeter Ujfalusi 3100519c5c0cSPeter Ujfalusi if (desc->num && free_bit < desc->num) 3101519c5c0cSPeter Ujfalusi return desc->start + free_bit; 3102519c5c0cSPeter Ujfalusi else 3103519c5c0cSPeter Ujfalusi return desc->start_sec + free_bit; 3104032a1ec5SLokesh Vutla } 3105032a1ec5SLokesh Vutla } 3106032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3107032a1ec5SLokesh Vutla 3108032a1ec5SLokesh Vutla return TI_SCI_RESOURCE_NULL; 3109032a1ec5SLokesh Vutla } 3110032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_get_free_resource); 3111032a1ec5SLokesh Vutla 3112032a1ec5SLokesh Vutla /** 3113032a1ec5SLokesh Vutla * ti_sci_release_resource() - Release a resource from TISCI resource. 3114032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3115032a1ec5SLokesh Vutla * @id: Resource id to be released. 3116032a1ec5SLokesh Vutla */ 3117032a1ec5SLokesh Vutla void ti_sci_release_resource(struct ti_sci_resource *res, u16 id) 3118032a1ec5SLokesh Vutla { 3119032a1ec5SLokesh Vutla unsigned long flags; 3120032a1ec5SLokesh Vutla u16 set; 3121032a1ec5SLokesh Vutla 3122032a1ec5SLokesh Vutla raw_spin_lock_irqsave(&res->lock, flags); 3123032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) { 3124519c5c0cSPeter Ujfalusi struct ti_sci_resource_desc *desc = &res->desc[set]; 3125519c5c0cSPeter Ujfalusi 3126519c5c0cSPeter Ujfalusi if (desc->num && desc->start <= id && 3127519c5c0cSPeter Ujfalusi (desc->start + desc->num) > id) 31284dc38832SChristophe JAILLET __clear_bit(id - desc->start, desc->res_map); 3129519c5c0cSPeter Ujfalusi else if (desc->num_sec && desc->start_sec <= id && 3130519c5c0cSPeter Ujfalusi (desc->start_sec + desc->num_sec) > id) 31314dc38832SChristophe JAILLET __clear_bit(id - desc->start_sec, desc->res_map); 3132032a1ec5SLokesh Vutla } 3133032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3134032a1ec5SLokesh Vutla } 3135032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_release_resource); 3136032a1ec5SLokesh Vutla 3137032a1ec5SLokesh Vutla /** 3138032a1ec5SLokesh Vutla * ti_sci_get_num_resources() - Get the number of resources in TISCI resource 3139032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3140032a1ec5SLokesh Vutla * 3141032a1ec5SLokesh Vutla * Return: Total number of available resources. 3142032a1ec5SLokesh Vutla */ 3143032a1ec5SLokesh Vutla u32 ti_sci_get_num_resources(struct ti_sci_resource *res) 3144032a1ec5SLokesh Vutla { 3145032a1ec5SLokesh Vutla u32 set, count = 0; 3146032a1ec5SLokesh Vutla 3147032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) 3148519c5c0cSPeter Ujfalusi count += res->desc[set].num + res->desc[set].num_sec; 3149032a1ec5SLokesh Vutla 3150032a1ec5SLokesh Vutla return count; 3151032a1ec5SLokesh Vutla } 3152032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_get_num_resources); 3153032a1ec5SLokesh Vutla 3154032a1ec5SLokesh Vutla /** 315553bf2b0eSLokesh Vutla * devm_ti_sci_get_resource_sets() - Get a TISCI resources assigned to a device 3156032a1ec5SLokesh Vutla * @handle: TISCI handle 3157032a1ec5SLokesh Vutla * @dev: Device pointer to which the resource is assigned 3158032a1ec5SLokesh Vutla * @dev_id: TISCI device id to which the resource is assigned 315953bf2b0eSLokesh Vutla * @sub_types: Array of sub_types assigned corresponding to device 316053bf2b0eSLokesh Vutla * @sets: Number of sub_types 3161032a1ec5SLokesh Vutla * 3162032a1ec5SLokesh Vutla * Return: Pointer to ti_sci_resource if all went well else appropriate 3163032a1ec5SLokesh Vutla * error pointer. 3164032a1ec5SLokesh Vutla */ 316553bf2b0eSLokesh Vutla static struct ti_sci_resource * 316653bf2b0eSLokesh Vutla devm_ti_sci_get_resource_sets(const struct ti_sci_handle *handle, 316753bf2b0eSLokesh Vutla struct device *dev, u32 dev_id, u32 *sub_types, 316853bf2b0eSLokesh Vutla u32 sets) 3169032a1ec5SLokesh Vutla { 3170032a1ec5SLokesh Vutla struct ti_sci_resource *res; 3171fa42da11SPeter Ujfalusi bool valid_set = false; 3172519c5c0cSPeter Ujfalusi int i, ret, res_count; 3173032a1ec5SLokesh Vutla 3174032a1ec5SLokesh Vutla res = devm_kzalloc(dev, sizeof(*res), GFP_KERNEL); 3175032a1ec5SLokesh Vutla if (!res) 3176032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3177032a1ec5SLokesh Vutla 317853bf2b0eSLokesh Vutla res->sets = sets; 3179032a1ec5SLokesh Vutla res->desc = devm_kcalloc(dev, res->sets, sizeof(*res->desc), 3180032a1ec5SLokesh Vutla GFP_KERNEL); 3181032a1ec5SLokesh Vutla if (!res->desc) 3182032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3183032a1ec5SLokesh Vutla 3184032a1ec5SLokesh Vutla for (i = 0; i < res->sets; i++) { 3185032a1ec5SLokesh Vutla ret = handle->ops.rm_core_ops.get_range(handle, dev_id, 318653bf2b0eSLokesh Vutla sub_types[i], 3187967a020bSPeter Ujfalusi &res->desc[i]); 3188032a1ec5SLokesh Vutla if (ret) { 3189fa42da11SPeter Ujfalusi dev_dbg(dev, "dev = %d subtype %d not allocated for this host\n", 319053bf2b0eSLokesh Vutla dev_id, sub_types[i]); 3191519c5c0cSPeter Ujfalusi memset(&res->desc[i], 0, sizeof(res->desc[i])); 3192fa42da11SPeter Ujfalusi continue; 3193032a1ec5SLokesh Vutla } 3194032a1ec5SLokesh Vutla 3195519c5c0cSPeter Ujfalusi dev_dbg(dev, "dev/sub_type: %d/%d, start/num: %d/%d | %d/%d\n", 319653bf2b0eSLokesh Vutla dev_id, sub_types[i], res->desc[i].start, 3197519c5c0cSPeter Ujfalusi res->desc[i].num, res->desc[i].start_sec, 3198519c5c0cSPeter Ujfalusi res->desc[i].num_sec); 3199032a1ec5SLokesh Vutla 3200fa42da11SPeter Ujfalusi valid_set = true; 3201519c5c0cSPeter Ujfalusi res_count = res->desc[i].num + res->desc[i].num_sec; 32022f9b0402SChristophe JAILLET res->desc[i].res_map = devm_bitmap_zalloc(dev, res_count, 32032f9b0402SChristophe JAILLET GFP_KERNEL); 3204032a1ec5SLokesh Vutla if (!res->desc[i].res_map) 3205032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3206032a1ec5SLokesh Vutla } 3207032a1ec5SLokesh Vutla raw_spin_lock_init(&res->lock); 3208032a1ec5SLokesh Vutla 3209fa42da11SPeter Ujfalusi if (valid_set) 3210032a1ec5SLokesh Vutla return res; 3211fa42da11SPeter Ujfalusi 3212fa42da11SPeter Ujfalusi return ERR_PTR(-EINVAL); 3213032a1ec5SLokesh Vutla } 3214032a1ec5SLokesh Vutla 321553bf2b0eSLokesh Vutla /** 321653bf2b0eSLokesh Vutla * devm_ti_sci_get_of_resource() - Get a TISCI resource assigned to a device 321753bf2b0eSLokesh Vutla * @handle: TISCI handle 321853bf2b0eSLokesh Vutla * @dev: Device pointer to which the resource is assigned 321953bf2b0eSLokesh Vutla * @dev_id: TISCI device id to which the resource is assigned 322053bf2b0eSLokesh Vutla * @of_prop: property name by which the resource are represented 322153bf2b0eSLokesh Vutla * 322253bf2b0eSLokesh Vutla * Return: Pointer to ti_sci_resource if all went well else appropriate 322353bf2b0eSLokesh Vutla * error pointer. 322453bf2b0eSLokesh Vutla */ 322553bf2b0eSLokesh Vutla struct ti_sci_resource * 322653bf2b0eSLokesh Vutla devm_ti_sci_get_of_resource(const struct ti_sci_handle *handle, 322753bf2b0eSLokesh Vutla struct device *dev, u32 dev_id, char *of_prop) 322853bf2b0eSLokesh Vutla { 322953bf2b0eSLokesh Vutla struct ti_sci_resource *res; 323053bf2b0eSLokesh Vutla u32 *sub_types; 323153bf2b0eSLokesh Vutla int sets; 323253bf2b0eSLokesh Vutla 323353bf2b0eSLokesh Vutla sets = of_property_count_elems_of_size(dev_of_node(dev), of_prop, 323453bf2b0eSLokesh Vutla sizeof(u32)); 323553bf2b0eSLokesh Vutla if (sets < 0) { 323653bf2b0eSLokesh Vutla dev_err(dev, "%s resource type ids not available\n", of_prop); 323753bf2b0eSLokesh Vutla return ERR_PTR(sets); 323853bf2b0eSLokesh Vutla } 323953bf2b0eSLokesh Vutla 324053bf2b0eSLokesh Vutla sub_types = kcalloc(sets, sizeof(*sub_types), GFP_KERNEL); 324153bf2b0eSLokesh Vutla if (!sub_types) 324253bf2b0eSLokesh Vutla return ERR_PTR(-ENOMEM); 324353bf2b0eSLokesh Vutla 324453bf2b0eSLokesh Vutla of_property_read_u32_array(dev_of_node(dev), of_prop, sub_types, sets); 324553bf2b0eSLokesh Vutla res = devm_ti_sci_get_resource_sets(handle, dev, dev_id, sub_types, 324653bf2b0eSLokesh Vutla sets); 324753bf2b0eSLokesh Vutla 324853bf2b0eSLokesh Vutla kfree(sub_types); 324953bf2b0eSLokesh Vutla return res; 325053bf2b0eSLokesh Vutla } 325153bf2b0eSLokesh Vutla EXPORT_SYMBOL_GPL(devm_ti_sci_get_of_resource); 325253bf2b0eSLokesh Vutla 325353bf2b0eSLokesh Vutla /** 325453bf2b0eSLokesh Vutla * devm_ti_sci_get_resource() - Get a resource range assigned to the device 325553bf2b0eSLokesh Vutla * @handle: TISCI handle 325653bf2b0eSLokesh Vutla * @dev: Device pointer to which the resource is assigned 325753bf2b0eSLokesh Vutla * @dev_id: TISCI device id to which the resource is assigned 3258*3e67fd8dSNishanth Menon * @sub_type: TISCI resource subytpe representing the resource. 325953bf2b0eSLokesh Vutla * 326053bf2b0eSLokesh Vutla * Return: Pointer to ti_sci_resource if all went well else appropriate 326153bf2b0eSLokesh Vutla * error pointer. 326253bf2b0eSLokesh Vutla */ 326353bf2b0eSLokesh Vutla struct ti_sci_resource * 326453bf2b0eSLokesh Vutla devm_ti_sci_get_resource(const struct ti_sci_handle *handle, struct device *dev, 326553bf2b0eSLokesh Vutla u32 dev_id, u32 sub_type) 326653bf2b0eSLokesh Vutla { 326753bf2b0eSLokesh Vutla return devm_ti_sci_get_resource_sets(handle, dev, dev_id, &sub_type, 1); 326853bf2b0eSLokesh Vutla } 326953bf2b0eSLokesh Vutla EXPORT_SYMBOL_GPL(devm_ti_sci_get_resource); 327053bf2b0eSLokesh Vutla 3271912cffb4SNishanth Menon static int tisci_reboot_handler(struct notifier_block *nb, unsigned long mode, 3272912cffb4SNishanth Menon void *cmd) 3273912cffb4SNishanth Menon { 3274912cffb4SNishanth Menon struct ti_sci_info *info = reboot_to_ti_sci_info(nb); 3275912cffb4SNishanth Menon const struct ti_sci_handle *handle = &info->handle; 3276912cffb4SNishanth Menon 3277912cffb4SNishanth Menon ti_sci_cmd_core_reboot(handle); 3278912cffb4SNishanth Menon 3279912cffb4SNishanth Menon /* call fail OR pass, we should not be here in the first place */ 3280912cffb4SNishanth Menon return NOTIFY_BAD; 3281912cffb4SNishanth Menon } 3282912cffb4SNishanth Menon 3283aa276781SNishanth Menon /* Description for K2G */ 3284aa276781SNishanth Menon static const struct ti_sci_desc ti_sci_pmmc_k2g_desc = { 3285e69a3553SNishanth Menon .default_host_id = 2, 3286aa276781SNishanth Menon /* Conservative duration */ 3287aa276781SNishanth Menon .max_rx_timeout_ms = 1000, 3288aa276781SNishanth Menon /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */ 3289aa276781SNishanth Menon .max_msgs = 20, 3290aa276781SNishanth Menon .max_msg_size = 64, 3291754c9477SPeter Ujfalusi }; 3292754c9477SPeter Ujfalusi 3293754c9477SPeter Ujfalusi /* Description for AM654 */ 3294754c9477SPeter Ujfalusi static const struct ti_sci_desc ti_sci_pmmc_am654_desc = { 3295754c9477SPeter Ujfalusi .default_host_id = 12, 3296754c9477SPeter Ujfalusi /* Conservative duration */ 3297754c9477SPeter Ujfalusi .max_rx_timeout_ms = 10000, 3298754c9477SPeter Ujfalusi /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */ 3299754c9477SPeter Ujfalusi .max_msgs = 20, 3300754c9477SPeter Ujfalusi .max_msg_size = 60, 3301aa276781SNishanth Menon }; 3302aa276781SNishanth Menon 3303aa276781SNishanth Menon static const struct of_device_id ti_sci_of_match[] = { 3304aa276781SNishanth Menon {.compatible = "ti,k2g-sci", .data = &ti_sci_pmmc_k2g_desc}, 3305754c9477SPeter Ujfalusi {.compatible = "ti,am654-sci", .data = &ti_sci_pmmc_am654_desc}, 3306aa276781SNishanth Menon { /* Sentinel */ }, 3307aa276781SNishanth Menon }; 3308aa276781SNishanth Menon MODULE_DEVICE_TABLE(of, ti_sci_of_match); 3309aa276781SNishanth Menon 3310aa276781SNishanth Menon static int ti_sci_probe(struct platform_device *pdev) 3311aa276781SNishanth Menon { 3312aa276781SNishanth Menon struct device *dev = &pdev->dev; 3313aa276781SNishanth Menon const struct of_device_id *of_id; 3314aa276781SNishanth Menon const struct ti_sci_desc *desc; 3315aa276781SNishanth Menon struct ti_sci_xfer *xfer; 3316aa276781SNishanth Menon struct ti_sci_info *info = NULL; 3317aa276781SNishanth Menon struct ti_sci_xfers_info *minfo; 3318aa276781SNishanth Menon struct mbox_client *cl; 3319aa276781SNishanth Menon int ret = -EINVAL; 3320aa276781SNishanth Menon int i; 3321912cffb4SNishanth Menon int reboot = 0; 3322e69a3553SNishanth Menon u32 h_id; 3323aa276781SNishanth Menon 3324aa276781SNishanth Menon of_id = of_match_device(ti_sci_of_match, dev); 3325aa276781SNishanth Menon if (!of_id) { 3326aa276781SNishanth Menon dev_err(dev, "OF data missing\n"); 3327aa276781SNishanth Menon return -EINVAL; 3328aa276781SNishanth Menon } 3329aa276781SNishanth Menon desc = of_id->data; 3330aa276781SNishanth Menon 3331aa276781SNishanth Menon info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL); 3332aa276781SNishanth Menon if (!info) 3333aa276781SNishanth Menon return -ENOMEM; 3334aa276781SNishanth Menon 3335aa276781SNishanth Menon info->dev = dev; 3336aa276781SNishanth Menon info->desc = desc; 3337e69a3553SNishanth Menon ret = of_property_read_u32(dev->of_node, "ti,host-id", &h_id); 3338e69a3553SNishanth Menon /* if the property is not present in DT, use a default from desc */ 3339e69a3553SNishanth Menon if (ret < 0) { 3340e69a3553SNishanth Menon info->host_id = info->desc->default_host_id; 3341e69a3553SNishanth Menon } else { 3342e69a3553SNishanth Menon if (!h_id) { 3343e69a3553SNishanth Menon dev_warn(dev, "Host ID 0 is reserved for firmware\n"); 3344e69a3553SNishanth Menon info->host_id = info->desc->default_host_id; 3345e69a3553SNishanth Menon } else { 3346e69a3553SNishanth Menon info->host_id = h_id; 3347e69a3553SNishanth Menon } 3348e69a3553SNishanth Menon } 3349e69a3553SNishanth Menon 3350912cffb4SNishanth Menon reboot = of_property_read_bool(dev->of_node, 3351912cffb4SNishanth Menon "ti,system-reboot-controller"); 3352aa276781SNishanth Menon INIT_LIST_HEAD(&info->node); 3353aa276781SNishanth Menon minfo = &info->minfo; 3354aa276781SNishanth Menon 3355aa276781SNishanth Menon /* 3356aa276781SNishanth Menon * Pre-allocate messages 3357aa276781SNishanth Menon * NEVER allocate more than what we can indicate in hdr.seq 3358aa276781SNishanth Menon * if we have data description bug, force a fix.. 3359aa276781SNishanth Menon */ 3360aa276781SNishanth Menon if (WARN_ON(desc->max_msgs >= 3361aa276781SNishanth Menon 1 << 8 * sizeof(((struct ti_sci_msg_hdr *)0)->seq))) 3362aa276781SNishanth Menon return -EINVAL; 3363aa276781SNishanth Menon 3364aa276781SNishanth Menon minfo->xfer_block = devm_kcalloc(dev, 3365aa276781SNishanth Menon desc->max_msgs, 3366aa276781SNishanth Menon sizeof(*minfo->xfer_block), 3367aa276781SNishanth Menon GFP_KERNEL); 3368aa276781SNishanth Menon if (!minfo->xfer_block) 3369aa276781SNishanth Menon return -ENOMEM; 3370aa276781SNishanth Menon 337126507b03SChristophe JAILLET minfo->xfer_alloc_table = devm_bitmap_zalloc(dev, 337226507b03SChristophe JAILLET desc->max_msgs, 3373aa276781SNishanth Menon GFP_KERNEL); 3374aa276781SNishanth Menon if (!minfo->xfer_alloc_table) 3375aa276781SNishanth Menon return -ENOMEM; 3376aa276781SNishanth Menon 3377aa276781SNishanth Menon /* Pre-initialize the buffer pointer to pre-allocated buffers */ 3378aa276781SNishanth Menon for (i = 0, xfer = minfo->xfer_block; i < desc->max_msgs; i++, xfer++) { 3379aa276781SNishanth Menon xfer->xfer_buf = devm_kcalloc(dev, 1, desc->max_msg_size, 3380aa276781SNishanth Menon GFP_KERNEL); 3381aa276781SNishanth Menon if (!xfer->xfer_buf) 3382aa276781SNishanth Menon return -ENOMEM; 3383aa276781SNishanth Menon 3384aa276781SNishanth Menon xfer->tx_message.buf = xfer->xfer_buf; 3385aa276781SNishanth Menon init_completion(&xfer->done); 3386aa276781SNishanth Menon } 3387aa276781SNishanth Menon 3388aa276781SNishanth Menon ret = ti_sci_debugfs_create(pdev, info); 3389aa276781SNishanth Menon if (ret) 3390aa276781SNishanth Menon dev_warn(dev, "Failed to create debug file\n"); 3391aa276781SNishanth Menon 3392aa276781SNishanth Menon platform_set_drvdata(pdev, info); 3393aa276781SNishanth Menon 3394aa276781SNishanth Menon cl = &info->cl; 3395aa276781SNishanth Menon cl->dev = dev; 3396aa276781SNishanth Menon cl->tx_block = false; 3397aa276781SNishanth Menon cl->rx_callback = ti_sci_rx_callback; 3398aa276781SNishanth Menon cl->knows_txdone = true; 3399aa276781SNishanth Menon 3400aa276781SNishanth Menon spin_lock_init(&minfo->xfer_lock); 3401aa276781SNishanth Menon sema_init(&minfo->sem_xfer_count, desc->max_msgs); 3402aa276781SNishanth Menon 3403aa276781SNishanth Menon info->chan_rx = mbox_request_channel_byname(cl, "rx"); 3404aa276781SNishanth Menon if (IS_ERR(info->chan_rx)) { 3405aa276781SNishanth Menon ret = PTR_ERR(info->chan_rx); 3406aa276781SNishanth Menon goto out; 3407aa276781SNishanth Menon } 3408aa276781SNishanth Menon 3409aa276781SNishanth Menon info->chan_tx = mbox_request_channel_byname(cl, "tx"); 3410aa276781SNishanth Menon if (IS_ERR(info->chan_tx)) { 3411aa276781SNishanth Menon ret = PTR_ERR(info->chan_tx); 3412aa276781SNishanth Menon goto out; 3413aa276781SNishanth Menon } 3414aa276781SNishanth Menon ret = ti_sci_cmd_get_revision(info); 3415aa276781SNishanth Menon if (ret) { 3416aa276781SNishanth Menon dev_err(dev, "Unable to communicate with TISCI(%d)\n", ret); 3417aa276781SNishanth Menon goto out; 3418aa276781SNishanth Menon } 3419aa276781SNishanth Menon 34209e7d756dSNishanth Menon ti_sci_setup_ops(info); 34219e7d756dSNishanth Menon 3422912cffb4SNishanth Menon if (reboot) { 3423912cffb4SNishanth Menon info->nb.notifier_call = tisci_reboot_handler; 3424912cffb4SNishanth Menon info->nb.priority = 128; 3425912cffb4SNishanth Menon 3426912cffb4SNishanth Menon ret = register_restart_handler(&info->nb); 3427912cffb4SNishanth Menon if (ret) { 3428912cffb4SNishanth Menon dev_err(dev, "reboot registration fail(%d)\n", ret); 3429a181bcfcSPeiwei Hu goto out; 3430912cffb4SNishanth Menon } 3431912cffb4SNishanth Menon } 3432912cffb4SNishanth Menon 3433aa276781SNishanth Menon dev_info(dev, "ABI: %d.%d (firmware rev 0x%04x '%s')\n", 3434aa276781SNishanth Menon info->handle.version.abi_major, info->handle.version.abi_minor, 3435aa276781SNishanth Menon info->handle.version.firmware_revision, 3436aa276781SNishanth Menon info->handle.version.firmware_description); 3437aa276781SNishanth Menon 3438aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 3439aa276781SNishanth Menon list_add_tail(&info->node, &ti_sci_list); 3440aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 3441aa276781SNishanth Menon 3442aa276781SNishanth Menon return of_platform_populate(dev->of_node, NULL, NULL, dev); 3443aa276781SNishanth Menon out: 3444aa276781SNishanth Menon if (!IS_ERR(info->chan_tx)) 3445aa276781SNishanth Menon mbox_free_channel(info->chan_tx); 3446aa276781SNishanth Menon if (!IS_ERR(info->chan_rx)) 3447aa276781SNishanth Menon mbox_free_channel(info->chan_rx); 3448aa276781SNishanth Menon debugfs_remove(info->d); 3449aa276781SNishanth Menon return ret; 3450aa276781SNishanth Menon } 3451aa276781SNishanth Menon 3452aa276781SNishanth Menon static int ti_sci_remove(struct platform_device *pdev) 3453aa276781SNishanth Menon { 3454aa276781SNishanth Menon struct ti_sci_info *info; 3455aa276781SNishanth Menon struct device *dev = &pdev->dev; 3456aa276781SNishanth Menon int ret = 0; 3457aa276781SNishanth Menon 3458aa276781SNishanth Menon of_platform_depopulate(dev); 3459aa276781SNishanth Menon 3460aa276781SNishanth Menon info = platform_get_drvdata(pdev); 3461aa276781SNishanth Menon 3462912cffb4SNishanth Menon if (info->nb.notifier_call) 3463912cffb4SNishanth Menon unregister_restart_handler(&info->nb); 3464912cffb4SNishanth Menon 3465aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 3466aa276781SNishanth Menon if (info->users) 3467aa276781SNishanth Menon ret = -EBUSY; 3468aa276781SNishanth Menon else 3469aa276781SNishanth Menon list_del(&info->node); 3470aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 3471aa276781SNishanth Menon 3472aa276781SNishanth Menon if (!ret) { 3473aa276781SNishanth Menon ti_sci_debugfs_destroy(pdev, info); 3474aa276781SNishanth Menon 3475aa276781SNishanth Menon /* Safe to free channels since no more users */ 3476aa276781SNishanth Menon mbox_free_channel(info->chan_tx); 3477aa276781SNishanth Menon mbox_free_channel(info->chan_rx); 3478aa276781SNishanth Menon } 3479aa276781SNishanth Menon 3480aa276781SNishanth Menon return ret; 3481aa276781SNishanth Menon } 3482aa276781SNishanth Menon 3483aa276781SNishanth Menon static struct platform_driver ti_sci_driver = { 3484aa276781SNishanth Menon .probe = ti_sci_probe, 3485aa276781SNishanth Menon .remove = ti_sci_remove, 3486aa276781SNishanth Menon .driver = { 3487aa276781SNishanth Menon .name = "ti-sci", 3488aa276781SNishanth Menon .of_match_table = of_match_ptr(ti_sci_of_match), 3489aa276781SNishanth Menon }, 3490aa276781SNishanth Menon }; 3491aa276781SNishanth Menon module_platform_driver(ti_sci_driver); 3492aa276781SNishanth Menon 3493aa276781SNishanth Menon MODULE_LICENSE("GPL v2"); 3494aa276781SNishanth Menon MODULE_DESCRIPTION("TI System Control Interface(SCI) driver"); 3495aa276781SNishanth Menon MODULE_AUTHOR("Nishanth Menon"); 3496aa276781SNishanth Menon MODULE_ALIAS("platform:ti-sci"); 3497