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