11e0a6014SLokesh Vutla // SPDX-License-Identifier: GPL-2.0 2aa276781SNishanth Menon /* 3aa276781SNishanth Menon * Texas Instruments System Control Interface Protocol Driver 4aa276781SNishanth Menon * 5a6df49f4SAlexander A. Klimov * Copyright (C) 2015-2016 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> 15aa276781SNishanth Menon #include <linux/kernel.h> 16aa276781SNishanth Menon #include <linux/mailbox_client.h> 17aa276781SNishanth Menon #include <linux/module.h> 18aa276781SNishanth Menon #include <linux/of_device.h> 19aa276781SNishanth Menon #include <linux/semaphore.h> 20aa276781SNishanth Menon #include <linux/slab.h> 21aa276781SNishanth Menon #include <linux/soc/ti/ti-msgmgr.h> 22aa276781SNishanth Menon #include <linux/soc/ti/ti_sci_protocol.h> 23912cffb4SNishanth Menon #include <linux/reboot.h> 24aa276781SNishanth Menon 25aa276781SNishanth Menon #include "ti_sci.h" 26aa276781SNishanth Menon 27aa276781SNishanth Menon /* List of all TI SCI devices active in system */ 28aa276781SNishanth Menon static LIST_HEAD(ti_sci_list); 29aa276781SNishanth Menon /* Protection for the entire list */ 30aa276781SNishanth Menon static DEFINE_MUTEX(ti_sci_list_mutex); 31aa276781SNishanth Menon 32aa276781SNishanth Menon /** 33aa276781SNishanth Menon * struct ti_sci_xfer - Structure representing a message flow 34aa276781SNishanth Menon * @tx_message: Transmit message 35aa276781SNishanth Menon * @rx_len: Receive message length 36aa276781SNishanth Menon * @xfer_buf: Preallocated buffer to store receive message 37aa276781SNishanth Menon * Since we work with request-ACK protocol, we can 38aa276781SNishanth Menon * reuse the same buffer for the rx path as we 39aa276781SNishanth Menon * use for the tx path. 40aa276781SNishanth Menon * @done: completion event 41aa276781SNishanth Menon */ 42aa276781SNishanth Menon struct ti_sci_xfer { 43aa276781SNishanth Menon struct ti_msgmgr_message tx_message; 44aa276781SNishanth Menon u8 rx_len; 45aa276781SNishanth Menon u8 *xfer_buf; 46aa276781SNishanth Menon struct completion done; 47aa276781SNishanth Menon }; 48aa276781SNishanth Menon 49aa276781SNishanth Menon /** 50aa276781SNishanth Menon * struct ti_sci_xfers_info - Structure to manage transfer information 51aa276781SNishanth Menon * @sem_xfer_count: Counting Semaphore for managing max simultaneous 52aa276781SNishanth Menon * Messages. 53aa276781SNishanth Menon * @xfer_block: Preallocated Message array 54aa276781SNishanth Menon * @xfer_alloc_table: Bitmap table for allocated messages. 55aa276781SNishanth Menon * Index of this bitmap table is also used for message 56aa276781SNishanth Menon * sequence identifier. 57aa276781SNishanth Menon * @xfer_lock: Protection for message allocation 58aa276781SNishanth Menon */ 59aa276781SNishanth Menon struct ti_sci_xfers_info { 60aa276781SNishanth Menon struct semaphore sem_xfer_count; 61aa276781SNishanth Menon struct ti_sci_xfer *xfer_block; 62aa276781SNishanth Menon unsigned long *xfer_alloc_table; 63aa276781SNishanth Menon /* protect transfer allocation */ 64aa276781SNishanth Menon spinlock_t xfer_lock; 65aa276781SNishanth Menon }; 66aa276781SNishanth Menon 67aa276781SNishanth Menon /** 68aa276781SNishanth Menon * struct ti_sci_desc - Description of SoC integration 69e69a3553SNishanth Menon * @default_host_id: Host identifier representing the compute entity 70aa276781SNishanth Menon * @max_rx_timeout_ms: Timeout for communication with SoC (in Milliseconds) 71aa276781SNishanth Menon * @max_msgs: Maximum number of messages that can be pending 72aa276781SNishanth Menon * simultaneously in the system 73aa276781SNishanth Menon * @max_msg_size: Maximum size of data per message that can be handled. 74aa276781SNishanth Menon */ 75aa276781SNishanth Menon struct ti_sci_desc { 76e69a3553SNishanth Menon u8 default_host_id; 77aa276781SNishanth Menon int max_rx_timeout_ms; 78aa276781SNishanth Menon int max_msgs; 79aa276781SNishanth Menon int max_msg_size; 80aa276781SNishanth Menon }; 81aa276781SNishanth Menon 82aa276781SNishanth Menon /** 83aa276781SNishanth Menon * struct ti_sci_info - Structure representing a TI SCI instance 84aa276781SNishanth Menon * @dev: Device pointer 85aa276781SNishanth Menon * @desc: SoC description for this instance 86912cffb4SNishanth Menon * @nb: Reboot Notifier block 87aa276781SNishanth Menon * @d: Debugfs file entry 88aa276781SNishanth Menon * @debug_region: Memory region where the debug message are available 89aa276781SNishanth Menon * @debug_region_size: Debug region size 90aa276781SNishanth Menon * @debug_buffer: Buffer allocated to copy debug messages. 91aa276781SNishanth Menon * @handle: Instance of TI SCI handle to send to clients. 92aa276781SNishanth Menon * @cl: Mailbox Client 93aa276781SNishanth Menon * @chan_tx: Transmit mailbox channel 94aa276781SNishanth Menon * @chan_rx: Receive mailbox channel 95aa276781SNishanth Menon * @minfo: Message info 96aa276781SNishanth Menon * @node: list head 97e69a3553SNishanth Menon * @host_id: Host ID 98aa276781SNishanth Menon * @users: Number of users of this instance 99aa276781SNishanth Menon */ 100aa276781SNishanth Menon struct ti_sci_info { 101aa276781SNishanth Menon struct device *dev; 102912cffb4SNishanth Menon struct notifier_block nb; 103aa276781SNishanth Menon const struct ti_sci_desc *desc; 104aa276781SNishanth Menon struct dentry *d; 105aa276781SNishanth Menon void __iomem *debug_region; 106aa276781SNishanth Menon char *debug_buffer; 107aa276781SNishanth Menon size_t debug_region_size; 108aa276781SNishanth Menon struct ti_sci_handle handle; 109aa276781SNishanth Menon struct mbox_client cl; 110aa276781SNishanth Menon struct mbox_chan *chan_tx; 111aa276781SNishanth Menon struct mbox_chan *chan_rx; 112aa276781SNishanth Menon struct ti_sci_xfers_info minfo; 113aa276781SNishanth Menon struct list_head node; 114e69a3553SNishanth Menon u8 host_id; 115aa276781SNishanth Menon /* protected by ti_sci_list_mutex */ 116aa276781SNishanth Menon int users; 117912cffb4SNishanth Menon 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; 352aa276781SNishanth Menon xfer->rx_len = (u8)rx_message_size; 353aa276781SNishanth Menon 354aa276781SNishanth Menon reinit_completion(&xfer->done); 355aa276781SNishanth Menon 356aa276781SNishanth Menon hdr->seq = xfer_id; 357aa276781SNishanth Menon hdr->type = msg_type; 358e69a3553SNishanth Menon hdr->host = info->host_id; 359aa276781SNishanth Menon hdr->flags = msg_flags; 360aa276781SNishanth Menon 361aa276781SNishanth Menon return xfer; 362aa276781SNishanth Menon } 363aa276781SNishanth Menon 364aa276781SNishanth Menon /** 365aa276781SNishanth Menon * ti_sci_put_one_xfer() - Release a message 366aa276781SNishanth Menon * @minfo: transfer info pointer 367aa276781SNishanth Menon * @xfer: message that was reserved by ti_sci_get_one_xfer 368aa276781SNishanth Menon * 369aa276781SNishanth Menon * This holds a spinlock to maintain integrity of internal data structures. 370aa276781SNishanth Menon */ 371aa276781SNishanth Menon static void ti_sci_put_one_xfer(struct ti_sci_xfers_info *minfo, 372aa276781SNishanth Menon struct ti_sci_xfer *xfer) 373aa276781SNishanth Menon { 374aa276781SNishanth Menon unsigned long flags; 375aa276781SNishanth Menon struct ti_sci_msg_hdr *hdr; 376aa276781SNishanth Menon u8 xfer_id; 377aa276781SNishanth Menon 378aa276781SNishanth Menon hdr = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 379aa276781SNishanth Menon xfer_id = hdr->seq; 380aa276781SNishanth Menon 381aa276781SNishanth Menon /* 382aa276781SNishanth Menon * Keep the locked section as small as possible 383aa276781SNishanth Menon * NOTE: we might escape with smp_mb and no lock here.. 384aa276781SNishanth Menon * but just be conservative and symmetric. 385aa276781SNishanth Menon */ 386aa276781SNishanth Menon spin_lock_irqsave(&minfo->xfer_lock, flags); 387aa276781SNishanth Menon clear_bit(xfer_id, minfo->xfer_alloc_table); 388aa276781SNishanth Menon spin_unlock_irqrestore(&minfo->xfer_lock, flags); 389aa276781SNishanth Menon 390aa276781SNishanth Menon /* Increment the count for the next user to get through */ 391aa276781SNishanth Menon up(&minfo->sem_xfer_count); 392aa276781SNishanth Menon } 393aa276781SNishanth Menon 394aa276781SNishanth Menon /** 395aa276781SNishanth Menon * ti_sci_do_xfer() - Do one transfer 396aa276781SNishanth Menon * @info: Pointer to SCI entity information 397aa276781SNishanth Menon * @xfer: Transfer to initiate and wait for response 398aa276781SNishanth Menon * 399aa276781SNishanth Menon * Return: -ETIMEDOUT in case of no response, if transmit error, 400aa276781SNishanth Menon * return corresponding error, else if all goes well, 401aa276781SNishanth Menon * return 0. 402aa276781SNishanth Menon */ 403aa276781SNishanth Menon static inline int ti_sci_do_xfer(struct ti_sci_info *info, 404aa276781SNishanth Menon struct ti_sci_xfer *xfer) 405aa276781SNishanth Menon { 406aa276781SNishanth Menon int ret; 407aa276781SNishanth Menon int timeout; 408aa276781SNishanth Menon struct device *dev = info->dev; 409aa276781SNishanth Menon 410aa276781SNishanth Menon ret = mbox_send_message(info->chan_tx, &xfer->tx_message); 411aa276781SNishanth Menon if (ret < 0) 412aa276781SNishanth Menon return ret; 413aa276781SNishanth Menon 414aa276781SNishanth Menon ret = 0; 415aa276781SNishanth Menon 416aa276781SNishanth Menon /* And we wait for the response. */ 417aa276781SNishanth Menon timeout = msecs_to_jiffies(info->desc->max_rx_timeout_ms); 418aa276781SNishanth Menon if (!wait_for_completion_timeout(&xfer->done, timeout)) { 419595f3a9dSHelge Deller dev_err(dev, "Mbox timedout in resp(caller: %pS)\n", 420aa276781SNishanth Menon (void *)_RET_IP_); 421aa276781SNishanth Menon ret = -ETIMEDOUT; 422aa276781SNishanth Menon } 423aa276781SNishanth Menon /* 424aa276781SNishanth Menon * NOTE: we might prefer not to need the mailbox ticker to manage the 425aa276781SNishanth Menon * transfer queueing since the protocol layer queues things by itself. 426aa276781SNishanth Menon * Unfortunately, we have to kick the mailbox framework after we have 427aa276781SNishanth Menon * received our message. 428aa276781SNishanth Menon */ 429aa276781SNishanth Menon mbox_client_txdone(info->chan_tx, ret); 430aa276781SNishanth Menon 431aa276781SNishanth Menon return ret; 432aa276781SNishanth Menon } 433aa276781SNishanth Menon 434aa276781SNishanth Menon /** 435aa276781SNishanth Menon * ti_sci_cmd_get_revision() - command to get the revision of the SCI entity 436aa276781SNishanth Menon * @info: Pointer to SCI entity information 437aa276781SNishanth Menon * 438aa276781SNishanth Menon * Updates the SCI information in the internal data structure. 439aa276781SNishanth Menon * 440aa276781SNishanth Menon * Return: 0 if all went fine, else return appropriate error. 441aa276781SNishanth Menon */ 442aa276781SNishanth Menon static int ti_sci_cmd_get_revision(struct ti_sci_info *info) 443aa276781SNishanth Menon { 444aa276781SNishanth Menon struct device *dev = info->dev; 445aa276781SNishanth Menon struct ti_sci_handle *handle = &info->handle; 446aa276781SNishanth Menon struct ti_sci_version_info *ver = &handle->version; 447aa276781SNishanth Menon struct ti_sci_msg_resp_version *rev_info; 448aa276781SNishanth Menon struct ti_sci_xfer *xfer; 449aa276781SNishanth Menon int ret; 450aa276781SNishanth Menon 451aa276781SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_VERSION, 45266f030eaSAndrew F. Davis TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 45366f030eaSAndrew F. Davis sizeof(struct ti_sci_msg_hdr), 454aa276781SNishanth Menon sizeof(*rev_info)); 455aa276781SNishanth Menon if (IS_ERR(xfer)) { 456aa276781SNishanth Menon ret = PTR_ERR(xfer); 457aa276781SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 458aa276781SNishanth Menon return ret; 459aa276781SNishanth Menon } 460aa276781SNishanth Menon 461aa276781SNishanth Menon rev_info = (struct ti_sci_msg_resp_version *)xfer->xfer_buf; 462aa276781SNishanth Menon 463aa276781SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 464aa276781SNishanth Menon if (ret) { 465aa276781SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 466aa276781SNishanth Menon goto fail; 467aa276781SNishanth Menon } 468aa276781SNishanth Menon 469aa276781SNishanth Menon ver->abi_major = rev_info->abi_major; 470aa276781SNishanth Menon ver->abi_minor = rev_info->abi_minor; 471aa276781SNishanth Menon ver->firmware_revision = rev_info->firmware_revision; 472aa276781SNishanth Menon strncpy(ver->firmware_description, rev_info->firmware_description, 473aa276781SNishanth Menon sizeof(ver->firmware_description)); 474aa276781SNishanth Menon 475aa276781SNishanth Menon fail: 476aa276781SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 477aa276781SNishanth Menon return ret; 478aa276781SNishanth Menon } 479aa276781SNishanth Menon 480aa276781SNishanth Menon /** 4819e7d756dSNishanth Menon * ti_sci_is_response_ack() - Generic ACK/NACK message checkup 4829e7d756dSNishanth Menon * @r: pointer to response buffer 4839e7d756dSNishanth Menon * 4849e7d756dSNishanth Menon * Return: true if the response was an ACK, else returns false. 4859e7d756dSNishanth Menon */ 4869e7d756dSNishanth Menon static inline bool ti_sci_is_response_ack(void *r) 4879e7d756dSNishanth Menon { 4889e7d756dSNishanth Menon struct ti_sci_msg_hdr *hdr = r; 4899e7d756dSNishanth Menon 4909e7d756dSNishanth Menon return hdr->flags & TI_SCI_FLAG_RESP_GENERIC_ACK ? true : false; 4919e7d756dSNishanth Menon } 4929e7d756dSNishanth Menon 4939e7d756dSNishanth Menon /** 4949e7d756dSNishanth Menon * ti_sci_set_device_state() - Set device state helper 4959e7d756dSNishanth Menon * @handle: pointer to TI SCI handle 4969e7d756dSNishanth Menon * @id: Device identifier 4979e7d756dSNishanth Menon * @flags: flags to setup for the device 4989e7d756dSNishanth Menon * @state: State to move the device to 4999e7d756dSNishanth Menon * 5009e7d756dSNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 5019e7d756dSNishanth Menon */ 5029e7d756dSNishanth Menon static int ti_sci_set_device_state(const struct ti_sci_handle *handle, 5039e7d756dSNishanth Menon u32 id, u32 flags, u8 state) 5049e7d756dSNishanth Menon { 5059e7d756dSNishanth Menon struct ti_sci_info *info; 5069e7d756dSNishanth Menon struct ti_sci_msg_req_set_device_state *req; 5079e7d756dSNishanth Menon struct ti_sci_msg_hdr *resp; 5089e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 5099e7d756dSNishanth Menon struct device *dev; 5109e7d756dSNishanth Menon int ret = 0; 5119e7d756dSNishanth Menon 5129e7d756dSNishanth Menon if (IS_ERR(handle)) 5139e7d756dSNishanth Menon return PTR_ERR(handle); 5149e7d756dSNishanth Menon if (!handle) 5159e7d756dSNishanth Menon return -EINVAL; 5169e7d756dSNishanth Menon 5179e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 5189e7d756dSNishanth Menon dev = info->dev; 5199e7d756dSNishanth Menon 5209e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_STATE, 5219e7d756dSNishanth Menon flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 5229e7d756dSNishanth Menon sizeof(*req), sizeof(*resp)); 5239e7d756dSNishanth Menon if (IS_ERR(xfer)) { 5249e7d756dSNishanth Menon ret = PTR_ERR(xfer); 5259e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 5269e7d756dSNishanth Menon return ret; 5279e7d756dSNishanth Menon } 5289e7d756dSNishanth Menon req = (struct ti_sci_msg_req_set_device_state *)xfer->xfer_buf; 5299e7d756dSNishanth Menon req->id = id; 5309e7d756dSNishanth Menon req->state = state; 5319e7d756dSNishanth Menon 5329e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 5339e7d756dSNishanth Menon if (ret) { 5349e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 5359e7d756dSNishanth Menon goto fail; 5369e7d756dSNishanth Menon } 5379e7d756dSNishanth Menon 5389e7d756dSNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 5399e7d756dSNishanth Menon 5409e7d756dSNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 5419e7d756dSNishanth Menon 5429e7d756dSNishanth Menon fail: 5439e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 5449e7d756dSNishanth Menon 5459e7d756dSNishanth Menon return ret; 5469e7d756dSNishanth Menon } 5479e7d756dSNishanth Menon 5489e7d756dSNishanth Menon /** 5499e7d756dSNishanth Menon * ti_sci_get_device_state() - Get device state helper 5509e7d756dSNishanth Menon * @handle: Handle to the device 5519e7d756dSNishanth Menon * @id: Device Identifier 5529e7d756dSNishanth Menon * @clcnt: Pointer to Context Loss Count 5539e7d756dSNishanth Menon * @resets: pointer to resets 5549e7d756dSNishanth Menon * @p_state: pointer to p_state 5559e7d756dSNishanth Menon * @c_state: pointer to c_state 5569e7d756dSNishanth Menon * 5579e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 5589e7d756dSNishanth Menon */ 5599e7d756dSNishanth Menon static int ti_sci_get_device_state(const struct ti_sci_handle *handle, 5609e7d756dSNishanth Menon u32 id, u32 *clcnt, u32 *resets, 5619e7d756dSNishanth Menon u8 *p_state, u8 *c_state) 5629e7d756dSNishanth Menon { 5639e7d756dSNishanth Menon struct ti_sci_info *info; 5649e7d756dSNishanth Menon struct ti_sci_msg_req_get_device_state *req; 5659e7d756dSNishanth Menon struct ti_sci_msg_resp_get_device_state *resp; 5669e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 5679e7d756dSNishanth Menon struct device *dev; 5689e7d756dSNishanth Menon int ret = 0; 5699e7d756dSNishanth Menon 5709e7d756dSNishanth Menon if (IS_ERR(handle)) 5719e7d756dSNishanth Menon return PTR_ERR(handle); 5729e7d756dSNishanth Menon if (!handle) 5739e7d756dSNishanth Menon return -EINVAL; 5749e7d756dSNishanth Menon 5759e7d756dSNishanth Menon if (!clcnt && !resets && !p_state && !c_state) 5769e7d756dSNishanth Menon return -EINVAL; 5779e7d756dSNishanth Menon 5789e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 5799e7d756dSNishanth Menon dev = info->dev; 5809e7d756dSNishanth Menon 5819e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_DEVICE_STATE, 58266f030eaSAndrew F. Davis TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 58366f030eaSAndrew F. Davis sizeof(*req), sizeof(*resp)); 5849e7d756dSNishanth Menon if (IS_ERR(xfer)) { 5859e7d756dSNishanth Menon ret = PTR_ERR(xfer); 5869e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 5879e7d756dSNishanth Menon return ret; 5889e7d756dSNishanth Menon } 5899e7d756dSNishanth Menon req = (struct ti_sci_msg_req_get_device_state *)xfer->xfer_buf; 5909e7d756dSNishanth Menon req->id = id; 5919e7d756dSNishanth Menon 5929e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 5939e7d756dSNishanth Menon if (ret) { 5949e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 5959e7d756dSNishanth Menon goto fail; 5969e7d756dSNishanth Menon } 5979e7d756dSNishanth Menon 5989e7d756dSNishanth Menon resp = (struct ti_sci_msg_resp_get_device_state *)xfer->xfer_buf; 5999e7d756dSNishanth Menon if (!ti_sci_is_response_ack(resp)) { 6009e7d756dSNishanth Menon ret = -ENODEV; 6019e7d756dSNishanth Menon goto fail; 6029e7d756dSNishanth Menon } 6039e7d756dSNishanth Menon 6049e7d756dSNishanth Menon if (clcnt) 6059e7d756dSNishanth Menon *clcnt = resp->context_loss_count; 6069e7d756dSNishanth Menon if (resets) 6079e7d756dSNishanth Menon *resets = resp->resets; 6089e7d756dSNishanth Menon if (p_state) 6099e7d756dSNishanth Menon *p_state = resp->programmed_state; 6109e7d756dSNishanth Menon if (c_state) 6119e7d756dSNishanth Menon *c_state = resp->current_state; 6129e7d756dSNishanth Menon fail: 6139e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 6149e7d756dSNishanth Menon 6159e7d756dSNishanth Menon return ret; 6169e7d756dSNishanth Menon } 6179e7d756dSNishanth Menon 6189e7d756dSNishanth Menon /** 6199e7d756dSNishanth Menon * ti_sci_cmd_get_device() - command to request for device managed by TISCI 62045b659eeSLokesh Vutla * that can be shared with other hosts. 6219e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 6229e7d756dSNishanth Menon * @id: Device Identifier 6239e7d756dSNishanth Menon * 6249e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 6259e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 6269e7d756dSNishanth Menon * managed by driver for that purpose. 6279e7d756dSNishanth Menon * 6289e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 6299e7d756dSNishanth Menon */ 6309e7d756dSNishanth Menon static int ti_sci_cmd_get_device(const struct ti_sci_handle *handle, u32 id) 6319e7d756dSNishanth Menon { 63245b659eeSLokesh Vutla return ti_sci_set_device_state(handle, id, 0, 63345b659eeSLokesh Vutla MSG_DEVICE_SW_STATE_ON); 63445b659eeSLokesh Vutla } 63545b659eeSLokesh Vutla 63645b659eeSLokesh Vutla /** 63745b659eeSLokesh Vutla * ti_sci_cmd_get_device_exclusive() - command to request for device managed by 63845b659eeSLokesh Vutla * TISCI that is exclusively owned by the 63945b659eeSLokesh Vutla * requesting host. 64045b659eeSLokesh Vutla * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 64145b659eeSLokesh Vutla * @id: Device Identifier 64245b659eeSLokesh Vutla * 64345b659eeSLokesh Vutla * Request for the device - NOTE: the client MUST maintain integrity of 64445b659eeSLokesh Vutla * usage count by balancing get_device with put_device. No refcounting is 64545b659eeSLokesh Vutla * managed by driver for that purpose. 64645b659eeSLokesh Vutla * 64745b659eeSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 64845b659eeSLokesh Vutla */ 64945b659eeSLokesh Vutla static int ti_sci_cmd_get_device_exclusive(const struct ti_sci_handle *handle, 65045b659eeSLokesh Vutla u32 id) 65145b659eeSLokesh Vutla { 6529e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 6539e7d756dSNishanth Menon MSG_FLAG_DEVICE_EXCLUSIVE, 6549e7d756dSNishanth Menon MSG_DEVICE_SW_STATE_ON); 6559e7d756dSNishanth Menon } 6569e7d756dSNishanth Menon 6579e7d756dSNishanth Menon /** 6589e7d756dSNishanth Menon * ti_sci_cmd_idle_device() - Command to idle a device managed by TISCI 6599e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 6609e7d756dSNishanth Menon * @id: Device Identifier 6619e7d756dSNishanth Menon * 6629e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 6639e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 6649e7d756dSNishanth Menon * managed by driver for that purpose. 6659e7d756dSNishanth Menon * 6669e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 6679e7d756dSNishanth Menon */ 6689e7d756dSNishanth Menon static int ti_sci_cmd_idle_device(const struct ti_sci_handle *handle, u32 id) 6699e7d756dSNishanth Menon { 67045b659eeSLokesh Vutla return ti_sci_set_device_state(handle, id, 0, 67145b659eeSLokesh Vutla MSG_DEVICE_SW_STATE_RETENTION); 67245b659eeSLokesh Vutla } 67345b659eeSLokesh Vutla 67445b659eeSLokesh Vutla /** 67545b659eeSLokesh Vutla * ti_sci_cmd_idle_device_exclusive() - Command to idle a device managed by 67645b659eeSLokesh Vutla * TISCI that is exclusively owned by 67745b659eeSLokesh Vutla * requesting host. 67845b659eeSLokesh Vutla * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 67945b659eeSLokesh Vutla * @id: Device Identifier 68045b659eeSLokesh Vutla * 68145b659eeSLokesh Vutla * Request for the device - NOTE: the client MUST maintain integrity of 68245b659eeSLokesh Vutla * usage count by balancing get_device with put_device. No refcounting is 68345b659eeSLokesh Vutla * managed by driver for that purpose. 68445b659eeSLokesh Vutla * 68545b659eeSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 68645b659eeSLokesh Vutla */ 68745b659eeSLokesh Vutla static int ti_sci_cmd_idle_device_exclusive(const struct ti_sci_handle *handle, 68845b659eeSLokesh Vutla u32 id) 68945b659eeSLokesh Vutla { 6909e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 6919e7d756dSNishanth Menon MSG_FLAG_DEVICE_EXCLUSIVE, 6929e7d756dSNishanth Menon MSG_DEVICE_SW_STATE_RETENTION); 6939e7d756dSNishanth Menon } 6949e7d756dSNishanth Menon 6959e7d756dSNishanth Menon /** 6969e7d756dSNishanth Menon * ti_sci_cmd_put_device() - command to release a device managed by TISCI 6979e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 6989e7d756dSNishanth Menon * @id: Device Identifier 6999e7d756dSNishanth Menon * 7009e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 7019e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 7029e7d756dSNishanth Menon * managed by driver for that purpose. 7039e7d756dSNishanth Menon * 7049e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7059e7d756dSNishanth Menon */ 7069e7d756dSNishanth Menon static int ti_sci_cmd_put_device(const struct ti_sci_handle *handle, u32 id) 7079e7d756dSNishanth Menon { 7089e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 7099e7d756dSNishanth Menon 0, MSG_DEVICE_SW_STATE_AUTO_OFF); 7109e7d756dSNishanth Menon } 7119e7d756dSNishanth Menon 7129e7d756dSNishanth Menon /** 7139e7d756dSNishanth Menon * ti_sci_cmd_dev_is_valid() - Is the device valid 7149e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 7159e7d756dSNishanth Menon * @id: Device Identifier 7169e7d756dSNishanth Menon * 7179e7d756dSNishanth Menon * Return: 0 if all went fine and the device ID is valid, else return 7189e7d756dSNishanth Menon * appropriate error. 7199e7d756dSNishanth Menon */ 7209e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_valid(const struct ti_sci_handle *handle, u32 id) 7219e7d756dSNishanth Menon { 7229e7d756dSNishanth Menon u8 unused; 7239e7d756dSNishanth Menon 7249e7d756dSNishanth Menon /* check the device state which will also tell us if the ID is valid */ 7259e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &unused); 7269e7d756dSNishanth Menon } 7279e7d756dSNishanth Menon 7289e7d756dSNishanth Menon /** 7299e7d756dSNishanth Menon * ti_sci_cmd_dev_get_clcnt() - Get context loss counter 7309e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7319e7d756dSNishanth Menon * @id: Device Identifier 7329e7d756dSNishanth Menon * @count: Pointer to Context Loss counter to populate 7339e7d756dSNishanth Menon * 7349e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7359e7d756dSNishanth Menon */ 7369e7d756dSNishanth Menon static int ti_sci_cmd_dev_get_clcnt(const struct ti_sci_handle *handle, u32 id, 7379e7d756dSNishanth Menon u32 *count) 7389e7d756dSNishanth Menon { 7399e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, count, NULL, NULL, NULL); 7409e7d756dSNishanth Menon } 7419e7d756dSNishanth Menon 7429e7d756dSNishanth Menon /** 7439e7d756dSNishanth Menon * ti_sci_cmd_dev_is_idle() - Check if the device is requested to be idle 7449e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7459e7d756dSNishanth Menon * @id: Device Identifier 7469e7d756dSNishanth Menon * @r_state: true if requested to be idle 7479e7d756dSNishanth Menon * 7489e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7499e7d756dSNishanth Menon */ 7509e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_idle(const struct ti_sci_handle *handle, u32 id, 7519e7d756dSNishanth Menon bool *r_state) 7529e7d756dSNishanth Menon { 7539e7d756dSNishanth Menon int ret; 7549e7d756dSNishanth Menon u8 state; 7559e7d756dSNishanth Menon 7569e7d756dSNishanth Menon if (!r_state) 7579e7d756dSNishanth Menon return -EINVAL; 7589e7d756dSNishanth Menon 7599e7d756dSNishanth Menon ret = ti_sci_get_device_state(handle, id, NULL, NULL, &state, NULL); 7609e7d756dSNishanth Menon if (ret) 7619e7d756dSNishanth Menon return ret; 7629e7d756dSNishanth Menon 7639e7d756dSNishanth Menon *r_state = (state == MSG_DEVICE_SW_STATE_RETENTION); 7649e7d756dSNishanth Menon 7659e7d756dSNishanth Menon return 0; 7669e7d756dSNishanth Menon } 7679e7d756dSNishanth Menon 7689e7d756dSNishanth Menon /** 7699e7d756dSNishanth Menon * ti_sci_cmd_dev_is_stop() - Check if the device is requested to be stopped 7709e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7719e7d756dSNishanth Menon * @id: Device Identifier 7729e7d756dSNishanth Menon * @r_state: true if requested to be stopped 7739e7d756dSNishanth Menon * @curr_state: true if currently stopped. 7749e7d756dSNishanth Menon * 7759e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7769e7d756dSNishanth Menon */ 7779e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_stop(const struct ti_sci_handle *handle, u32 id, 7789e7d756dSNishanth Menon bool *r_state, bool *curr_state) 7799e7d756dSNishanth Menon { 7809e7d756dSNishanth Menon int ret; 7819e7d756dSNishanth Menon u8 p_state, c_state; 7829e7d756dSNishanth Menon 7839e7d756dSNishanth Menon if (!r_state && !curr_state) 7849e7d756dSNishanth Menon return -EINVAL; 7859e7d756dSNishanth Menon 7869e7d756dSNishanth Menon ret = 7879e7d756dSNishanth Menon ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state); 7889e7d756dSNishanth Menon if (ret) 7899e7d756dSNishanth Menon return ret; 7909e7d756dSNishanth Menon 7919e7d756dSNishanth Menon if (r_state) 7929e7d756dSNishanth Menon *r_state = (p_state == MSG_DEVICE_SW_STATE_AUTO_OFF); 7939e7d756dSNishanth Menon if (curr_state) 7949e7d756dSNishanth Menon *curr_state = (c_state == MSG_DEVICE_HW_STATE_OFF); 7959e7d756dSNishanth Menon 7969e7d756dSNishanth Menon return 0; 7979e7d756dSNishanth Menon } 7989e7d756dSNishanth Menon 7999e7d756dSNishanth Menon /** 8009e7d756dSNishanth Menon * ti_sci_cmd_dev_is_on() - Check if the device is requested to be ON 8019e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 8029e7d756dSNishanth Menon * @id: Device Identifier 8039e7d756dSNishanth Menon * @r_state: true if requested to be ON 8049e7d756dSNishanth Menon * @curr_state: true if currently ON and active 8059e7d756dSNishanth Menon * 8069e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8079e7d756dSNishanth Menon */ 8089e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_on(const struct ti_sci_handle *handle, u32 id, 8099e7d756dSNishanth Menon bool *r_state, bool *curr_state) 8109e7d756dSNishanth Menon { 8119e7d756dSNishanth Menon int ret; 8129e7d756dSNishanth Menon u8 p_state, c_state; 8139e7d756dSNishanth Menon 8149e7d756dSNishanth Menon if (!r_state && !curr_state) 8159e7d756dSNishanth Menon return -EINVAL; 8169e7d756dSNishanth Menon 8179e7d756dSNishanth Menon ret = 8189e7d756dSNishanth Menon ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state); 8199e7d756dSNishanth Menon if (ret) 8209e7d756dSNishanth Menon return ret; 8219e7d756dSNishanth Menon 8229e7d756dSNishanth Menon if (r_state) 8239e7d756dSNishanth Menon *r_state = (p_state == MSG_DEVICE_SW_STATE_ON); 8249e7d756dSNishanth Menon if (curr_state) 8259e7d756dSNishanth Menon *curr_state = (c_state == MSG_DEVICE_HW_STATE_ON); 8269e7d756dSNishanth Menon 8279e7d756dSNishanth Menon return 0; 8289e7d756dSNishanth Menon } 8299e7d756dSNishanth Menon 8309e7d756dSNishanth Menon /** 8319e7d756dSNishanth Menon * ti_sci_cmd_dev_is_trans() - Check if the device is currently transitioning 8329e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 8339e7d756dSNishanth Menon * @id: Device Identifier 8349e7d756dSNishanth Menon * @curr_state: true if currently transitioning. 8359e7d756dSNishanth Menon * 8369e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8379e7d756dSNishanth Menon */ 8389e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_trans(const struct ti_sci_handle *handle, u32 id, 8399e7d756dSNishanth Menon bool *curr_state) 8409e7d756dSNishanth Menon { 8419e7d756dSNishanth Menon int ret; 8429e7d756dSNishanth Menon u8 state; 8439e7d756dSNishanth Menon 8449e7d756dSNishanth Menon if (!curr_state) 8459e7d756dSNishanth Menon return -EINVAL; 8469e7d756dSNishanth Menon 8479e7d756dSNishanth Menon ret = ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &state); 8489e7d756dSNishanth Menon if (ret) 8499e7d756dSNishanth Menon return ret; 8509e7d756dSNishanth Menon 8519e7d756dSNishanth Menon *curr_state = (state == MSG_DEVICE_HW_STATE_TRANS); 8529e7d756dSNishanth Menon 8539e7d756dSNishanth Menon return 0; 8549e7d756dSNishanth Menon } 8559e7d756dSNishanth Menon 8569e7d756dSNishanth Menon /** 8579e7d756dSNishanth Menon * ti_sci_cmd_set_device_resets() - command to set resets for device managed 8589e7d756dSNishanth Menon * by TISCI 8599e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 8609e7d756dSNishanth Menon * @id: Device Identifier 8619e7d756dSNishanth Menon * @reset_state: Device specific reset bit field 8629e7d756dSNishanth Menon * 8639e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8649e7d756dSNishanth Menon */ 8659e7d756dSNishanth Menon static int ti_sci_cmd_set_device_resets(const struct ti_sci_handle *handle, 8669e7d756dSNishanth Menon u32 id, u32 reset_state) 8679e7d756dSNishanth Menon { 8689e7d756dSNishanth Menon struct ti_sci_info *info; 8699e7d756dSNishanth Menon struct ti_sci_msg_req_set_device_resets *req; 8709e7d756dSNishanth Menon struct ti_sci_msg_hdr *resp; 8719e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 8729e7d756dSNishanth Menon struct device *dev; 8739e7d756dSNishanth Menon int ret = 0; 8749e7d756dSNishanth Menon 8759e7d756dSNishanth Menon if (IS_ERR(handle)) 8769e7d756dSNishanth Menon return PTR_ERR(handle); 8779e7d756dSNishanth Menon if (!handle) 8789e7d756dSNishanth Menon return -EINVAL; 8799e7d756dSNishanth Menon 8809e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 8819e7d756dSNishanth Menon dev = info->dev; 8829e7d756dSNishanth Menon 8839e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_RESETS, 8849e7d756dSNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 8859e7d756dSNishanth Menon sizeof(*req), sizeof(*resp)); 8869e7d756dSNishanth Menon if (IS_ERR(xfer)) { 8879e7d756dSNishanth Menon ret = PTR_ERR(xfer); 8889e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 8899e7d756dSNishanth Menon return ret; 8909e7d756dSNishanth Menon } 8919e7d756dSNishanth Menon req = (struct ti_sci_msg_req_set_device_resets *)xfer->xfer_buf; 8929e7d756dSNishanth Menon req->id = id; 8939e7d756dSNishanth Menon req->resets = reset_state; 8949e7d756dSNishanth Menon 8959e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 8969e7d756dSNishanth Menon if (ret) { 8979e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 8989e7d756dSNishanth Menon goto fail; 8999e7d756dSNishanth Menon } 9009e7d756dSNishanth Menon 9019e7d756dSNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 9029e7d756dSNishanth Menon 9039e7d756dSNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 9049e7d756dSNishanth Menon 9059e7d756dSNishanth Menon fail: 9069e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 9079e7d756dSNishanth Menon 9089e7d756dSNishanth Menon return ret; 9099e7d756dSNishanth Menon } 9109e7d756dSNishanth Menon 9119e7d756dSNishanth Menon /** 9129e7d756dSNishanth Menon * ti_sci_cmd_get_device_resets() - Get reset state for device managed 9139e7d756dSNishanth Menon * by TISCI 9149e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 9159e7d756dSNishanth Menon * @id: Device Identifier 9169e7d756dSNishanth Menon * @reset_state: Pointer to reset state to populate 9179e7d756dSNishanth Menon * 9189e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 9199e7d756dSNishanth Menon */ 9209e7d756dSNishanth Menon static int ti_sci_cmd_get_device_resets(const struct ti_sci_handle *handle, 9219e7d756dSNishanth Menon u32 id, u32 *reset_state) 9229e7d756dSNishanth Menon { 9239e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, NULL, reset_state, NULL, 9249e7d756dSNishanth Menon NULL); 9259e7d756dSNishanth Menon } 9269e7d756dSNishanth Menon 9279f723220SNishanth Menon /** 9289f723220SNishanth Menon * ti_sci_set_clock_state() - Set clock state helper 9299f723220SNishanth Menon * @handle: pointer to TI SCI handle 9309f723220SNishanth Menon * @dev_id: Device identifier this request is for 9319f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 9329f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 9339f723220SNishanth Menon * which clock input to modify. 9349f723220SNishanth Menon * @flags: Header flags as needed 9359f723220SNishanth Menon * @state: State to request for the clock. 9369f723220SNishanth Menon * 9379f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 9389f723220SNishanth Menon */ 9399f723220SNishanth Menon static int ti_sci_set_clock_state(const struct ti_sci_handle *handle, 94081f4458cSTero Kristo u32 dev_id, u32 clk_id, 9419f723220SNishanth Menon u32 flags, u8 state) 9429f723220SNishanth Menon { 9439f723220SNishanth Menon struct ti_sci_info *info; 9449f723220SNishanth Menon struct ti_sci_msg_req_set_clock_state *req; 9459f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 9469f723220SNishanth Menon struct ti_sci_xfer *xfer; 9479f723220SNishanth Menon struct device *dev; 9489f723220SNishanth Menon int ret = 0; 9499f723220SNishanth Menon 9509f723220SNishanth Menon if (IS_ERR(handle)) 9519f723220SNishanth Menon return PTR_ERR(handle); 9529f723220SNishanth Menon if (!handle) 9539f723220SNishanth Menon return -EINVAL; 9549f723220SNishanth Menon 9559f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 9569f723220SNishanth Menon dev = info->dev; 9579f723220SNishanth Menon 9589f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_STATE, 9599f723220SNishanth Menon flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 9609f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 9619f723220SNishanth Menon if (IS_ERR(xfer)) { 9629f723220SNishanth Menon ret = PTR_ERR(xfer); 9639f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 9649f723220SNishanth Menon return ret; 9659f723220SNishanth Menon } 9669f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_state *)xfer->xfer_buf; 9679f723220SNishanth Menon req->dev_id = dev_id; 96881f4458cSTero Kristo if (clk_id < 255) { 9699f723220SNishanth Menon req->clk_id = clk_id; 97081f4458cSTero Kristo } else { 97181f4458cSTero Kristo req->clk_id = 255; 97281f4458cSTero Kristo req->clk_id_32 = clk_id; 97381f4458cSTero Kristo } 9749f723220SNishanth Menon req->request_state = state; 9759f723220SNishanth Menon 9769f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 9779f723220SNishanth Menon if (ret) { 9789f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 9799f723220SNishanth Menon goto fail; 9809f723220SNishanth Menon } 9819f723220SNishanth Menon 9829f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 9839f723220SNishanth Menon 9849f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 9859f723220SNishanth Menon 9869f723220SNishanth Menon fail: 9879f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 9889f723220SNishanth Menon 9899f723220SNishanth Menon return ret; 9909f723220SNishanth Menon } 9919f723220SNishanth Menon 9929f723220SNishanth Menon /** 9939f723220SNishanth Menon * ti_sci_cmd_get_clock_state() - Get clock state helper 9949f723220SNishanth Menon * @handle: pointer to TI SCI handle 9959f723220SNishanth Menon * @dev_id: Device identifier this request is for 9969f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 9979f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 9989f723220SNishanth Menon * which clock input to modify. 9999f723220SNishanth Menon * @programmed_state: State requested for clock to move to 10009f723220SNishanth Menon * @current_state: State that the clock is currently in 10019f723220SNishanth Menon * 10029f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 10039f723220SNishanth Menon */ 10049f723220SNishanth Menon static int ti_sci_cmd_get_clock_state(const struct ti_sci_handle *handle, 100581f4458cSTero Kristo u32 dev_id, u32 clk_id, 10069f723220SNishanth Menon u8 *programmed_state, u8 *current_state) 10079f723220SNishanth Menon { 10089f723220SNishanth Menon struct ti_sci_info *info; 10099f723220SNishanth Menon struct ti_sci_msg_req_get_clock_state *req; 10109f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_state *resp; 10119f723220SNishanth Menon struct ti_sci_xfer *xfer; 10129f723220SNishanth Menon struct device *dev; 10139f723220SNishanth Menon int ret = 0; 10149f723220SNishanth Menon 10159f723220SNishanth Menon if (IS_ERR(handle)) 10169f723220SNishanth Menon return PTR_ERR(handle); 10179f723220SNishanth Menon if (!handle) 10189f723220SNishanth Menon return -EINVAL; 10199f723220SNishanth Menon 10209f723220SNishanth Menon if (!programmed_state && !current_state) 10219f723220SNishanth Menon return -EINVAL; 10229f723220SNishanth Menon 10239f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 10249f723220SNishanth Menon dev = info->dev; 10259f723220SNishanth Menon 10269f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_STATE, 10279f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 10289f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 10299f723220SNishanth Menon if (IS_ERR(xfer)) { 10309f723220SNishanth Menon ret = PTR_ERR(xfer); 10319f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 10329f723220SNishanth Menon return ret; 10339f723220SNishanth Menon } 10349f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_state *)xfer->xfer_buf; 10359f723220SNishanth Menon req->dev_id = dev_id; 103681f4458cSTero Kristo if (clk_id < 255) { 10379f723220SNishanth Menon req->clk_id = clk_id; 103881f4458cSTero Kristo } else { 103981f4458cSTero Kristo req->clk_id = 255; 104081f4458cSTero Kristo req->clk_id_32 = clk_id; 104181f4458cSTero Kristo } 10429f723220SNishanth Menon 10439f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 10449f723220SNishanth Menon if (ret) { 10459f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 10469f723220SNishanth Menon goto fail; 10479f723220SNishanth Menon } 10489f723220SNishanth Menon 10499f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_state *)xfer->xfer_buf; 10509f723220SNishanth Menon 10519f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) { 10529f723220SNishanth Menon ret = -ENODEV; 10539f723220SNishanth Menon goto fail; 10549f723220SNishanth Menon } 10559f723220SNishanth Menon 10569f723220SNishanth Menon if (programmed_state) 10579f723220SNishanth Menon *programmed_state = resp->programmed_state; 10589f723220SNishanth Menon if (current_state) 10599f723220SNishanth Menon *current_state = resp->current_state; 10609f723220SNishanth Menon 10619f723220SNishanth Menon fail: 10629f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 10639f723220SNishanth Menon 10649f723220SNishanth Menon return ret; 10659f723220SNishanth Menon } 10669f723220SNishanth Menon 10679f723220SNishanth Menon /** 10689f723220SNishanth Menon * ti_sci_cmd_get_clock() - Get control of a clock from TI SCI 10699f723220SNishanth Menon * @handle: pointer to TI SCI handle 10709f723220SNishanth Menon * @dev_id: Device identifier this request is for 10719f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 10729f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 10739f723220SNishanth Menon * which clock input to modify. 10749f723220SNishanth Menon * @needs_ssc: 'true' if Spread Spectrum clock is desired, else 'false' 10759f723220SNishanth Menon * @can_change_freq: 'true' if frequency change is desired, else 'false' 10769f723220SNishanth Menon * @enable_input_term: 'true' if input termination is desired, else 'false' 10779f723220SNishanth Menon * 10789f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 10799f723220SNishanth Menon */ 10809f723220SNishanth Menon static int ti_sci_cmd_get_clock(const struct ti_sci_handle *handle, u32 dev_id, 108181f4458cSTero Kristo u32 clk_id, bool needs_ssc, 108281f4458cSTero Kristo bool can_change_freq, bool enable_input_term) 10839f723220SNishanth Menon { 10849f723220SNishanth Menon u32 flags = 0; 10859f723220SNishanth Menon 10869f723220SNishanth Menon flags |= needs_ssc ? MSG_FLAG_CLOCK_ALLOW_SSC : 0; 10879f723220SNishanth Menon flags |= can_change_freq ? MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE : 0; 10889f723220SNishanth Menon flags |= enable_input_term ? MSG_FLAG_CLOCK_INPUT_TERM : 0; 10899f723220SNishanth Menon 10909f723220SNishanth Menon return ti_sci_set_clock_state(handle, dev_id, clk_id, flags, 10919f723220SNishanth Menon MSG_CLOCK_SW_STATE_REQ); 10929f723220SNishanth Menon } 10939f723220SNishanth Menon 10949f723220SNishanth Menon /** 10959f723220SNishanth Menon * ti_sci_cmd_idle_clock() - Idle a clock which is in our control 10969f723220SNishanth Menon * @handle: pointer to TI SCI handle 10979f723220SNishanth Menon * @dev_id: Device identifier this request is for 10989f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 10999f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11009f723220SNishanth Menon * which clock input to modify. 11019f723220SNishanth Menon * 11029f723220SNishanth Menon * NOTE: This clock must have been requested by get_clock previously. 11039f723220SNishanth Menon * 11049f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11059f723220SNishanth Menon */ 11069f723220SNishanth Menon static int ti_sci_cmd_idle_clock(const struct ti_sci_handle *handle, 110781f4458cSTero Kristo u32 dev_id, u32 clk_id) 11089f723220SNishanth Menon { 11099f723220SNishanth Menon return ti_sci_set_clock_state(handle, dev_id, clk_id, 0, 11109f723220SNishanth Menon MSG_CLOCK_SW_STATE_UNREQ); 11119f723220SNishanth Menon } 11129f723220SNishanth Menon 11139f723220SNishanth Menon /** 11149f723220SNishanth Menon * ti_sci_cmd_put_clock() - Release a clock from our control back to TISCI 11159f723220SNishanth Menon * @handle: pointer to TI SCI handle 11169f723220SNishanth Menon * @dev_id: Device identifier this request is for 11179f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11189f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11199f723220SNishanth Menon * which clock input to modify. 11209f723220SNishanth Menon * 11219f723220SNishanth Menon * NOTE: This clock must have been requested by get_clock previously. 11229f723220SNishanth Menon * 11239f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11249f723220SNishanth Menon */ 11259f723220SNishanth Menon static int ti_sci_cmd_put_clock(const struct ti_sci_handle *handle, 112681f4458cSTero Kristo u32 dev_id, u32 clk_id) 11279f723220SNishanth Menon { 11289f723220SNishanth Menon return ti_sci_set_clock_state(handle, dev_id, clk_id, 0, 11299f723220SNishanth Menon MSG_CLOCK_SW_STATE_AUTO); 11309f723220SNishanth Menon } 11319f723220SNishanth Menon 11329f723220SNishanth Menon /** 11339f723220SNishanth Menon * ti_sci_cmd_clk_is_auto() - Is the clock being auto managed 11349f723220SNishanth Menon * @handle: pointer to TI SCI handle 11359f723220SNishanth Menon * @dev_id: Device identifier this request is for 11369f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11379f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11389f723220SNishanth Menon * which clock input to modify. 11399f723220SNishanth Menon * @req_state: state indicating if the clock is auto managed 11409f723220SNishanth Menon * 11419f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11429f723220SNishanth Menon */ 11439f723220SNishanth Menon static int ti_sci_cmd_clk_is_auto(const struct ti_sci_handle *handle, 114481f4458cSTero Kristo u32 dev_id, u32 clk_id, bool *req_state) 11459f723220SNishanth Menon { 11469f723220SNishanth Menon u8 state = 0; 11479f723220SNishanth Menon int ret; 11489f723220SNishanth Menon 11499f723220SNishanth Menon if (!req_state) 11509f723220SNishanth Menon return -EINVAL; 11519f723220SNishanth Menon 11529f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, &state, NULL); 11539f723220SNishanth Menon if (ret) 11549f723220SNishanth Menon return ret; 11559f723220SNishanth Menon 11569f723220SNishanth Menon *req_state = (state == MSG_CLOCK_SW_STATE_AUTO); 11579f723220SNishanth Menon return 0; 11589f723220SNishanth Menon } 11599f723220SNishanth Menon 11609f723220SNishanth Menon /** 11619f723220SNishanth Menon * ti_sci_cmd_clk_is_on() - Is the clock ON 11629f723220SNishanth Menon * @handle: pointer to TI SCI handle 11639f723220SNishanth Menon * @dev_id: Device identifier this request is for 11649f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11659f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11669f723220SNishanth Menon * which clock input to modify. 11679f723220SNishanth Menon * @req_state: state indicating if the clock is managed by us and enabled 11689f723220SNishanth Menon * @curr_state: state indicating if the clock is ready for operation 11699f723220SNishanth Menon * 11709f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11719f723220SNishanth Menon */ 11729f723220SNishanth Menon static int ti_sci_cmd_clk_is_on(const struct ti_sci_handle *handle, u32 dev_id, 117381f4458cSTero Kristo u32 clk_id, bool *req_state, bool *curr_state) 11749f723220SNishanth Menon { 11759f723220SNishanth Menon u8 c_state = 0, r_state = 0; 11769f723220SNishanth Menon int ret; 11779f723220SNishanth Menon 11789f723220SNishanth Menon if (!req_state && !curr_state) 11799f723220SNishanth Menon return -EINVAL; 11809f723220SNishanth Menon 11819f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, 11829f723220SNishanth Menon &r_state, &c_state); 11839f723220SNishanth Menon if (ret) 11849f723220SNishanth Menon return ret; 11859f723220SNishanth Menon 11869f723220SNishanth Menon if (req_state) 11879f723220SNishanth Menon *req_state = (r_state == MSG_CLOCK_SW_STATE_REQ); 11889f723220SNishanth Menon if (curr_state) 11899f723220SNishanth Menon *curr_state = (c_state == MSG_CLOCK_HW_STATE_READY); 11909f723220SNishanth Menon return 0; 11919f723220SNishanth Menon } 11929f723220SNishanth Menon 11939f723220SNishanth Menon /** 11949f723220SNishanth Menon * ti_sci_cmd_clk_is_off() - Is the clock OFF 11959f723220SNishanth Menon * @handle: pointer to TI SCI handle 11969f723220SNishanth Menon * @dev_id: Device identifier this request is for 11979f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11989f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11999f723220SNishanth Menon * which clock input to modify. 12009f723220SNishanth Menon * @req_state: state indicating if the clock is managed by us and disabled 12019f723220SNishanth Menon * @curr_state: state indicating if the clock is NOT ready for operation 12029f723220SNishanth Menon * 12039f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 12049f723220SNishanth Menon */ 12059f723220SNishanth Menon static int ti_sci_cmd_clk_is_off(const struct ti_sci_handle *handle, u32 dev_id, 120681f4458cSTero Kristo u32 clk_id, bool *req_state, bool *curr_state) 12079f723220SNishanth Menon { 12089f723220SNishanth Menon u8 c_state = 0, r_state = 0; 12099f723220SNishanth Menon int ret; 12109f723220SNishanth Menon 12119f723220SNishanth Menon if (!req_state && !curr_state) 12129f723220SNishanth Menon return -EINVAL; 12139f723220SNishanth Menon 12149f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, 12159f723220SNishanth Menon &r_state, &c_state); 12169f723220SNishanth Menon if (ret) 12179f723220SNishanth Menon return ret; 12189f723220SNishanth Menon 12199f723220SNishanth Menon if (req_state) 12209f723220SNishanth Menon *req_state = (r_state == MSG_CLOCK_SW_STATE_UNREQ); 12219f723220SNishanth Menon if (curr_state) 12229f723220SNishanth Menon *curr_state = (c_state == MSG_CLOCK_HW_STATE_NOT_READY); 12239f723220SNishanth Menon return 0; 12249f723220SNishanth Menon } 12259f723220SNishanth Menon 12269f723220SNishanth Menon /** 12279f723220SNishanth Menon * ti_sci_cmd_clk_set_parent() - Set the clock source of a specific device clock 12289f723220SNishanth Menon * @handle: pointer to TI SCI handle 12299f723220SNishanth Menon * @dev_id: Device identifier this request is for 12309f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 12319f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 12329f723220SNishanth Menon * which clock input to modify. 12339f723220SNishanth Menon * @parent_id: Parent clock identifier to set 12349f723220SNishanth Menon * 12359f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 12369f723220SNishanth Menon */ 12379f723220SNishanth Menon static int ti_sci_cmd_clk_set_parent(const struct ti_sci_handle *handle, 123881f4458cSTero Kristo u32 dev_id, u32 clk_id, u32 parent_id) 12399f723220SNishanth Menon { 12409f723220SNishanth Menon struct ti_sci_info *info; 12419f723220SNishanth Menon struct ti_sci_msg_req_set_clock_parent *req; 12429f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 12439f723220SNishanth Menon struct ti_sci_xfer *xfer; 12449f723220SNishanth Menon struct device *dev; 12459f723220SNishanth Menon int ret = 0; 12469f723220SNishanth Menon 12479f723220SNishanth Menon if (IS_ERR(handle)) 12489f723220SNishanth Menon return PTR_ERR(handle); 12499f723220SNishanth Menon if (!handle) 12509f723220SNishanth Menon return -EINVAL; 12519f723220SNishanth Menon 12529f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 12539f723220SNishanth Menon dev = info->dev; 12549f723220SNishanth Menon 12559f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_PARENT, 12569f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 12579f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 12589f723220SNishanth Menon if (IS_ERR(xfer)) { 12599f723220SNishanth Menon ret = PTR_ERR(xfer); 12609f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 12619f723220SNishanth Menon return ret; 12629f723220SNishanth Menon } 12639f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_parent *)xfer->xfer_buf; 12649f723220SNishanth Menon req->dev_id = dev_id; 126581f4458cSTero Kristo if (clk_id < 255) { 12669f723220SNishanth Menon req->clk_id = clk_id; 126781f4458cSTero Kristo } else { 126881f4458cSTero Kristo req->clk_id = 255; 126981f4458cSTero Kristo req->clk_id_32 = clk_id; 127081f4458cSTero Kristo } 127181f4458cSTero Kristo if (parent_id < 255) { 12729f723220SNishanth Menon req->parent_id = parent_id; 127381f4458cSTero Kristo } else { 127481f4458cSTero Kristo req->parent_id = 255; 127581f4458cSTero Kristo req->parent_id_32 = parent_id; 127681f4458cSTero Kristo } 12779f723220SNishanth Menon 12789f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 12799f723220SNishanth Menon if (ret) { 12809f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 12819f723220SNishanth Menon goto fail; 12829f723220SNishanth Menon } 12839f723220SNishanth Menon 12849f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 12859f723220SNishanth Menon 12869f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 12879f723220SNishanth Menon 12889f723220SNishanth Menon fail: 12899f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 12909f723220SNishanth Menon 12919f723220SNishanth Menon return ret; 12929f723220SNishanth Menon } 12939f723220SNishanth Menon 12949f723220SNishanth Menon /** 12959f723220SNishanth Menon * ti_sci_cmd_clk_get_parent() - Get current parent clock source 12969f723220SNishanth Menon * @handle: pointer to TI SCI handle 12979f723220SNishanth Menon * @dev_id: Device identifier this request is for 12989f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 12999f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 13009f723220SNishanth Menon * which clock input to modify. 13019f723220SNishanth Menon * @parent_id: Current clock parent 13029f723220SNishanth Menon * 13039f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 13049f723220SNishanth Menon */ 13059f723220SNishanth Menon static int ti_sci_cmd_clk_get_parent(const struct ti_sci_handle *handle, 130681f4458cSTero Kristo u32 dev_id, u32 clk_id, u32 *parent_id) 13079f723220SNishanth Menon { 13089f723220SNishanth Menon struct ti_sci_info *info; 13099f723220SNishanth Menon struct ti_sci_msg_req_get_clock_parent *req; 13109f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_parent *resp; 13119f723220SNishanth Menon struct ti_sci_xfer *xfer; 13129f723220SNishanth Menon struct device *dev; 13139f723220SNishanth Menon int ret = 0; 13149f723220SNishanth Menon 13159f723220SNishanth Menon if (IS_ERR(handle)) 13169f723220SNishanth Menon return PTR_ERR(handle); 13179f723220SNishanth Menon if (!handle || !parent_id) 13189f723220SNishanth Menon return -EINVAL; 13199f723220SNishanth Menon 13209f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 13219f723220SNishanth Menon dev = info->dev; 13229f723220SNishanth Menon 13239f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_PARENT, 13249f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 13259f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 13269f723220SNishanth Menon if (IS_ERR(xfer)) { 13279f723220SNishanth Menon ret = PTR_ERR(xfer); 13289f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 13299f723220SNishanth Menon return ret; 13309f723220SNishanth Menon } 13319f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_parent *)xfer->xfer_buf; 13329f723220SNishanth Menon req->dev_id = dev_id; 133381f4458cSTero Kristo if (clk_id < 255) { 13349f723220SNishanth Menon req->clk_id = clk_id; 133581f4458cSTero Kristo } else { 133681f4458cSTero Kristo req->clk_id = 255; 133781f4458cSTero Kristo req->clk_id_32 = clk_id; 133881f4458cSTero Kristo } 13399f723220SNishanth Menon 13409f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 13419f723220SNishanth Menon if (ret) { 13429f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 13439f723220SNishanth Menon goto fail; 13449f723220SNishanth Menon } 13459f723220SNishanth Menon 13469f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_parent *)xfer->xfer_buf; 13479f723220SNishanth Menon 134881f4458cSTero Kristo if (!ti_sci_is_response_ack(resp)) { 13499f723220SNishanth Menon ret = -ENODEV; 135081f4458cSTero Kristo } else { 135181f4458cSTero Kristo if (resp->parent_id < 255) 13529f723220SNishanth Menon *parent_id = resp->parent_id; 135381f4458cSTero Kristo else 135481f4458cSTero Kristo *parent_id = resp->parent_id_32; 135581f4458cSTero Kristo } 13569f723220SNishanth Menon 13579f723220SNishanth Menon fail: 13589f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 13599f723220SNishanth Menon 13609f723220SNishanth Menon return ret; 13619f723220SNishanth Menon } 13629f723220SNishanth Menon 13639f723220SNishanth Menon /** 13649f723220SNishanth Menon * ti_sci_cmd_clk_get_num_parents() - Get num parents of the current clk source 13659f723220SNishanth Menon * @handle: pointer to TI SCI handle 13669f723220SNishanth Menon * @dev_id: Device identifier this request is for 13679f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 13689f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 13699f723220SNishanth Menon * which clock input to modify. 13709f723220SNishanth Menon * @num_parents: Returns he number of parents to the current clock. 13719f723220SNishanth Menon * 13729f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 13739f723220SNishanth Menon */ 13749f723220SNishanth Menon static int ti_sci_cmd_clk_get_num_parents(const struct ti_sci_handle *handle, 137581f4458cSTero Kristo u32 dev_id, u32 clk_id, 137681f4458cSTero Kristo u32 *num_parents) 13779f723220SNishanth Menon { 13789f723220SNishanth Menon struct ti_sci_info *info; 13799f723220SNishanth Menon struct ti_sci_msg_req_get_clock_num_parents *req; 13809f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_num_parents *resp; 13819f723220SNishanth Menon struct ti_sci_xfer *xfer; 13829f723220SNishanth Menon struct device *dev; 13839f723220SNishanth Menon int ret = 0; 13849f723220SNishanth Menon 13859f723220SNishanth Menon if (IS_ERR(handle)) 13869f723220SNishanth Menon return PTR_ERR(handle); 13879f723220SNishanth Menon if (!handle || !num_parents) 13889f723220SNishanth Menon return -EINVAL; 13899f723220SNishanth Menon 13909f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 13919f723220SNishanth Menon dev = info->dev; 13929f723220SNishanth Menon 13939f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_NUM_CLOCK_PARENTS, 13949f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 13959f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 13969f723220SNishanth Menon if (IS_ERR(xfer)) { 13979f723220SNishanth Menon ret = PTR_ERR(xfer); 13989f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 13999f723220SNishanth Menon return ret; 14009f723220SNishanth Menon } 14019f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_num_parents *)xfer->xfer_buf; 14029f723220SNishanth Menon req->dev_id = dev_id; 140381f4458cSTero Kristo if (clk_id < 255) { 14049f723220SNishanth Menon req->clk_id = clk_id; 140581f4458cSTero Kristo } else { 140681f4458cSTero Kristo req->clk_id = 255; 140781f4458cSTero Kristo req->clk_id_32 = clk_id; 140881f4458cSTero Kristo } 14099f723220SNishanth Menon 14109f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 14119f723220SNishanth Menon if (ret) { 14129f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 14139f723220SNishanth Menon goto fail; 14149f723220SNishanth Menon } 14159f723220SNishanth Menon 14169f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_num_parents *)xfer->xfer_buf; 14179f723220SNishanth Menon 141881f4458cSTero Kristo if (!ti_sci_is_response_ack(resp)) { 14199f723220SNishanth Menon ret = -ENODEV; 142081f4458cSTero Kristo } else { 142181f4458cSTero Kristo if (resp->num_parents < 255) 14229f723220SNishanth Menon *num_parents = resp->num_parents; 142381f4458cSTero Kristo else 142481f4458cSTero Kristo *num_parents = resp->num_parents_32; 142581f4458cSTero Kristo } 14269f723220SNishanth Menon 14279f723220SNishanth Menon fail: 14289f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 14299f723220SNishanth Menon 14309f723220SNishanth Menon return ret; 14319f723220SNishanth Menon } 14329f723220SNishanth Menon 14339f723220SNishanth Menon /** 14349f723220SNishanth Menon * ti_sci_cmd_clk_get_match_freq() - Find a good match for frequency 14359f723220SNishanth Menon * @handle: pointer to TI SCI handle 14369f723220SNishanth Menon * @dev_id: Device identifier this request is for 14379f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 14389f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 14399f723220SNishanth Menon * which clock input to modify. 14409f723220SNishanth Menon * @min_freq: The minimum allowable frequency in Hz. This is the minimum 14419f723220SNishanth Menon * allowable programmed frequency and does not account for clock 14429f723220SNishanth Menon * tolerances and jitter. 14439f723220SNishanth Menon * @target_freq: The target clock frequency in Hz. A frequency will be 14449f723220SNishanth Menon * processed as close to this target frequency as possible. 14459f723220SNishanth Menon * @max_freq: The maximum allowable frequency in Hz. This is the maximum 14469f723220SNishanth Menon * allowable programmed frequency and does not account for clock 14479f723220SNishanth Menon * tolerances and jitter. 14489f723220SNishanth Menon * @match_freq: Frequency match in Hz response. 14499f723220SNishanth Menon * 14509f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 14519f723220SNishanth Menon */ 14529f723220SNishanth Menon static int ti_sci_cmd_clk_get_match_freq(const struct ti_sci_handle *handle, 145381f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 min_freq, 14549f723220SNishanth Menon u64 target_freq, u64 max_freq, 14559f723220SNishanth Menon u64 *match_freq) 14569f723220SNishanth Menon { 14579f723220SNishanth Menon struct ti_sci_info *info; 14589f723220SNishanth Menon struct ti_sci_msg_req_query_clock_freq *req; 14599f723220SNishanth Menon struct ti_sci_msg_resp_query_clock_freq *resp; 14609f723220SNishanth Menon struct ti_sci_xfer *xfer; 14619f723220SNishanth Menon struct device *dev; 14629f723220SNishanth Menon int ret = 0; 14639f723220SNishanth Menon 14649f723220SNishanth Menon if (IS_ERR(handle)) 14659f723220SNishanth Menon return PTR_ERR(handle); 14669f723220SNishanth Menon if (!handle || !match_freq) 14679f723220SNishanth Menon return -EINVAL; 14689f723220SNishanth Menon 14699f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 14709f723220SNishanth Menon dev = info->dev; 14719f723220SNishanth Menon 14729f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_QUERY_CLOCK_FREQ, 14739f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 14749f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 14759f723220SNishanth Menon if (IS_ERR(xfer)) { 14769f723220SNishanth Menon ret = PTR_ERR(xfer); 14779f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 14789f723220SNishanth Menon return ret; 14799f723220SNishanth Menon } 14809f723220SNishanth Menon req = (struct ti_sci_msg_req_query_clock_freq *)xfer->xfer_buf; 14819f723220SNishanth Menon req->dev_id = dev_id; 148281f4458cSTero Kristo if (clk_id < 255) { 14839f723220SNishanth Menon req->clk_id = clk_id; 148481f4458cSTero Kristo } else { 148581f4458cSTero Kristo req->clk_id = 255; 148681f4458cSTero Kristo req->clk_id_32 = clk_id; 148781f4458cSTero Kristo } 14889f723220SNishanth Menon req->min_freq_hz = min_freq; 14899f723220SNishanth Menon req->target_freq_hz = target_freq; 14909f723220SNishanth Menon req->max_freq_hz = max_freq; 14919f723220SNishanth Menon 14929f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 14939f723220SNishanth Menon if (ret) { 14949f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 14959f723220SNishanth Menon goto fail; 14969f723220SNishanth Menon } 14979f723220SNishanth Menon 14989f723220SNishanth Menon resp = (struct ti_sci_msg_resp_query_clock_freq *)xfer->xfer_buf; 14999f723220SNishanth Menon 15009f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) 15019f723220SNishanth Menon ret = -ENODEV; 15029f723220SNishanth Menon else 15039f723220SNishanth Menon *match_freq = resp->freq_hz; 15049f723220SNishanth Menon 15059f723220SNishanth Menon fail: 15069f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 15079f723220SNishanth Menon 15089f723220SNishanth Menon return ret; 15099f723220SNishanth Menon } 15109f723220SNishanth Menon 15119f723220SNishanth Menon /** 15129f723220SNishanth Menon * ti_sci_cmd_clk_set_freq() - Set a frequency for clock 15139f723220SNishanth Menon * @handle: pointer to TI SCI handle 15149f723220SNishanth Menon * @dev_id: Device identifier this request is for 15159f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 15169f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 15179f723220SNishanth Menon * which clock input to modify. 15189f723220SNishanth Menon * @min_freq: The minimum allowable frequency in Hz. This is the minimum 15199f723220SNishanth Menon * allowable programmed frequency and does not account for clock 15209f723220SNishanth Menon * tolerances and jitter. 15219f723220SNishanth Menon * @target_freq: The target clock frequency in Hz. A frequency will be 15229f723220SNishanth Menon * processed as close to this target frequency as possible. 15239f723220SNishanth Menon * @max_freq: The maximum allowable frequency in Hz. This is the maximum 15249f723220SNishanth Menon * allowable programmed frequency and does not account for clock 15259f723220SNishanth Menon * tolerances and jitter. 15269f723220SNishanth Menon * 15279f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 15289f723220SNishanth Menon */ 15299f723220SNishanth Menon static int ti_sci_cmd_clk_set_freq(const struct ti_sci_handle *handle, 153081f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 min_freq, 15319f723220SNishanth Menon u64 target_freq, u64 max_freq) 15329f723220SNishanth Menon { 15339f723220SNishanth Menon struct ti_sci_info *info; 15349f723220SNishanth Menon struct ti_sci_msg_req_set_clock_freq *req; 15359f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 15369f723220SNishanth Menon struct ti_sci_xfer *xfer; 15379f723220SNishanth Menon struct device *dev; 15389f723220SNishanth Menon int ret = 0; 15399f723220SNishanth Menon 15409f723220SNishanth Menon if (IS_ERR(handle)) 15419f723220SNishanth Menon return PTR_ERR(handle); 15429f723220SNishanth Menon if (!handle) 15439f723220SNishanth Menon return -EINVAL; 15449f723220SNishanth Menon 15459f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 15469f723220SNishanth Menon dev = info->dev; 15479f723220SNishanth Menon 15489f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_FREQ, 15499f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 15509f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 15519f723220SNishanth Menon if (IS_ERR(xfer)) { 15529f723220SNishanth Menon ret = PTR_ERR(xfer); 15539f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 15549f723220SNishanth Menon return ret; 15559f723220SNishanth Menon } 15569f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_freq *)xfer->xfer_buf; 15579f723220SNishanth Menon req->dev_id = dev_id; 155881f4458cSTero Kristo if (clk_id < 255) { 15599f723220SNishanth Menon req->clk_id = clk_id; 156081f4458cSTero Kristo } else { 156181f4458cSTero Kristo req->clk_id = 255; 156281f4458cSTero Kristo req->clk_id_32 = clk_id; 156381f4458cSTero Kristo } 15649f723220SNishanth Menon req->min_freq_hz = min_freq; 15659f723220SNishanth Menon req->target_freq_hz = target_freq; 15669f723220SNishanth Menon req->max_freq_hz = max_freq; 15679f723220SNishanth Menon 15689f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 15699f723220SNishanth Menon if (ret) { 15709f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 15719f723220SNishanth Menon goto fail; 15729f723220SNishanth Menon } 15739f723220SNishanth Menon 15749f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 15759f723220SNishanth Menon 15769f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 15779f723220SNishanth Menon 15789f723220SNishanth Menon fail: 15799f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 15809f723220SNishanth Menon 15819f723220SNishanth Menon return ret; 15829f723220SNishanth Menon } 15839f723220SNishanth Menon 15849f723220SNishanth Menon /** 15859f723220SNishanth Menon * ti_sci_cmd_clk_get_freq() - Get current frequency 15869f723220SNishanth Menon * @handle: pointer to TI SCI handle 15879f723220SNishanth Menon * @dev_id: Device identifier this request is for 15889f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 15899f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 15909f723220SNishanth Menon * which clock input to modify. 15919f723220SNishanth Menon * @freq: Currently frequency in Hz 15929f723220SNishanth Menon * 15939f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 15949f723220SNishanth Menon */ 15959f723220SNishanth Menon static int ti_sci_cmd_clk_get_freq(const struct ti_sci_handle *handle, 159681f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 *freq) 15979f723220SNishanth Menon { 15989f723220SNishanth Menon struct ti_sci_info *info; 15999f723220SNishanth Menon struct ti_sci_msg_req_get_clock_freq *req; 16009f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_freq *resp; 16019f723220SNishanth Menon struct ti_sci_xfer *xfer; 16029f723220SNishanth Menon struct device *dev; 16039f723220SNishanth Menon int ret = 0; 16049f723220SNishanth Menon 16059f723220SNishanth Menon if (IS_ERR(handle)) 16069f723220SNishanth Menon return PTR_ERR(handle); 16079f723220SNishanth Menon if (!handle || !freq) 16089f723220SNishanth Menon return -EINVAL; 16099f723220SNishanth Menon 16109f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 16119f723220SNishanth Menon dev = info->dev; 16129f723220SNishanth Menon 16139f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_FREQ, 16149f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 16159f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 16169f723220SNishanth Menon if (IS_ERR(xfer)) { 16179f723220SNishanth Menon ret = PTR_ERR(xfer); 16189f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 16199f723220SNishanth Menon return ret; 16209f723220SNishanth Menon } 16219f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_freq *)xfer->xfer_buf; 16229f723220SNishanth Menon req->dev_id = dev_id; 162381f4458cSTero Kristo if (clk_id < 255) { 16249f723220SNishanth Menon req->clk_id = clk_id; 162581f4458cSTero Kristo } else { 162681f4458cSTero Kristo req->clk_id = 255; 162781f4458cSTero Kristo req->clk_id_32 = clk_id; 162881f4458cSTero Kristo } 16299f723220SNishanth Menon 16309f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 16319f723220SNishanth Menon if (ret) { 16329f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 16339f723220SNishanth Menon goto fail; 16349f723220SNishanth Menon } 16359f723220SNishanth Menon 16369f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_freq *)xfer->xfer_buf; 16379f723220SNishanth Menon 16389f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) 16399f723220SNishanth Menon ret = -ENODEV; 16409f723220SNishanth Menon else 16419f723220SNishanth Menon *freq = resp->freq_hz; 16429f723220SNishanth Menon 16439f723220SNishanth Menon fail: 16449f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 16459f723220SNishanth Menon 16469f723220SNishanth Menon return ret; 16479f723220SNishanth Menon } 16489f723220SNishanth Menon 1649912cffb4SNishanth Menon static int ti_sci_cmd_core_reboot(const struct ti_sci_handle *handle) 1650912cffb4SNishanth Menon { 1651912cffb4SNishanth Menon struct ti_sci_info *info; 1652912cffb4SNishanth Menon struct ti_sci_msg_req_reboot *req; 1653912cffb4SNishanth Menon struct ti_sci_msg_hdr *resp; 1654912cffb4SNishanth Menon struct ti_sci_xfer *xfer; 1655912cffb4SNishanth Menon struct device *dev; 1656912cffb4SNishanth Menon int ret = 0; 1657912cffb4SNishanth Menon 1658912cffb4SNishanth Menon if (IS_ERR(handle)) 1659912cffb4SNishanth Menon return PTR_ERR(handle); 1660912cffb4SNishanth Menon if (!handle) 1661912cffb4SNishanth Menon return -EINVAL; 1662912cffb4SNishanth Menon 1663912cffb4SNishanth Menon info = handle_to_ti_sci_info(handle); 1664912cffb4SNishanth Menon dev = info->dev; 1665912cffb4SNishanth Menon 1666912cffb4SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SYS_RESET, 1667912cffb4SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 1668912cffb4SNishanth Menon sizeof(*req), sizeof(*resp)); 1669912cffb4SNishanth Menon if (IS_ERR(xfer)) { 1670912cffb4SNishanth Menon ret = PTR_ERR(xfer); 1671912cffb4SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 1672912cffb4SNishanth Menon return ret; 1673912cffb4SNishanth Menon } 1674912cffb4SNishanth Menon req = (struct ti_sci_msg_req_reboot *)xfer->xfer_buf; 1675912cffb4SNishanth Menon 1676912cffb4SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 1677912cffb4SNishanth Menon if (ret) { 1678912cffb4SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 1679912cffb4SNishanth Menon goto fail; 1680912cffb4SNishanth Menon } 1681912cffb4SNishanth Menon 1682912cffb4SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 1683912cffb4SNishanth Menon 1684912cffb4SNishanth Menon if (!ti_sci_is_response_ack(resp)) 1685912cffb4SNishanth Menon ret = -ENODEV; 1686912cffb4SNishanth Menon else 1687912cffb4SNishanth Menon ret = 0; 1688912cffb4SNishanth Menon 1689912cffb4SNishanth Menon fail: 1690912cffb4SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 1691912cffb4SNishanth Menon 1692912cffb4SNishanth Menon return ret; 1693912cffb4SNishanth Menon } 1694912cffb4SNishanth Menon 16959c19fb68SLokesh Vutla /** 16969c19fb68SLokesh Vutla * ti_sci_get_resource_range - Helper to get a range of resources assigned 16979c19fb68SLokesh Vutla * to a host. Resource is uniquely identified by 16989c19fb68SLokesh Vutla * type and subtype. 16999c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 17009c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 17019c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 17029c19fb68SLokesh Vutla * from the given device. 17039c19fb68SLokesh Vutla * @s_host: Host processor ID to which the resources are allocated 17049c19fb68SLokesh Vutla * @range_start: Start index of the resource range 17059c19fb68SLokesh Vutla * @range_num: Number of resources in the range 17069c19fb68SLokesh Vutla * 17079c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 17089c19fb68SLokesh Vutla */ 17099c19fb68SLokesh Vutla static int ti_sci_get_resource_range(const struct ti_sci_handle *handle, 17109c19fb68SLokesh Vutla u32 dev_id, u8 subtype, u8 s_host, 17119c19fb68SLokesh Vutla u16 *range_start, u16 *range_num) 17129c19fb68SLokesh Vutla { 17139c19fb68SLokesh Vutla struct ti_sci_msg_resp_get_resource_range *resp; 17149c19fb68SLokesh Vutla struct ti_sci_msg_req_get_resource_range *req; 17159c19fb68SLokesh Vutla struct ti_sci_xfer *xfer; 17169c19fb68SLokesh Vutla struct ti_sci_info *info; 17179c19fb68SLokesh Vutla struct device *dev; 17189c19fb68SLokesh Vutla int ret = 0; 17199c19fb68SLokesh Vutla 17209c19fb68SLokesh Vutla if (IS_ERR(handle)) 17219c19fb68SLokesh Vutla return PTR_ERR(handle); 17229c19fb68SLokesh Vutla if (!handle) 17239c19fb68SLokesh Vutla return -EINVAL; 17249c19fb68SLokesh Vutla 17259c19fb68SLokesh Vutla info = handle_to_ti_sci_info(handle); 17269c19fb68SLokesh Vutla dev = info->dev; 17279c19fb68SLokesh Vutla 17289c19fb68SLokesh Vutla xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_RESOURCE_RANGE, 17299c19fb68SLokesh Vutla TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 17309c19fb68SLokesh Vutla sizeof(*req), sizeof(*resp)); 17319c19fb68SLokesh Vutla if (IS_ERR(xfer)) { 17329c19fb68SLokesh Vutla ret = PTR_ERR(xfer); 17339c19fb68SLokesh Vutla dev_err(dev, "Message alloc failed(%d)\n", ret); 17349c19fb68SLokesh Vutla return ret; 17359c19fb68SLokesh Vutla } 17369c19fb68SLokesh Vutla 17379c19fb68SLokesh Vutla req = (struct ti_sci_msg_req_get_resource_range *)xfer->xfer_buf; 17389c19fb68SLokesh Vutla req->secondary_host = s_host; 1739*9b98e02aSLokesh Vutla req->type = dev_id & MSG_RM_RESOURCE_TYPE_MASK; 17409c19fb68SLokesh Vutla req->subtype = subtype & MSG_RM_RESOURCE_SUBTYPE_MASK; 17419c19fb68SLokesh Vutla 17429c19fb68SLokesh Vutla ret = ti_sci_do_xfer(info, xfer); 17439c19fb68SLokesh Vutla if (ret) { 17449c19fb68SLokesh Vutla dev_err(dev, "Mbox send fail %d\n", ret); 17459c19fb68SLokesh Vutla goto fail; 17469c19fb68SLokesh Vutla } 17479c19fb68SLokesh Vutla 17489c19fb68SLokesh Vutla resp = (struct ti_sci_msg_resp_get_resource_range *)xfer->xfer_buf; 17499c19fb68SLokesh Vutla 17509c19fb68SLokesh Vutla if (!ti_sci_is_response_ack(resp)) { 17519c19fb68SLokesh Vutla ret = -ENODEV; 17529c19fb68SLokesh Vutla } else if (!resp->range_start && !resp->range_num) { 17539c19fb68SLokesh Vutla ret = -ENODEV; 17549c19fb68SLokesh Vutla } else { 17559c19fb68SLokesh Vutla *range_start = resp->range_start; 17569c19fb68SLokesh Vutla *range_num = resp->range_num; 17579c19fb68SLokesh Vutla }; 17589c19fb68SLokesh Vutla 17599c19fb68SLokesh Vutla fail: 17609c19fb68SLokesh Vutla ti_sci_put_one_xfer(&info->minfo, xfer); 17619c19fb68SLokesh Vutla 17629c19fb68SLokesh Vutla return ret; 17639c19fb68SLokesh Vutla } 17649c19fb68SLokesh Vutla 17659c19fb68SLokesh Vutla /** 17669c19fb68SLokesh Vutla * ti_sci_cmd_get_resource_range - Get a range of resources assigned to host 17679c19fb68SLokesh Vutla * that is same as ti sci interface host. 17689c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 17699c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 17709c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 17719c19fb68SLokesh Vutla * from the given device. 17729c19fb68SLokesh Vutla * @range_start: Start index of the resource range 17739c19fb68SLokesh Vutla * @range_num: Number of resources in the range 17749c19fb68SLokesh Vutla * 17759c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 17769c19fb68SLokesh Vutla */ 17779c19fb68SLokesh Vutla static int ti_sci_cmd_get_resource_range(const struct ti_sci_handle *handle, 17789c19fb68SLokesh Vutla u32 dev_id, u8 subtype, 17799c19fb68SLokesh Vutla u16 *range_start, u16 *range_num) 17809c19fb68SLokesh Vutla { 17819c19fb68SLokesh Vutla return ti_sci_get_resource_range(handle, dev_id, subtype, 17829c19fb68SLokesh Vutla TI_SCI_IRQ_SECONDARY_HOST_INVALID, 17839c19fb68SLokesh Vutla range_start, range_num); 17849c19fb68SLokesh Vutla } 17859c19fb68SLokesh Vutla 17869c19fb68SLokesh Vutla /** 17879c19fb68SLokesh Vutla * ti_sci_cmd_get_resource_range_from_shost - Get a range of resources 17889c19fb68SLokesh Vutla * assigned to a specified 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. 17939c19fb68SLokesh Vutla * @s_host: Host processor ID to which the resources are allocated 17949c19fb68SLokesh Vutla * @range_start: Start index of the resource range 17959c19fb68SLokesh Vutla * @range_num: Number of resources in the range 17969c19fb68SLokesh Vutla * 17979c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 17989c19fb68SLokesh Vutla */ 17999c19fb68SLokesh Vutla static 18009c19fb68SLokesh Vutla int ti_sci_cmd_get_resource_range_from_shost(const struct ti_sci_handle *handle, 18019c19fb68SLokesh Vutla u32 dev_id, u8 subtype, u8 s_host, 18029c19fb68SLokesh Vutla u16 *range_start, u16 *range_num) 18039c19fb68SLokesh Vutla { 18049c19fb68SLokesh Vutla return ti_sci_get_resource_range(handle, dev_id, subtype, s_host, 18059c19fb68SLokesh Vutla range_start, range_num); 18069c19fb68SLokesh Vutla } 18079c19fb68SLokesh Vutla 1808997b001fSLokesh Vutla /** 1809997b001fSLokesh Vutla * ti_sci_manage_irq() - Helper api to configure/release the irq route between 1810997b001fSLokesh Vutla * the requested source and destination 1811997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1812997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1813997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1814997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1815997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1816997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1817997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1818997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1819997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1820997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1821997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1822997b001fSLokesh Vutla * requested for. 1823997b001fSLokesh Vutla * @type: Request type irq set or release. 1824997b001fSLokesh Vutla * 1825997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1826997b001fSLokesh Vutla */ 1827997b001fSLokesh Vutla static int ti_sci_manage_irq(const struct ti_sci_handle *handle, 1828997b001fSLokesh Vutla u32 valid_params, u16 src_id, u16 src_index, 1829997b001fSLokesh Vutla u16 dst_id, u16 dst_host_irq, u16 ia_id, u16 vint, 1830997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host, 1831997b001fSLokesh Vutla u16 type) 1832997b001fSLokesh Vutla { 1833997b001fSLokesh Vutla struct ti_sci_msg_req_manage_irq *req; 1834997b001fSLokesh Vutla struct ti_sci_msg_hdr *resp; 1835997b001fSLokesh Vutla struct ti_sci_xfer *xfer; 1836997b001fSLokesh Vutla struct ti_sci_info *info; 1837997b001fSLokesh Vutla struct device *dev; 1838997b001fSLokesh Vutla int ret = 0; 1839997b001fSLokesh Vutla 1840997b001fSLokesh Vutla if (IS_ERR(handle)) 1841997b001fSLokesh Vutla return PTR_ERR(handle); 1842997b001fSLokesh Vutla if (!handle) 1843997b001fSLokesh Vutla return -EINVAL; 1844997b001fSLokesh Vutla 1845997b001fSLokesh Vutla info = handle_to_ti_sci_info(handle); 1846997b001fSLokesh Vutla dev = info->dev; 1847997b001fSLokesh Vutla 1848997b001fSLokesh Vutla xfer = ti_sci_get_one_xfer(info, type, TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 1849997b001fSLokesh Vutla sizeof(*req), sizeof(*resp)); 1850997b001fSLokesh Vutla if (IS_ERR(xfer)) { 1851997b001fSLokesh Vutla ret = PTR_ERR(xfer); 1852997b001fSLokesh Vutla dev_err(dev, "Message alloc failed(%d)\n", ret); 1853997b001fSLokesh Vutla return ret; 1854997b001fSLokesh Vutla } 1855997b001fSLokesh Vutla req = (struct ti_sci_msg_req_manage_irq *)xfer->xfer_buf; 1856997b001fSLokesh Vutla req->valid_params = valid_params; 1857997b001fSLokesh Vutla req->src_id = src_id; 1858997b001fSLokesh Vutla req->src_index = src_index; 1859997b001fSLokesh Vutla req->dst_id = dst_id; 1860997b001fSLokesh Vutla req->dst_host_irq = dst_host_irq; 1861997b001fSLokesh Vutla req->ia_id = ia_id; 1862997b001fSLokesh Vutla req->vint = vint; 1863997b001fSLokesh Vutla req->global_event = global_event; 1864997b001fSLokesh Vutla req->vint_status_bit = vint_status_bit; 1865997b001fSLokesh Vutla req->secondary_host = s_host; 1866997b001fSLokesh Vutla 1867997b001fSLokesh Vutla ret = ti_sci_do_xfer(info, xfer); 1868997b001fSLokesh Vutla if (ret) { 1869997b001fSLokesh Vutla dev_err(dev, "Mbox send fail %d\n", ret); 1870997b001fSLokesh Vutla goto fail; 1871997b001fSLokesh Vutla } 1872997b001fSLokesh Vutla 1873997b001fSLokesh Vutla resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 1874997b001fSLokesh Vutla 1875997b001fSLokesh Vutla ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 1876997b001fSLokesh Vutla 1877997b001fSLokesh Vutla fail: 1878997b001fSLokesh Vutla ti_sci_put_one_xfer(&info->minfo, xfer); 1879997b001fSLokesh Vutla 1880997b001fSLokesh Vutla return ret; 1881997b001fSLokesh Vutla } 1882997b001fSLokesh Vutla 1883997b001fSLokesh Vutla /** 1884997b001fSLokesh Vutla * ti_sci_set_irq() - Helper api to configure the irq route between the 1885997b001fSLokesh Vutla * requested source and destination 1886997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1887997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1888997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1889997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1890997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1891997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1892997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1893997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1894997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1895997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1896997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1897997b001fSLokesh Vutla * requested for. 1898997b001fSLokesh Vutla * 1899997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1900997b001fSLokesh Vutla */ 1901997b001fSLokesh Vutla static int ti_sci_set_irq(const struct ti_sci_handle *handle, u32 valid_params, 1902997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 dst_id, 1903997b001fSLokesh Vutla u16 dst_host_irq, u16 ia_id, u16 vint, 1904997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host) 1905997b001fSLokesh Vutla { 1906997b001fSLokesh 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", 1907997b001fSLokesh Vutla __func__, valid_params, src_id, src_index, 1908997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, global_event, 1909997b001fSLokesh Vutla vint_status_bit); 1910997b001fSLokesh Vutla 1911997b001fSLokesh Vutla return ti_sci_manage_irq(handle, valid_params, src_id, src_index, 1912997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, 1913997b001fSLokesh Vutla global_event, vint_status_bit, s_host, 1914997b001fSLokesh Vutla TI_SCI_MSG_SET_IRQ); 1915997b001fSLokesh Vutla } 1916997b001fSLokesh Vutla 1917997b001fSLokesh Vutla /** 1918997b001fSLokesh Vutla * ti_sci_free_irq() - Helper api to free the irq route between the 1919997b001fSLokesh Vutla * requested source and destination 1920997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1921997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1922997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1923997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1924997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1925997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1926997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1927997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1928997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1929997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1930997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1931997b001fSLokesh Vutla * requested for. 1932997b001fSLokesh Vutla * 1933997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1934997b001fSLokesh Vutla */ 1935997b001fSLokesh Vutla static int ti_sci_free_irq(const struct ti_sci_handle *handle, u32 valid_params, 1936997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 dst_id, 1937997b001fSLokesh Vutla u16 dst_host_irq, u16 ia_id, u16 vint, 1938997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host) 1939997b001fSLokesh Vutla { 1940997b001fSLokesh 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", 1941997b001fSLokesh Vutla __func__, valid_params, src_id, src_index, 1942997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, global_event, 1943997b001fSLokesh Vutla vint_status_bit); 1944997b001fSLokesh Vutla 1945997b001fSLokesh Vutla return ti_sci_manage_irq(handle, valid_params, src_id, src_index, 1946997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, 1947997b001fSLokesh Vutla global_event, vint_status_bit, s_host, 1948997b001fSLokesh Vutla TI_SCI_MSG_FREE_IRQ); 1949997b001fSLokesh Vutla } 1950997b001fSLokesh Vutla 1951997b001fSLokesh Vutla /** 1952997b001fSLokesh Vutla * ti_sci_cmd_set_irq() - Configure a host irq route between the requested 1953997b001fSLokesh Vutla * source and destination. 1954997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1955997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1956997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1957997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1958997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1959997b001fSLokesh Vutla * @vint_irq: Boolean specifying if this interrupt belongs to 1960997b001fSLokesh Vutla * Interrupt Aggregator. 1961997b001fSLokesh Vutla * 1962997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1963997b001fSLokesh Vutla */ 1964997b001fSLokesh Vutla static int ti_sci_cmd_set_irq(const struct ti_sci_handle *handle, u16 src_id, 1965997b001fSLokesh Vutla u16 src_index, u16 dst_id, u16 dst_host_irq) 1966997b001fSLokesh Vutla { 1967997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID; 1968997b001fSLokesh Vutla 1969997b001fSLokesh Vutla return ti_sci_set_irq(handle, valid_params, src_id, src_index, dst_id, 1970997b001fSLokesh Vutla dst_host_irq, 0, 0, 0, 0, 0); 1971997b001fSLokesh Vutla } 1972997b001fSLokesh Vutla 1973997b001fSLokesh Vutla /** 1974997b001fSLokesh Vutla * ti_sci_cmd_set_event_map() - Configure an event based irq route between the 1975997b001fSLokesh Vutla * requested source and Interrupt Aggregator. 1976997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1977997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1978997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1979997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1980997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1981997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1982997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1983997b001fSLokesh Vutla * 1984997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1985997b001fSLokesh Vutla */ 1986997b001fSLokesh Vutla static int ti_sci_cmd_set_event_map(const struct ti_sci_handle *handle, 1987997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 ia_id, 1988997b001fSLokesh Vutla u16 vint, u16 global_event, 1989997b001fSLokesh Vutla u8 vint_status_bit) 1990997b001fSLokesh Vutla { 1991997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_IA_ID_VALID | MSG_FLAG_VINT_VALID | 1992997b001fSLokesh Vutla MSG_FLAG_GLB_EVNT_VALID | 1993997b001fSLokesh Vutla MSG_FLAG_VINT_STS_BIT_VALID; 1994997b001fSLokesh Vutla 1995997b001fSLokesh Vutla return ti_sci_set_irq(handle, valid_params, src_id, src_index, 0, 0, 1996997b001fSLokesh Vutla ia_id, vint, global_event, vint_status_bit, 0); 1997997b001fSLokesh Vutla } 1998997b001fSLokesh Vutla 1999997b001fSLokesh Vutla /** 2000997b001fSLokesh Vutla * ti_sci_cmd_free_irq() - Free a host irq route between the between the 2001997b001fSLokesh Vutla * requested source and destination. 2002997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 2003997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 2004997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 2005997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 2006997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 2007997b001fSLokesh Vutla * @vint_irq: Boolean specifying if this interrupt belongs to 2008997b001fSLokesh Vutla * Interrupt Aggregator. 2009997b001fSLokesh Vutla * 2010997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2011997b001fSLokesh Vutla */ 2012997b001fSLokesh Vutla static int ti_sci_cmd_free_irq(const struct ti_sci_handle *handle, u16 src_id, 2013997b001fSLokesh Vutla u16 src_index, u16 dst_id, u16 dst_host_irq) 2014997b001fSLokesh Vutla { 2015997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID; 2016997b001fSLokesh Vutla 2017997b001fSLokesh Vutla return ti_sci_free_irq(handle, valid_params, src_id, src_index, dst_id, 2018997b001fSLokesh Vutla dst_host_irq, 0, 0, 0, 0, 0); 2019997b001fSLokesh Vutla } 2020997b001fSLokesh Vutla 2021997b001fSLokesh Vutla /** 2022997b001fSLokesh Vutla * ti_sci_cmd_free_event_map() - Free an event map between the requested source 2023997b001fSLokesh Vutla * and Interrupt Aggregator. 2024997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 2025997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 2026997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 2027997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 2028997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 2029997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 2030997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 2031997b001fSLokesh Vutla * 2032997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2033997b001fSLokesh Vutla */ 2034997b001fSLokesh Vutla static int ti_sci_cmd_free_event_map(const struct ti_sci_handle *handle, 2035997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 ia_id, 2036997b001fSLokesh Vutla u16 vint, u16 global_event, 2037997b001fSLokesh Vutla u8 vint_status_bit) 2038997b001fSLokesh Vutla { 2039997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_IA_ID_VALID | 2040997b001fSLokesh Vutla MSG_FLAG_VINT_VALID | MSG_FLAG_GLB_EVNT_VALID | 2041997b001fSLokesh Vutla MSG_FLAG_VINT_STS_BIT_VALID; 2042997b001fSLokesh Vutla 2043997b001fSLokesh Vutla return ti_sci_free_irq(handle, valid_params, src_id, src_index, 0, 0, 2044997b001fSLokesh Vutla ia_id, vint, global_event, vint_status_bit, 0); 2045997b001fSLokesh Vutla } 2046997b001fSLokesh Vutla 204768608b5eSPeter Ujfalusi /** 204868608b5eSPeter Ujfalusi * ti_sci_cmd_ring_config() - configure RA ring 204968608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 205068608b5eSPeter Ujfalusi * @valid_params: Bitfield defining validity of ring configuration 205168608b5eSPeter Ujfalusi * parameters 205268608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem from which the ring is 205368608b5eSPeter Ujfalusi * allocated 205468608b5eSPeter Ujfalusi * @index: Ring index 205568608b5eSPeter Ujfalusi * @addr_lo: The ring base address lo 32 bits 205668608b5eSPeter Ujfalusi * @addr_hi: The ring base address hi 32 bits 205768608b5eSPeter Ujfalusi * @count: Number of ring elements 205868608b5eSPeter Ujfalusi * @mode: The mode of the ring 205968608b5eSPeter Ujfalusi * @size: The ring element size. 206068608b5eSPeter Ujfalusi * @order_id: Specifies the ring's bus order ID 206168608b5eSPeter Ujfalusi * 206268608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 206368608b5eSPeter Ujfalusi * 206468608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_ring_cfg_req for more info. 206568608b5eSPeter Ujfalusi */ 206668608b5eSPeter Ujfalusi static int ti_sci_cmd_ring_config(const struct ti_sci_handle *handle, 206768608b5eSPeter Ujfalusi u32 valid_params, u16 nav_id, u16 index, 206868608b5eSPeter Ujfalusi u32 addr_lo, u32 addr_hi, u32 count, 206968608b5eSPeter Ujfalusi u8 mode, u8 size, u8 order_id) 207068608b5eSPeter Ujfalusi { 207168608b5eSPeter Ujfalusi struct ti_sci_msg_rm_ring_cfg_req *req; 207268608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 207368608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 207468608b5eSPeter Ujfalusi struct ti_sci_info *info; 207568608b5eSPeter Ujfalusi struct device *dev; 207668608b5eSPeter Ujfalusi int ret = 0; 207768608b5eSPeter Ujfalusi 207868608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 207968608b5eSPeter Ujfalusi return -EINVAL; 208068608b5eSPeter Ujfalusi 208168608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 208268608b5eSPeter Ujfalusi dev = info->dev; 208368608b5eSPeter Ujfalusi 208468608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_RING_CFG, 208568608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 208668608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 208768608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 208868608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 20894c960505SYueHaibing dev_err(dev, "RM_RA:Message config failed(%d)\n", ret); 209068608b5eSPeter Ujfalusi return ret; 209168608b5eSPeter Ujfalusi } 209268608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_ring_cfg_req *)xfer->xfer_buf; 209368608b5eSPeter Ujfalusi req->valid_params = valid_params; 209468608b5eSPeter Ujfalusi req->nav_id = nav_id; 209568608b5eSPeter Ujfalusi req->index = index; 209668608b5eSPeter Ujfalusi req->addr_lo = addr_lo; 209768608b5eSPeter Ujfalusi req->addr_hi = addr_hi; 209868608b5eSPeter Ujfalusi req->count = count; 209968608b5eSPeter Ujfalusi req->mode = mode; 210068608b5eSPeter Ujfalusi req->size = size; 210168608b5eSPeter Ujfalusi req->order_id = order_id; 210268608b5eSPeter Ujfalusi 210368608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 210468608b5eSPeter Ujfalusi if (ret) { 21054c960505SYueHaibing dev_err(dev, "RM_RA:Mbox config send fail %d\n", ret); 210668608b5eSPeter Ujfalusi goto fail; 210768608b5eSPeter Ujfalusi } 210868608b5eSPeter Ujfalusi 210968608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 211068608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 211168608b5eSPeter Ujfalusi 211268608b5eSPeter Ujfalusi fail: 211368608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 21144c960505SYueHaibing dev_dbg(dev, "RM_RA:config ring %u ret:%d\n", index, ret); 211568608b5eSPeter Ujfalusi return ret; 211668608b5eSPeter Ujfalusi } 211768608b5eSPeter Ujfalusi 211868608b5eSPeter Ujfalusi /** 211968608b5eSPeter Ujfalusi * ti_sci_cmd_ring_get_config() - get RA ring configuration 212068608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 212168608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem from which the ring is 212268608b5eSPeter Ujfalusi * allocated 212368608b5eSPeter Ujfalusi * @index: Ring index 212468608b5eSPeter Ujfalusi * @addr_lo: Returns ring's base address lo 32 bits 212568608b5eSPeter Ujfalusi * @addr_hi: Returns ring's base address hi 32 bits 212668608b5eSPeter Ujfalusi * @count: Returns number of ring elements 212768608b5eSPeter Ujfalusi * @mode: Returns mode of the ring 212868608b5eSPeter Ujfalusi * @size: Returns ring element size 212968608b5eSPeter Ujfalusi * @order_id: Returns ring's bus order ID 213068608b5eSPeter Ujfalusi * 213168608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 213268608b5eSPeter Ujfalusi * 213368608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_ring_get_cfg_req for more info. 213468608b5eSPeter Ujfalusi */ 213568608b5eSPeter Ujfalusi static int ti_sci_cmd_ring_get_config(const struct ti_sci_handle *handle, 213668608b5eSPeter Ujfalusi u32 nav_id, u32 index, u8 *mode, 213768608b5eSPeter Ujfalusi u32 *addr_lo, u32 *addr_hi, 213868608b5eSPeter Ujfalusi u32 *count, u8 *size, u8 *order_id) 213968608b5eSPeter Ujfalusi { 214068608b5eSPeter Ujfalusi struct ti_sci_msg_rm_ring_get_cfg_resp *resp; 214168608b5eSPeter Ujfalusi struct ti_sci_msg_rm_ring_get_cfg_req *req; 214268608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 214368608b5eSPeter Ujfalusi struct ti_sci_info *info; 214468608b5eSPeter Ujfalusi struct device *dev; 214568608b5eSPeter Ujfalusi int ret = 0; 214668608b5eSPeter Ujfalusi 214768608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(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_RING_GET_CFG, 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); 21584c960505SYueHaibing dev_err(dev, 215968608b5eSPeter Ujfalusi "RM_RA:Message get config failed(%d)\n", ret); 216068608b5eSPeter Ujfalusi return ret; 216168608b5eSPeter Ujfalusi } 216268608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_ring_get_cfg_req *)xfer->xfer_buf; 216368608b5eSPeter Ujfalusi req->nav_id = nav_id; 216468608b5eSPeter Ujfalusi req->index = index; 216568608b5eSPeter Ujfalusi 216668608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 216768608b5eSPeter Ujfalusi if (ret) { 21684c960505SYueHaibing dev_err(dev, "RM_RA:Mbox get config send fail %d\n", ret); 216968608b5eSPeter Ujfalusi goto fail; 217068608b5eSPeter Ujfalusi } 217168608b5eSPeter Ujfalusi 217268608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_rm_ring_get_cfg_resp *)xfer->xfer_buf; 217368608b5eSPeter Ujfalusi 217468608b5eSPeter Ujfalusi if (!ti_sci_is_response_ack(resp)) { 217568608b5eSPeter Ujfalusi ret = -ENODEV; 217668608b5eSPeter Ujfalusi } else { 217768608b5eSPeter Ujfalusi if (mode) 217868608b5eSPeter Ujfalusi *mode = resp->mode; 217968608b5eSPeter Ujfalusi if (addr_lo) 218068608b5eSPeter Ujfalusi *addr_lo = resp->addr_lo; 218168608b5eSPeter Ujfalusi if (addr_hi) 218268608b5eSPeter Ujfalusi *addr_hi = resp->addr_hi; 218368608b5eSPeter Ujfalusi if (count) 218468608b5eSPeter Ujfalusi *count = resp->count; 218568608b5eSPeter Ujfalusi if (size) 218668608b5eSPeter Ujfalusi *size = resp->size; 218768608b5eSPeter Ujfalusi if (order_id) 218868608b5eSPeter Ujfalusi *order_id = resp->order_id; 218968608b5eSPeter Ujfalusi }; 219068608b5eSPeter Ujfalusi 219168608b5eSPeter Ujfalusi fail: 219268608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 21934c960505SYueHaibing dev_dbg(dev, "RM_RA:get config ring %u ret:%d\n", index, ret); 219468608b5eSPeter Ujfalusi return ret; 219568608b5eSPeter Ujfalusi } 219668608b5eSPeter Ujfalusi 219768608b5eSPeter Ujfalusi /** 219868608b5eSPeter Ujfalusi * ti_sci_cmd_rm_psil_pair() - Pair PSI-L source to destination thread 219968608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 220068608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem which should be used for 220168608b5eSPeter Ujfalusi * pairing 220268608b5eSPeter Ujfalusi * @src_thread: Source PSI-L thread ID 220368608b5eSPeter Ujfalusi * @dst_thread: Destination PSI-L thread ID 220468608b5eSPeter Ujfalusi * 220568608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 220668608b5eSPeter Ujfalusi */ 220768608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_psil_pair(const struct ti_sci_handle *handle, 220868608b5eSPeter Ujfalusi u32 nav_id, u32 src_thread, u32 dst_thread) 220968608b5eSPeter Ujfalusi { 221068608b5eSPeter Ujfalusi struct ti_sci_msg_psil_pair *req; 221168608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 221268608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 221368608b5eSPeter Ujfalusi struct ti_sci_info *info; 221468608b5eSPeter Ujfalusi struct device *dev; 221568608b5eSPeter Ujfalusi int ret = 0; 221668608b5eSPeter Ujfalusi 221768608b5eSPeter Ujfalusi if (IS_ERR(handle)) 221868608b5eSPeter Ujfalusi return PTR_ERR(handle); 221968608b5eSPeter Ujfalusi if (!handle) 222068608b5eSPeter Ujfalusi return -EINVAL; 222168608b5eSPeter Ujfalusi 222268608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 222368608b5eSPeter Ujfalusi dev = info->dev; 222468608b5eSPeter Ujfalusi 222568608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_PAIR, 222668608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 222768608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 222868608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 222968608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 223068608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret); 223168608b5eSPeter Ujfalusi return ret; 223268608b5eSPeter Ujfalusi } 223368608b5eSPeter Ujfalusi req = (struct ti_sci_msg_psil_pair *)xfer->xfer_buf; 223468608b5eSPeter Ujfalusi req->nav_id = nav_id; 223568608b5eSPeter Ujfalusi req->src_thread = src_thread; 223668608b5eSPeter Ujfalusi req->dst_thread = dst_thread; 223768608b5eSPeter Ujfalusi 223868608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 223968608b5eSPeter Ujfalusi if (ret) { 224068608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Mbox send fail %d\n", ret); 224168608b5eSPeter Ujfalusi goto fail; 224268608b5eSPeter Ujfalusi } 224368608b5eSPeter Ujfalusi 224468608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 224568608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 224668608b5eSPeter Ujfalusi 224768608b5eSPeter Ujfalusi fail: 224868608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 224968608b5eSPeter Ujfalusi 225068608b5eSPeter Ujfalusi return ret; 225168608b5eSPeter Ujfalusi } 225268608b5eSPeter Ujfalusi 225368608b5eSPeter Ujfalusi /** 225468608b5eSPeter Ujfalusi * ti_sci_cmd_rm_psil_unpair() - Unpair PSI-L source from destination thread 225568608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 225668608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem which should be used for 225768608b5eSPeter Ujfalusi * unpairing 225868608b5eSPeter Ujfalusi * @src_thread: Source PSI-L thread ID 225968608b5eSPeter Ujfalusi * @dst_thread: Destination PSI-L thread ID 226068608b5eSPeter Ujfalusi * 226168608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 226268608b5eSPeter Ujfalusi */ 226368608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_psil_unpair(const struct ti_sci_handle *handle, 226468608b5eSPeter Ujfalusi u32 nav_id, u32 src_thread, u32 dst_thread) 226568608b5eSPeter Ujfalusi { 226668608b5eSPeter Ujfalusi struct ti_sci_msg_psil_unpair *req; 226768608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 226868608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 226968608b5eSPeter Ujfalusi struct ti_sci_info *info; 227068608b5eSPeter Ujfalusi struct device *dev; 227168608b5eSPeter Ujfalusi int ret = 0; 227268608b5eSPeter Ujfalusi 227368608b5eSPeter Ujfalusi if (IS_ERR(handle)) 227468608b5eSPeter Ujfalusi return PTR_ERR(handle); 227568608b5eSPeter Ujfalusi if (!handle) 227668608b5eSPeter Ujfalusi return -EINVAL; 227768608b5eSPeter Ujfalusi 227868608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 227968608b5eSPeter Ujfalusi dev = info->dev; 228068608b5eSPeter Ujfalusi 228168608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_UNPAIR, 228268608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 228368608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 228468608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 228568608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 228668608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret); 228768608b5eSPeter Ujfalusi return ret; 228868608b5eSPeter Ujfalusi } 228968608b5eSPeter Ujfalusi req = (struct ti_sci_msg_psil_unpair *)xfer->xfer_buf; 229068608b5eSPeter Ujfalusi req->nav_id = nav_id; 229168608b5eSPeter Ujfalusi req->src_thread = src_thread; 229268608b5eSPeter Ujfalusi req->dst_thread = dst_thread; 229368608b5eSPeter Ujfalusi 229468608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 229568608b5eSPeter Ujfalusi if (ret) { 229668608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Mbox send 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); 230568608b5eSPeter Ujfalusi 230668608b5eSPeter Ujfalusi return ret; 230768608b5eSPeter Ujfalusi } 230868608b5eSPeter Ujfalusi 230968608b5eSPeter Ujfalusi /** 231068608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_tx_ch_cfg() - Configure a UDMAP TX channel 231168608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 231268608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_tx_ch_cfg TX 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_tx_ch_cfg and @ti_sci_msg_rm_udmap_tx_ch_cfg_req for 231868608b5eSPeter Ujfalusi * more info. 231968608b5eSPeter Ujfalusi */ 232068608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_tx_ch_cfg(const struct ti_sci_handle *handle, 232168608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_tx_ch_cfg *params) 232268608b5eSPeter Ujfalusi { 232368608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_tx_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_TX_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 TX_CH_CFG alloc failed(%d)\n", ret); 234268608b5eSPeter Ujfalusi return ret; 234368608b5eSPeter Ujfalusi } 234468608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_tx_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->tx_pause_on_err = params->tx_pause_on_err; 234968608b5eSPeter Ujfalusi req->tx_filt_einfo = params->tx_filt_einfo; 235068608b5eSPeter Ujfalusi req->tx_filt_pswords = params->tx_filt_pswords; 235168608b5eSPeter Ujfalusi req->tx_atype = params->tx_atype; 235268608b5eSPeter Ujfalusi req->tx_chan_type = params->tx_chan_type; 235368608b5eSPeter Ujfalusi req->tx_supr_tdpkt = params->tx_supr_tdpkt; 235468608b5eSPeter Ujfalusi req->tx_fetch_size = params->tx_fetch_size; 235568608b5eSPeter Ujfalusi req->tx_credit_count = params->tx_credit_count; 235668608b5eSPeter Ujfalusi req->txcq_qnum = params->txcq_qnum; 235768608b5eSPeter Ujfalusi req->tx_priority = params->tx_priority; 235868608b5eSPeter Ujfalusi req->tx_qos = params->tx_qos; 235968608b5eSPeter Ujfalusi req->tx_orderid = params->tx_orderid; 236068608b5eSPeter Ujfalusi req->fdepth = params->fdepth; 236168608b5eSPeter Ujfalusi req->tx_sched_priority = params->tx_sched_priority; 236268608b5eSPeter Ujfalusi req->tx_burst_size = params->tx_burst_size; 236368608b5eSPeter Ujfalusi 236468608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 236568608b5eSPeter Ujfalusi if (ret) { 23664c960505SYueHaibing dev_err(dev, "Mbox send TX_CH_CFG fail %d\n", ret); 236768608b5eSPeter Ujfalusi goto fail; 236868608b5eSPeter Ujfalusi } 236968608b5eSPeter Ujfalusi 237068608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 237168608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 237268608b5eSPeter Ujfalusi 237368608b5eSPeter Ujfalusi fail: 237468608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 23754c960505SYueHaibing dev_dbg(dev, "TX_CH_CFG: chn %u ret:%u\n", params->index, ret); 237668608b5eSPeter Ujfalusi return ret; 237768608b5eSPeter Ujfalusi } 237868608b5eSPeter Ujfalusi 237968608b5eSPeter Ujfalusi /** 238068608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_rx_ch_cfg() - Configure a UDMAP RX channel 238168608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 238268608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_rx_ch_cfg RX channel config 238368608b5eSPeter Ujfalusi * structure 238468608b5eSPeter Ujfalusi * 238568608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 238668608b5eSPeter Ujfalusi * 238768608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_rx_ch_cfg and @ti_sci_msg_rm_udmap_rx_ch_cfg_req for 238868608b5eSPeter Ujfalusi * more info. 238968608b5eSPeter Ujfalusi */ 239068608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_rx_ch_cfg(const struct ti_sci_handle *handle, 239168608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_rx_ch_cfg *params) 239268608b5eSPeter Ujfalusi { 239368608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *req; 239468608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 239568608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 239668608b5eSPeter Ujfalusi struct ti_sci_info *info; 239768608b5eSPeter Ujfalusi struct device *dev; 239868608b5eSPeter Ujfalusi int ret = 0; 239968608b5eSPeter Ujfalusi 240068608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 240168608b5eSPeter Ujfalusi return -EINVAL; 240268608b5eSPeter Ujfalusi 240368608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 240468608b5eSPeter Ujfalusi dev = info->dev; 240568608b5eSPeter Ujfalusi 240668608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_RX_CH_CFG, 240768608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 240868608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 240968608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 241068608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 24114c960505SYueHaibing dev_err(dev, "Message RX_CH_CFG alloc failed(%d)\n", ret); 241268608b5eSPeter Ujfalusi return ret; 241368608b5eSPeter Ujfalusi } 241468608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *)xfer->xfer_buf; 241568608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 241668608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 241768608b5eSPeter Ujfalusi req->index = params->index; 241868608b5eSPeter Ujfalusi req->rx_fetch_size = params->rx_fetch_size; 241968608b5eSPeter Ujfalusi req->rxcq_qnum = params->rxcq_qnum; 242068608b5eSPeter Ujfalusi req->rx_priority = params->rx_priority; 242168608b5eSPeter Ujfalusi req->rx_qos = params->rx_qos; 242268608b5eSPeter Ujfalusi req->rx_orderid = params->rx_orderid; 242368608b5eSPeter Ujfalusi req->rx_sched_priority = params->rx_sched_priority; 242468608b5eSPeter Ujfalusi req->flowid_start = params->flowid_start; 242568608b5eSPeter Ujfalusi req->flowid_cnt = params->flowid_cnt; 242668608b5eSPeter Ujfalusi req->rx_pause_on_err = params->rx_pause_on_err; 242768608b5eSPeter Ujfalusi req->rx_atype = params->rx_atype; 242868608b5eSPeter Ujfalusi req->rx_chan_type = params->rx_chan_type; 242968608b5eSPeter Ujfalusi req->rx_ignore_short = params->rx_ignore_short; 243068608b5eSPeter Ujfalusi req->rx_ignore_long = params->rx_ignore_long; 243168608b5eSPeter Ujfalusi req->rx_burst_size = params->rx_burst_size; 243268608b5eSPeter Ujfalusi 243368608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 243468608b5eSPeter Ujfalusi if (ret) { 24354c960505SYueHaibing dev_err(dev, "Mbox send RX_CH_CFG fail %d\n", ret); 243668608b5eSPeter Ujfalusi goto fail; 243768608b5eSPeter Ujfalusi } 243868608b5eSPeter Ujfalusi 243968608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 244068608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 244168608b5eSPeter Ujfalusi 244268608b5eSPeter Ujfalusi fail: 244368608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 24444c960505SYueHaibing dev_dbg(dev, "RX_CH_CFG: chn %u ret:%d\n", params->index, ret); 244568608b5eSPeter Ujfalusi return ret; 244668608b5eSPeter Ujfalusi } 244768608b5eSPeter Ujfalusi 244868608b5eSPeter Ujfalusi /** 244968608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_rx_flow_cfg() - Configure UDMAP RX FLOW 245068608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 245168608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_flow_cfg RX FLOW config 245268608b5eSPeter Ujfalusi * structure 245368608b5eSPeter Ujfalusi * 245468608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 245568608b5eSPeter Ujfalusi * 245668608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_flow_cfg and @ti_sci_msg_rm_udmap_flow_cfg_req for 245768608b5eSPeter Ujfalusi * more info. 245868608b5eSPeter Ujfalusi */ 245968608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_rx_flow_cfg(const struct ti_sci_handle *handle, 246068608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_flow_cfg *params) 246168608b5eSPeter Ujfalusi { 246268608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_flow_cfg_req *req; 246368608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 246468608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 246568608b5eSPeter Ujfalusi struct ti_sci_info *info; 246668608b5eSPeter Ujfalusi struct device *dev; 246768608b5eSPeter Ujfalusi int ret = 0; 246868608b5eSPeter Ujfalusi 246968608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 247068608b5eSPeter Ujfalusi return -EINVAL; 247168608b5eSPeter Ujfalusi 247268608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 247368608b5eSPeter Ujfalusi dev = info->dev; 247468608b5eSPeter Ujfalusi 247568608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_FLOW_CFG, 247668608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 247768608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 247868608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 247968608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 248068608b5eSPeter Ujfalusi dev_err(dev, "RX_FL_CFG: Message alloc failed(%d)\n", ret); 248168608b5eSPeter Ujfalusi return ret; 248268608b5eSPeter Ujfalusi } 248368608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_flow_cfg_req *)xfer->xfer_buf; 248468608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 248568608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 248668608b5eSPeter Ujfalusi req->flow_index = params->flow_index; 248768608b5eSPeter Ujfalusi req->rx_einfo_present = params->rx_einfo_present; 248868608b5eSPeter Ujfalusi req->rx_psinfo_present = params->rx_psinfo_present; 248968608b5eSPeter Ujfalusi req->rx_error_handling = params->rx_error_handling; 249068608b5eSPeter Ujfalusi req->rx_desc_type = params->rx_desc_type; 249168608b5eSPeter Ujfalusi req->rx_sop_offset = params->rx_sop_offset; 249268608b5eSPeter Ujfalusi req->rx_dest_qnum = params->rx_dest_qnum; 249368608b5eSPeter Ujfalusi req->rx_src_tag_hi = params->rx_src_tag_hi; 249468608b5eSPeter Ujfalusi req->rx_src_tag_lo = params->rx_src_tag_lo; 249568608b5eSPeter Ujfalusi req->rx_dest_tag_hi = params->rx_dest_tag_hi; 249668608b5eSPeter Ujfalusi req->rx_dest_tag_lo = params->rx_dest_tag_lo; 249768608b5eSPeter Ujfalusi req->rx_src_tag_hi_sel = params->rx_src_tag_hi_sel; 249868608b5eSPeter Ujfalusi req->rx_src_tag_lo_sel = params->rx_src_tag_lo_sel; 249968608b5eSPeter Ujfalusi req->rx_dest_tag_hi_sel = params->rx_dest_tag_hi_sel; 250068608b5eSPeter Ujfalusi req->rx_dest_tag_lo_sel = params->rx_dest_tag_lo_sel; 250168608b5eSPeter Ujfalusi req->rx_fdq0_sz0_qnum = params->rx_fdq0_sz0_qnum; 250268608b5eSPeter Ujfalusi req->rx_fdq1_qnum = params->rx_fdq1_qnum; 250368608b5eSPeter Ujfalusi req->rx_fdq2_qnum = params->rx_fdq2_qnum; 250468608b5eSPeter Ujfalusi req->rx_fdq3_qnum = params->rx_fdq3_qnum; 250568608b5eSPeter Ujfalusi req->rx_ps_location = params->rx_ps_location; 250668608b5eSPeter Ujfalusi 250768608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 250868608b5eSPeter Ujfalusi if (ret) { 250968608b5eSPeter Ujfalusi dev_err(dev, "RX_FL_CFG: Mbox send fail %d\n", ret); 251068608b5eSPeter Ujfalusi goto fail; 251168608b5eSPeter Ujfalusi } 251268608b5eSPeter Ujfalusi 251368608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 251468608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 251568608b5eSPeter Ujfalusi 251668608b5eSPeter Ujfalusi fail: 251768608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 251868608b5eSPeter Ujfalusi dev_dbg(info->dev, "RX_FL_CFG: %u ret:%d\n", params->flow_index, ret); 251968608b5eSPeter Ujfalusi return ret; 252068608b5eSPeter Ujfalusi } 252168608b5eSPeter Ujfalusi 25221e407f33SSuman Anna /** 25231e407f33SSuman Anna * ti_sci_cmd_proc_request() - Command to request a physical processor control 25241e407f33SSuman Anna * @handle: Pointer to TI SCI handle 25251e407f33SSuman Anna * @proc_id: Processor ID this request is for 25261e407f33SSuman Anna * 25271e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 25281e407f33SSuman Anna */ 25291e407f33SSuman Anna static int ti_sci_cmd_proc_request(const struct ti_sci_handle *handle, 25301e407f33SSuman Anna u8 proc_id) 25311e407f33SSuman Anna { 25321e407f33SSuman Anna struct ti_sci_msg_req_proc_request *req; 25331e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 25341e407f33SSuman Anna struct ti_sci_info *info; 25351e407f33SSuman Anna struct ti_sci_xfer *xfer; 25361e407f33SSuman Anna struct device *dev; 25371e407f33SSuman Anna int ret = 0; 25381e407f33SSuman Anna 25391e407f33SSuman Anna if (!handle) 25401e407f33SSuman Anna return -EINVAL; 25411e407f33SSuman Anna if (IS_ERR(handle)) 25421e407f33SSuman Anna return PTR_ERR(handle); 25431e407f33SSuman Anna 25441e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 25451e407f33SSuman Anna dev = info->dev; 25461e407f33SSuman Anna 25471e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_REQUEST, 25481e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 25491e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 25501e407f33SSuman Anna if (IS_ERR(xfer)) { 25511e407f33SSuman Anna ret = PTR_ERR(xfer); 25521e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 25531e407f33SSuman Anna return ret; 25541e407f33SSuman Anna } 25551e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_request *)xfer->xfer_buf; 25561e407f33SSuman Anna req->processor_id = proc_id; 25571e407f33SSuman Anna 25581e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 25591e407f33SSuman Anna if (ret) { 25601e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 25611e407f33SSuman Anna goto fail; 25621e407f33SSuman Anna } 25631e407f33SSuman Anna 25641e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 25651e407f33SSuman Anna 25661e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 25671e407f33SSuman Anna 25681e407f33SSuman Anna fail: 25691e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 25701e407f33SSuman Anna 25711e407f33SSuman Anna return ret; 25721e407f33SSuman Anna } 25731e407f33SSuman Anna 25741e407f33SSuman Anna /** 25751e407f33SSuman Anna * ti_sci_cmd_proc_release() - Command to release a physical processor control 25761e407f33SSuman Anna * @handle: Pointer to TI SCI handle 25771e407f33SSuman Anna * @proc_id: Processor ID this request is for 25781e407f33SSuman Anna * 25791e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 25801e407f33SSuman Anna */ 25811e407f33SSuman Anna static int ti_sci_cmd_proc_release(const struct ti_sci_handle *handle, 25821e407f33SSuman Anna u8 proc_id) 25831e407f33SSuman Anna { 25841e407f33SSuman Anna struct ti_sci_msg_req_proc_release *req; 25851e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 25861e407f33SSuman Anna struct ti_sci_info *info; 25871e407f33SSuman Anna struct ti_sci_xfer *xfer; 25881e407f33SSuman Anna struct device *dev; 25891e407f33SSuman Anna int ret = 0; 25901e407f33SSuman Anna 25911e407f33SSuman Anna if (!handle) 25921e407f33SSuman Anna return -EINVAL; 25931e407f33SSuman Anna if (IS_ERR(handle)) 25941e407f33SSuman Anna return PTR_ERR(handle); 25951e407f33SSuman Anna 25961e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 25971e407f33SSuman Anna dev = info->dev; 25981e407f33SSuman Anna 25991e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_RELEASE, 26001e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 26011e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 26021e407f33SSuman Anna if (IS_ERR(xfer)) { 26031e407f33SSuman Anna ret = PTR_ERR(xfer); 26041e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 26051e407f33SSuman Anna return ret; 26061e407f33SSuman Anna } 26071e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_release *)xfer->xfer_buf; 26081e407f33SSuman Anna req->processor_id = proc_id; 26091e407f33SSuman Anna 26101e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 26111e407f33SSuman Anna if (ret) { 26121e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 26131e407f33SSuman Anna goto fail; 26141e407f33SSuman Anna } 26151e407f33SSuman Anna 26161e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 26171e407f33SSuman Anna 26181e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 26191e407f33SSuman Anna 26201e407f33SSuman Anna fail: 26211e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 26221e407f33SSuman Anna 26231e407f33SSuman Anna return ret; 26241e407f33SSuman Anna } 26251e407f33SSuman Anna 26261e407f33SSuman Anna /** 26271e407f33SSuman Anna * ti_sci_cmd_proc_handover() - Command to handover a physical processor 26281e407f33SSuman Anna * control to a host in the processor's access 26291e407f33SSuman Anna * control list. 26301e407f33SSuman Anna * @handle: Pointer to TI SCI handle 26311e407f33SSuman Anna * @proc_id: Processor ID this request is for 26321e407f33SSuman Anna * @host_id: Host ID to get the control of the processor 26331e407f33SSuman Anna * 26341e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 26351e407f33SSuman Anna */ 26361e407f33SSuman Anna static int ti_sci_cmd_proc_handover(const struct ti_sci_handle *handle, 26371e407f33SSuman Anna u8 proc_id, u8 host_id) 26381e407f33SSuman Anna { 26391e407f33SSuman Anna struct ti_sci_msg_req_proc_handover *req; 26401e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 26411e407f33SSuman Anna struct ti_sci_info *info; 26421e407f33SSuman Anna struct ti_sci_xfer *xfer; 26431e407f33SSuman Anna struct device *dev; 26441e407f33SSuman Anna int ret = 0; 26451e407f33SSuman Anna 26461e407f33SSuman Anna if (!handle) 26471e407f33SSuman Anna return -EINVAL; 26481e407f33SSuman Anna if (IS_ERR(handle)) 26491e407f33SSuman Anna return PTR_ERR(handle); 26501e407f33SSuman Anna 26511e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 26521e407f33SSuman Anna dev = info->dev; 26531e407f33SSuman Anna 26541e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_HANDOVER, 26551e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 26561e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 26571e407f33SSuman Anna if (IS_ERR(xfer)) { 26581e407f33SSuman Anna ret = PTR_ERR(xfer); 26591e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 26601e407f33SSuman Anna return ret; 26611e407f33SSuman Anna } 26621e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_handover *)xfer->xfer_buf; 26631e407f33SSuman Anna req->processor_id = proc_id; 26641e407f33SSuman Anna req->host_id = host_id; 26651e407f33SSuman Anna 26661e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 26671e407f33SSuman Anna if (ret) { 26681e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 26691e407f33SSuman Anna goto fail; 26701e407f33SSuman Anna } 26711e407f33SSuman Anna 26721e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 26731e407f33SSuman Anna 26741e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 26751e407f33SSuman Anna 26761e407f33SSuman Anna fail: 26771e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 26781e407f33SSuman Anna 26791e407f33SSuman Anna return ret; 26801e407f33SSuman Anna } 26811e407f33SSuman Anna 26821e407f33SSuman Anna /** 26831e407f33SSuman Anna * ti_sci_cmd_proc_set_config() - Command to set the processor boot 26841e407f33SSuman Anna * configuration flags 26851e407f33SSuman Anna * @handle: Pointer to TI SCI handle 26861e407f33SSuman Anna * @proc_id: Processor ID this request is for 26871e407f33SSuman Anna * @config_flags_set: Configuration flags to be set 26881e407f33SSuman Anna * @config_flags_clear: Configuration flags to be cleared. 26891e407f33SSuman Anna * 26901e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 26911e407f33SSuman Anna */ 26921e407f33SSuman Anna static int ti_sci_cmd_proc_set_config(const struct ti_sci_handle *handle, 26931e407f33SSuman Anna u8 proc_id, u64 bootvector, 26941e407f33SSuman Anna u32 config_flags_set, 26951e407f33SSuman Anna u32 config_flags_clear) 26961e407f33SSuman Anna { 26971e407f33SSuman Anna struct ti_sci_msg_req_set_config *req; 26981e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 26991e407f33SSuman Anna struct ti_sci_info *info; 27001e407f33SSuman Anna struct ti_sci_xfer *xfer; 27011e407f33SSuman Anna struct device *dev; 27021e407f33SSuman Anna int ret = 0; 27031e407f33SSuman Anna 27041e407f33SSuman Anna if (!handle) 27051e407f33SSuman Anna return -EINVAL; 27061e407f33SSuman Anna if (IS_ERR(handle)) 27071e407f33SSuman Anna return PTR_ERR(handle); 27081e407f33SSuman Anna 27091e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 27101e407f33SSuman Anna dev = info->dev; 27111e407f33SSuman Anna 27121e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CONFIG, 27131e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 27141e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 27151e407f33SSuman Anna if (IS_ERR(xfer)) { 27161e407f33SSuman Anna ret = PTR_ERR(xfer); 27171e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 27181e407f33SSuman Anna return ret; 27191e407f33SSuman Anna } 27201e407f33SSuman Anna req = (struct ti_sci_msg_req_set_config *)xfer->xfer_buf; 27211e407f33SSuman Anna req->processor_id = proc_id; 27221e407f33SSuman Anna req->bootvector_low = bootvector & TI_SCI_ADDR_LOW_MASK; 27231e407f33SSuman Anna req->bootvector_high = (bootvector & TI_SCI_ADDR_HIGH_MASK) >> 27241e407f33SSuman Anna TI_SCI_ADDR_HIGH_SHIFT; 27251e407f33SSuman Anna req->config_flags_set = config_flags_set; 27261e407f33SSuman Anna req->config_flags_clear = config_flags_clear; 27271e407f33SSuman Anna 27281e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 27291e407f33SSuman Anna if (ret) { 27301e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 27311e407f33SSuman Anna goto fail; 27321e407f33SSuman Anna } 27331e407f33SSuman Anna 27341e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 27351e407f33SSuman Anna 27361e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 27371e407f33SSuman Anna 27381e407f33SSuman Anna fail: 27391e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 27401e407f33SSuman Anna 27411e407f33SSuman Anna return ret; 27421e407f33SSuman Anna } 27431e407f33SSuman Anna 27441e407f33SSuman Anna /** 27451e407f33SSuman Anna * ti_sci_cmd_proc_set_control() - Command to set the processor boot 27461e407f33SSuman Anna * control flags 27471e407f33SSuman Anna * @handle: Pointer to TI SCI handle 27481e407f33SSuman Anna * @proc_id: Processor ID this request is for 27491e407f33SSuman Anna * @control_flags_set: Control flags to be set 27501e407f33SSuman Anna * @control_flags_clear: Control flags to be cleared 27511e407f33SSuman Anna * 27521e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 27531e407f33SSuman Anna */ 27541e407f33SSuman Anna static int ti_sci_cmd_proc_set_control(const struct ti_sci_handle *handle, 27551e407f33SSuman Anna u8 proc_id, u32 control_flags_set, 27561e407f33SSuman Anna u32 control_flags_clear) 27571e407f33SSuman Anna { 27581e407f33SSuman Anna struct ti_sci_msg_req_set_ctrl *req; 27591e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 27601e407f33SSuman Anna struct ti_sci_info *info; 27611e407f33SSuman Anna struct ti_sci_xfer *xfer; 27621e407f33SSuman Anna struct device *dev; 27631e407f33SSuman Anna int ret = 0; 27641e407f33SSuman Anna 27651e407f33SSuman Anna if (!handle) 27661e407f33SSuman Anna return -EINVAL; 27671e407f33SSuman Anna if (IS_ERR(handle)) 27681e407f33SSuman Anna return PTR_ERR(handle); 27691e407f33SSuman Anna 27701e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 27711e407f33SSuman Anna dev = info->dev; 27721e407f33SSuman Anna 27731e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CTRL, 27741e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 27751e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 27761e407f33SSuman Anna if (IS_ERR(xfer)) { 27771e407f33SSuman Anna ret = PTR_ERR(xfer); 27781e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 27791e407f33SSuman Anna return ret; 27801e407f33SSuman Anna } 27811e407f33SSuman Anna req = (struct ti_sci_msg_req_set_ctrl *)xfer->xfer_buf; 27821e407f33SSuman Anna req->processor_id = proc_id; 27831e407f33SSuman Anna req->control_flags_set = control_flags_set; 27841e407f33SSuman Anna req->control_flags_clear = control_flags_clear; 27851e407f33SSuman Anna 27861e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 27871e407f33SSuman Anna if (ret) { 27881e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 27891e407f33SSuman Anna goto fail; 27901e407f33SSuman Anna } 27911e407f33SSuman Anna 27921e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 27931e407f33SSuman Anna 27941e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 27951e407f33SSuman Anna 27961e407f33SSuman Anna fail: 27971e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 27981e407f33SSuman Anna 27991e407f33SSuman Anna return ret; 28001e407f33SSuman Anna } 28011e407f33SSuman Anna 28021e407f33SSuman Anna /** 28031e407f33SSuman Anna * ti_sci_cmd_get_boot_status() - Command to get the processor boot status 28041e407f33SSuman Anna * @handle: Pointer to TI SCI handle 28051e407f33SSuman Anna * @proc_id: Processor ID this request is for 28061e407f33SSuman Anna * 28071e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 28081e407f33SSuman Anna */ 28091e407f33SSuman Anna static int ti_sci_cmd_proc_get_status(const struct ti_sci_handle *handle, 28101e407f33SSuman Anna u8 proc_id, u64 *bv, u32 *cfg_flags, 28111e407f33SSuman Anna u32 *ctrl_flags, u32 *sts_flags) 28121e407f33SSuman Anna { 28131e407f33SSuman Anna struct ti_sci_msg_resp_get_status *resp; 28141e407f33SSuman Anna struct ti_sci_msg_req_get_status *req; 28151e407f33SSuman Anna struct ti_sci_info *info; 28161e407f33SSuman Anna struct ti_sci_xfer *xfer; 28171e407f33SSuman Anna struct device *dev; 28181e407f33SSuman Anna int ret = 0; 28191e407f33SSuman Anna 28201e407f33SSuman Anna if (!handle) 28211e407f33SSuman Anna return -EINVAL; 28221e407f33SSuman Anna if (IS_ERR(handle)) 28231e407f33SSuman Anna return PTR_ERR(handle); 28241e407f33SSuman Anna 28251e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 28261e407f33SSuman Anna dev = info->dev; 28271e407f33SSuman Anna 28281e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_STATUS, 28291e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 28301e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 28311e407f33SSuman Anna if (IS_ERR(xfer)) { 28321e407f33SSuman Anna ret = PTR_ERR(xfer); 28331e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 28341e407f33SSuman Anna return ret; 28351e407f33SSuman Anna } 28361e407f33SSuman Anna req = (struct ti_sci_msg_req_get_status *)xfer->xfer_buf; 28371e407f33SSuman Anna req->processor_id = proc_id; 28381e407f33SSuman Anna 28391e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 28401e407f33SSuman Anna if (ret) { 28411e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 28421e407f33SSuman Anna goto fail; 28431e407f33SSuman Anna } 28441e407f33SSuman Anna 28451e407f33SSuman Anna resp = (struct ti_sci_msg_resp_get_status *)xfer->tx_message.buf; 28461e407f33SSuman Anna 28471e407f33SSuman Anna if (!ti_sci_is_response_ack(resp)) { 28481e407f33SSuman Anna ret = -ENODEV; 28491e407f33SSuman Anna } else { 28501e407f33SSuman Anna *bv = (resp->bootvector_low & TI_SCI_ADDR_LOW_MASK) | 28511e407f33SSuman Anna (((u64)resp->bootvector_high << TI_SCI_ADDR_HIGH_SHIFT) & 28521e407f33SSuman Anna TI_SCI_ADDR_HIGH_MASK); 28531e407f33SSuman Anna *cfg_flags = resp->config_flags; 28541e407f33SSuman Anna *ctrl_flags = resp->control_flags; 28551e407f33SSuman Anna *sts_flags = resp->status_flags; 28561e407f33SSuman Anna } 28571e407f33SSuman Anna 28581e407f33SSuman Anna fail: 28591e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 28601e407f33SSuman Anna 28611e407f33SSuman Anna return ret; 28621e407f33SSuman Anna } 28631e407f33SSuman Anna 28649e7d756dSNishanth Menon /* 28659e7d756dSNishanth Menon * ti_sci_setup_ops() - Setup the operations structures 28669e7d756dSNishanth Menon * @info: pointer to TISCI pointer 28679e7d756dSNishanth Menon */ 28689e7d756dSNishanth Menon static void ti_sci_setup_ops(struct ti_sci_info *info) 28699e7d756dSNishanth Menon { 28709e7d756dSNishanth Menon struct ti_sci_ops *ops = &info->handle.ops; 2871912cffb4SNishanth Menon struct ti_sci_core_ops *core_ops = &ops->core_ops; 28729e7d756dSNishanth Menon struct ti_sci_dev_ops *dops = &ops->dev_ops; 28739f723220SNishanth Menon struct ti_sci_clk_ops *cops = &ops->clk_ops; 28749c19fb68SLokesh Vutla struct ti_sci_rm_core_ops *rm_core_ops = &ops->rm_core_ops; 2875997b001fSLokesh Vutla struct ti_sci_rm_irq_ops *iops = &ops->rm_irq_ops; 287668608b5eSPeter Ujfalusi struct ti_sci_rm_ringacc_ops *rops = &ops->rm_ring_ops; 287768608b5eSPeter Ujfalusi struct ti_sci_rm_psil_ops *psilops = &ops->rm_psil_ops; 287868608b5eSPeter Ujfalusi struct ti_sci_rm_udmap_ops *udmap_ops = &ops->rm_udmap_ops; 28791e407f33SSuman Anna struct ti_sci_proc_ops *pops = &ops->proc_ops; 28809e7d756dSNishanth Menon 2881912cffb4SNishanth Menon core_ops->reboot_device = ti_sci_cmd_core_reboot; 2882912cffb4SNishanth Menon 28839e7d756dSNishanth Menon dops->get_device = ti_sci_cmd_get_device; 288445b659eeSLokesh Vutla dops->get_device_exclusive = ti_sci_cmd_get_device_exclusive; 28859e7d756dSNishanth Menon dops->idle_device = ti_sci_cmd_idle_device; 288645b659eeSLokesh Vutla dops->idle_device_exclusive = ti_sci_cmd_idle_device_exclusive; 28879e7d756dSNishanth Menon dops->put_device = ti_sci_cmd_put_device; 28889e7d756dSNishanth Menon 28899e7d756dSNishanth Menon dops->is_valid = ti_sci_cmd_dev_is_valid; 28909e7d756dSNishanth Menon dops->get_context_loss_count = ti_sci_cmd_dev_get_clcnt; 28919e7d756dSNishanth Menon dops->is_idle = ti_sci_cmd_dev_is_idle; 28929e7d756dSNishanth Menon dops->is_stop = ti_sci_cmd_dev_is_stop; 28939e7d756dSNishanth Menon dops->is_on = ti_sci_cmd_dev_is_on; 28949e7d756dSNishanth Menon dops->is_transitioning = ti_sci_cmd_dev_is_trans; 28959e7d756dSNishanth Menon dops->set_device_resets = ti_sci_cmd_set_device_resets; 28969e7d756dSNishanth Menon dops->get_device_resets = ti_sci_cmd_get_device_resets; 28979f723220SNishanth Menon 28989f723220SNishanth Menon cops->get_clock = ti_sci_cmd_get_clock; 28999f723220SNishanth Menon cops->idle_clock = ti_sci_cmd_idle_clock; 29009f723220SNishanth Menon cops->put_clock = ti_sci_cmd_put_clock; 29019f723220SNishanth Menon cops->is_auto = ti_sci_cmd_clk_is_auto; 29029f723220SNishanth Menon cops->is_on = ti_sci_cmd_clk_is_on; 29039f723220SNishanth Menon cops->is_off = ti_sci_cmd_clk_is_off; 29049f723220SNishanth Menon 29059f723220SNishanth Menon cops->set_parent = ti_sci_cmd_clk_set_parent; 29069f723220SNishanth Menon cops->get_parent = ti_sci_cmd_clk_get_parent; 29079f723220SNishanth Menon cops->get_num_parents = ti_sci_cmd_clk_get_num_parents; 29089f723220SNishanth Menon 29099f723220SNishanth Menon cops->get_best_match_freq = ti_sci_cmd_clk_get_match_freq; 29109f723220SNishanth Menon cops->set_freq = ti_sci_cmd_clk_set_freq; 29119f723220SNishanth Menon cops->get_freq = ti_sci_cmd_clk_get_freq; 29129c19fb68SLokesh Vutla 29139c19fb68SLokesh Vutla rm_core_ops->get_range = ti_sci_cmd_get_resource_range; 29149c19fb68SLokesh Vutla rm_core_ops->get_range_from_shost = 29159c19fb68SLokesh Vutla ti_sci_cmd_get_resource_range_from_shost; 2916997b001fSLokesh Vutla 2917997b001fSLokesh Vutla iops->set_irq = ti_sci_cmd_set_irq; 2918997b001fSLokesh Vutla iops->set_event_map = ti_sci_cmd_set_event_map; 2919997b001fSLokesh Vutla iops->free_irq = ti_sci_cmd_free_irq; 2920997b001fSLokesh Vutla iops->free_event_map = ti_sci_cmd_free_event_map; 292168608b5eSPeter Ujfalusi 292268608b5eSPeter Ujfalusi rops->config = ti_sci_cmd_ring_config; 292368608b5eSPeter Ujfalusi rops->get_config = ti_sci_cmd_ring_get_config; 292468608b5eSPeter Ujfalusi 292568608b5eSPeter Ujfalusi psilops->pair = ti_sci_cmd_rm_psil_pair; 292668608b5eSPeter Ujfalusi psilops->unpair = ti_sci_cmd_rm_psil_unpair; 292768608b5eSPeter Ujfalusi 292868608b5eSPeter Ujfalusi udmap_ops->tx_ch_cfg = ti_sci_cmd_rm_udmap_tx_ch_cfg; 292968608b5eSPeter Ujfalusi udmap_ops->rx_ch_cfg = ti_sci_cmd_rm_udmap_rx_ch_cfg; 293068608b5eSPeter Ujfalusi udmap_ops->rx_flow_cfg = ti_sci_cmd_rm_udmap_rx_flow_cfg; 29311e407f33SSuman Anna 29321e407f33SSuman Anna pops->request = ti_sci_cmd_proc_request; 29331e407f33SSuman Anna pops->release = ti_sci_cmd_proc_release; 29341e407f33SSuman Anna pops->handover = ti_sci_cmd_proc_handover; 29351e407f33SSuman Anna pops->set_config = ti_sci_cmd_proc_set_config; 29361e407f33SSuman Anna pops->set_control = ti_sci_cmd_proc_set_control; 29371e407f33SSuman Anna pops->get_status = ti_sci_cmd_proc_get_status; 29389e7d756dSNishanth Menon } 29399e7d756dSNishanth Menon 29409e7d756dSNishanth Menon /** 2941aa276781SNishanth Menon * ti_sci_get_handle() - Get the TI SCI handle for a device 2942aa276781SNishanth Menon * @dev: Pointer to device for which we want SCI handle 2943aa276781SNishanth Menon * 2944aa276781SNishanth Menon * NOTE: The function does not track individual clients of the framework 2945aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2946aa276781SNishanth Menon * ti_sci_put_handle must be balanced with successful ti_sci_get_handle 2947aa276781SNishanth Menon * Return: pointer to handle if successful, else: 2948aa276781SNishanth Menon * -EPROBE_DEFER if the instance is not ready 2949aa276781SNishanth Menon * -ENODEV if the required node handler is missing 2950aa276781SNishanth Menon * -EINVAL if invalid conditions are encountered. 2951aa276781SNishanth Menon */ 2952aa276781SNishanth Menon const struct ti_sci_handle *ti_sci_get_handle(struct device *dev) 2953aa276781SNishanth Menon { 2954aa276781SNishanth Menon struct device_node *ti_sci_np; 2955aa276781SNishanth Menon struct list_head *p; 2956aa276781SNishanth Menon struct ti_sci_handle *handle = NULL; 2957aa276781SNishanth Menon struct ti_sci_info *info; 2958aa276781SNishanth Menon 2959aa276781SNishanth Menon if (!dev) { 2960aa276781SNishanth Menon pr_err("I need a device pointer\n"); 2961aa276781SNishanth Menon return ERR_PTR(-EINVAL); 2962aa276781SNishanth Menon } 2963aa276781SNishanth Menon ti_sci_np = of_get_parent(dev->of_node); 2964aa276781SNishanth Menon if (!ti_sci_np) { 2965aa276781SNishanth Menon dev_err(dev, "No OF information\n"); 2966aa276781SNishanth Menon return ERR_PTR(-EINVAL); 2967aa276781SNishanth Menon } 2968aa276781SNishanth Menon 2969aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 2970aa276781SNishanth Menon list_for_each(p, &ti_sci_list) { 2971aa276781SNishanth Menon info = list_entry(p, struct ti_sci_info, node); 2972aa276781SNishanth Menon if (ti_sci_np == info->dev->of_node) { 2973aa276781SNishanth Menon handle = &info->handle; 2974aa276781SNishanth Menon info->users++; 2975aa276781SNishanth Menon break; 2976aa276781SNishanth Menon } 2977aa276781SNishanth Menon } 2978aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 2979aa276781SNishanth Menon of_node_put(ti_sci_np); 2980aa276781SNishanth Menon 2981aa276781SNishanth Menon if (!handle) 2982aa276781SNishanth Menon return ERR_PTR(-EPROBE_DEFER); 2983aa276781SNishanth Menon 2984aa276781SNishanth Menon return handle; 2985aa276781SNishanth Menon } 2986aa276781SNishanth Menon EXPORT_SYMBOL_GPL(ti_sci_get_handle); 2987aa276781SNishanth Menon 2988aa276781SNishanth Menon /** 2989aa276781SNishanth Menon * ti_sci_put_handle() - Release the handle acquired by ti_sci_get_handle 2990aa276781SNishanth Menon * @handle: Handle acquired by ti_sci_get_handle 2991aa276781SNishanth Menon * 2992aa276781SNishanth Menon * NOTE: The function does not track individual clients of the framework 2993aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2994aa276781SNishanth Menon * ti_sci_put_handle must be balanced with successful ti_sci_get_handle 2995aa276781SNishanth Menon * 2996aa276781SNishanth Menon * Return: 0 is successfully released 2997aa276781SNishanth Menon * if an error pointer was passed, it returns the error value back, 2998aa276781SNishanth Menon * if null was passed, it returns -EINVAL; 2999aa276781SNishanth Menon */ 3000aa276781SNishanth Menon int ti_sci_put_handle(const struct ti_sci_handle *handle) 3001aa276781SNishanth Menon { 3002aa276781SNishanth Menon struct ti_sci_info *info; 3003aa276781SNishanth Menon 3004aa276781SNishanth Menon if (IS_ERR(handle)) 3005aa276781SNishanth Menon return PTR_ERR(handle); 3006aa276781SNishanth Menon if (!handle) 3007aa276781SNishanth Menon return -EINVAL; 3008aa276781SNishanth Menon 3009aa276781SNishanth Menon info = handle_to_ti_sci_info(handle); 3010aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 3011aa276781SNishanth Menon if (!WARN_ON(!info->users)) 3012aa276781SNishanth Menon info->users--; 3013aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 3014aa276781SNishanth Menon 3015aa276781SNishanth Menon return 0; 3016aa276781SNishanth Menon } 3017aa276781SNishanth Menon EXPORT_SYMBOL_GPL(ti_sci_put_handle); 3018aa276781SNishanth Menon 3019aa276781SNishanth Menon static void devm_ti_sci_release(struct device *dev, void *res) 3020aa276781SNishanth Menon { 3021aa276781SNishanth Menon const struct ti_sci_handle **ptr = res; 3022aa276781SNishanth Menon const struct ti_sci_handle *handle = *ptr; 3023aa276781SNishanth Menon int ret; 3024aa276781SNishanth Menon 3025aa276781SNishanth Menon ret = ti_sci_put_handle(handle); 3026aa276781SNishanth Menon if (ret) 3027aa276781SNishanth Menon dev_err(dev, "failed to put handle %d\n", ret); 3028aa276781SNishanth Menon } 3029aa276781SNishanth Menon 3030aa276781SNishanth Menon /** 3031aa276781SNishanth Menon * devm_ti_sci_get_handle() - Managed get handle 3032aa276781SNishanth Menon * @dev: device for which we want SCI handle for. 3033aa276781SNishanth Menon * 3034aa276781SNishanth Menon * NOTE: This releases the handle once the device resources are 3035aa276781SNishanth Menon * no longer needed. MUST NOT BE released with ti_sci_put_handle. 3036aa276781SNishanth Menon * The function does not track individual clients of the framework 3037aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 3038aa276781SNishanth Menon * 3039aa276781SNishanth Menon * Return: 0 if all went fine, else corresponding error. 3040aa276781SNishanth Menon */ 3041aa276781SNishanth Menon const struct ti_sci_handle *devm_ti_sci_get_handle(struct device *dev) 3042aa276781SNishanth Menon { 3043aa276781SNishanth Menon const struct ti_sci_handle **ptr; 3044aa276781SNishanth Menon const struct ti_sci_handle *handle; 3045aa276781SNishanth Menon 3046aa276781SNishanth Menon ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL); 3047aa276781SNishanth Menon if (!ptr) 3048aa276781SNishanth Menon return ERR_PTR(-ENOMEM); 3049aa276781SNishanth Menon handle = ti_sci_get_handle(dev); 3050aa276781SNishanth Menon 3051aa276781SNishanth Menon if (!IS_ERR(handle)) { 3052aa276781SNishanth Menon *ptr = handle; 3053aa276781SNishanth Menon devres_add(dev, ptr); 3054aa276781SNishanth Menon } else { 3055aa276781SNishanth Menon devres_free(ptr); 3056aa276781SNishanth Menon } 3057aa276781SNishanth Menon 3058aa276781SNishanth Menon return handle; 3059aa276781SNishanth Menon } 3060aa276781SNishanth Menon EXPORT_SYMBOL_GPL(devm_ti_sci_get_handle); 3061aa276781SNishanth Menon 3062905c3047SGrygorii Strashko /** 3063905c3047SGrygorii Strashko * ti_sci_get_by_phandle() - Get the TI SCI handle using DT phandle 3064905c3047SGrygorii Strashko * @np: device node 3065905c3047SGrygorii Strashko * @property: property name containing phandle on TISCI node 3066905c3047SGrygorii Strashko * 3067905c3047SGrygorii Strashko * NOTE: The function does not track individual clients of the framework 3068905c3047SGrygorii Strashko * and is expected to be maintained by caller of TI SCI protocol library. 3069905c3047SGrygorii Strashko * ti_sci_put_handle must be balanced with successful ti_sci_get_by_phandle 3070905c3047SGrygorii Strashko * Return: pointer to handle if successful, else: 3071905c3047SGrygorii Strashko * -EPROBE_DEFER if the instance is not ready 3072905c3047SGrygorii Strashko * -ENODEV if the required node handler is missing 3073905c3047SGrygorii Strashko * -EINVAL if invalid conditions are encountered. 3074905c3047SGrygorii Strashko */ 3075905c3047SGrygorii Strashko const struct ti_sci_handle *ti_sci_get_by_phandle(struct device_node *np, 3076905c3047SGrygorii Strashko const char *property) 3077905c3047SGrygorii Strashko { 3078905c3047SGrygorii Strashko struct ti_sci_handle *handle = NULL; 3079905c3047SGrygorii Strashko struct device_node *ti_sci_np; 3080905c3047SGrygorii Strashko struct ti_sci_info *info; 3081905c3047SGrygorii Strashko struct list_head *p; 3082905c3047SGrygorii Strashko 3083905c3047SGrygorii Strashko if (!np) { 3084905c3047SGrygorii Strashko pr_err("I need a device pointer\n"); 3085905c3047SGrygorii Strashko return ERR_PTR(-EINVAL); 3086905c3047SGrygorii Strashko } 3087905c3047SGrygorii Strashko 3088905c3047SGrygorii Strashko ti_sci_np = of_parse_phandle(np, property, 0); 3089905c3047SGrygorii Strashko if (!ti_sci_np) 3090905c3047SGrygorii Strashko return ERR_PTR(-ENODEV); 3091905c3047SGrygorii Strashko 3092905c3047SGrygorii Strashko mutex_lock(&ti_sci_list_mutex); 3093905c3047SGrygorii Strashko list_for_each(p, &ti_sci_list) { 3094905c3047SGrygorii Strashko info = list_entry(p, struct ti_sci_info, node); 3095905c3047SGrygorii Strashko if (ti_sci_np == info->dev->of_node) { 3096905c3047SGrygorii Strashko handle = &info->handle; 3097905c3047SGrygorii Strashko info->users++; 3098905c3047SGrygorii Strashko break; 3099905c3047SGrygorii Strashko } 3100905c3047SGrygorii Strashko } 3101905c3047SGrygorii Strashko mutex_unlock(&ti_sci_list_mutex); 3102905c3047SGrygorii Strashko of_node_put(ti_sci_np); 3103905c3047SGrygorii Strashko 3104905c3047SGrygorii Strashko if (!handle) 3105905c3047SGrygorii Strashko return ERR_PTR(-EPROBE_DEFER); 3106905c3047SGrygorii Strashko 3107905c3047SGrygorii Strashko return handle; 3108905c3047SGrygorii Strashko } 3109905c3047SGrygorii Strashko EXPORT_SYMBOL_GPL(ti_sci_get_by_phandle); 3110905c3047SGrygorii Strashko 3111905c3047SGrygorii Strashko /** 3112905c3047SGrygorii Strashko * devm_ti_sci_get_by_phandle() - Managed get handle using phandle 3113905c3047SGrygorii Strashko * @dev: Device pointer requesting TISCI handle 3114905c3047SGrygorii Strashko * @property: property name containing phandle on TISCI node 3115905c3047SGrygorii Strashko * 3116905c3047SGrygorii Strashko * NOTE: This releases the handle once the device resources are 3117905c3047SGrygorii Strashko * no longer needed. MUST NOT BE released with ti_sci_put_handle. 3118905c3047SGrygorii Strashko * The function does not track individual clients of the framework 3119905c3047SGrygorii Strashko * and is expected to be maintained by caller of TI SCI protocol library. 3120905c3047SGrygorii Strashko * 3121905c3047SGrygorii Strashko * Return: 0 if all went fine, else corresponding error. 3122905c3047SGrygorii Strashko */ 3123905c3047SGrygorii Strashko const struct ti_sci_handle *devm_ti_sci_get_by_phandle(struct device *dev, 3124905c3047SGrygorii Strashko const char *property) 3125905c3047SGrygorii Strashko { 3126905c3047SGrygorii Strashko const struct ti_sci_handle *handle; 3127905c3047SGrygorii Strashko const struct ti_sci_handle **ptr; 3128905c3047SGrygorii Strashko 3129905c3047SGrygorii Strashko ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL); 3130905c3047SGrygorii Strashko if (!ptr) 3131905c3047SGrygorii Strashko return ERR_PTR(-ENOMEM); 3132905c3047SGrygorii Strashko handle = ti_sci_get_by_phandle(dev_of_node(dev), property); 3133905c3047SGrygorii Strashko 3134905c3047SGrygorii Strashko if (!IS_ERR(handle)) { 3135905c3047SGrygorii Strashko *ptr = handle; 3136905c3047SGrygorii Strashko devres_add(dev, ptr); 3137905c3047SGrygorii Strashko } else { 3138905c3047SGrygorii Strashko devres_free(ptr); 3139905c3047SGrygorii Strashko } 3140905c3047SGrygorii Strashko 3141905c3047SGrygorii Strashko return handle; 3142905c3047SGrygorii Strashko } 3143905c3047SGrygorii Strashko EXPORT_SYMBOL_GPL(devm_ti_sci_get_by_phandle); 3144905c3047SGrygorii Strashko 3145032a1ec5SLokesh Vutla /** 3146032a1ec5SLokesh Vutla * ti_sci_get_free_resource() - Get a free resource from TISCI resource. 3147032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3148032a1ec5SLokesh Vutla * 3149032a1ec5SLokesh Vutla * Return: resource num if all went ok else TI_SCI_RESOURCE_NULL. 3150032a1ec5SLokesh Vutla */ 3151032a1ec5SLokesh Vutla u16 ti_sci_get_free_resource(struct ti_sci_resource *res) 3152032a1ec5SLokesh Vutla { 3153032a1ec5SLokesh Vutla unsigned long flags; 3154032a1ec5SLokesh Vutla u16 set, free_bit; 3155032a1ec5SLokesh Vutla 3156032a1ec5SLokesh Vutla raw_spin_lock_irqsave(&res->lock, flags); 3157032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) { 3158032a1ec5SLokesh Vutla free_bit = find_first_zero_bit(res->desc[set].res_map, 3159032a1ec5SLokesh Vutla res->desc[set].num); 3160032a1ec5SLokesh Vutla if (free_bit != res->desc[set].num) { 3161032a1ec5SLokesh Vutla set_bit(free_bit, res->desc[set].res_map); 3162032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3163032a1ec5SLokesh Vutla return res->desc[set].start + free_bit; 3164032a1ec5SLokesh Vutla } 3165032a1ec5SLokesh Vutla } 3166032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3167032a1ec5SLokesh Vutla 3168032a1ec5SLokesh Vutla return TI_SCI_RESOURCE_NULL; 3169032a1ec5SLokesh Vutla } 3170032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_get_free_resource); 3171032a1ec5SLokesh Vutla 3172032a1ec5SLokesh Vutla /** 3173032a1ec5SLokesh Vutla * ti_sci_release_resource() - Release a resource from TISCI resource. 3174032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3175032a1ec5SLokesh Vutla * @id: Resource id to be released. 3176032a1ec5SLokesh Vutla */ 3177032a1ec5SLokesh Vutla void ti_sci_release_resource(struct ti_sci_resource *res, u16 id) 3178032a1ec5SLokesh Vutla { 3179032a1ec5SLokesh Vutla unsigned long flags; 3180032a1ec5SLokesh Vutla u16 set; 3181032a1ec5SLokesh Vutla 3182032a1ec5SLokesh Vutla raw_spin_lock_irqsave(&res->lock, flags); 3183032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) { 3184032a1ec5SLokesh Vutla if (res->desc[set].start <= id && 3185032a1ec5SLokesh Vutla (res->desc[set].num + res->desc[set].start) > id) 3186032a1ec5SLokesh Vutla clear_bit(id - res->desc[set].start, 3187032a1ec5SLokesh Vutla res->desc[set].res_map); 3188032a1ec5SLokesh Vutla } 3189032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3190032a1ec5SLokesh Vutla } 3191032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_release_resource); 3192032a1ec5SLokesh Vutla 3193032a1ec5SLokesh Vutla /** 3194032a1ec5SLokesh Vutla * ti_sci_get_num_resources() - Get the number of resources in TISCI resource 3195032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3196032a1ec5SLokesh Vutla * 3197032a1ec5SLokesh Vutla * Return: Total number of available resources. 3198032a1ec5SLokesh Vutla */ 3199032a1ec5SLokesh Vutla u32 ti_sci_get_num_resources(struct ti_sci_resource *res) 3200032a1ec5SLokesh Vutla { 3201032a1ec5SLokesh Vutla u32 set, count = 0; 3202032a1ec5SLokesh Vutla 3203032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) 3204032a1ec5SLokesh Vutla count += res->desc[set].num; 3205032a1ec5SLokesh Vutla 3206032a1ec5SLokesh Vutla return count; 3207032a1ec5SLokesh Vutla } 3208032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_get_num_resources); 3209032a1ec5SLokesh Vutla 3210032a1ec5SLokesh Vutla /** 3211032a1ec5SLokesh Vutla * devm_ti_sci_get_of_resource() - Get a TISCI resource assigned to a device 3212032a1ec5SLokesh Vutla * @handle: TISCI handle 3213032a1ec5SLokesh Vutla * @dev: Device pointer to which the resource is assigned 3214032a1ec5SLokesh Vutla * @dev_id: TISCI device id to which the resource is assigned 3215032a1ec5SLokesh Vutla * @of_prop: property name by which the resource are represented 3216032a1ec5SLokesh Vutla * 3217032a1ec5SLokesh Vutla * Return: Pointer to ti_sci_resource if all went well else appropriate 3218032a1ec5SLokesh Vutla * error pointer. 3219032a1ec5SLokesh Vutla */ 3220032a1ec5SLokesh Vutla struct ti_sci_resource * 3221032a1ec5SLokesh Vutla devm_ti_sci_get_of_resource(const struct ti_sci_handle *handle, 3222032a1ec5SLokesh Vutla struct device *dev, u32 dev_id, char *of_prop) 3223032a1ec5SLokesh Vutla { 3224032a1ec5SLokesh Vutla struct ti_sci_resource *res; 3225fa42da11SPeter Ujfalusi bool valid_set = false; 3226032a1ec5SLokesh Vutla u32 resource_subtype; 3227032a1ec5SLokesh Vutla int i, ret; 3228032a1ec5SLokesh Vutla 3229032a1ec5SLokesh Vutla res = devm_kzalloc(dev, sizeof(*res), GFP_KERNEL); 3230032a1ec5SLokesh Vutla if (!res) 3231032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3232032a1ec5SLokesh Vutla 32330b88bc92SStephen Boyd ret = of_property_count_elems_of_size(dev_of_node(dev), of_prop, 3234032a1ec5SLokesh Vutla sizeof(u32)); 32350b88bc92SStephen Boyd if (ret < 0) { 3236032a1ec5SLokesh Vutla dev_err(dev, "%s resource type ids not available\n", of_prop); 32370b88bc92SStephen Boyd return ERR_PTR(ret); 3238032a1ec5SLokesh Vutla } 32390b88bc92SStephen Boyd res->sets = ret; 3240032a1ec5SLokesh Vutla 3241032a1ec5SLokesh Vutla res->desc = devm_kcalloc(dev, res->sets, sizeof(*res->desc), 3242032a1ec5SLokesh Vutla GFP_KERNEL); 3243032a1ec5SLokesh Vutla if (!res->desc) 3244032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3245032a1ec5SLokesh Vutla 3246032a1ec5SLokesh Vutla for (i = 0; i < res->sets; i++) { 3247032a1ec5SLokesh Vutla ret = of_property_read_u32_index(dev_of_node(dev), of_prop, i, 3248032a1ec5SLokesh Vutla &resource_subtype); 3249032a1ec5SLokesh Vutla if (ret) 3250032a1ec5SLokesh Vutla return ERR_PTR(-EINVAL); 3251032a1ec5SLokesh Vutla 3252032a1ec5SLokesh Vutla ret = handle->ops.rm_core_ops.get_range(handle, dev_id, 3253032a1ec5SLokesh Vutla resource_subtype, 3254032a1ec5SLokesh Vutla &res->desc[i].start, 3255032a1ec5SLokesh Vutla &res->desc[i].num); 3256032a1ec5SLokesh Vutla if (ret) { 3257fa42da11SPeter Ujfalusi dev_dbg(dev, "dev = %d subtype %d not allocated for this host\n", 3258032a1ec5SLokesh Vutla dev_id, resource_subtype); 3259fa42da11SPeter Ujfalusi res->desc[i].start = 0; 3260fa42da11SPeter Ujfalusi res->desc[i].num = 0; 3261fa42da11SPeter Ujfalusi continue; 3262032a1ec5SLokesh Vutla } 3263032a1ec5SLokesh Vutla 3264032a1ec5SLokesh Vutla dev_dbg(dev, "dev = %d, subtype = %d, start = %d, num = %d\n", 3265032a1ec5SLokesh Vutla dev_id, resource_subtype, res->desc[i].start, 3266032a1ec5SLokesh Vutla res->desc[i].num); 3267032a1ec5SLokesh Vutla 3268fa42da11SPeter Ujfalusi valid_set = true; 3269032a1ec5SLokesh Vutla res->desc[i].res_map = 3270032a1ec5SLokesh Vutla devm_kzalloc(dev, BITS_TO_LONGS(res->desc[i].num) * 3271032a1ec5SLokesh Vutla sizeof(*res->desc[i].res_map), GFP_KERNEL); 3272032a1ec5SLokesh Vutla if (!res->desc[i].res_map) 3273032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3274032a1ec5SLokesh Vutla } 3275032a1ec5SLokesh Vutla raw_spin_lock_init(&res->lock); 3276032a1ec5SLokesh Vutla 3277fa42da11SPeter Ujfalusi if (valid_set) 3278032a1ec5SLokesh Vutla return res; 3279fa42da11SPeter Ujfalusi 3280fa42da11SPeter Ujfalusi return ERR_PTR(-EINVAL); 3281032a1ec5SLokesh Vutla } 3282032a1ec5SLokesh Vutla 3283912cffb4SNishanth Menon static int tisci_reboot_handler(struct notifier_block *nb, unsigned long mode, 3284912cffb4SNishanth Menon void *cmd) 3285912cffb4SNishanth Menon { 3286912cffb4SNishanth Menon struct ti_sci_info *info = reboot_to_ti_sci_info(nb); 3287912cffb4SNishanth Menon const struct ti_sci_handle *handle = &info->handle; 3288912cffb4SNishanth Menon 3289912cffb4SNishanth Menon ti_sci_cmd_core_reboot(handle); 3290912cffb4SNishanth Menon 3291912cffb4SNishanth Menon /* call fail OR pass, we should not be here in the first place */ 3292912cffb4SNishanth Menon return NOTIFY_BAD; 3293912cffb4SNishanth Menon } 3294912cffb4SNishanth Menon 3295aa276781SNishanth Menon /* Description for K2G */ 3296aa276781SNishanth Menon static const struct ti_sci_desc ti_sci_pmmc_k2g_desc = { 3297e69a3553SNishanth Menon .default_host_id = 2, 3298aa276781SNishanth Menon /* Conservative duration */ 3299aa276781SNishanth Menon .max_rx_timeout_ms = 1000, 3300aa276781SNishanth Menon /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */ 3301aa276781SNishanth Menon .max_msgs = 20, 3302aa276781SNishanth Menon .max_msg_size = 64, 3303754c9477SPeter Ujfalusi }; 3304754c9477SPeter Ujfalusi 3305754c9477SPeter Ujfalusi /* Description for AM654 */ 3306754c9477SPeter Ujfalusi static const struct ti_sci_desc ti_sci_pmmc_am654_desc = { 3307754c9477SPeter Ujfalusi .default_host_id = 12, 3308754c9477SPeter Ujfalusi /* Conservative duration */ 3309754c9477SPeter Ujfalusi .max_rx_timeout_ms = 10000, 3310754c9477SPeter Ujfalusi /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */ 3311754c9477SPeter Ujfalusi .max_msgs = 20, 3312754c9477SPeter Ujfalusi .max_msg_size = 60, 3313aa276781SNishanth Menon }; 3314aa276781SNishanth Menon 3315aa276781SNishanth Menon static const struct of_device_id ti_sci_of_match[] = { 3316aa276781SNishanth Menon {.compatible = "ti,k2g-sci", .data = &ti_sci_pmmc_k2g_desc}, 3317754c9477SPeter Ujfalusi {.compatible = "ti,am654-sci", .data = &ti_sci_pmmc_am654_desc}, 3318aa276781SNishanth Menon { /* Sentinel */ }, 3319aa276781SNishanth Menon }; 3320aa276781SNishanth Menon MODULE_DEVICE_TABLE(of, ti_sci_of_match); 3321aa276781SNishanth Menon 3322aa276781SNishanth Menon static int ti_sci_probe(struct platform_device *pdev) 3323aa276781SNishanth Menon { 3324aa276781SNishanth Menon struct device *dev = &pdev->dev; 3325aa276781SNishanth Menon const struct of_device_id *of_id; 3326aa276781SNishanth Menon const struct ti_sci_desc *desc; 3327aa276781SNishanth Menon struct ti_sci_xfer *xfer; 3328aa276781SNishanth Menon struct ti_sci_info *info = NULL; 3329aa276781SNishanth Menon struct ti_sci_xfers_info *minfo; 3330aa276781SNishanth Menon struct mbox_client *cl; 3331aa276781SNishanth Menon int ret = -EINVAL; 3332aa276781SNishanth Menon int i; 3333912cffb4SNishanth Menon int reboot = 0; 3334e69a3553SNishanth Menon u32 h_id; 3335aa276781SNishanth Menon 3336aa276781SNishanth Menon of_id = of_match_device(ti_sci_of_match, dev); 3337aa276781SNishanth Menon if (!of_id) { 3338aa276781SNishanth Menon dev_err(dev, "OF data missing\n"); 3339aa276781SNishanth Menon return -EINVAL; 3340aa276781SNishanth Menon } 3341aa276781SNishanth Menon desc = of_id->data; 3342aa276781SNishanth Menon 3343aa276781SNishanth Menon info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL); 3344aa276781SNishanth Menon if (!info) 3345aa276781SNishanth Menon return -ENOMEM; 3346aa276781SNishanth Menon 3347aa276781SNishanth Menon info->dev = dev; 3348aa276781SNishanth Menon info->desc = desc; 3349e69a3553SNishanth Menon ret = of_property_read_u32(dev->of_node, "ti,host-id", &h_id); 3350e69a3553SNishanth Menon /* if the property is not present in DT, use a default from desc */ 3351e69a3553SNishanth Menon if (ret < 0) { 3352e69a3553SNishanth Menon info->host_id = info->desc->default_host_id; 3353e69a3553SNishanth Menon } else { 3354e69a3553SNishanth Menon if (!h_id) { 3355e69a3553SNishanth Menon dev_warn(dev, "Host ID 0 is reserved for firmware\n"); 3356e69a3553SNishanth Menon info->host_id = info->desc->default_host_id; 3357e69a3553SNishanth Menon } else { 3358e69a3553SNishanth Menon info->host_id = h_id; 3359e69a3553SNishanth Menon } 3360e69a3553SNishanth Menon } 3361e69a3553SNishanth Menon 3362912cffb4SNishanth Menon reboot = of_property_read_bool(dev->of_node, 3363912cffb4SNishanth Menon "ti,system-reboot-controller"); 3364aa276781SNishanth Menon INIT_LIST_HEAD(&info->node); 3365aa276781SNishanth Menon minfo = &info->minfo; 3366aa276781SNishanth Menon 3367aa276781SNishanth Menon /* 3368aa276781SNishanth Menon * Pre-allocate messages 3369aa276781SNishanth Menon * NEVER allocate more than what we can indicate in hdr.seq 3370aa276781SNishanth Menon * if we have data description bug, force a fix.. 3371aa276781SNishanth Menon */ 3372aa276781SNishanth Menon if (WARN_ON(desc->max_msgs >= 3373aa276781SNishanth Menon 1 << 8 * sizeof(((struct ti_sci_msg_hdr *)0)->seq))) 3374aa276781SNishanth Menon return -EINVAL; 3375aa276781SNishanth Menon 3376aa276781SNishanth Menon minfo->xfer_block = devm_kcalloc(dev, 3377aa276781SNishanth Menon desc->max_msgs, 3378aa276781SNishanth Menon sizeof(*minfo->xfer_block), 3379aa276781SNishanth Menon GFP_KERNEL); 3380aa276781SNishanth Menon if (!minfo->xfer_block) 3381aa276781SNishanth Menon return -ENOMEM; 3382aa276781SNishanth Menon 3383a86854d0SKees Cook minfo->xfer_alloc_table = devm_kcalloc(dev, 3384a86854d0SKees Cook BITS_TO_LONGS(desc->max_msgs), 3385a86854d0SKees Cook sizeof(unsigned long), 3386aa276781SNishanth Menon GFP_KERNEL); 3387aa276781SNishanth Menon if (!minfo->xfer_alloc_table) 3388aa276781SNishanth Menon return -ENOMEM; 3389aa276781SNishanth Menon bitmap_zero(minfo->xfer_alloc_table, desc->max_msgs); 3390aa276781SNishanth Menon 3391aa276781SNishanth Menon /* Pre-initialize the buffer pointer to pre-allocated buffers */ 3392aa276781SNishanth Menon for (i = 0, xfer = minfo->xfer_block; i < desc->max_msgs; i++, xfer++) { 3393aa276781SNishanth Menon xfer->xfer_buf = devm_kcalloc(dev, 1, desc->max_msg_size, 3394aa276781SNishanth Menon GFP_KERNEL); 3395aa276781SNishanth Menon if (!xfer->xfer_buf) 3396aa276781SNishanth Menon return -ENOMEM; 3397aa276781SNishanth Menon 3398aa276781SNishanth Menon xfer->tx_message.buf = xfer->xfer_buf; 3399aa276781SNishanth Menon init_completion(&xfer->done); 3400aa276781SNishanth Menon } 3401aa276781SNishanth Menon 3402aa276781SNishanth Menon ret = ti_sci_debugfs_create(pdev, info); 3403aa276781SNishanth Menon if (ret) 3404aa276781SNishanth Menon dev_warn(dev, "Failed to create debug file\n"); 3405aa276781SNishanth Menon 3406aa276781SNishanth Menon platform_set_drvdata(pdev, info); 3407aa276781SNishanth Menon 3408aa276781SNishanth Menon cl = &info->cl; 3409aa276781SNishanth Menon cl->dev = dev; 3410aa276781SNishanth Menon cl->tx_block = false; 3411aa276781SNishanth Menon cl->rx_callback = ti_sci_rx_callback; 3412aa276781SNishanth Menon cl->knows_txdone = true; 3413aa276781SNishanth Menon 3414aa276781SNishanth Menon spin_lock_init(&minfo->xfer_lock); 3415aa276781SNishanth Menon sema_init(&minfo->sem_xfer_count, desc->max_msgs); 3416aa276781SNishanth Menon 3417aa276781SNishanth Menon info->chan_rx = mbox_request_channel_byname(cl, "rx"); 3418aa276781SNishanth Menon if (IS_ERR(info->chan_rx)) { 3419aa276781SNishanth Menon ret = PTR_ERR(info->chan_rx); 3420aa276781SNishanth Menon goto out; 3421aa276781SNishanth Menon } 3422aa276781SNishanth Menon 3423aa276781SNishanth Menon info->chan_tx = mbox_request_channel_byname(cl, "tx"); 3424aa276781SNishanth Menon if (IS_ERR(info->chan_tx)) { 3425aa276781SNishanth Menon ret = PTR_ERR(info->chan_tx); 3426aa276781SNishanth Menon goto out; 3427aa276781SNishanth Menon } 3428aa276781SNishanth Menon ret = ti_sci_cmd_get_revision(info); 3429aa276781SNishanth Menon if (ret) { 3430aa276781SNishanth Menon dev_err(dev, "Unable to communicate with TISCI(%d)\n", ret); 3431aa276781SNishanth Menon goto out; 3432aa276781SNishanth Menon } 3433aa276781SNishanth Menon 34349e7d756dSNishanth Menon ti_sci_setup_ops(info); 34359e7d756dSNishanth Menon 3436912cffb4SNishanth Menon if (reboot) { 3437912cffb4SNishanth Menon info->nb.notifier_call = tisci_reboot_handler; 3438912cffb4SNishanth Menon info->nb.priority = 128; 3439912cffb4SNishanth Menon 3440912cffb4SNishanth Menon ret = register_restart_handler(&info->nb); 3441912cffb4SNishanth Menon if (ret) { 3442912cffb4SNishanth Menon dev_err(dev, "reboot registration fail(%d)\n", ret); 3443912cffb4SNishanth Menon return ret; 3444912cffb4SNishanth Menon } 3445912cffb4SNishanth Menon } 3446912cffb4SNishanth Menon 3447aa276781SNishanth Menon dev_info(dev, "ABI: %d.%d (firmware rev 0x%04x '%s')\n", 3448aa276781SNishanth Menon info->handle.version.abi_major, info->handle.version.abi_minor, 3449aa276781SNishanth Menon info->handle.version.firmware_revision, 3450aa276781SNishanth Menon info->handle.version.firmware_description); 3451aa276781SNishanth Menon 3452aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 3453aa276781SNishanth Menon list_add_tail(&info->node, &ti_sci_list); 3454aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 3455aa276781SNishanth Menon 3456aa276781SNishanth Menon return of_platform_populate(dev->of_node, NULL, NULL, dev); 3457aa276781SNishanth Menon out: 3458aa276781SNishanth Menon if (!IS_ERR(info->chan_tx)) 3459aa276781SNishanth Menon mbox_free_channel(info->chan_tx); 3460aa276781SNishanth Menon if (!IS_ERR(info->chan_rx)) 3461aa276781SNishanth Menon mbox_free_channel(info->chan_rx); 3462aa276781SNishanth Menon debugfs_remove(info->d); 3463aa276781SNishanth Menon return ret; 3464aa276781SNishanth Menon } 3465aa276781SNishanth Menon 3466aa276781SNishanth Menon static int ti_sci_remove(struct platform_device *pdev) 3467aa276781SNishanth Menon { 3468aa276781SNishanth Menon struct ti_sci_info *info; 3469aa276781SNishanth Menon struct device *dev = &pdev->dev; 3470aa276781SNishanth Menon int ret = 0; 3471aa276781SNishanth Menon 3472aa276781SNishanth Menon of_platform_depopulate(dev); 3473aa276781SNishanth Menon 3474aa276781SNishanth Menon info = platform_get_drvdata(pdev); 3475aa276781SNishanth Menon 3476912cffb4SNishanth Menon if (info->nb.notifier_call) 3477912cffb4SNishanth Menon unregister_restart_handler(&info->nb); 3478912cffb4SNishanth Menon 3479aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 3480aa276781SNishanth Menon if (info->users) 3481aa276781SNishanth Menon ret = -EBUSY; 3482aa276781SNishanth Menon else 3483aa276781SNishanth Menon list_del(&info->node); 3484aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 3485aa276781SNishanth Menon 3486aa276781SNishanth Menon if (!ret) { 3487aa276781SNishanth Menon ti_sci_debugfs_destroy(pdev, info); 3488aa276781SNishanth Menon 3489aa276781SNishanth Menon /* Safe to free channels since no more users */ 3490aa276781SNishanth Menon mbox_free_channel(info->chan_tx); 3491aa276781SNishanth Menon mbox_free_channel(info->chan_rx); 3492aa276781SNishanth Menon } 3493aa276781SNishanth Menon 3494aa276781SNishanth Menon return ret; 3495aa276781SNishanth Menon } 3496aa276781SNishanth Menon 3497aa276781SNishanth Menon static struct platform_driver ti_sci_driver = { 3498aa276781SNishanth Menon .probe = ti_sci_probe, 3499aa276781SNishanth Menon .remove = ti_sci_remove, 3500aa276781SNishanth Menon .driver = { 3501aa276781SNishanth Menon .name = "ti-sci", 3502aa276781SNishanth Menon .of_match_table = of_match_ptr(ti_sci_of_match), 3503aa276781SNishanth Menon }, 3504aa276781SNishanth Menon }; 3505aa276781SNishanth Menon module_platform_driver(ti_sci_driver); 3506aa276781SNishanth Menon 3507aa276781SNishanth Menon MODULE_LICENSE("GPL v2"); 3508aa276781SNishanth Menon MODULE_DESCRIPTION("TI System Control Interface(SCI) driver"); 3509aa276781SNishanth Menon MODULE_AUTHOR("Nishanth Menon"); 3510aa276781SNishanth Menon MODULE_ALIAS("platform:ti-sci"); 3511