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, 432b9e8a7d9SDave Gerlach true, 1, 433b9e8a7d9SDave Gerlach info->desc->max_rx_timeout_ms * 1000, 434b9e8a7d9SDave Gerlach false, &xfer->done); 435b9e8a7d9SDave Gerlach } 436b9e8a7d9SDave Gerlach 437b9e8a7d9SDave Gerlach if (ret == -ETIMEDOUT || !done_state) { 438595f3a9dSHelge Deller dev_err(dev, "Mbox timedout in resp(caller: %pS)\n", 439aa276781SNishanth Menon (void *)_RET_IP_); 440aa276781SNishanth Menon } 441b9e8a7d9SDave Gerlach 442aa276781SNishanth Menon /* 443aa276781SNishanth Menon * NOTE: we might prefer not to need the mailbox ticker to manage the 444aa276781SNishanth Menon * transfer queueing since the protocol layer queues things by itself. 445aa276781SNishanth Menon * Unfortunately, we have to kick the mailbox framework after we have 446aa276781SNishanth Menon * received our message. 447aa276781SNishanth Menon */ 448aa276781SNishanth Menon mbox_client_txdone(info->chan_tx, ret); 449aa276781SNishanth Menon 450aa276781SNishanth Menon return ret; 451aa276781SNishanth Menon } 452aa276781SNishanth Menon 453aa276781SNishanth Menon /** 454aa276781SNishanth Menon * ti_sci_cmd_get_revision() - command to get the revision of the SCI entity 455aa276781SNishanth Menon * @info: Pointer to SCI entity information 456aa276781SNishanth Menon * 457aa276781SNishanth Menon * Updates the SCI information in the internal data structure. 458aa276781SNishanth Menon * 459aa276781SNishanth Menon * Return: 0 if all went fine, else return appropriate error. 460aa276781SNishanth Menon */ 461aa276781SNishanth Menon static int ti_sci_cmd_get_revision(struct ti_sci_info *info) 462aa276781SNishanth Menon { 463aa276781SNishanth Menon struct device *dev = info->dev; 464aa276781SNishanth Menon struct ti_sci_handle *handle = &info->handle; 465aa276781SNishanth Menon struct ti_sci_version_info *ver = &handle->version; 466aa276781SNishanth Menon struct ti_sci_msg_resp_version *rev_info; 467aa276781SNishanth Menon struct ti_sci_xfer *xfer; 468aa276781SNishanth Menon int ret; 469aa276781SNishanth Menon 470aa276781SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_VERSION, 47166f030eaSAndrew F. Davis TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 47266f030eaSAndrew F. Davis sizeof(struct ti_sci_msg_hdr), 473aa276781SNishanth Menon sizeof(*rev_info)); 474aa276781SNishanth Menon if (IS_ERR(xfer)) { 475aa276781SNishanth Menon ret = PTR_ERR(xfer); 476aa276781SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 477aa276781SNishanth Menon return ret; 478aa276781SNishanth Menon } 479aa276781SNishanth Menon 480aa276781SNishanth Menon rev_info = (struct ti_sci_msg_resp_version *)xfer->xfer_buf; 481aa276781SNishanth Menon 482aa276781SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 483aa276781SNishanth Menon if (ret) { 484aa276781SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 485aa276781SNishanth Menon goto fail; 486aa276781SNishanth Menon } 487aa276781SNishanth Menon 488aa276781SNishanth Menon ver->abi_major = rev_info->abi_major; 489aa276781SNishanth Menon ver->abi_minor = rev_info->abi_minor; 490aa276781SNishanth Menon ver->firmware_revision = rev_info->firmware_revision; 491aa276781SNishanth Menon strncpy(ver->firmware_description, rev_info->firmware_description, 492aa276781SNishanth Menon sizeof(ver->firmware_description)); 493aa276781SNishanth Menon 494aa276781SNishanth Menon fail: 495aa276781SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 496aa276781SNishanth Menon return ret; 497aa276781SNishanth Menon } 498aa276781SNishanth Menon 499aa276781SNishanth Menon /** 5009e7d756dSNishanth Menon * ti_sci_is_response_ack() - Generic ACK/NACK message checkup 5019e7d756dSNishanth Menon * @r: pointer to response buffer 5029e7d756dSNishanth Menon * 5039e7d756dSNishanth Menon * Return: true if the response was an ACK, else returns false. 5049e7d756dSNishanth Menon */ 5059e7d756dSNishanth Menon static inline bool ti_sci_is_response_ack(void *r) 5069e7d756dSNishanth Menon { 5079e7d756dSNishanth Menon struct ti_sci_msg_hdr *hdr = r; 5089e7d756dSNishanth Menon 5099e7d756dSNishanth Menon return hdr->flags & TI_SCI_FLAG_RESP_GENERIC_ACK ? true : false; 5109e7d756dSNishanth Menon } 5119e7d756dSNishanth Menon 5129e7d756dSNishanth Menon /** 5139e7d756dSNishanth Menon * ti_sci_set_device_state() - Set device state helper 5149e7d756dSNishanth Menon * @handle: pointer to TI SCI handle 5159e7d756dSNishanth Menon * @id: Device identifier 5169e7d756dSNishanth Menon * @flags: flags to setup for the device 5179e7d756dSNishanth Menon * @state: State to move the device to 5189e7d756dSNishanth Menon * 5199e7d756dSNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 5209e7d756dSNishanth Menon */ 5219e7d756dSNishanth Menon static int ti_sci_set_device_state(const struct ti_sci_handle *handle, 5229e7d756dSNishanth Menon u32 id, u32 flags, u8 state) 5239e7d756dSNishanth Menon { 5249e7d756dSNishanth Menon struct ti_sci_info *info; 5259e7d756dSNishanth Menon struct ti_sci_msg_req_set_device_state *req; 5269e7d756dSNishanth Menon struct ti_sci_msg_hdr *resp; 5279e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 5289e7d756dSNishanth Menon struct device *dev; 5299e7d756dSNishanth Menon int ret = 0; 5309e7d756dSNishanth Menon 5319e7d756dSNishanth Menon if (IS_ERR(handle)) 5329e7d756dSNishanth Menon return PTR_ERR(handle); 5339e7d756dSNishanth Menon if (!handle) 5349e7d756dSNishanth Menon return -EINVAL; 5359e7d756dSNishanth Menon 5369e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 5379e7d756dSNishanth Menon dev = info->dev; 5389e7d756dSNishanth Menon 5399e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_STATE, 5409e7d756dSNishanth Menon flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 5419e7d756dSNishanth Menon sizeof(*req), sizeof(*resp)); 5429e7d756dSNishanth Menon if (IS_ERR(xfer)) { 5439e7d756dSNishanth Menon ret = PTR_ERR(xfer); 5449e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 5459e7d756dSNishanth Menon return ret; 5469e7d756dSNishanth Menon } 5479e7d756dSNishanth Menon req = (struct ti_sci_msg_req_set_device_state *)xfer->xfer_buf; 5489e7d756dSNishanth Menon req->id = id; 5499e7d756dSNishanth Menon req->state = state; 5509e7d756dSNishanth Menon 5519e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 5529e7d756dSNishanth Menon if (ret) { 5539e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 5549e7d756dSNishanth Menon goto fail; 5559e7d756dSNishanth Menon } 5569e7d756dSNishanth Menon 5579e7d756dSNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 5589e7d756dSNishanth Menon 5599e7d756dSNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 5609e7d756dSNishanth Menon 5619e7d756dSNishanth Menon fail: 5629e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 5639e7d756dSNishanth Menon 5649e7d756dSNishanth Menon return ret; 5659e7d756dSNishanth Menon } 5669e7d756dSNishanth Menon 5679e7d756dSNishanth Menon /** 5689e7d756dSNishanth Menon * ti_sci_get_device_state() - Get device state helper 5699e7d756dSNishanth Menon * @handle: Handle to the device 5709e7d756dSNishanth Menon * @id: Device Identifier 5719e7d756dSNishanth Menon * @clcnt: Pointer to Context Loss Count 5729e7d756dSNishanth Menon * @resets: pointer to resets 5739e7d756dSNishanth Menon * @p_state: pointer to p_state 5749e7d756dSNishanth Menon * @c_state: pointer to c_state 5759e7d756dSNishanth Menon * 5769e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 5779e7d756dSNishanth Menon */ 5789e7d756dSNishanth Menon static int ti_sci_get_device_state(const struct ti_sci_handle *handle, 5799e7d756dSNishanth Menon u32 id, u32 *clcnt, u32 *resets, 5809e7d756dSNishanth Menon u8 *p_state, u8 *c_state) 5819e7d756dSNishanth Menon { 5829e7d756dSNishanth Menon struct ti_sci_info *info; 5839e7d756dSNishanth Menon struct ti_sci_msg_req_get_device_state *req; 5849e7d756dSNishanth Menon struct ti_sci_msg_resp_get_device_state *resp; 5859e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 5869e7d756dSNishanth Menon struct device *dev; 5879e7d756dSNishanth Menon int ret = 0; 5889e7d756dSNishanth Menon 5899e7d756dSNishanth Menon if (IS_ERR(handle)) 5909e7d756dSNishanth Menon return PTR_ERR(handle); 5919e7d756dSNishanth Menon if (!handle) 5929e7d756dSNishanth Menon return -EINVAL; 5939e7d756dSNishanth Menon 5949e7d756dSNishanth Menon if (!clcnt && !resets && !p_state && !c_state) 5959e7d756dSNishanth Menon return -EINVAL; 5969e7d756dSNishanth Menon 5979e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 5989e7d756dSNishanth Menon dev = info->dev; 5999e7d756dSNishanth Menon 6009e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_DEVICE_STATE, 60166f030eaSAndrew F. Davis TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 60266f030eaSAndrew F. Davis sizeof(*req), sizeof(*resp)); 6039e7d756dSNishanth Menon if (IS_ERR(xfer)) { 6049e7d756dSNishanth Menon ret = PTR_ERR(xfer); 6059e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 6069e7d756dSNishanth Menon return ret; 6079e7d756dSNishanth Menon } 6089e7d756dSNishanth Menon req = (struct ti_sci_msg_req_get_device_state *)xfer->xfer_buf; 6099e7d756dSNishanth Menon req->id = id; 6109e7d756dSNishanth Menon 6119e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 6129e7d756dSNishanth Menon if (ret) { 6139e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 6149e7d756dSNishanth Menon goto fail; 6159e7d756dSNishanth Menon } 6169e7d756dSNishanth Menon 6179e7d756dSNishanth Menon resp = (struct ti_sci_msg_resp_get_device_state *)xfer->xfer_buf; 6189e7d756dSNishanth Menon if (!ti_sci_is_response_ack(resp)) { 6199e7d756dSNishanth Menon ret = -ENODEV; 6209e7d756dSNishanth Menon goto fail; 6219e7d756dSNishanth Menon } 6229e7d756dSNishanth Menon 6239e7d756dSNishanth Menon if (clcnt) 6249e7d756dSNishanth Menon *clcnt = resp->context_loss_count; 6259e7d756dSNishanth Menon if (resets) 6269e7d756dSNishanth Menon *resets = resp->resets; 6279e7d756dSNishanth Menon if (p_state) 6289e7d756dSNishanth Menon *p_state = resp->programmed_state; 6299e7d756dSNishanth Menon if (c_state) 6309e7d756dSNishanth Menon *c_state = resp->current_state; 6319e7d756dSNishanth Menon fail: 6329e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 6339e7d756dSNishanth Menon 6349e7d756dSNishanth Menon return ret; 6359e7d756dSNishanth Menon } 6369e7d756dSNishanth Menon 6379e7d756dSNishanth Menon /** 6389e7d756dSNishanth Menon * ti_sci_cmd_get_device() - command to request for device managed by TISCI 63945b659eeSLokesh Vutla * that can be shared with other hosts. 6409e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 6419e7d756dSNishanth Menon * @id: Device Identifier 6429e7d756dSNishanth Menon * 6439e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 6449e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 6459e7d756dSNishanth Menon * managed by driver for that purpose. 6469e7d756dSNishanth Menon * 6479e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 6489e7d756dSNishanth Menon */ 6499e7d756dSNishanth Menon static int ti_sci_cmd_get_device(const struct ti_sci_handle *handle, u32 id) 6509e7d756dSNishanth Menon { 65145b659eeSLokesh Vutla return ti_sci_set_device_state(handle, id, 0, 65245b659eeSLokesh Vutla MSG_DEVICE_SW_STATE_ON); 65345b659eeSLokesh Vutla } 65445b659eeSLokesh Vutla 65545b659eeSLokesh Vutla /** 65645b659eeSLokesh Vutla * ti_sci_cmd_get_device_exclusive() - command to request for device managed by 65745b659eeSLokesh Vutla * TISCI that is exclusively owned by the 65845b659eeSLokesh Vutla * requesting host. 65945b659eeSLokesh Vutla * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 66045b659eeSLokesh Vutla * @id: Device Identifier 66145b659eeSLokesh Vutla * 66245b659eeSLokesh Vutla * Request for the device - NOTE: the client MUST maintain integrity of 66345b659eeSLokesh Vutla * usage count by balancing get_device with put_device. No refcounting is 66445b659eeSLokesh Vutla * managed by driver for that purpose. 66545b659eeSLokesh Vutla * 66645b659eeSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 66745b659eeSLokesh Vutla */ 66845b659eeSLokesh Vutla static int ti_sci_cmd_get_device_exclusive(const struct ti_sci_handle *handle, 66945b659eeSLokesh Vutla u32 id) 67045b659eeSLokesh Vutla { 6719e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 6729e7d756dSNishanth Menon MSG_FLAG_DEVICE_EXCLUSIVE, 6739e7d756dSNishanth Menon MSG_DEVICE_SW_STATE_ON); 6749e7d756dSNishanth Menon } 6759e7d756dSNishanth Menon 6769e7d756dSNishanth Menon /** 6779e7d756dSNishanth Menon * ti_sci_cmd_idle_device() - Command to idle a device managed by TISCI 6789e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 6799e7d756dSNishanth Menon * @id: Device Identifier 6809e7d756dSNishanth Menon * 6819e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 6829e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 6839e7d756dSNishanth Menon * managed by driver for that purpose. 6849e7d756dSNishanth Menon * 6859e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 6869e7d756dSNishanth Menon */ 6879e7d756dSNishanth Menon static int ti_sci_cmd_idle_device(const struct ti_sci_handle *handle, u32 id) 6889e7d756dSNishanth Menon { 68945b659eeSLokesh Vutla return ti_sci_set_device_state(handle, id, 0, 69045b659eeSLokesh Vutla MSG_DEVICE_SW_STATE_RETENTION); 69145b659eeSLokesh Vutla } 69245b659eeSLokesh Vutla 69345b659eeSLokesh Vutla /** 69445b659eeSLokesh Vutla * ti_sci_cmd_idle_device_exclusive() - Command to idle a device managed by 69545b659eeSLokesh Vutla * TISCI that is exclusively owned by 69645b659eeSLokesh Vutla * requesting host. 69745b659eeSLokesh Vutla * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 69845b659eeSLokesh Vutla * @id: Device Identifier 69945b659eeSLokesh Vutla * 70045b659eeSLokesh Vutla * Request for the device - NOTE: the client MUST maintain integrity of 70145b659eeSLokesh Vutla * usage count by balancing get_device with put_device. No refcounting is 70245b659eeSLokesh Vutla * managed by driver for that purpose. 70345b659eeSLokesh Vutla * 70445b659eeSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 70545b659eeSLokesh Vutla */ 70645b659eeSLokesh Vutla static int ti_sci_cmd_idle_device_exclusive(const struct ti_sci_handle *handle, 70745b659eeSLokesh Vutla u32 id) 70845b659eeSLokesh Vutla { 7099e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 7109e7d756dSNishanth Menon MSG_FLAG_DEVICE_EXCLUSIVE, 7119e7d756dSNishanth Menon MSG_DEVICE_SW_STATE_RETENTION); 7129e7d756dSNishanth Menon } 7139e7d756dSNishanth Menon 7149e7d756dSNishanth Menon /** 7159e7d756dSNishanth Menon * ti_sci_cmd_put_device() - command to release a device managed by TISCI 7169e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 7179e7d756dSNishanth Menon * @id: Device Identifier 7189e7d756dSNishanth Menon * 7199e7d756dSNishanth Menon * Request for the device - NOTE: the client MUST maintain integrity of 7209e7d756dSNishanth Menon * usage count by balancing get_device with put_device. No refcounting is 7219e7d756dSNishanth Menon * managed by driver for that purpose. 7229e7d756dSNishanth Menon * 7239e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7249e7d756dSNishanth Menon */ 7259e7d756dSNishanth Menon static int ti_sci_cmd_put_device(const struct ti_sci_handle *handle, u32 id) 7269e7d756dSNishanth Menon { 7279e7d756dSNishanth Menon return ti_sci_set_device_state(handle, id, 7289e7d756dSNishanth Menon 0, MSG_DEVICE_SW_STATE_AUTO_OFF); 7299e7d756dSNishanth Menon } 7309e7d756dSNishanth Menon 7319e7d756dSNishanth Menon /** 7329e7d756dSNishanth Menon * ti_sci_cmd_dev_is_valid() - Is the device valid 7339e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 7349e7d756dSNishanth Menon * @id: Device Identifier 7359e7d756dSNishanth Menon * 7369e7d756dSNishanth Menon * Return: 0 if all went fine and the device ID is valid, else return 7379e7d756dSNishanth Menon * appropriate error. 7389e7d756dSNishanth Menon */ 7399e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_valid(const struct ti_sci_handle *handle, u32 id) 7409e7d756dSNishanth Menon { 7419e7d756dSNishanth Menon u8 unused; 7429e7d756dSNishanth Menon 7439e7d756dSNishanth Menon /* check the device state which will also tell us if the ID is valid */ 7449e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &unused); 7459e7d756dSNishanth Menon } 7469e7d756dSNishanth Menon 7479e7d756dSNishanth Menon /** 7489e7d756dSNishanth Menon * ti_sci_cmd_dev_get_clcnt() - Get context loss counter 7499e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7509e7d756dSNishanth Menon * @id: Device Identifier 7519e7d756dSNishanth Menon * @count: Pointer to Context Loss counter to populate 7529e7d756dSNishanth Menon * 7539e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7549e7d756dSNishanth Menon */ 7559e7d756dSNishanth Menon static int ti_sci_cmd_dev_get_clcnt(const struct ti_sci_handle *handle, u32 id, 7569e7d756dSNishanth Menon u32 *count) 7579e7d756dSNishanth Menon { 7589e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, count, NULL, NULL, NULL); 7599e7d756dSNishanth Menon } 7609e7d756dSNishanth Menon 7619e7d756dSNishanth Menon /** 7629e7d756dSNishanth Menon * ti_sci_cmd_dev_is_idle() - Check if the device is requested to be idle 7639e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7649e7d756dSNishanth Menon * @id: Device Identifier 7659e7d756dSNishanth Menon * @r_state: true if requested to be idle 7669e7d756dSNishanth Menon * 7679e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7689e7d756dSNishanth Menon */ 7699e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_idle(const struct ti_sci_handle *handle, u32 id, 7709e7d756dSNishanth Menon bool *r_state) 7719e7d756dSNishanth Menon { 7729e7d756dSNishanth Menon int ret; 7739e7d756dSNishanth Menon u8 state; 7749e7d756dSNishanth Menon 7759e7d756dSNishanth Menon if (!r_state) 7769e7d756dSNishanth Menon return -EINVAL; 7779e7d756dSNishanth Menon 7789e7d756dSNishanth Menon ret = ti_sci_get_device_state(handle, id, NULL, NULL, &state, NULL); 7799e7d756dSNishanth Menon if (ret) 7809e7d756dSNishanth Menon return ret; 7819e7d756dSNishanth Menon 7829e7d756dSNishanth Menon *r_state = (state == MSG_DEVICE_SW_STATE_RETENTION); 7839e7d756dSNishanth Menon 7849e7d756dSNishanth Menon return 0; 7859e7d756dSNishanth Menon } 7869e7d756dSNishanth Menon 7879e7d756dSNishanth Menon /** 7889e7d756dSNishanth Menon * ti_sci_cmd_dev_is_stop() - Check if the device is requested to be stopped 7899e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 7909e7d756dSNishanth Menon * @id: Device Identifier 7919e7d756dSNishanth Menon * @r_state: true if requested to be stopped 7929e7d756dSNishanth Menon * @curr_state: true if currently stopped. 7939e7d756dSNishanth Menon * 7949e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 7959e7d756dSNishanth Menon */ 7969e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_stop(const struct ti_sci_handle *handle, u32 id, 7979e7d756dSNishanth Menon bool *r_state, bool *curr_state) 7989e7d756dSNishanth Menon { 7999e7d756dSNishanth Menon int ret; 8009e7d756dSNishanth Menon u8 p_state, c_state; 8019e7d756dSNishanth Menon 8029e7d756dSNishanth Menon if (!r_state && !curr_state) 8039e7d756dSNishanth Menon return -EINVAL; 8049e7d756dSNishanth Menon 8059e7d756dSNishanth Menon ret = 8069e7d756dSNishanth Menon ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state); 8079e7d756dSNishanth Menon if (ret) 8089e7d756dSNishanth Menon return ret; 8099e7d756dSNishanth Menon 8109e7d756dSNishanth Menon if (r_state) 8119e7d756dSNishanth Menon *r_state = (p_state == MSG_DEVICE_SW_STATE_AUTO_OFF); 8129e7d756dSNishanth Menon if (curr_state) 8139e7d756dSNishanth Menon *curr_state = (c_state == MSG_DEVICE_HW_STATE_OFF); 8149e7d756dSNishanth Menon 8159e7d756dSNishanth Menon return 0; 8169e7d756dSNishanth Menon } 8179e7d756dSNishanth Menon 8189e7d756dSNishanth Menon /** 8199e7d756dSNishanth Menon * ti_sci_cmd_dev_is_on() - Check if the device is requested to be ON 8209e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 8219e7d756dSNishanth Menon * @id: Device Identifier 8229e7d756dSNishanth Menon * @r_state: true if requested to be ON 8239e7d756dSNishanth Menon * @curr_state: true if currently ON and active 8249e7d756dSNishanth Menon * 8259e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8269e7d756dSNishanth Menon */ 8279e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_on(const struct ti_sci_handle *handle, u32 id, 8289e7d756dSNishanth Menon bool *r_state, bool *curr_state) 8299e7d756dSNishanth Menon { 8309e7d756dSNishanth Menon int ret; 8319e7d756dSNishanth Menon u8 p_state, c_state; 8329e7d756dSNishanth Menon 8339e7d756dSNishanth Menon if (!r_state && !curr_state) 8349e7d756dSNishanth Menon return -EINVAL; 8359e7d756dSNishanth Menon 8369e7d756dSNishanth Menon ret = 8379e7d756dSNishanth Menon ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state); 8389e7d756dSNishanth Menon if (ret) 8399e7d756dSNishanth Menon return ret; 8409e7d756dSNishanth Menon 8419e7d756dSNishanth Menon if (r_state) 8429e7d756dSNishanth Menon *r_state = (p_state == MSG_DEVICE_SW_STATE_ON); 8439e7d756dSNishanth Menon if (curr_state) 8449e7d756dSNishanth Menon *curr_state = (c_state == MSG_DEVICE_HW_STATE_ON); 8459e7d756dSNishanth Menon 8469e7d756dSNishanth Menon return 0; 8479e7d756dSNishanth Menon } 8489e7d756dSNishanth Menon 8499e7d756dSNishanth Menon /** 8509e7d756dSNishanth Menon * ti_sci_cmd_dev_is_trans() - Check if the device is currently transitioning 8519e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 8529e7d756dSNishanth Menon * @id: Device Identifier 8539e7d756dSNishanth Menon * @curr_state: true if currently transitioning. 8549e7d756dSNishanth Menon * 8559e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8569e7d756dSNishanth Menon */ 8579e7d756dSNishanth Menon static int ti_sci_cmd_dev_is_trans(const struct ti_sci_handle *handle, u32 id, 8589e7d756dSNishanth Menon bool *curr_state) 8599e7d756dSNishanth Menon { 8609e7d756dSNishanth Menon int ret; 8619e7d756dSNishanth Menon u8 state; 8629e7d756dSNishanth Menon 8639e7d756dSNishanth Menon if (!curr_state) 8649e7d756dSNishanth Menon return -EINVAL; 8659e7d756dSNishanth Menon 8669e7d756dSNishanth Menon ret = ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &state); 8679e7d756dSNishanth Menon if (ret) 8689e7d756dSNishanth Menon return ret; 8699e7d756dSNishanth Menon 8709e7d756dSNishanth Menon *curr_state = (state == MSG_DEVICE_HW_STATE_TRANS); 8719e7d756dSNishanth Menon 8729e7d756dSNishanth Menon return 0; 8739e7d756dSNishanth Menon } 8749e7d756dSNishanth Menon 8759e7d756dSNishanth Menon /** 8769e7d756dSNishanth Menon * ti_sci_cmd_set_device_resets() - command to set resets for device managed 8779e7d756dSNishanth Menon * by TISCI 8789e7d756dSNishanth Menon * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle 8799e7d756dSNishanth Menon * @id: Device Identifier 8809e7d756dSNishanth Menon * @reset_state: Device specific reset bit field 8819e7d756dSNishanth Menon * 8829e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 8839e7d756dSNishanth Menon */ 8849e7d756dSNishanth Menon static int ti_sci_cmd_set_device_resets(const struct ti_sci_handle *handle, 8859e7d756dSNishanth Menon u32 id, u32 reset_state) 8869e7d756dSNishanth Menon { 8879e7d756dSNishanth Menon struct ti_sci_info *info; 8889e7d756dSNishanth Menon struct ti_sci_msg_req_set_device_resets *req; 8899e7d756dSNishanth Menon struct ti_sci_msg_hdr *resp; 8909e7d756dSNishanth Menon struct ti_sci_xfer *xfer; 8919e7d756dSNishanth Menon struct device *dev; 8929e7d756dSNishanth Menon int ret = 0; 8939e7d756dSNishanth Menon 8949e7d756dSNishanth Menon if (IS_ERR(handle)) 8959e7d756dSNishanth Menon return PTR_ERR(handle); 8969e7d756dSNishanth Menon if (!handle) 8979e7d756dSNishanth Menon return -EINVAL; 8989e7d756dSNishanth Menon 8999e7d756dSNishanth Menon info = handle_to_ti_sci_info(handle); 9009e7d756dSNishanth Menon dev = info->dev; 9019e7d756dSNishanth Menon 9029e7d756dSNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_RESETS, 9039e7d756dSNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 9049e7d756dSNishanth Menon sizeof(*req), sizeof(*resp)); 9059e7d756dSNishanth Menon if (IS_ERR(xfer)) { 9069e7d756dSNishanth Menon ret = PTR_ERR(xfer); 9079e7d756dSNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 9089e7d756dSNishanth Menon return ret; 9099e7d756dSNishanth Menon } 9109e7d756dSNishanth Menon req = (struct ti_sci_msg_req_set_device_resets *)xfer->xfer_buf; 9119e7d756dSNishanth Menon req->id = id; 9129e7d756dSNishanth Menon req->resets = reset_state; 9139e7d756dSNishanth Menon 9149e7d756dSNishanth Menon ret = ti_sci_do_xfer(info, xfer); 9159e7d756dSNishanth Menon if (ret) { 9169e7d756dSNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 9179e7d756dSNishanth Menon goto fail; 9189e7d756dSNishanth Menon } 9199e7d756dSNishanth Menon 9209e7d756dSNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 9219e7d756dSNishanth Menon 9229e7d756dSNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 9239e7d756dSNishanth Menon 9249e7d756dSNishanth Menon fail: 9259e7d756dSNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 9269e7d756dSNishanth Menon 9279e7d756dSNishanth Menon return ret; 9289e7d756dSNishanth Menon } 9299e7d756dSNishanth Menon 9309e7d756dSNishanth Menon /** 9319e7d756dSNishanth Menon * ti_sci_cmd_get_device_resets() - Get reset state for device managed 9329e7d756dSNishanth Menon * by TISCI 9339e7d756dSNishanth Menon * @handle: Pointer to TISCI handle 9349e7d756dSNishanth Menon * @id: Device Identifier 9359e7d756dSNishanth Menon * @reset_state: Pointer to reset state to populate 9369e7d756dSNishanth Menon * 9379e7d756dSNishanth Menon * Return: 0 if all went fine, else return appropriate error. 9389e7d756dSNishanth Menon */ 9399e7d756dSNishanth Menon static int ti_sci_cmd_get_device_resets(const struct ti_sci_handle *handle, 9409e7d756dSNishanth Menon u32 id, u32 *reset_state) 9419e7d756dSNishanth Menon { 9429e7d756dSNishanth Menon return ti_sci_get_device_state(handle, id, NULL, reset_state, NULL, 9439e7d756dSNishanth Menon NULL); 9449e7d756dSNishanth Menon } 9459e7d756dSNishanth Menon 9469f723220SNishanth Menon /** 9479f723220SNishanth Menon * ti_sci_set_clock_state() - Set clock state helper 9489f723220SNishanth Menon * @handle: pointer to TI SCI handle 9499f723220SNishanth Menon * @dev_id: Device identifier this request is for 9509f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 9519f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 9529f723220SNishanth Menon * which clock input to modify. 9539f723220SNishanth Menon * @flags: Header flags as needed 9549f723220SNishanth Menon * @state: State to request for the clock. 9559f723220SNishanth Menon * 9569f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 9579f723220SNishanth Menon */ 9589f723220SNishanth Menon static int ti_sci_set_clock_state(const struct ti_sci_handle *handle, 95981f4458cSTero Kristo u32 dev_id, u32 clk_id, 9609f723220SNishanth Menon u32 flags, u8 state) 9619f723220SNishanth Menon { 9629f723220SNishanth Menon struct ti_sci_info *info; 9639f723220SNishanth Menon struct ti_sci_msg_req_set_clock_state *req; 9649f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 9659f723220SNishanth Menon struct ti_sci_xfer *xfer; 9669f723220SNishanth Menon struct device *dev; 9679f723220SNishanth Menon int ret = 0; 9689f723220SNishanth Menon 9699f723220SNishanth Menon if (IS_ERR(handle)) 9709f723220SNishanth Menon return PTR_ERR(handle); 9719f723220SNishanth Menon if (!handle) 9729f723220SNishanth Menon return -EINVAL; 9739f723220SNishanth Menon 9749f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 9759f723220SNishanth Menon dev = info->dev; 9769f723220SNishanth Menon 9779f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_STATE, 9789f723220SNishanth Menon flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 9799f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 9809f723220SNishanth Menon if (IS_ERR(xfer)) { 9819f723220SNishanth Menon ret = PTR_ERR(xfer); 9829f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 9839f723220SNishanth Menon return ret; 9849f723220SNishanth Menon } 9859f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_state *)xfer->xfer_buf; 9869f723220SNishanth Menon req->dev_id = dev_id; 98781f4458cSTero Kristo if (clk_id < 255) { 9889f723220SNishanth Menon req->clk_id = clk_id; 98981f4458cSTero Kristo } else { 99081f4458cSTero Kristo req->clk_id = 255; 99181f4458cSTero Kristo req->clk_id_32 = clk_id; 99281f4458cSTero Kristo } 9939f723220SNishanth Menon req->request_state = state; 9949f723220SNishanth Menon 9959f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 9969f723220SNishanth Menon if (ret) { 9979f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 9989f723220SNishanth Menon goto fail; 9999f723220SNishanth Menon } 10009f723220SNishanth Menon 10019f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 10029f723220SNishanth Menon 10039f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 10049f723220SNishanth Menon 10059f723220SNishanth Menon fail: 10069f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 10079f723220SNishanth Menon 10089f723220SNishanth Menon return ret; 10099f723220SNishanth Menon } 10109f723220SNishanth Menon 10119f723220SNishanth Menon /** 10129f723220SNishanth Menon * ti_sci_cmd_get_clock_state() - Get clock state helper 10139f723220SNishanth Menon * @handle: pointer to TI SCI handle 10149f723220SNishanth Menon * @dev_id: Device identifier this request is for 10159f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 10169f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 10179f723220SNishanth Menon * which clock input to modify. 10189f723220SNishanth Menon * @programmed_state: State requested for clock to move to 10199f723220SNishanth Menon * @current_state: State that the clock is currently in 10209f723220SNishanth Menon * 10219f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 10229f723220SNishanth Menon */ 10239f723220SNishanth Menon static int ti_sci_cmd_get_clock_state(const struct ti_sci_handle *handle, 102481f4458cSTero Kristo u32 dev_id, u32 clk_id, 10259f723220SNishanth Menon u8 *programmed_state, u8 *current_state) 10269f723220SNishanth Menon { 10279f723220SNishanth Menon struct ti_sci_info *info; 10289f723220SNishanth Menon struct ti_sci_msg_req_get_clock_state *req; 10299f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_state *resp; 10309f723220SNishanth Menon struct ti_sci_xfer *xfer; 10319f723220SNishanth Menon struct device *dev; 10329f723220SNishanth Menon int ret = 0; 10339f723220SNishanth Menon 10349f723220SNishanth Menon if (IS_ERR(handle)) 10359f723220SNishanth Menon return PTR_ERR(handle); 10369f723220SNishanth Menon if (!handle) 10379f723220SNishanth Menon return -EINVAL; 10389f723220SNishanth Menon 10399f723220SNishanth Menon if (!programmed_state && !current_state) 10409f723220SNishanth Menon return -EINVAL; 10419f723220SNishanth Menon 10429f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 10439f723220SNishanth Menon dev = info->dev; 10449f723220SNishanth Menon 10459f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_STATE, 10469f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 10479f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 10489f723220SNishanth Menon if (IS_ERR(xfer)) { 10499f723220SNishanth Menon ret = PTR_ERR(xfer); 10509f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 10519f723220SNishanth Menon return ret; 10529f723220SNishanth Menon } 10539f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_state *)xfer->xfer_buf; 10549f723220SNishanth Menon req->dev_id = dev_id; 105581f4458cSTero Kristo if (clk_id < 255) { 10569f723220SNishanth Menon req->clk_id = clk_id; 105781f4458cSTero Kristo } else { 105881f4458cSTero Kristo req->clk_id = 255; 105981f4458cSTero Kristo req->clk_id_32 = clk_id; 106081f4458cSTero Kristo } 10619f723220SNishanth Menon 10629f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 10639f723220SNishanth Menon if (ret) { 10649f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 10659f723220SNishanth Menon goto fail; 10669f723220SNishanth Menon } 10679f723220SNishanth Menon 10689f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_state *)xfer->xfer_buf; 10699f723220SNishanth Menon 10709f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) { 10719f723220SNishanth Menon ret = -ENODEV; 10729f723220SNishanth Menon goto fail; 10739f723220SNishanth Menon } 10749f723220SNishanth Menon 10759f723220SNishanth Menon if (programmed_state) 10769f723220SNishanth Menon *programmed_state = resp->programmed_state; 10779f723220SNishanth Menon if (current_state) 10789f723220SNishanth Menon *current_state = resp->current_state; 10799f723220SNishanth Menon 10809f723220SNishanth Menon fail: 10819f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 10829f723220SNishanth Menon 10839f723220SNishanth Menon return ret; 10849f723220SNishanth Menon } 10859f723220SNishanth Menon 10869f723220SNishanth Menon /** 10879f723220SNishanth Menon * ti_sci_cmd_get_clock() - Get control of a clock from TI SCI 10889f723220SNishanth Menon * @handle: pointer to TI SCI handle 10899f723220SNishanth Menon * @dev_id: Device identifier this request is for 10909f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 10919f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 10929f723220SNishanth Menon * which clock input to modify. 10939f723220SNishanth Menon * @needs_ssc: 'true' if Spread Spectrum clock is desired, else 'false' 10949f723220SNishanth Menon * @can_change_freq: 'true' if frequency change is desired, else 'false' 10959f723220SNishanth Menon * @enable_input_term: 'true' if input termination is desired, else 'false' 10969f723220SNishanth Menon * 10979f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 10989f723220SNishanth Menon */ 10999f723220SNishanth Menon static int ti_sci_cmd_get_clock(const struct ti_sci_handle *handle, u32 dev_id, 110081f4458cSTero Kristo u32 clk_id, bool needs_ssc, 110181f4458cSTero Kristo bool can_change_freq, bool enable_input_term) 11029f723220SNishanth Menon { 11039f723220SNishanth Menon u32 flags = 0; 11049f723220SNishanth Menon 11059f723220SNishanth Menon flags |= needs_ssc ? MSG_FLAG_CLOCK_ALLOW_SSC : 0; 11069f723220SNishanth Menon flags |= can_change_freq ? MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE : 0; 11079f723220SNishanth Menon flags |= enable_input_term ? MSG_FLAG_CLOCK_INPUT_TERM : 0; 11089f723220SNishanth Menon 11099f723220SNishanth Menon return ti_sci_set_clock_state(handle, dev_id, clk_id, flags, 11109f723220SNishanth Menon MSG_CLOCK_SW_STATE_REQ); 11119f723220SNishanth Menon } 11129f723220SNishanth Menon 11139f723220SNishanth Menon /** 11149f723220SNishanth Menon * ti_sci_cmd_idle_clock() - Idle a clock which is in our control 11159f723220SNishanth Menon * @handle: pointer to TI SCI handle 11169f723220SNishanth Menon * @dev_id: Device identifier this request is for 11179f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11189f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11199f723220SNishanth Menon * which clock input to modify. 11209f723220SNishanth Menon * 11219f723220SNishanth Menon * NOTE: This clock must have been requested by get_clock previously. 11229f723220SNishanth Menon * 11239f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11249f723220SNishanth Menon */ 11259f723220SNishanth Menon static int ti_sci_cmd_idle_clock(const struct ti_sci_handle *handle, 112681f4458cSTero Kristo u32 dev_id, u32 clk_id) 11279f723220SNishanth Menon { 112871b61082STero Kristo return ti_sci_set_clock_state(handle, dev_id, clk_id, 112971b61082STero Kristo MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE, 11309f723220SNishanth Menon MSG_CLOCK_SW_STATE_UNREQ); 11319f723220SNishanth Menon } 11329f723220SNishanth Menon 11339f723220SNishanth Menon /** 11349f723220SNishanth Menon * ti_sci_cmd_put_clock() - Release a clock from our control back to TISCI 11359f723220SNishanth Menon * @handle: pointer to TI SCI handle 11369f723220SNishanth Menon * @dev_id: Device identifier this request is for 11379f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11389f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11399f723220SNishanth Menon * which clock input to modify. 11409f723220SNishanth Menon * 11419f723220SNishanth Menon * NOTE: This clock must have been requested by get_clock previously. 11429f723220SNishanth Menon * 11439f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11449f723220SNishanth Menon */ 11459f723220SNishanth Menon static int ti_sci_cmd_put_clock(const struct ti_sci_handle *handle, 114681f4458cSTero Kristo u32 dev_id, u32 clk_id) 11479f723220SNishanth Menon { 114871b61082STero Kristo return ti_sci_set_clock_state(handle, dev_id, clk_id, 114971b61082STero Kristo MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE, 11509f723220SNishanth Menon MSG_CLOCK_SW_STATE_AUTO); 11519f723220SNishanth Menon } 11529f723220SNishanth Menon 11539f723220SNishanth Menon /** 11549f723220SNishanth Menon * ti_sci_cmd_clk_is_auto() - Is the clock being auto managed 11559f723220SNishanth Menon * @handle: pointer to TI SCI handle 11569f723220SNishanth Menon * @dev_id: Device identifier this request is for 11579f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11589f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11599f723220SNishanth Menon * which clock input to modify. 11609f723220SNishanth Menon * @req_state: state indicating if the clock is auto managed 11619f723220SNishanth Menon * 11629f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11639f723220SNishanth Menon */ 11649f723220SNishanth Menon static int ti_sci_cmd_clk_is_auto(const struct ti_sci_handle *handle, 116581f4458cSTero Kristo u32 dev_id, u32 clk_id, bool *req_state) 11669f723220SNishanth Menon { 11679f723220SNishanth Menon u8 state = 0; 11689f723220SNishanth Menon int ret; 11699f723220SNishanth Menon 11709f723220SNishanth Menon if (!req_state) 11719f723220SNishanth Menon return -EINVAL; 11729f723220SNishanth Menon 11739f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, &state, NULL); 11749f723220SNishanth Menon if (ret) 11759f723220SNishanth Menon return ret; 11769f723220SNishanth Menon 11779f723220SNishanth Menon *req_state = (state == MSG_CLOCK_SW_STATE_AUTO); 11789f723220SNishanth Menon return 0; 11799f723220SNishanth Menon } 11809f723220SNishanth Menon 11819f723220SNishanth Menon /** 11829f723220SNishanth Menon * ti_sci_cmd_clk_is_on() - Is the clock ON 11839f723220SNishanth Menon * @handle: pointer to TI SCI handle 11849f723220SNishanth Menon * @dev_id: Device identifier this request is for 11859f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 11869f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 11879f723220SNishanth Menon * which clock input to modify. 11889f723220SNishanth Menon * @req_state: state indicating if the clock is managed by us and enabled 11899f723220SNishanth Menon * @curr_state: state indicating if the clock is ready for operation 11909f723220SNishanth Menon * 11919f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 11929f723220SNishanth Menon */ 11939f723220SNishanth Menon static int ti_sci_cmd_clk_is_on(const struct ti_sci_handle *handle, u32 dev_id, 119481f4458cSTero Kristo u32 clk_id, bool *req_state, bool *curr_state) 11959f723220SNishanth Menon { 11969f723220SNishanth Menon u8 c_state = 0, r_state = 0; 11979f723220SNishanth Menon int ret; 11989f723220SNishanth Menon 11999f723220SNishanth Menon if (!req_state && !curr_state) 12009f723220SNishanth Menon return -EINVAL; 12019f723220SNishanth Menon 12029f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, 12039f723220SNishanth Menon &r_state, &c_state); 12049f723220SNishanth Menon if (ret) 12059f723220SNishanth Menon return ret; 12069f723220SNishanth Menon 12079f723220SNishanth Menon if (req_state) 12089f723220SNishanth Menon *req_state = (r_state == MSG_CLOCK_SW_STATE_REQ); 12099f723220SNishanth Menon if (curr_state) 12109f723220SNishanth Menon *curr_state = (c_state == MSG_CLOCK_HW_STATE_READY); 12119f723220SNishanth Menon return 0; 12129f723220SNishanth Menon } 12139f723220SNishanth Menon 12149f723220SNishanth Menon /** 12159f723220SNishanth Menon * ti_sci_cmd_clk_is_off() - Is the clock OFF 12169f723220SNishanth Menon * @handle: pointer to TI SCI handle 12179f723220SNishanth Menon * @dev_id: Device identifier this request is for 12189f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 12199f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 12209f723220SNishanth Menon * which clock input to modify. 12219f723220SNishanth Menon * @req_state: state indicating if the clock is managed by us and disabled 12229f723220SNishanth Menon * @curr_state: state indicating if the clock is NOT ready for operation 12239f723220SNishanth Menon * 12249f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 12259f723220SNishanth Menon */ 12269f723220SNishanth Menon static int ti_sci_cmd_clk_is_off(const struct ti_sci_handle *handle, u32 dev_id, 122781f4458cSTero Kristo u32 clk_id, bool *req_state, bool *curr_state) 12289f723220SNishanth Menon { 12299f723220SNishanth Menon u8 c_state = 0, r_state = 0; 12309f723220SNishanth Menon int ret; 12319f723220SNishanth Menon 12329f723220SNishanth Menon if (!req_state && !curr_state) 12339f723220SNishanth Menon return -EINVAL; 12349f723220SNishanth Menon 12359f723220SNishanth Menon ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, 12369f723220SNishanth Menon &r_state, &c_state); 12379f723220SNishanth Menon if (ret) 12389f723220SNishanth Menon return ret; 12399f723220SNishanth Menon 12409f723220SNishanth Menon if (req_state) 12419f723220SNishanth Menon *req_state = (r_state == MSG_CLOCK_SW_STATE_UNREQ); 12429f723220SNishanth Menon if (curr_state) 12439f723220SNishanth Menon *curr_state = (c_state == MSG_CLOCK_HW_STATE_NOT_READY); 12449f723220SNishanth Menon return 0; 12459f723220SNishanth Menon } 12469f723220SNishanth Menon 12479f723220SNishanth Menon /** 12489f723220SNishanth Menon * ti_sci_cmd_clk_set_parent() - Set the clock source of a specific device clock 12499f723220SNishanth Menon * @handle: pointer to TI SCI handle 12509f723220SNishanth Menon * @dev_id: Device identifier this request is for 12519f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 12529f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 12539f723220SNishanth Menon * which clock input to modify. 12549f723220SNishanth Menon * @parent_id: Parent clock identifier to set 12559f723220SNishanth Menon * 12569f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 12579f723220SNishanth Menon */ 12589f723220SNishanth Menon static int ti_sci_cmd_clk_set_parent(const struct ti_sci_handle *handle, 125981f4458cSTero Kristo u32 dev_id, u32 clk_id, u32 parent_id) 12609f723220SNishanth Menon { 12619f723220SNishanth Menon struct ti_sci_info *info; 12629f723220SNishanth Menon struct ti_sci_msg_req_set_clock_parent *req; 12639f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 12649f723220SNishanth Menon struct ti_sci_xfer *xfer; 12659f723220SNishanth Menon struct device *dev; 12669f723220SNishanth Menon int ret = 0; 12679f723220SNishanth Menon 12689f723220SNishanth Menon if (IS_ERR(handle)) 12699f723220SNishanth Menon return PTR_ERR(handle); 12709f723220SNishanth Menon if (!handle) 12719f723220SNishanth Menon return -EINVAL; 12729f723220SNishanth Menon 12739f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 12749f723220SNishanth Menon dev = info->dev; 12759f723220SNishanth Menon 12769f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_PARENT, 12779f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 12789f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 12799f723220SNishanth Menon if (IS_ERR(xfer)) { 12809f723220SNishanth Menon ret = PTR_ERR(xfer); 12819f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 12829f723220SNishanth Menon return ret; 12839f723220SNishanth Menon } 12849f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_parent *)xfer->xfer_buf; 12859f723220SNishanth Menon req->dev_id = dev_id; 128681f4458cSTero Kristo if (clk_id < 255) { 12879f723220SNishanth Menon req->clk_id = clk_id; 128881f4458cSTero Kristo } else { 128981f4458cSTero Kristo req->clk_id = 255; 129081f4458cSTero Kristo req->clk_id_32 = clk_id; 129181f4458cSTero Kristo } 129281f4458cSTero Kristo if (parent_id < 255) { 12939f723220SNishanth Menon req->parent_id = parent_id; 129481f4458cSTero Kristo } else { 129581f4458cSTero Kristo req->parent_id = 255; 129681f4458cSTero Kristo req->parent_id_32 = parent_id; 129781f4458cSTero Kristo } 12989f723220SNishanth Menon 12999f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 13009f723220SNishanth Menon if (ret) { 13019f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 13029f723220SNishanth Menon goto fail; 13039f723220SNishanth Menon } 13049f723220SNishanth Menon 13059f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 13069f723220SNishanth Menon 13079f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 13089f723220SNishanth Menon 13099f723220SNishanth Menon fail: 13109f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 13119f723220SNishanth Menon 13129f723220SNishanth Menon return ret; 13139f723220SNishanth Menon } 13149f723220SNishanth Menon 13159f723220SNishanth Menon /** 13169f723220SNishanth Menon * ti_sci_cmd_clk_get_parent() - Get current parent clock source 13179f723220SNishanth Menon * @handle: pointer to TI SCI handle 13189f723220SNishanth Menon * @dev_id: Device identifier this request is for 13199f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 13209f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 13219f723220SNishanth Menon * which clock input to modify. 13229f723220SNishanth Menon * @parent_id: Current clock parent 13239f723220SNishanth Menon * 13249f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 13259f723220SNishanth Menon */ 13269f723220SNishanth Menon static int ti_sci_cmd_clk_get_parent(const struct ti_sci_handle *handle, 132781f4458cSTero Kristo u32 dev_id, u32 clk_id, u32 *parent_id) 13289f723220SNishanth Menon { 13299f723220SNishanth Menon struct ti_sci_info *info; 13309f723220SNishanth Menon struct ti_sci_msg_req_get_clock_parent *req; 13319f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_parent *resp; 13329f723220SNishanth Menon struct ti_sci_xfer *xfer; 13339f723220SNishanth Menon struct device *dev; 13349f723220SNishanth Menon int ret = 0; 13359f723220SNishanth Menon 13369f723220SNishanth Menon if (IS_ERR(handle)) 13379f723220SNishanth Menon return PTR_ERR(handle); 13389f723220SNishanth Menon if (!handle || !parent_id) 13399f723220SNishanth Menon return -EINVAL; 13409f723220SNishanth Menon 13419f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 13429f723220SNishanth Menon dev = info->dev; 13439f723220SNishanth Menon 13449f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_PARENT, 13459f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 13469f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 13479f723220SNishanth Menon if (IS_ERR(xfer)) { 13489f723220SNishanth Menon ret = PTR_ERR(xfer); 13499f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 13509f723220SNishanth Menon return ret; 13519f723220SNishanth Menon } 13529f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_parent *)xfer->xfer_buf; 13539f723220SNishanth Menon req->dev_id = dev_id; 135481f4458cSTero Kristo if (clk_id < 255) { 13559f723220SNishanth Menon req->clk_id = clk_id; 135681f4458cSTero Kristo } else { 135781f4458cSTero Kristo req->clk_id = 255; 135881f4458cSTero Kristo req->clk_id_32 = clk_id; 135981f4458cSTero Kristo } 13609f723220SNishanth Menon 13619f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 13629f723220SNishanth Menon if (ret) { 13639f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 13649f723220SNishanth Menon goto fail; 13659f723220SNishanth Menon } 13669f723220SNishanth Menon 13679f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_parent *)xfer->xfer_buf; 13689f723220SNishanth Menon 136981f4458cSTero Kristo if (!ti_sci_is_response_ack(resp)) { 13709f723220SNishanth Menon ret = -ENODEV; 137181f4458cSTero Kristo } else { 137281f4458cSTero Kristo if (resp->parent_id < 255) 13739f723220SNishanth Menon *parent_id = resp->parent_id; 137481f4458cSTero Kristo else 137581f4458cSTero Kristo *parent_id = resp->parent_id_32; 137681f4458cSTero Kristo } 13779f723220SNishanth Menon 13789f723220SNishanth Menon fail: 13799f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 13809f723220SNishanth Menon 13819f723220SNishanth Menon return ret; 13829f723220SNishanth Menon } 13839f723220SNishanth Menon 13849f723220SNishanth Menon /** 13859f723220SNishanth Menon * ti_sci_cmd_clk_get_num_parents() - Get num parents of the current clk source 13869f723220SNishanth Menon * @handle: pointer to TI SCI handle 13879f723220SNishanth Menon * @dev_id: Device identifier this request is for 13889f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 13899f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 13909f723220SNishanth Menon * which clock input to modify. 13919f723220SNishanth Menon * @num_parents: Returns he number of parents to the current clock. 13929f723220SNishanth Menon * 13939f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 13949f723220SNishanth Menon */ 13959f723220SNishanth Menon static int ti_sci_cmd_clk_get_num_parents(const struct ti_sci_handle *handle, 139681f4458cSTero Kristo u32 dev_id, u32 clk_id, 139781f4458cSTero Kristo u32 *num_parents) 13989f723220SNishanth Menon { 13999f723220SNishanth Menon struct ti_sci_info *info; 14009f723220SNishanth Menon struct ti_sci_msg_req_get_clock_num_parents *req; 14019f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_num_parents *resp; 14029f723220SNishanth Menon struct ti_sci_xfer *xfer; 14039f723220SNishanth Menon struct device *dev; 14049f723220SNishanth Menon int ret = 0; 14059f723220SNishanth Menon 14069f723220SNishanth Menon if (IS_ERR(handle)) 14079f723220SNishanth Menon return PTR_ERR(handle); 14089f723220SNishanth Menon if (!handle || !num_parents) 14099f723220SNishanth Menon return -EINVAL; 14109f723220SNishanth Menon 14119f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 14129f723220SNishanth Menon dev = info->dev; 14139f723220SNishanth Menon 14149f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_NUM_CLOCK_PARENTS, 14159f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 14169f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 14179f723220SNishanth Menon if (IS_ERR(xfer)) { 14189f723220SNishanth Menon ret = PTR_ERR(xfer); 14199f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 14209f723220SNishanth Menon return ret; 14219f723220SNishanth Menon } 14229f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_num_parents *)xfer->xfer_buf; 14239f723220SNishanth Menon req->dev_id = dev_id; 142481f4458cSTero Kristo if (clk_id < 255) { 14259f723220SNishanth Menon req->clk_id = clk_id; 142681f4458cSTero Kristo } else { 142781f4458cSTero Kristo req->clk_id = 255; 142881f4458cSTero Kristo req->clk_id_32 = clk_id; 142981f4458cSTero Kristo } 14309f723220SNishanth Menon 14319f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 14329f723220SNishanth Menon if (ret) { 14339f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 14349f723220SNishanth Menon goto fail; 14359f723220SNishanth Menon } 14369f723220SNishanth Menon 14379f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_num_parents *)xfer->xfer_buf; 14389f723220SNishanth Menon 143981f4458cSTero Kristo if (!ti_sci_is_response_ack(resp)) { 14409f723220SNishanth Menon ret = -ENODEV; 144181f4458cSTero Kristo } else { 144281f4458cSTero Kristo if (resp->num_parents < 255) 14439f723220SNishanth Menon *num_parents = resp->num_parents; 144481f4458cSTero Kristo else 144581f4458cSTero Kristo *num_parents = resp->num_parents_32; 144681f4458cSTero Kristo } 14479f723220SNishanth Menon 14489f723220SNishanth Menon fail: 14499f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 14509f723220SNishanth Menon 14519f723220SNishanth Menon return ret; 14529f723220SNishanth Menon } 14539f723220SNishanth Menon 14549f723220SNishanth Menon /** 14559f723220SNishanth Menon * ti_sci_cmd_clk_get_match_freq() - Find a good match for frequency 14569f723220SNishanth Menon * @handle: pointer to TI SCI handle 14579f723220SNishanth Menon * @dev_id: Device identifier this request is for 14589f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 14599f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 14609f723220SNishanth Menon * which clock input to modify. 14619f723220SNishanth Menon * @min_freq: The minimum allowable frequency in Hz. This is the minimum 14629f723220SNishanth Menon * allowable programmed frequency and does not account for clock 14639f723220SNishanth Menon * tolerances and jitter. 14649f723220SNishanth Menon * @target_freq: The target clock frequency in Hz. A frequency will be 14659f723220SNishanth Menon * processed as close to this target frequency as possible. 14669f723220SNishanth Menon * @max_freq: The maximum allowable frequency in Hz. This is the maximum 14679f723220SNishanth Menon * allowable programmed frequency and does not account for clock 14689f723220SNishanth Menon * tolerances and jitter. 14699f723220SNishanth Menon * @match_freq: Frequency match in Hz response. 14709f723220SNishanth Menon * 14719f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 14729f723220SNishanth Menon */ 14739f723220SNishanth Menon static int ti_sci_cmd_clk_get_match_freq(const struct ti_sci_handle *handle, 147481f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 min_freq, 14759f723220SNishanth Menon u64 target_freq, u64 max_freq, 14769f723220SNishanth Menon u64 *match_freq) 14779f723220SNishanth Menon { 14789f723220SNishanth Menon struct ti_sci_info *info; 14799f723220SNishanth Menon struct ti_sci_msg_req_query_clock_freq *req; 14809f723220SNishanth Menon struct ti_sci_msg_resp_query_clock_freq *resp; 14819f723220SNishanth Menon struct ti_sci_xfer *xfer; 14829f723220SNishanth Menon struct device *dev; 14839f723220SNishanth Menon int ret = 0; 14849f723220SNishanth Menon 14859f723220SNishanth Menon if (IS_ERR(handle)) 14869f723220SNishanth Menon return PTR_ERR(handle); 14879f723220SNishanth Menon if (!handle || !match_freq) 14889f723220SNishanth Menon return -EINVAL; 14899f723220SNishanth Menon 14909f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 14919f723220SNishanth Menon dev = info->dev; 14929f723220SNishanth Menon 14939f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_QUERY_CLOCK_FREQ, 14949f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 14959f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 14969f723220SNishanth Menon if (IS_ERR(xfer)) { 14979f723220SNishanth Menon ret = PTR_ERR(xfer); 14989f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 14999f723220SNishanth Menon return ret; 15009f723220SNishanth Menon } 15019f723220SNishanth Menon req = (struct ti_sci_msg_req_query_clock_freq *)xfer->xfer_buf; 15029f723220SNishanth Menon req->dev_id = dev_id; 150381f4458cSTero Kristo if (clk_id < 255) { 15049f723220SNishanth Menon req->clk_id = clk_id; 150581f4458cSTero Kristo } else { 150681f4458cSTero Kristo req->clk_id = 255; 150781f4458cSTero Kristo req->clk_id_32 = clk_id; 150881f4458cSTero Kristo } 15099f723220SNishanth Menon req->min_freq_hz = min_freq; 15109f723220SNishanth Menon req->target_freq_hz = target_freq; 15119f723220SNishanth Menon req->max_freq_hz = max_freq; 15129f723220SNishanth Menon 15139f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 15149f723220SNishanth Menon if (ret) { 15159f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 15169f723220SNishanth Menon goto fail; 15179f723220SNishanth Menon } 15189f723220SNishanth Menon 15199f723220SNishanth Menon resp = (struct ti_sci_msg_resp_query_clock_freq *)xfer->xfer_buf; 15209f723220SNishanth Menon 15219f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) 15229f723220SNishanth Menon ret = -ENODEV; 15239f723220SNishanth Menon else 15249f723220SNishanth Menon *match_freq = resp->freq_hz; 15259f723220SNishanth Menon 15269f723220SNishanth Menon fail: 15279f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 15289f723220SNishanth Menon 15299f723220SNishanth Menon return ret; 15309f723220SNishanth Menon } 15319f723220SNishanth Menon 15329f723220SNishanth Menon /** 15339f723220SNishanth Menon * ti_sci_cmd_clk_set_freq() - Set a frequency for clock 15349f723220SNishanth Menon * @handle: pointer to TI SCI handle 15359f723220SNishanth Menon * @dev_id: Device identifier this request is for 15369f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 15379f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 15389f723220SNishanth Menon * which clock input to modify. 15399f723220SNishanth Menon * @min_freq: The minimum allowable frequency in Hz. This is the minimum 15409f723220SNishanth Menon * allowable programmed frequency and does not account for clock 15419f723220SNishanth Menon * tolerances and jitter. 15429f723220SNishanth Menon * @target_freq: The target clock frequency in Hz. A frequency will be 15439f723220SNishanth Menon * processed as close to this target frequency as possible. 15449f723220SNishanth Menon * @max_freq: The maximum allowable frequency in Hz. This is the maximum 15459f723220SNishanth Menon * allowable programmed frequency and does not account for clock 15469f723220SNishanth Menon * tolerances and jitter. 15479f723220SNishanth Menon * 15489f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 15499f723220SNishanth Menon */ 15509f723220SNishanth Menon static int ti_sci_cmd_clk_set_freq(const struct ti_sci_handle *handle, 155181f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 min_freq, 15529f723220SNishanth Menon u64 target_freq, u64 max_freq) 15539f723220SNishanth Menon { 15549f723220SNishanth Menon struct ti_sci_info *info; 15559f723220SNishanth Menon struct ti_sci_msg_req_set_clock_freq *req; 15569f723220SNishanth Menon struct ti_sci_msg_hdr *resp; 15579f723220SNishanth Menon struct ti_sci_xfer *xfer; 15589f723220SNishanth Menon struct device *dev; 15599f723220SNishanth Menon int ret = 0; 15609f723220SNishanth Menon 15619f723220SNishanth Menon if (IS_ERR(handle)) 15629f723220SNishanth Menon return PTR_ERR(handle); 15639f723220SNishanth Menon if (!handle) 15649f723220SNishanth Menon return -EINVAL; 15659f723220SNishanth Menon 15669f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 15679f723220SNishanth Menon dev = info->dev; 15689f723220SNishanth Menon 15699f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_FREQ, 15709f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 15719f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 15729f723220SNishanth Menon if (IS_ERR(xfer)) { 15739f723220SNishanth Menon ret = PTR_ERR(xfer); 15749f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 15759f723220SNishanth Menon return ret; 15769f723220SNishanth Menon } 15779f723220SNishanth Menon req = (struct ti_sci_msg_req_set_clock_freq *)xfer->xfer_buf; 15789f723220SNishanth Menon req->dev_id = dev_id; 157981f4458cSTero Kristo if (clk_id < 255) { 15809f723220SNishanth Menon req->clk_id = clk_id; 158181f4458cSTero Kristo } else { 158281f4458cSTero Kristo req->clk_id = 255; 158381f4458cSTero Kristo req->clk_id_32 = clk_id; 158481f4458cSTero Kristo } 15859f723220SNishanth Menon req->min_freq_hz = min_freq; 15869f723220SNishanth Menon req->target_freq_hz = target_freq; 15879f723220SNishanth Menon req->max_freq_hz = max_freq; 15889f723220SNishanth Menon 15899f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 15909f723220SNishanth Menon if (ret) { 15919f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 15929f723220SNishanth Menon goto fail; 15939f723220SNishanth Menon } 15949f723220SNishanth Menon 15959f723220SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 15969f723220SNishanth Menon 15979f723220SNishanth Menon ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 15989f723220SNishanth Menon 15999f723220SNishanth Menon fail: 16009f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 16019f723220SNishanth Menon 16029f723220SNishanth Menon return ret; 16039f723220SNishanth Menon } 16049f723220SNishanth Menon 16059f723220SNishanth Menon /** 16069f723220SNishanth Menon * ti_sci_cmd_clk_get_freq() - Get current frequency 16079f723220SNishanth Menon * @handle: pointer to TI SCI handle 16089f723220SNishanth Menon * @dev_id: Device identifier this request is for 16099f723220SNishanth Menon * @clk_id: Clock identifier for the device for this request. 16109f723220SNishanth Menon * Each device has it's own set of clock inputs. This indexes 16119f723220SNishanth Menon * which clock input to modify. 16129f723220SNishanth Menon * @freq: Currently frequency in Hz 16139f723220SNishanth Menon * 16149f723220SNishanth Menon * Return: 0 if all went well, else returns appropriate error value. 16159f723220SNishanth Menon */ 16169f723220SNishanth Menon static int ti_sci_cmd_clk_get_freq(const struct ti_sci_handle *handle, 161781f4458cSTero Kristo u32 dev_id, u32 clk_id, u64 *freq) 16189f723220SNishanth Menon { 16199f723220SNishanth Menon struct ti_sci_info *info; 16209f723220SNishanth Menon struct ti_sci_msg_req_get_clock_freq *req; 16219f723220SNishanth Menon struct ti_sci_msg_resp_get_clock_freq *resp; 16229f723220SNishanth Menon struct ti_sci_xfer *xfer; 16239f723220SNishanth Menon struct device *dev; 16249f723220SNishanth Menon int ret = 0; 16259f723220SNishanth Menon 16269f723220SNishanth Menon if (IS_ERR(handle)) 16279f723220SNishanth Menon return PTR_ERR(handle); 16289f723220SNishanth Menon if (!handle || !freq) 16299f723220SNishanth Menon return -EINVAL; 16309f723220SNishanth Menon 16319f723220SNishanth Menon info = handle_to_ti_sci_info(handle); 16329f723220SNishanth Menon dev = info->dev; 16339f723220SNishanth Menon 16349f723220SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_FREQ, 16359f723220SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 16369f723220SNishanth Menon sizeof(*req), sizeof(*resp)); 16379f723220SNishanth Menon if (IS_ERR(xfer)) { 16389f723220SNishanth Menon ret = PTR_ERR(xfer); 16399f723220SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 16409f723220SNishanth Menon return ret; 16419f723220SNishanth Menon } 16429f723220SNishanth Menon req = (struct ti_sci_msg_req_get_clock_freq *)xfer->xfer_buf; 16439f723220SNishanth Menon req->dev_id = dev_id; 164481f4458cSTero Kristo if (clk_id < 255) { 16459f723220SNishanth Menon req->clk_id = clk_id; 164681f4458cSTero Kristo } else { 164781f4458cSTero Kristo req->clk_id = 255; 164881f4458cSTero Kristo req->clk_id_32 = clk_id; 164981f4458cSTero Kristo } 16509f723220SNishanth Menon 16519f723220SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 16529f723220SNishanth Menon if (ret) { 16539f723220SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 16549f723220SNishanth Menon goto fail; 16559f723220SNishanth Menon } 16569f723220SNishanth Menon 16579f723220SNishanth Menon resp = (struct ti_sci_msg_resp_get_clock_freq *)xfer->xfer_buf; 16589f723220SNishanth Menon 16599f723220SNishanth Menon if (!ti_sci_is_response_ack(resp)) 16609f723220SNishanth Menon ret = -ENODEV; 16619f723220SNishanth Menon else 16629f723220SNishanth Menon *freq = resp->freq_hz; 16639f723220SNishanth Menon 16649f723220SNishanth Menon fail: 16659f723220SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 16669f723220SNishanth Menon 16679f723220SNishanth Menon return ret; 16689f723220SNishanth Menon } 16699f723220SNishanth Menon 1670912cffb4SNishanth Menon static int ti_sci_cmd_core_reboot(const struct ti_sci_handle *handle) 1671912cffb4SNishanth Menon { 1672912cffb4SNishanth Menon struct ti_sci_info *info; 1673912cffb4SNishanth Menon struct ti_sci_msg_req_reboot *req; 1674912cffb4SNishanth Menon struct ti_sci_msg_hdr *resp; 1675912cffb4SNishanth Menon struct ti_sci_xfer *xfer; 1676912cffb4SNishanth Menon struct device *dev; 1677912cffb4SNishanth Menon int ret = 0; 1678912cffb4SNishanth Menon 1679912cffb4SNishanth Menon if (IS_ERR(handle)) 1680912cffb4SNishanth Menon return PTR_ERR(handle); 1681912cffb4SNishanth Menon if (!handle) 1682912cffb4SNishanth Menon return -EINVAL; 1683912cffb4SNishanth Menon 1684912cffb4SNishanth Menon info = handle_to_ti_sci_info(handle); 1685912cffb4SNishanth Menon dev = info->dev; 1686912cffb4SNishanth Menon 1687912cffb4SNishanth Menon xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SYS_RESET, 1688912cffb4SNishanth Menon TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 1689912cffb4SNishanth Menon sizeof(*req), sizeof(*resp)); 1690912cffb4SNishanth Menon if (IS_ERR(xfer)) { 1691912cffb4SNishanth Menon ret = PTR_ERR(xfer); 1692912cffb4SNishanth Menon dev_err(dev, "Message alloc failed(%d)\n", ret); 1693912cffb4SNishanth Menon return ret; 1694912cffb4SNishanth Menon } 1695912cffb4SNishanth Menon req = (struct ti_sci_msg_req_reboot *)xfer->xfer_buf; 1696912cffb4SNishanth Menon 1697912cffb4SNishanth Menon ret = ti_sci_do_xfer(info, xfer); 1698912cffb4SNishanth Menon if (ret) { 1699912cffb4SNishanth Menon dev_err(dev, "Mbox send fail %d\n", ret); 1700912cffb4SNishanth Menon goto fail; 1701912cffb4SNishanth Menon } 1702912cffb4SNishanth Menon 1703912cffb4SNishanth Menon resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 1704912cffb4SNishanth Menon 1705912cffb4SNishanth Menon if (!ti_sci_is_response_ack(resp)) 1706912cffb4SNishanth Menon ret = -ENODEV; 1707912cffb4SNishanth Menon else 1708912cffb4SNishanth Menon ret = 0; 1709912cffb4SNishanth Menon 1710912cffb4SNishanth Menon fail: 1711912cffb4SNishanth Menon ti_sci_put_one_xfer(&info->minfo, xfer); 1712912cffb4SNishanth Menon 1713912cffb4SNishanth Menon return ret; 1714912cffb4SNishanth Menon } 1715912cffb4SNishanth Menon 17169c19fb68SLokesh Vutla /** 17179c19fb68SLokesh Vutla * ti_sci_get_resource_range - Helper to get a range of resources assigned 17189c19fb68SLokesh Vutla * to a host. Resource is uniquely identified by 17199c19fb68SLokesh Vutla * type and subtype. 17209c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 17219c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 17229c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 17239c19fb68SLokesh Vutla * from the given device. 17249c19fb68SLokesh Vutla * @s_host: Host processor ID to which the resources are allocated 1725967a020bSPeter Ujfalusi * @desc: Pointer to ti_sci_resource_desc to be updated with the 1726967a020bSPeter Ujfalusi * resource range start index and number of resources 17279c19fb68SLokesh Vutla * 17289c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 17299c19fb68SLokesh Vutla */ 17309c19fb68SLokesh Vutla static int ti_sci_get_resource_range(const struct ti_sci_handle *handle, 17319c19fb68SLokesh Vutla u32 dev_id, u8 subtype, u8 s_host, 1732967a020bSPeter Ujfalusi struct ti_sci_resource_desc *desc) 17339c19fb68SLokesh Vutla { 17349c19fb68SLokesh Vutla struct ti_sci_msg_resp_get_resource_range *resp; 17359c19fb68SLokesh Vutla struct ti_sci_msg_req_get_resource_range *req; 17369c19fb68SLokesh Vutla struct ti_sci_xfer *xfer; 17379c19fb68SLokesh Vutla struct ti_sci_info *info; 17389c19fb68SLokesh Vutla struct device *dev; 17399c19fb68SLokesh Vutla int ret = 0; 17409c19fb68SLokesh Vutla 17419c19fb68SLokesh Vutla if (IS_ERR(handle)) 17429c19fb68SLokesh Vutla return PTR_ERR(handle); 1743967a020bSPeter Ujfalusi if (!handle || !desc) 17449c19fb68SLokesh Vutla return -EINVAL; 17459c19fb68SLokesh Vutla 17469c19fb68SLokesh Vutla info = handle_to_ti_sci_info(handle); 17479c19fb68SLokesh Vutla dev = info->dev; 17489c19fb68SLokesh Vutla 17499c19fb68SLokesh Vutla xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_RESOURCE_RANGE, 17509c19fb68SLokesh Vutla TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 17519c19fb68SLokesh Vutla sizeof(*req), sizeof(*resp)); 17529c19fb68SLokesh Vutla if (IS_ERR(xfer)) { 17539c19fb68SLokesh Vutla ret = PTR_ERR(xfer); 17549c19fb68SLokesh Vutla dev_err(dev, "Message alloc failed(%d)\n", ret); 17559c19fb68SLokesh Vutla return ret; 17569c19fb68SLokesh Vutla } 17579c19fb68SLokesh Vutla 17589c19fb68SLokesh Vutla req = (struct ti_sci_msg_req_get_resource_range *)xfer->xfer_buf; 17599c19fb68SLokesh Vutla req->secondary_host = s_host; 17609b98e02aSLokesh Vutla req->type = dev_id & MSG_RM_RESOURCE_TYPE_MASK; 17619c19fb68SLokesh Vutla req->subtype = subtype & MSG_RM_RESOURCE_SUBTYPE_MASK; 17629c19fb68SLokesh Vutla 17639c19fb68SLokesh Vutla ret = ti_sci_do_xfer(info, xfer); 17649c19fb68SLokesh Vutla if (ret) { 17659c19fb68SLokesh Vutla dev_err(dev, "Mbox send fail %d\n", ret); 17669c19fb68SLokesh Vutla goto fail; 17679c19fb68SLokesh Vutla } 17689c19fb68SLokesh Vutla 17699c19fb68SLokesh Vutla resp = (struct ti_sci_msg_resp_get_resource_range *)xfer->xfer_buf; 17709c19fb68SLokesh Vutla 17719c19fb68SLokesh Vutla if (!ti_sci_is_response_ack(resp)) { 17729c19fb68SLokesh Vutla ret = -ENODEV; 1773519c5c0cSPeter Ujfalusi } else if (!resp->range_num && !resp->range_num_sec) { 1774519c5c0cSPeter Ujfalusi /* Neither of the two resource range is valid */ 17759c19fb68SLokesh Vutla ret = -ENODEV; 17769c19fb68SLokesh Vutla } else { 1777967a020bSPeter Ujfalusi desc->start = resp->range_start; 1778967a020bSPeter Ujfalusi desc->num = resp->range_num; 1779519c5c0cSPeter Ujfalusi desc->start_sec = resp->range_start_sec; 1780519c5c0cSPeter Ujfalusi desc->num_sec = resp->range_num_sec; 17817c1c1d36SJason Wang } 17829c19fb68SLokesh Vutla 17839c19fb68SLokesh Vutla fail: 17849c19fb68SLokesh Vutla ti_sci_put_one_xfer(&info->minfo, xfer); 17859c19fb68SLokesh Vutla 17869c19fb68SLokesh Vutla return ret; 17879c19fb68SLokesh Vutla } 17889c19fb68SLokesh Vutla 17899c19fb68SLokesh Vutla /** 17909c19fb68SLokesh Vutla * ti_sci_cmd_get_resource_range - Get a range of resources assigned to host 17919c19fb68SLokesh Vutla * that is same as ti sci interface host. 17929c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 17939c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 17949c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 17959c19fb68SLokesh Vutla * from the given device. 1796967a020bSPeter Ujfalusi * @desc: Pointer to ti_sci_resource_desc to be updated with the 1797967a020bSPeter Ujfalusi * resource range start index and number of resources 17989c19fb68SLokesh Vutla * 17999c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 18009c19fb68SLokesh Vutla */ 18019c19fb68SLokesh Vutla static int ti_sci_cmd_get_resource_range(const struct ti_sci_handle *handle, 18029c19fb68SLokesh Vutla u32 dev_id, u8 subtype, 1803967a020bSPeter Ujfalusi struct ti_sci_resource_desc *desc) 18049c19fb68SLokesh Vutla { 18059c19fb68SLokesh Vutla return ti_sci_get_resource_range(handle, dev_id, subtype, 18069c19fb68SLokesh Vutla TI_SCI_IRQ_SECONDARY_HOST_INVALID, 1807967a020bSPeter Ujfalusi desc); 18089c19fb68SLokesh Vutla } 18099c19fb68SLokesh Vutla 18109c19fb68SLokesh Vutla /** 18119c19fb68SLokesh Vutla * ti_sci_cmd_get_resource_range_from_shost - Get a range of resources 18129c19fb68SLokesh Vutla * assigned to a specified host. 18139c19fb68SLokesh Vutla * @handle: Pointer to TISCI handle. 18149c19fb68SLokesh Vutla * @dev_id: TISCI device ID. 18159c19fb68SLokesh Vutla * @subtype: Resource assignment subtype that is being requested 18169c19fb68SLokesh Vutla * from the given device. 18179c19fb68SLokesh Vutla * @s_host: Host processor ID to which the resources are allocated 1818967a020bSPeter Ujfalusi * @desc: Pointer to ti_sci_resource_desc to be updated with the 1819967a020bSPeter Ujfalusi * resource range start index and number of resources 18209c19fb68SLokesh Vutla * 18219c19fb68SLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 18229c19fb68SLokesh Vutla */ 18239c19fb68SLokesh Vutla static 18249c19fb68SLokesh Vutla int ti_sci_cmd_get_resource_range_from_shost(const struct ti_sci_handle *handle, 18259c19fb68SLokesh Vutla u32 dev_id, u8 subtype, u8 s_host, 1826967a020bSPeter Ujfalusi struct ti_sci_resource_desc *desc) 18279c19fb68SLokesh Vutla { 1828967a020bSPeter Ujfalusi return ti_sci_get_resource_range(handle, dev_id, subtype, s_host, desc); 18299c19fb68SLokesh Vutla } 18309c19fb68SLokesh Vutla 1831997b001fSLokesh Vutla /** 1832997b001fSLokesh Vutla * ti_sci_manage_irq() - Helper api to configure/release the irq route between 1833997b001fSLokesh Vutla * the requested source and destination 1834997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1835997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1836997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1837997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1838997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1839997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1840997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1841997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1842997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1843997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1844997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1845997b001fSLokesh Vutla * requested for. 1846997b001fSLokesh Vutla * @type: Request type irq set or release. 1847997b001fSLokesh Vutla * 1848997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1849997b001fSLokesh Vutla */ 1850997b001fSLokesh Vutla static int ti_sci_manage_irq(const struct ti_sci_handle *handle, 1851997b001fSLokesh Vutla u32 valid_params, u16 src_id, u16 src_index, 1852997b001fSLokesh Vutla u16 dst_id, u16 dst_host_irq, u16 ia_id, u16 vint, 1853997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host, 1854997b001fSLokesh Vutla u16 type) 1855997b001fSLokesh Vutla { 1856997b001fSLokesh Vutla struct ti_sci_msg_req_manage_irq *req; 1857997b001fSLokesh Vutla struct ti_sci_msg_hdr *resp; 1858997b001fSLokesh Vutla struct ti_sci_xfer *xfer; 1859997b001fSLokesh Vutla struct ti_sci_info *info; 1860997b001fSLokesh Vutla struct device *dev; 1861997b001fSLokesh Vutla int ret = 0; 1862997b001fSLokesh Vutla 1863997b001fSLokesh Vutla if (IS_ERR(handle)) 1864997b001fSLokesh Vutla return PTR_ERR(handle); 1865997b001fSLokesh Vutla if (!handle) 1866997b001fSLokesh Vutla return -EINVAL; 1867997b001fSLokesh Vutla 1868997b001fSLokesh Vutla info = handle_to_ti_sci_info(handle); 1869997b001fSLokesh Vutla dev = info->dev; 1870997b001fSLokesh Vutla 1871997b001fSLokesh Vutla xfer = ti_sci_get_one_xfer(info, type, TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 1872997b001fSLokesh Vutla sizeof(*req), sizeof(*resp)); 1873997b001fSLokesh Vutla if (IS_ERR(xfer)) { 1874997b001fSLokesh Vutla ret = PTR_ERR(xfer); 1875997b001fSLokesh Vutla dev_err(dev, "Message alloc failed(%d)\n", ret); 1876997b001fSLokesh Vutla return ret; 1877997b001fSLokesh Vutla } 1878997b001fSLokesh Vutla req = (struct ti_sci_msg_req_manage_irq *)xfer->xfer_buf; 1879997b001fSLokesh Vutla req->valid_params = valid_params; 1880997b001fSLokesh Vutla req->src_id = src_id; 1881997b001fSLokesh Vutla req->src_index = src_index; 1882997b001fSLokesh Vutla req->dst_id = dst_id; 1883997b001fSLokesh Vutla req->dst_host_irq = dst_host_irq; 1884997b001fSLokesh Vutla req->ia_id = ia_id; 1885997b001fSLokesh Vutla req->vint = vint; 1886997b001fSLokesh Vutla req->global_event = global_event; 1887997b001fSLokesh Vutla req->vint_status_bit = vint_status_bit; 1888997b001fSLokesh Vutla req->secondary_host = s_host; 1889997b001fSLokesh Vutla 1890997b001fSLokesh Vutla ret = ti_sci_do_xfer(info, xfer); 1891997b001fSLokesh Vutla if (ret) { 1892997b001fSLokesh Vutla dev_err(dev, "Mbox send fail %d\n", ret); 1893997b001fSLokesh Vutla goto fail; 1894997b001fSLokesh Vutla } 1895997b001fSLokesh Vutla 1896997b001fSLokesh Vutla resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 1897997b001fSLokesh Vutla 1898997b001fSLokesh Vutla ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 1899997b001fSLokesh Vutla 1900997b001fSLokesh Vutla fail: 1901997b001fSLokesh Vutla ti_sci_put_one_xfer(&info->minfo, xfer); 1902997b001fSLokesh Vutla 1903997b001fSLokesh Vutla return ret; 1904997b001fSLokesh Vutla } 1905997b001fSLokesh Vutla 1906997b001fSLokesh Vutla /** 1907997b001fSLokesh Vutla * ti_sci_set_irq() - Helper api to configure the irq route between the 1908997b001fSLokesh Vutla * requested source and destination 1909997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1910997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1911997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1912997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1913997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1914997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1915997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1916997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1917997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1918997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1919997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1920997b001fSLokesh Vutla * requested for. 1921997b001fSLokesh Vutla * 1922997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1923997b001fSLokesh Vutla */ 1924997b001fSLokesh Vutla static int ti_sci_set_irq(const struct ti_sci_handle *handle, u32 valid_params, 1925997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 dst_id, 1926997b001fSLokesh Vutla u16 dst_host_irq, u16 ia_id, u16 vint, 1927997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host) 1928997b001fSLokesh Vutla { 1929997b001fSLokesh 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", 1930997b001fSLokesh Vutla __func__, valid_params, src_id, src_index, 1931997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, global_event, 1932997b001fSLokesh Vutla vint_status_bit); 1933997b001fSLokesh Vutla 1934997b001fSLokesh Vutla return ti_sci_manage_irq(handle, valid_params, src_id, src_index, 1935997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, 1936997b001fSLokesh Vutla global_event, vint_status_bit, s_host, 1937997b001fSLokesh Vutla TI_SCI_MSG_SET_IRQ); 1938997b001fSLokesh Vutla } 1939997b001fSLokesh Vutla 1940997b001fSLokesh Vutla /** 1941997b001fSLokesh Vutla * ti_sci_free_irq() - Helper api to free the irq route between the 1942997b001fSLokesh Vutla * requested source and destination 1943997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1944997b001fSLokesh Vutla * @valid_params: Bit fields defining the validity of certain params 1945997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1946997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1947997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1948997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1949997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 1950997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 1951997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 1952997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 1953997b001fSLokesh Vutla * @s_host: Secondary host ID to which the irq/event is being 1954997b001fSLokesh Vutla * requested for. 1955997b001fSLokesh Vutla * 1956997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1957997b001fSLokesh Vutla */ 1958997b001fSLokesh Vutla static int ti_sci_free_irq(const struct ti_sci_handle *handle, u32 valid_params, 1959997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 dst_id, 1960997b001fSLokesh Vutla u16 dst_host_irq, u16 ia_id, u16 vint, 1961997b001fSLokesh Vutla u16 global_event, u8 vint_status_bit, u8 s_host) 1962997b001fSLokesh Vutla { 1963997b001fSLokesh 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", 1964997b001fSLokesh Vutla __func__, valid_params, src_id, src_index, 1965997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, global_event, 1966997b001fSLokesh Vutla vint_status_bit); 1967997b001fSLokesh Vutla 1968997b001fSLokesh Vutla return ti_sci_manage_irq(handle, valid_params, src_id, src_index, 1969997b001fSLokesh Vutla dst_id, dst_host_irq, ia_id, vint, 1970997b001fSLokesh Vutla global_event, vint_status_bit, s_host, 1971997b001fSLokesh Vutla TI_SCI_MSG_FREE_IRQ); 1972997b001fSLokesh Vutla } 1973997b001fSLokesh Vutla 1974997b001fSLokesh Vutla /** 1975997b001fSLokesh Vutla * ti_sci_cmd_set_irq() - Configure a host irq route between the requested 1976997b001fSLokesh Vutla * source and destination. 1977997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 1978997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 1979997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 1980997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 1981997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 1982997b001fSLokesh Vutla * @vint_irq: Boolean specifying if this interrupt belongs to 1983997b001fSLokesh Vutla * Interrupt Aggregator. 1984997b001fSLokesh Vutla * 1985997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 1986997b001fSLokesh Vutla */ 1987997b001fSLokesh Vutla static int ti_sci_cmd_set_irq(const struct ti_sci_handle *handle, u16 src_id, 1988997b001fSLokesh Vutla u16 src_index, u16 dst_id, u16 dst_host_irq) 1989997b001fSLokesh Vutla { 1990997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID; 1991997b001fSLokesh Vutla 1992997b001fSLokesh Vutla return ti_sci_set_irq(handle, valid_params, src_id, src_index, dst_id, 1993997b001fSLokesh Vutla dst_host_irq, 0, 0, 0, 0, 0); 1994997b001fSLokesh Vutla } 1995997b001fSLokesh Vutla 1996997b001fSLokesh Vutla /** 1997997b001fSLokesh Vutla * ti_sci_cmd_set_event_map() - Configure an event based irq route between the 1998997b001fSLokesh Vutla * requested source and Interrupt Aggregator. 1999997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 2000997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 2001997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 2002997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 2003997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 2004997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 2005997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 2006997b001fSLokesh Vutla * 2007997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2008997b001fSLokesh Vutla */ 2009997b001fSLokesh Vutla static int ti_sci_cmd_set_event_map(const struct ti_sci_handle *handle, 2010997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 ia_id, 2011997b001fSLokesh Vutla u16 vint, u16 global_event, 2012997b001fSLokesh Vutla u8 vint_status_bit) 2013997b001fSLokesh Vutla { 2014997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_IA_ID_VALID | MSG_FLAG_VINT_VALID | 2015997b001fSLokesh Vutla MSG_FLAG_GLB_EVNT_VALID | 2016997b001fSLokesh Vutla MSG_FLAG_VINT_STS_BIT_VALID; 2017997b001fSLokesh Vutla 2018997b001fSLokesh Vutla return ti_sci_set_irq(handle, valid_params, src_id, src_index, 0, 0, 2019997b001fSLokesh Vutla ia_id, vint, global_event, vint_status_bit, 0); 2020997b001fSLokesh Vutla } 2021997b001fSLokesh Vutla 2022997b001fSLokesh Vutla /** 2023997b001fSLokesh Vutla * ti_sci_cmd_free_irq() - Free a host irq route between the between the 2024997b001fSLokesh Vutla * requested source and destination. 2025997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 2026997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 2027997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 2028997b001fSLokesh Vutla * @dst_id: Device ID of the IRQ destination 2029997b001fSLokesh Vutla * @dst_host_irq: IRQ number of the destination device 2030997b001fSLokesh Vutla * @vint_irq: Boolean specifying if this interrupt belongs to 2031997b001fSLokesh Vutla * Interrupt Aggregator. 2032997b001fSLokesh Vutla * 2033997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2034997b001fSLokesh Vutla */ 2035997b001fSLokesh Vutla static int ti_sci_cmd_free_irq(const struct ti_sci_handle *handle, u16 src_id, 2036997b001fSLokesh Vutla u16 src_index, u16 dst_id, u16 dst_host_irq) 2037997b001fSLokesh Vutla { 2038997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID; 2039997b001fSLokesh Vutla 2040997b001fSLokesh Vutla return ti_sci_free_irq(handle, valid_params, src_id, src_index, dst_id, 2041997b001fSLokesh Vutla dst_host_irq, 0, 0, 0, 0, 0); 2042997b001fSLokesh Vutla } 2043997b001fSLokesh Vutla 2044997b001fSLokesh Vutla /** 2045997b001fSLokesh Vutla * ti_sci_cmd_free_event_map() - Free an event map between the requested source 2046997b001fSLokesh Vutla * and Interrupt Aggregator. 2047997b001fSLokesh Vutla * @handle: Pointer to TISCI handle. 2048997b001fSLokesh Vutla * @src_id: Device ID of the IRQ source 2049997b001fSLokesh Vutla * @src_index: IRQ source index within the source device 2050997b001fSLokesh Vutla * @ia_id: Device ID of the IA, if the IRQ flows through this IA 2051997b001fSLokesh Vutla * @vint: Virtual interrupt to be used within the IA 2052997b001fSLokesh Vutla * @global_event: Global event number to be used for the requesting event 2053997b001fSLokesh Vutla * @vint_status_bit: Virtual interrupt status bit to be used for the event 2054997b001fSLokesh Vutla * 2055997b001fSLokesh Vutla * Return: 0 if all went fine, else return appropriate error. 2056997b001fSLokesh Vutla */ 2057997b001fSLokesh Vutla static int ti_sci_cmd_free_event_map(const struct ti_sci_handle *handle, 2058997b001fSLokesh Vutla u16 src_id, u16 src_index, u16 ia_id, 2059997b001fSLokesh Vutla u16 vint, u16 global_event, 2060997b001fSLokesh Vutla u8 vint_status_bit) 2061997b001fSLokesh Vutla { 2062997b001fSLokesh Vutla u32 valid_params = MSG_FLAG_IA_ID_VALID | 2063997b001fSLokesh Vutla MSG_FLAG_VINT_VALID | MSG_FLAG_GLB_EVNT_VALID | 2064997b001fSLokesh Vutla MSG_FLAG_VINT_STS_BIT_VALID; 2065997b001fSLokesh Vutla 2066997b001fSLokesh Vutla return ti_sci_free_irq(handle, valid_params, src_id, src_index, 0, 0, 2067997b001fSLokesh Vutla ia_id, vint, global_event, vint_status_bit, 0); 2068997b001fSLokesh Vutla } 2069997b001fSLokesh Vutla 207068608b5eSPeter Ujfalusi /** 20713c201753SPeter Ujfalusi * ti_sci_cmd_rm_ring_cfg() - Configure a NAVSS ring 20723c201753SPeter Ujfalusi * @handle: Pointer to TI SCI handle. 20733c201753SPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_ring_cfg ring config structure 20743c201753SPeter Ujfalusi * 20753c201753SPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 20763c201753SPeter Ujfalusi * 20773c201753SPeter Ujfalusi * See @ti_sci_msg_rm_ring_cfg and @ti_sci_msg_rm_ring_cfg_req for 20783c201753SPeter Ujfalusi * more info. 20793c201753SPeter Ujfalusi */ 20803c201753SPeter Ujfalusi static int ti_sci_cmd_rm_ring_cfg(const struct ti_sci_handle *handle, 20813c201753SPeter Ujfalusi const struct ti_sci_msg_rm_ring_cfg *params) 20823c201753SPeter Ujfalusi { 20833c201753SPeter Ujfalusi struct ti_sci_msg_rm_ring_cfg_req *req; 20843c201753SPeter Ujfalusi struct ti_sci_msg_hdr *resp; 20853c201753SPeter Ujfalusi struct ti_sci_xfer *xfer; 20863c201753SPeter Ujfalusi struct ti_sci_info *info; 20873c201753SPeter Ujfalusi struct device *dev; 20883c201753SPeter Ujfalusi int ret = 0; 20893c201753SPeter Ujfalusi 20903c201753SPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 20913c201753SPeter Ujfalusi return -EINVAL; 20923c201753SPeter Ujfalusi 20933c201753SPeter Ujfalusi info = handle_to_ti_sci_info(handle); 20943c201753SPeter Ujfalusi dev = info->dev; 20953c201753SPeter Ujfalusi 20963c201753SPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_RING_CFG, 20973c201753SPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 20983c201753SPeter Ujfalusi sizeof(*req), sizeof(*resp)); 20993c201753SPeter Ujfalusi if (IS_ERR(xfer)) { 21003c201753SPeter Ujfalusi ret = PTR_ERR(xfer); 21013c201753SPeter Ujfalusi dev_err(dev, "RM_RA:Message config failed(%d)\n", ret); 21023c201753SPeter Ujfalusi return ret; 21033c201753SPeter Ujfalusi } 21043c201753SPeter Ujfalusi req = (struct ti_sci_msg_rm_ring_cfg_req *)xfer->xfer_buf; 21053c201753SPeter Ujfalusi req->valid_params = params->valid_params; 21063c201753SPeter Ujfalusi req->nav_id = params->nav_id; 21073c201753SPeter Ujfalusi req->index = params->index; 21083c201753SPeter Ujfalusi req->addr_lo = params->addr_lo; 21093c201753SPeter Ujfalusi req->addr_hi = params->addr_hi; 21103c201753SPeter Ujfalusi req->count = params->count; 21113c201753SPeter Ujfalusi req->mode = params->mode; 21123c201753SPeter Ujfalusi req->size = params->size; 21133c201753SPeter Ujfalusi req->order_id = params->order_id; 21143c201753SPeter Ujfalusi req->virtid = params->virtid; 21153c201753SPeter Ujfalusi req->asel = params->asel; 21163c201753SPeter Ujfalusi 21173c201753SPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 21183c201753SPeter Ujfalusi if (ret) { 21193c201753SPeter Ujfalusi dev_err(dev, "RM_RA:Mbox config send fail %d\n", ret); 21203c201753SPeter Ujfalusi goto fail; 21213c201753SPeter Ujfalusi } 21223c201753SPeter Ujfalusi 21233c201753SPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 21243c201753SPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 21253c201753SPeter Ujfalusi 21263c201753SPeter Ujfalusi fail: 21273c201753SPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 21283c201753SPeter Ujfalusi dev_dbg(dev, "RM_RA:config ring %u ret:%d\n", params->index, ret); 21293c201753SPeter Ujfalusi return ret; 21303c201753SPeter Ujfalusi } 21313c201753SPeter Ujfalusi 21323c201753SPeter Ujfalusi /** 213368608b5eSPeter Ujfalusi * ti_sci_cmd_rm_psil_pair() - Pair PSI-L source to destination thread 213468608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 213568608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem which should be used for 213668608b5eSPeter Ujfalusi * pairing 213768608b5eSPeter Ujfalusi * @src_thread: Source PSI-L thread ID 213868608b5eSPeter Ujfalusi * @dst_thread: Destination PSI-L thread ID 213968608b5eSPeter Ujfalusi * 214068608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 214168608b5eSPeter Ujfalusi */ 214268608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_psil_pair(const struct ti_sci_handle *handle, 214368608b5eSPeter Ujfalusi u32 nav_id, u32 src_thread, u32 dst_thread) 214468608b5eSPeter Ujfalusi { 214568608b5eSPeter Ujfalusi struct ti_sci_msg_psil_pair *req; 214668608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 214768608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 214868608b5eSPeter Ujfalusi struct ti_sci_info *info; 214968608b5eSPeter Ujfalusi struct device *dev; 215068608b5eSPeter Ujfalusi int ret = 0; 215168608b5eSPeter Ujfalusi 215268608b5eSPeter Ujfalusi if (IS_ERR(handle)) 215368608b5eSPeter Ujfalusi return PTR_ERR(handle); 215468608b5eSPeter Ujfalusi if (!handle) 215568608b5eSPeter Ujfalusi return -EINVAL; 215668608b5eSPeter Ujfalusi 215768608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 215868608b5eSPeter Ujfalusi dev = info->dev; 215968608b5eSPeter Ujfalusi 216068608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_PAIR, 216168608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 216268608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 216368608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 216468608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 216568608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret); 216668608b5eSPeter Ujfalusi return ret; 216768608b5eSPeter Ujfalusi } 216868608b5eSPeter Ujfalusi req = (struct ti_sci_msg_psil_pair *)xfer->xfer_buf; 216968608b5eSPeter Ujfalusi req->nav_id = nav_id; 217068608b5eSPeter Ujfalusi req->src_thread = src_thread; 217168608b5eSPeter Ujfalusi req->dst_thread = dst_thread; 217268608b5eSPeter Ujfalusi 217368608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 217468608b5eSPeter Ujfalusi if (ret) { 217568608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Mbox send fail %d\n", ret); 217668608b5eSPeter Ujfalusi goto fail; 217768608b5eSPeter Ujfalusi } 217868608b5eSPeter Ujfalusi 217968608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 218068608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 218168608b5eSPeter Ujfalusi 218268608b5eSPeter Ujfalusi fail: 218368608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 218468608b5eSPeter Ujfalusi 218568608b5eSPeter Ujfalusi return ret; 218668608b5eSPeter Ujfalusi } 218768608b5eSPeter Ujfalusi 218868608b5eSPeter Ujfalusi /** 218968608b5eSPeter Ujfalusi * ti_sci_cmd_rm_psil_unpair() - Unpair PSI-L source from destination thread 219068608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 219168608b5eSPeter Ujfalusi * @nav_id: Device ID of Navigator Subsystem which should be used for 219268608b5eSPeter Ujfalusi * unpairing 219368608b5eSPeter Ujfalusi * @src_thread: Source PSI-L thread ID 219468608b5eSPeter Ujfalusi * @dst_thread: Destination PSI-L thread ID 219568608b5eSPeter Ujfalusi * 219668608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 219768608b5eSPeter Ujfalusi */ 219868608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_psil_unpair(const struct ti_sci_handle *handle, 219968608b5eSPeter Ujfalusi u32 nav_id, u32 src_thread, u32 dst_thread) 220068608b5eSPeter Ujfalusi { 220168608b5eSPeter Ujfalusi struct ti_sci_msg_psil_unpair *req; 220268608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 220368608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 220468608b5eSPeter Ujfalusi struct ti_sci_info *info; 220568608b5eSPeter Ujfalusi struct device *dev; 220668608b5eSPeter Ujfalusi int ret = 0; 220768608b5eSPeter Ujfalusi 220868608b5eSPeter Ujfalusi if (IS_ERR(handle)) 220968608b5eSPeter Ujfalusi return PTR_ERR(handle); 221068608b5eSPeter Ujfalusi if (!handle) 221168608b5eSPeter Ujfalusi return -EINVAL; 221268608b5eSPeter Ujfalusi 221368608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 221468608b5eSPeter Ujfalusi dev = info->dev; 221568608b5eSPeter Ujfalusi 221668608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_UNPAIR, 221768608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 221868608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 221968608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 222068608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 222168608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret); 222268608b5eSPeter Ujfalusi return ret; 222368608b5eSPeter Ujfalusi } 222468608b5eSPeter Ujfalusi req = (struct ti_sci_msg_psil_unpair *)xfer->xfer_buf; 222568608b5eSPeter Ujfalusi req->nav_id = nav_id; 222668608b5eSPeter Ujfalusi req->src_thread = src_thread; 222768608b5eSPeter Ujfalusi req->dst_thread = dst_thread; 222868608b5eSPeter Ujfalusi 222968608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 223068608b5eSPeter Ujfalusi if (ret) { 223168608b5eSPeter Ujfalusi dev_err(dev, "RM_PSIL:Mbox send fail %d\n", ret); 223268608b5eSPeter Ujfalusi goto fail; 223368608b5eSPeter Ujfalusi } 223468608b5eSPeter Ujfalusi 223568608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 223668608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 223768608b5eSPeter Ujfalusi 223868608b5eSPeter Ujfalusi fail: 223968608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 224068608b5eSPeter Ujfalusi 224168608b5eSPeter Ujfalusi return ret; 224268608b5eSPeter Ujfalusi } 224368608b5eSPeter Ujfalusi 224468608b5eSPeter Ujfalusi /** 224568608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_tx_ch_cfg() - Configure a UDMAP TX channel 224668608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 224768608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_tx_ch_cfg TX channel config 224868608b5eSPeter Ujfalusi * structure 224968608b5eSPeter Ujfalusi * 225068608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 225168608b5eSPeter Ujfalusi * 225268608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_tx_ch_cfg and @ti_sci_msg_rm_udmap_tx_ch_cfg_req for 225368608b5eSPeter Ujfalusi * more info. 225468608b5eSPeter Ujfalusi */ 225568608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_tx_ch_cfg(const struct ti_sci_handle *handle, 225668608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_tx_ch_cfg *params) 225768608b5eSPeter Ujfalusi { 225868608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_tx_ch_cfg_req *req; 225968608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 226068608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 226168608b5eSPeter Ujfalusi struct ti_sci_info *info; 226268608b5eSPeter Ujfalusi struct device *dev; 226368608b5eSPeter Ujfalusi int ret = 0; 226468608b5eSPeter Ujfalusi 226568608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 226668608b5eSPeter Ujfalusi return -EINVAL; 226768608b5eSPeter Ujfalusi 226868608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 226968608b5eSPeter Ujfalusi dev = info->dev; 227068608b5eSPeter Ujfalusi 227168608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_TX_CH_CFG, 227268608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 227368608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 227468608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 227568608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 22764c960505SYueHaibing dev_err(dev, "Message TX_CH_CFG alloc failed(%d)\n", ret); 227768608b5eSPeter Ujfalusi return ret; 227868608b5eSPeter Ujfalusi } 227968608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_tx_ch_cfg_req *)xfer->xfer_buf; 228068608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 228168608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 228268608b5eSPeter Ujfalusi req->index = params->index; 228368608b5eSPeter Ujfalusi req->tx_pause_on_err = params->tx_pause_on_err; 228468608b5eSPeter Ujfalusi req->tx_filt_einfo = params->tx_filt_einfo; 228568608b5eSPeter Ujfalusi req->tx_filt_pswords = params->tx_filt_pswords; 228668608b5eSPeter Ujfalusi req->tx_atype = params->tx_atype; 228768608b5eSPeter Ujfalusi req->tx_chan_type = params->tx_chan_type; 228868608b5eSPeter Ujfalusi req->tx_supr_tdpkt = params->tx_supr_tdpkt; 228968608b5eSPeter Ujfalusi req->tx_fetch_size = params->tx_fetch_size; 229068608b5eSPeter Ujfalusi req->tx_credit_count = params->tx_credit_count; 229168608b5eSPeter Ujfalusi req->txcq_qnum = params->txcq_qnum; 229268608b5eSPeter Ujfalusi req->tx_priority = params->tx_priority; 229368608b5eSPeter Ujfalusi req->tx_qos = params->tx_qos; 229468608b5eSPeter Ujfalusi req->tx_orderid = params->tx_orderid; 229568608b5eSPeter Ujfalusi req->fdepth = params->fdepth; 229668608b5eSPeter Ujfalusi req->tx_sched_priority = params->tx_sched_priority; 229768608b5eSPeter Ujfalusi req->tx_burst_size = params->tx_burst_size; 22981c552e08SPeter Ujfalusi req->tx_tdtype = params->tx_tdtype; 2299ce1feed5SPeter Ujfalusi req->extended_ch_type = params->extended_ch_type; 230068608b5eSPeter Ujfalusi 230168608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 230268608b5eSPeter Ujfalusi if (ret) { 23034c960505SYueHaibing dev_err(dev, "Mbox send TX_CH_CFG fail %d\n", ret); 230468608b5eSPeter Ujfalusi goto fail; 230568608b5eSPeter Ujfalusi } 230668608b5eSPeter Ujfalusi 230768608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 230868608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 230968608b5eSPeter Ujfalusi 231068608b5eSPeter Ujfalusi fail: 231168608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 23124c960505SYueHaibing dev_dbg(dev, "TX_CH_CFG: chn %u ret:%u\n", params->index, ret); 231368608b5eSPeter Ujfalusi return ret; 231468608b5eSPeter Ujfalusi } 231568608b5eSPeter Ujfalusi 231668608b5eSPeter Ujfalusi /** 231768608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_rx_ch_cfg() - Configure a UDMAP RX channel 231868608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 231968608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_rx_ch_cfg RX channel config 232068608b5eSPeter Ujfalusi * structure 232168608b5eSPeter Ujfalusi * 232268608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 232368608b5eSPeter Ujfalusi * 232468608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_rx_ch_cfg and @ti_sci_msg_rm_udmap_rx_ch_cfg_req for 232568608b5eSPeter Ujfalusi * more info. 232668608b5eSPeter Ujfalusi */ 232768608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_rx_ch_cfg(const struct ti_sci_handle *handle, 232868608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_rx_ch_cfg *params) 232968608b5eSPeter Ujfalusi { 233068608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *req; 233168608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 233268608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 233368608b5eSPeter Ujfalusi struct ti_sci_info *info; 233468608b5eSPeter Ujfalusi struct device *dev; 233568608b5eSPeter Ujfalusi int ret = 0; 233668608b5eSPeter Ujfalusi 233768608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 233868608b5eSPeter Ujfalusi return -EINVAL; 233968608b5eSPeter Ujfalusi 234068608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 234168608b5eSPeter Ujfalusi dev = info->dev; 234268608b5eSPeter Ujfalusi 234368608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_RX_CH_CFG, 234468608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 234568608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 234668608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 234768608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 23484c960505SYueHaibing dev_err(dev, "Message RX_CH_CFG alloc failed(%d)\n", ret); 234968608b5eSPeter Ujfalusi return ret; 235068608b5eSPeter Ujfalusi } 235168608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *)xfer->xfer_buf; 235268608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 235368608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 235468608b5eSPeter Ujfalusi req->index = params->index; 235568608b5eSPeter Ujfalusi req->rx_fetch_size = params->rx_fetch_size; 235668608b5eSPeter Ujfalusi req->rxcq_qnum = params->rxcq_qnum; 235768608b5eSPeter Ujfalusi req->rx_priority = params->rx_priority; 235868608b5eSPeter Ujfalusi req->rx_qos = params->rx_qos; 235968608b5eSPeter Ujfalusi req->rx_orderid = params->rx_orderid; 236068608b5eSPeter Ujfalusi req->rx_sched_priority = params->rx_sched_priority; 236168608b5eSPeter Ujfalusi req->flowid_start = params->flowid_start; 236268608b5eSPeter Ujfalusi req->flowid_cnt = params->flowid_cnt; 236368608b5eSPeter Ujfalusi req->rx_pause_on_err = params->rx_pause_on_err; 236468608b5eSPeter Ujfalusi req->rx_atype = params->rx_atype; 236568608b5eSPeter Ujfalusi req->rx_chan_type = params->rx_chan_type; 236668608b5eSPeter Ujfalusi req->rx_ignore_short = params->rx_ignore_short; 236768608b5eSPeter Ujfalusi req->rx_ignore_long = params->rx_ignore_long; 236868608b5eSPeter Ujfalusi req->rx_burst_size = params->rx_burst_size; 236968608b5eSPeter Ujfalusi 237068608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 237168608b5eSPeter Ujfalusi if (ret) { 23724c960505SYueHaibing dev_err(dev, "Mbox send RX_CH_CFG fail %d\n", ret); 237368608b5eSPeter Ujfalusi goto fail; 237468608b5eSPeter Ujfalusi } 237568608b5eSPeter Ujfalusi 237668608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 237768608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 237868608b5eSPeter Ujfalusi 237968608b5eSPeter Ujfalusi fail: 238068608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 23814c960505SYueHaibing dev_dbg(dev, "RX_CH_CFG: chn %u ret:%d\n", params->index, ret); 238268608b5eSPeter Ujfalusi return ret; 238368608b5eSPeter Ujfalusi } 238468608b5eSPeter Ujfalusi 238568608b5eSPeter Ujfalusi /** 238668608b5eSPeter Ujfalusi * ti_sci_cmd_rm_udmap_rx_flow_cfg() - Configure UDMAP RX FLOW 238768608b5eSPeter Ujfalusi * @handle: Pointer to TI SCI handle. 238868608b5eSPeter Ujfalusi * @params: Pointer to ti_sci_msg_rm_udmap_flow_cfg RX FLOW config 238968608b5eSPeter Ujfalusi * structure 239068608b5eSPeter Ujfalusi * 239168608b5eSPeter Ujfalusi * Return: 0 if all went well, else returns appropriate error value. 239268608b5eSPeter Ujfalusi * 239368608b5eSPeter Ujfalusi * See @ti_sci_msg_rm_udmap_flow_cfg and @ti_sci_msg_rm_udmap_flow_cfg_req for 239468608b5eSPeter Ujfalusi * more info. 239568608b5eSPeter Ujfalusi */ 239668608b5eSPeter Ujfalusi static int ti_sci_cmd_rm_udmap_rx_flow_cfg(const struct ti_sci_handle *handle, 239768608b5eSPeter Ujfalusi const struct ti_sci_msg_rm_udmap_flow_cfg *params) 239868608b5eSPeter Ujfalusi { 239968608b5eSPeter Ujfalusi struct ti_sci_msg_rm_udmap_flow_cfg_req *req; 240068608b5eSPeter Ujfalusi struct ti_sci_msg_hdr *resp; 240168608b5eSPeter Ujfalusi struct ti_sci_xfer *xfer; 240268608b5eSPeter Ujfalusi struct ti_sci_info *info; 240368608b5eSPeter Ujfalusi struct device *dev; 240468608b5eSPeter Ujfalusi int ret = 0; 240568608b5eSPeter Ujfalusi 240668608b5eSPeter Ujfalusi if (IS_ERR_OR_NULL(handle)) 240768608b5eSPeter Ujfalusi return -EINVAL; 240868608b5eSPeter Ujfalusi 240968608b5eSPeter Ujfalusi info = handle_to_ti_sci_info(handle); 241068608b5eSPeter Ujfalusi dev = info->dev; 241168608b5eSPeter Ujfalusi 241268608b5eSPeter Ujfalusi xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_FLOW_CFG, 241368608b5eSPeter Ujfalusi TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 241468608b5eSPeter Ujfalusi sizeof(*req), sizeof(*resp)); 241568608b5eSPeter Ujfalusi if (IS_ERR(xfer)) { 241668608b5eSPeter Ujfalusi ret = PTR_ERR(xfer); 241768608b5eSPeter Ujfalusi dev_err(dev, "RX_FL_CFG: Message alloc failed(%d)\n", ret); 241868608b5eSPeter Ujfalusi return ret; 241968608b5eSPeter Ujfalusi } 242068608b5eSPeter Ujfalusi req = (struct ti_sci_msg_rm_udmap_flow_cfg_req *)xfer->xfer_buf; 242168608b5eSPeter Ujfalusi req->valid_params = params->valid_params; 242268608b5eSPeter Ujfalusi req->nav_id = params->nav_id; 242368608b5eSPeter Ujfalusi req->flow_index = params->flow_index; 242468608b5eSPeter Ujfalusi req->rx_einfo_present = params->rx_einfo_present; 242568608b5eSPeter Ujfalusi req->rx_psinfo_present = params->rx_psinfo_present; 242668608b5eSPeter Ujfalusi req->rx_error_handling = params->rx_error_handling; 242768608b5eSPeter Ujfalusi req->rx_desc_type = params->rx_desc_type; 242868608b5eSPeter Ujfalusi req->rx_sop_offset = params->rx_sop_offset; 242968608b5eSPeter Ujfalusi req->rx_dest_qnum = params->rx_dest_qnum; 243068608b5eSPeter Ujfalusi req->rx_src_tag_hi = params->rx_src_tag_hi; 243168608b5eSPeter Ujfalusi req->rx_src_tag_lo = params->rx_src_tag_lo; 243268608b5eSPeter Ujfalusi req->rx_dest_tag_hi = params->rx_dest_tag_hi; 243368608b5eSPeter Ujfalusi req->rx_dest_tag_lo = params->rx_dest_tag_lo; 243468608b5eSPeter Ujfalusi req->rx_src_tag_hi_sel = params->rx_src_tag_hi_sel; 243568608b5eSPeter Ujfalusi req->rx_src_tag_lo_sel = params->rx_src_tag_lo_sel; 243668608b5eSPeter Ujfalusi req->rx_dest_tag_hi_sel = params->rx_dest_tag_hi_sel; 243768608b5eSPeter Ujfalusi req->rx_dest_tag_lo_sel = params->rx_dest_tag_lo_sel; 243868608b5eSPeter Ujfalusi req->rx_fdq0_sz0_qnum = params->rx_fdq0_sz0_qnum; 243968608b5eSPeter Ujfalusi req->rx_fdq1_qnum = params->rx_fdq1_qnum; 244068608b5eSPeter Ujfalusi req->rx_fdq2_qnum = params->rx_fdq2_qnum; 244168608b5eSPeter Ujfalusi req->rx_fdq3_qnum = params->rx_fdq3_qnum; 244268608b5eSPeter Ujfalusi req->rx_ps_location = params->rx_ps_location; 244368608b5eSPeter Ujfalusi 244468608b5eSPeter Ujfalusi ret = ti_sci_do_xfer(info, xfer); 244568608b5eSPeter Ujfalusi if (ret) { 244668608b5eSPeter Ujfalusi dev_err(dev, "RX_FL_CFG: Mbox send fail %d\n", ret); 244768608b5eSPeter Ujfalusi goto fail; 244868608b5eSPeter Ujfalusi } 244968608b5eSPeter Ujfalusi 245068608b5eSPeter Ujfalusi resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf; 245168608b5eSPeter Ujfalusi ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL; 245268608b5eSPeter Ujfalusi 245368608b5eSPeter Ujfalusi fail: 245468608b5eSPeter Ujfalusi ti_sci_put_one_xfer(&info->minfo, xfer); 245568608b5eSPeter Ujfalusi dev_dbg(info->dev, "RX_FL_CFG: %u ret:%d\n", params->flow_index, ret); 245668608b5eSPeter Ujfalusi return ret; 245768608b5eSPeter Ujfalusi } 245868608b5eSPeter Ujfalusi 24591e407f33SSuman Anna /** 24601e407f33SSuman Anna * ti_sci_cmd_proc_request() - Command to request a physical processor control 24611e407f33SSuman Anna * @handle: Pointer to TI SCI handle 24621e407f33SSuman Anna * @proc_id: Processor ID this request is for 24631e407f33SSuman Anna * 24641e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 24651e407f33SSuman Anna */ 24661e407f33SSuman Anna static int ti_sci_cmd_proc_request(const struct ti_sci_handle *handle, 24671e407f33SSuman Anna u8 proc_id) 24681e407f33SSuman Anna { 24691e407f33SSuman Anna struct ti_sci_msg_req_proc_request *req; 24701e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 24711e407f33SSuman Anna struct ti_sci_info *info; 24721e407f33SSuman Anna struct ti_sci_xfer *xfer; 24731e407f33SSuman Anna struct device *dev; 24741e407f33SSuman Anna int ret = 0; 24751e407f33SSuman Anna 24761e407f33SSuman Anna if (!handle) 24771e407f33SSuman Anna return -EINVAL; 24781e407f33SSuman Anna if (IS_ERR(handle)) 24791e407f33SSuman Anna return PTR_ERR(handle); 24801e407f33SSuman Anna 24811e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 24821e407f33SSuman Anna dev = info->dev; 24831e407f33SSuman Anna 24841e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_REQUEST, 24851e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 24861e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 24871e407f33SSuman Anna if (IS_ERR(xfer)) { 24881e407f33SSuman Anna ret = PTR_ERR(xfer); 24891e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 24901e407f33SSuman Anna return ret; 24911e407f33SSuman Anna } 24921e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_request *)xfer->xfer_buf; 24931e407f33SSuman Anna req->processor_id = proc_id; 24941e407f33SSuman Anna 24951e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 24961e407f33SSuman Anna if (ret) { 24971e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 24981e407f33SSuman Anna goto fail; 24991e407f33SSuman Anna } 25001e407f33SSuman Anna 25011e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 25021e407f33SSuman Anna 25031e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 25041e407f33SSuman Anna 25051e407f33SSuman Anna fail: 25061e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 25071e407f33SSuman Anna 25081e407f33SSuman Anna return ret; 25091e407f33SSuman Anna } 25101e407f33SSuman Anna 25111e407f33SSuman Anna /** 25121e407f33SSuman Anna * ti_sci_cmd_proc_release() - Command to release a physical processor control 25131e407f33SSuman Anna * @handle: Pointer to TI SCI handle 25141e407f33SSuman Anna * @proc_id: Processor ID this request is for 25151e407f33SSuman Anna * 25161e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 25171e407f33SSuman Anna */ 25181e407f33SSuman Anna static int ti_sci_cmd_proc_release(const struct ti_sci_handle *handle, 25191e407f33SSuman Anna u8 proc_id) 25201e407f33SSuman Anna { 25211e407f33SSuman Anna struct ti_sci_msg_req_proc_release *req; 25221e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 25231e407f33SSuman Anna struct ti_sci_info *info; 25241e407f33SSuman Anna struct ti_sci_xfer *xfer; 25251e407f33SSuman Anna struct device *dev; 25261e407f33SSuman Anna int ret = 0; 25271e407f33SSuman Anna 25281e407f33SSuman Anna if (!handle) 25291e407f33SSuman Anna return -EINVAL; 25301e407f33SSuman Anna if (IS_ERR(handle)) 25311e407f33SSuman Anna return PTR_ERR(handle); 25321e407f33SSuman Anna 25331e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 25341e407f33SSuman Anna dev = info->dev; 25351e407f33SSuman Anna 25361e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_RELEASE, 25371e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 25381e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 25391e407f33SSuman Anna if (IS_ERR(xfer)) { 25401e407f33SSuman Anna ret = PTR_ERR(xfer); 25411e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 25421e407f33SSuman Anna return ret; 25431e407f33SSuman Anna } 25441e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_release *)xfer->xfer_buf; 25451e407f33SSuman Anna req->processor_id = proc_id; 25461e407f33SSuman Anna 25471e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 25481e407f33SSuman Anna if (ret) { 25491e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 25501e407f33SSuman Anna goto fail; 25511e407f33SSuman Anna } 25521e407f33SSuman Anna 25531e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 25541e407f33SSuman Anna 25551e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 25561e407f33SSuman Anna 25571e407f33SSuman Anna fail: 25581e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 25591e407f33SSuman Anna 25601e407f33SSuman Anna return ret; 25611e407f33SSuman Anna } 25621e407f33SSuman Anna 25631e407f33SSuman Anna /** 25641e407f33SSuman Anna * ti_sci_cmd_proc_handover() - Command to handover a physical processor 25651e407f33SSuman Anna * control to a host in the processor's access 25661e407f33SSuman Anna * control list. 25671e407f33SSuman Anna * @handle: Pointer to TI SCI handle 25681e407f33SSuman Anna * @proc_id: Processor ID this request is for 25691e407f33SSuman Anna * @host_id: Host ID to get the control of the processor 25701e407f33SSuman Anna * 25711e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 25721e407f33SSuman Anna */ 25731e407f33SSuman Anna static int ti_sci_cmd_proc_handover(const struct ti_sci_handle *handle, 25741e407f33SSuman Anna u8 proc_id, u8 host_id) 25751e407f33SSuman Anna { 25761e407f33SSuman Anna struct ti_sci_msg_req_proc_handover *req; 25771e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 25781e407f33SSuman Anna struct ti_sci_info *info; 25791e407f33SSuman Anna struct ti_sci_xfer *xfer; 25801e407f33SSuman Anna struct device *dev; 25811e407f33SSuman Anna int ret = 0; 25821e407f33SSuman Anna 25831e407f33SSuman Anna if (!handle) 25841e407f33SSuman Anna return -EINVAL; 25851e407f33SSuman Anna if (IS_ERR(handle)) 25861e407f33SSuman Anna return PTR_ERR(handle); 25871e407f33SSuman Anna 25881e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 25891e407f33SSuman Anna dev = info->dev; 25901e407f33SSuman Anna 25911e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_HANDOVER, 25921e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 25931e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 25941e407f33SSuman Anna if (IS_ERR(xfer)) { 25951e407f33SSuman Anna ret = PTR_ERR(xfer); 25961e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 25971e407f33SSuman Anna return ret; 25981e407f33SSuman Anna } 25991e407f33SSuman Anna req = (struct ti_sci_msg_req_proc_handover *)xfer->xfer_buf; 26001e407f33SSuman Anna req->processor_id = proc_id; 26011e407f33SSuman Anna req->host_id = host_id; 26021e407f33SSuman Anna 26031e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 26041e407f33SSuman Anna if (ret) { 26051e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 26061e407f33SSuman Anna goto fail; 26071e407f33SSuman Anna } 26081e407f33SSuman Anna 26091e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 26101e407f33SSuman Anna 26111e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 26121e407f33SSuman Anna 26131e407f33SSuman Anna fail: 26141e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 26151e407f33SSuman Anna 26161e407f33SSuman Anna return ret; 26171e407f33SSuman Anna } 26181e407f33SSuman Anna 26191e407f33SSuman Anna /** 26201e407f33SSuman Anna * ti_sci_cmd_proc_set_config() - Command to set the processor boot 26211e407f33SSuman Anna * configuration flags 26221e407f33SSuman Anna * @handle: Pointer to TI SCI handle 26231e407f33SSuman Anna * @proc_id: Processor ID this request is for 26241e407f33SSuman Anna * @config_flags_set: Configuration flags to be set 26251e407f33SSuman Anna * @config_flags_clear: Configuration flags to be cleared. 26261e407f33SSuman Anna * 26271e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 26281e407f33SSuman Anna */ 26291e407f33SSuman Anna static int ti_sci_cmd_proc_set_config(const struct ti_sci_handle *handle, 26301e407f33SSuman Anna u8 proc_id, u64 bootvector, 26311e407f33SSuman Anna u32 config_flags_set, 26321e407f33SSuman Anna u32 config_flags_clear) 26331e407f33SSuman Anna { 26341e407f33SSuman Anna struct ti_sci_msg_req_set_config *req; 26351e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 26361e407f33SSuman Anna struct ti_sci_info *info; 26371e407f33SSuman Anna struct ti_sci_xfer *xfer; 26381e407f33SSuman Anna struct device *dev; 26391e407f33SSuman Anna int ret = 0; 26401e407f33SSuman Anna 26411e407f33SSuman Anna if (!handle) 26421e407f33SSuman Anna return -EINVAL; 26431e407f33SSuman Anna if (IS_ERR(handle)) 26441e407f33SSuman Anna return PTR_ERR(handle); 26451e407f33SSuman Anna 26461e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 26471e407f33SSuman Anna dev = info->dev; 26481e407f33SSuman Anna 26491e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CONFIG, 26501e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 26511e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 26521e407f33SSuman Anna if (IS_ERR(xfer)) { 26531e407f33SSuman Anna ret = PTR_ERR(xfer); 26541e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 26551e407f33SSuman Anna return ret; 26561e407f33SSuman Anna } 26571e407f33SSuman Anna req = (struct ti_sci_msg_req_set_config *)xfer->xfer_buf; 26581e407f33SSuman Anna req->processor_id = proc_id; 26591e407f33SSuman Anna req->bootvector_low = bootvector & TI_SCI_ADDR_LOW_MASK; 26601e407f33SSuman Anna req->bootvector_high = (bootvector & TI_SCI_ADDR_HIGH_MASK) >> 26611e407f33SSuman Anna TI_SCI_ADDR_HIGH_SHIFT; 26621e407f33SSuman Anna req->config_flags_set = config_flags_set; 26631e407f33SSuman Anna req->config_flags_clear = config_flags_clear; 26641e407f33SSuman Anna 26651e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 26661e407f33SSuman Anna if (ret) { 26671e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 26681e407f33SSuman Anna goto fail; 26691e407f33SSuman Anna } 26701e407f33SSuman Anna 26711e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 26721e407f33SSuman Anna 26731e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 26741e407f33SSuman Anna 26751e407f33SSuman Anna fail: 26761e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 26771e407f33SSuman Anna 26781e407f33SSuman Anna return ret; 26791e407f33SSuman Anna } 26801e407f33SSuman Anna 26811e407f33SSuman Anna /** 26821e407f33SSuman Anna * ti_sci_cmd_proc_set_control() - Command to set the processor boot 26831e407f33SSuman Anna * control flags 26841e407f33SSuman Anna * @handle: Pointer to TI SCI handle 26851e407f33SSuman Anna * @proc_id: Processor ID this request is for 26861e407f33SSuman Anna * @control_flags_set: Control flags to be set 26871e407f33SSuman Anna * @control_flags_clear: Control flags to be cleared 26881e407f33SSuman Anna * 26891e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 26901e407f33SSuman Anna */ 26911e407f33SSuman Anna static int ti_sci_cmd_proc_set_control(const struct ti_sci_handle *handle, 26921e407f33SSuman Anna u8 proc_id, u32 control_flags_set, 26931e407f33SSuman Anna u32 control_flags_clear) 26941e407f33SSuman Anna { 26951e407f33SSuman Anna struct ti_sci_msg_req_set_ctrl *req; 26961e407f33SSuman Anna struct ti_sci_msg_hdr *resp; 26971e407f33SSuman Anna struct ti_sci_info *info; 26981e407f33SSuman Anna struct ti_sci_xfer *xfer; 26991e407f33SSuman Anna struct device *dev; 27001e407f33SSuman Anna int ret = 0; 27011e407f33SSuman Anna 27021e407f33SSuman Anna if (!handle) 27031e407f33SSuman Anna return -EINVAL; 27041e407f33SSuman Anna if (IS_ERR(handle)) 27051e407f33SSuman Anna return PTR_ERR(handle); 27061e407f33SSuman Anna 27071e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 27081e407f33SSuman Anna dev = info->dev; 27091e407f33SSuman Anna 27101e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CTRL, 27111e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 27121e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 27131e407f33SSuman Anna if (IS_ERR(xfer)) { 27141e407f33SSuman Anna ret = PTR_ERR(xfer); 27151e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 27161e407f33SSuman Anna return ret; 27171e407f33SSuman Anna } 27181e407f33SSuman Anna req = (struct ti_sci_msg_req_set_ctrl *)xfer->xfer_buf; 27191e407f33SSuman Anna req->processor_id = proc_id; 27201e407f33SSuman Anna req->control_flags_set = control_flags_set; 27211e407f33SSuman Anna req->control_flags_clear = control_flags_clear; 27221e407f33SSuman Anna 27231e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 27241e407f33SSuman Anna if (ret) { 27251e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 27261e407f33SSuman Anna goto fail; 27271e407f33SSuman Anna } 27281e407f33SSuman Anna 27291e407f33SSuman Anna resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf; 27301e407f33SSuman Anna 27311e407f33SSuman Anna ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV; 27321e407f33SSuman Anna 27331e407f33SSuman Anna fail: 27341e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 27351e407f33SSuman Anna 27361e407f33SSuman Anna return ret; 27371e407f33SSuman Anna } 27381e407f33SSuman Anna 27391e407f33SSuman Anna /** 27401e407f33SSuman Anna * ti_sci_cmd_get_boot_status() - Command to get the processor boot status 27411e407f33SSuman Anna * @handle: Pointer to TI SCI handle 27421e407f33SSuman Anna * @proc_id: Processor ID this request is for 27431e407f33SSuman Anna * 27441e407f33SSuman Anna * Return: 0 if all went well, else returns appropriate error value. 27451e407f33SSuman Anna */ 27461e407f33SSuman Anna static int ti_sci_cmd_proc_get_status(const struct ti_sci_handle *handle, 27471e407f33SSuman Anna u8 proc_id, u64 *bv, u32 *cfg_flags, 27481e407f33SSuman Anna u32 *ctrl_flags, u32 *sts_flags) 27491e407f33SSuman Anna { 27501e407f33SSuman Anna struct ti_sci_msg_resp_get_status *resp; 27511e407f33SSuman Anna struct ti_sci_msg_req_get_status *req; 27521e407f33SSuman Anna struct ti_sci_info *info; 27531e407f33SSuman Anna struct ti_sci_xfer *xfer; 27541e407f33SSuman Anna struct device *dev; 27551e407f33SSuman Anna int ret = 0; 27561e407f33SSuman Anna 27571e407f33SSuman Anna if (!handle) 27581e407f33SSuman Anna return -EINVAL; 27591e407f33SSuman Anna if (IS_ERR(handle)) 27601e407f33SSuman Anna return PTR_ERR(handle); 27611e407f33SSuman Anna 27621e407f33SSuman Anna info = handle_to_ti_sci_info(handle); 27631e407f33SSuman Anna dev = info->dev; 27641e407f33SSuman Anna 27651e407f33SSuman Anna xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_STATUS, 27661e407f33SSuman Anna TI_SCI_FLAG_REQ_ACK_ON_PROCESSED, 27671e407f33SSuman Anna sizeof(*req), sizeof(*resp)); 27681e407f33SSuman Anna if (IS_ERR(xfer)) { 27691e407f33SSuman Anna ret = PTR_ERR(xfer); 27701e407f33SSuman Anna dev_err(dev, "Message alloc failed(%d)\n", ret); 27711e407f33SSuman Anna return ret; 27721e407f33SSuman Anna } 27731e407f33SSuman Anna req = (struct ti_sci_msg_req_get_status *)xfer->xfer_buf; 27741e407f33SSuman Anna req->processor_id = proc_id; 27751e407f33SSuman Anna 27761e407f33SSuman Anna ret = ti_sci_do_xfer(info, xfer); 27771e407f33SSuman Anna if (ret) { 27781e407f33SSuman Anna dev_err(dev, "Mbox send fail %d\n", ret); 27791e407f33SSuman Anna goto fail; 27801e407f33SSuman Anna } 27811e407f33SSuman Anna 27821e407f33SSuman Anna resp = (struct ti_sci_msg_resp_get_status *)xfer->tx_message.buf; 27831e407f33SSuman Anna 27841e407f33SSuman Anna if (!ti_sci_is_response_ack(resp)) { 27851e407f33SSuman Anna ret = -ENODEV; 27861e407f33SSuman Anna } else { 27871e407f33SSuman Anna *bv = (resp->bootvector_low & TI_SCI_ADDR_LOW_MASK) | 27881e407f33SSuman Anna (((u64)resp->bootvector_high << TI_SCI_ADDR_HIGH_SHIFT) & 27891e407f33SSuman Anna TI_SCI_ADDR_HIGH_MASK); 27901e407f33SSuman Anna *cfg_flags = resp->config_flags; 27911e407f33SSuman Anna *ctrl_flags = resp->control_flags; 27921e407f33SSuman Anna *sts_flags = resp->status_flags; 27931e407f33SSuman Anna } 27941e407f33SSuman Anna 27951e407f33SSuman Anna fail: 27961e407f33SSuman Anna ti_sci_put_one_xfer(&info->minfo, xfer); 27971e407f33SSuman Anna 27981e407f33SSuman Anna return ret; 27991e407f33SSuman Anna } 28001e407f33SSuman Anna 28019e7d756dSNishanth Menon /* 28029e7d756dSNishanth Menon * ti_sci_setup_ops() - Setup the operations structures 28039e7d756dSNishanth Menon * @info: pointer to TISCI pointer 28049e7d756dSNishanth Menon */ 28059e7d756dSNishanth Menon static void ti_sci_setup_ops(struct ti_sci_info *info) 28069e7d756dSNishanth Menon { 28079e7d756dSNishanth Menon struct ti_sci_ops *ops = &info->handle.ops; 2808912cffb4SNishanth Menon struct ti_sci_core_ops *core_ops = &ops->core_ops; 28099e7d756dSNishanth Menon struct ti_sci_dev_ops *dops = &ops->dev_ops; 28109f723220SNishanth Menon struct ti_sci_clk_ops *cops = &ops->clk_ops; 28119c19fb68SLokesh Vutla struct ti_sci_rm_core_ops *rm_core_ops = &ops->rm_core_ops; 2812997b001fSLokesh Vutla struct ti_sci_rm_irq_ops *iops = &ops->rm_irq_ops; 281368608b5eSPeter Ujfalusi struct ti_sci_rm_ringacc_ops *rops = &ops->rm_ring_ops; 281468608b5eSPeter Ujfalusi struct ti_sci_rm_psil_ops *psilops = &ops->rm_psil_ops; 281568608b5eSPeter Ujfalusi struct ti_sci_rm_udmap_ops *udmap_ops = &ops->rm_udmap_ops; 28161e407f33SSuman Anna struct ti_sci_proc_ops *pops = &ops->proc_ops; 28179e7d756dSNishanth Menon 2818912cffb4SNishanth Menon core_ops->reboot_device = ti_sci_cmd_core_reboot; 2819912cffb4SNishanth Menon 28209e7d756dSNishanth Menon dops->get_device = ti_sci_cmd_get_device; 282145b659eeSLokesh Vutla dops->get_device_exclusive = ti_sci_cmd_get_device_exclusive; 28229e7d756dSNishanth Menon dops->idle_device = ti_sci_cmd_idle_device; 282345b659eeSLokesh Vutla dops->idle_device_exclusive = ti_sci_cmd_idle_device_exclusive; 28249e7d756dSNishanth Menon dops->put_device = ti_sci_cmd_put_device; 28259e7d756dSNishanth Menon 28269e7d756dSNishanth Menon dops->is_valid = ti_sci_cmd_dev_is_valid; 28279e7d756dSNishanth Menon dops->get_context_loss_count = ti_sci_cmd_dev_get_clcnt; 28289e7d756dSNishanth Menon dops->is_idle = ti_sci_cmd_dev_is_idle; 28299e7d756dSNishanth Menon dops->is_stop = ti_sci_cmd_dev_is_stop; 28309e7d756dSNishanth Menon dops->is_on = ti_sci_cmd_dev_is_on; 28319e7d756dSNishanth Menon dops->is_transitioning = ti_sci_cmd_dev_is_trans; 28329e7d756dSNishanth Menon dops->set_device_resets = ti_sci_cmd_set_device_resets; 28339e7d756dSNishanth Menon dops->get_device_resets = ti_sci_cmd_get_device_resets; 28349f723220SNishanth Menon 28359f723220SNishanth Menon cops->get_clock = ti_sci_cmd_get_clock; 28369f723220SNishanth Menon cops->idle_clock = ti_sci_cmd_idle_clock; 28379f723220SNishanth Menon cops->put_clock = ti_sci_cmd_put_clock; 28389f723220SNishanth Menon cops->is_auto = ti_sci_cmd_clk_is_auto; 28399f723220SNishanth Menon cops->is_on = ti_sci_cmd_clk_is_on; 28409f723220SNishanth Menon cops->is_off = ti_sci_cmd_clk_is_off; 28419f723220SNishanth Menon 28429f723220SNishanth Menon cops->set_parent = ti_sci_cmd_clk_set_parent; 28439f723220SNishanth Menon cops->get_parent = ti_sci_cmd_clk_get_parent; 28449f723220SNishanth Menon cops->get_num_parents = ti_sci_cmd_clk_get_num_parents; 28459f723220SNishanth Menon 28469f723220SNishanth Menon cops->get_best_match_freq = ti_sci_cmd_clk_get_match_freq; 28479f723220SNishanth Menon cops->set_freq = ti_sci_cmd_clk_set_freq; 28489f723220SNishanth Menon cops->get_freq = ti_sci_cmd_clk_get_freq; 28499c19fb68SLokesh Vutla 28509c19fb68SLokesh Vutla rm_core_ops->get_range = ti_sci_cmd_get_resource_range; 28519c19fb68SLokesh Vutla rm_core_ops->get_range_from_shost = 28529c19fb68SLokesh Vutla ti_sci_cmd_get_resource_range_from_shost; 2853997b001fSLokesh Vutla 2854997b001fSLokesh Vutla iops->set_irq = ti_sci_cmd_set_irq; 2855997b001fSLokesh Vutla iops->set_event_map = ti_sci_cmd_set_event_map; 2856997b001fSLokesh Vutla iops->free_irq = ti_sci_cmd_free_irq; 2857997b001fSLokesh Vutla iops->free_event_map = ti_sci_cmd_free_event_map; 285868608b5eSPeter Ujfalusi 28593c201753SPeter Ujfalusi rops->set_cfg = ti_sci_cmd_rm_ring_cfg; 286068608b5eSPeter Ujfalusi 286168608b5eSPeter Ujfalusi psilops->pair = ti_sci_cmd_rm_psil_pair; 286268608b5eSPeter Ujfalusi psilops->unpair = ti_sci_cmd_rm_psil_unpair; 286368608b5eSPeter Ujfalusi 286468608b5eSPeter Ujfalusi udmap_ops->tx_ch_cfg = ti_sci_cmd_rm_udmap_tx_ch_cfg; 286568608b5eSPeter Ujfalusi udmap_ops->rx_ch_cfg = ti_sci_cmd_rm_udmap_rx_ch_cfg; 286668608b5eSPeter Ujfalusi udmap_ops->rx_flow_cfg = ti_sci_cmd_rm_udmap_rx_flow_cfg; 28671e407f33SSuman Anna 28681e407f33SSuman Anna pops->request = ti_sci_cmd_proc_request; 28691e407f33SSuman Anna pops->release = ti_sci_cmd_proc_release; 28701e407f33SSuman Anna pops->handover = ti_sci_cmd_proc_handover; 28711e407f33SSuman Anna pops->set_config = ti_sci_cmd_proc_set_config; 28721e407f33SSuman Anna pops->set_control = ti_sci_cmd_proc_set_control; 28731e407f33SSuman Anna pops->get_status = ti_sci_cmd_proc_get_status; 28749e7d756dSNishanth Menon } 28759e7d756dSNishanth Menon 28769e7d756dSNishanth Menon /** 2877aa276781SNishanth Menon * ti_sci_get_handle() - Get the TI SCI handle for a device 2878aa276781SNishanth Menon * @dev: Pointer to device for which we want SCI handle 2879aa276781SNishanth Menon * 2880aa276781SNishanth Menon * NOTE: The function does not track individual clients of the framework 2881aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2882aa276781SNishanth Menon * ti_sci_put_handle must be balanced with successful ti_sci_get_handle 2883aa276781SNishanth Menon * Return: pointer to handle if successful, else: 2884aa276781SNishanth Menon * -EPROBE_DEFER if the instance is not ready 2885aa276781SNishanth Menon * -ENODEV if the required node handler is missing 2886aa276781SNishanth Menon * -EINVAL if invalid conditions are encountered. 2887aa276781SNishanth Menon */ 2888aa276781SNishanth Menon const struct ti_sci_handle *ti_sci_get_handle(struct device *dev) 2889aa276781SNishanth Menon { 2890aa276781SNishanth Menon struct device_node *ti_sci_np; 2891aa276781SNishanth Menon struct list_head *p; 2892aa276781SNishanth Menon struct ti_sci_handle *handle = NULL; 2893aa276781SNishanth Menon struct ti_sci_info *info; 2894aa276781SNishanth Menon 2895aa276781SNishanth Menon if (!dev) { 2896aa276781SNishanth Menon pr_err("I need a device pointer\n"); 2897aa276781SNishanth Menon return ERR_PTR(-EINVAL); 2898aa276781SNishanth Menon } 2899aa276781SNishanth Menon ti_sci_np = of_get_parent(dev->of_node); 2900aa276781SNishanth Menon if (!ti_sci_np) { 2901aa276781SNishanth Menon dev_err(dev, "No OF information\n"); 2902aa276781SNishanth Menon return ERR_PTR(-EINVAL); 2903aa276781SNishanth Menon } 2904aa276781SNishanth Menon 2905aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 2906aa276781SNishanth Menon list_for_each(p, &ti_sci_list) { 2907aa276781SNishanth Menon info = list_entry(p, struct ti_sci_info, node); 2908aa276781SNishanth Menon if (ti_sci_np == info->dev->of_node) { 2909aa276781SNishanth Menon handle = &info->handle; 2910aa276781SNishanth Menon info->users++; 2911aa276781SNishanth Menon break; 2912aa276781SNishanth Menon } 2913aa276781SNishanth Menon } 2914aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 2915aa276781SNishanth Menon of_node_put(ti_sci_np); 2916aa276781SNishanth Menon 2917aa276781SNishanth Menon if (!handle) 2918aa276781SNishanth Menon return ERR_PTR(-EPROBE_DEFER); 2919aa276781SNishanth Menon 2920aa276781SNishanth Menon return handle; 2921aa276781SNishanth Menon } 2922aa276781SNishanth Menon EXPORT_SYMBOL_GPL(ti_sci_get_handle); 2923aa276781SNishanth Menon 2924aa276781SNishanth Menon /** 2925aa276781SNishanth Menon * ti_sci_put_handle() - Release the handle acquired by ti_sci_get_handle 2926aa276781SNishanth Menon * @handle: Handle acquired by ti_sci_get_handle 2927aa276781SNishanth Menon * 2928aa276781SNishanth Menon * NOTE: The function does not track individual clients of the framework 2929aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2930aa276781SNishanth Menon * ti_sci_put_handle must be balanced with successful ti_sci_get_handle 2931aa276781SNishanth Menon * 2932aa276781SNishanth Menon * Return: 0 is successfully released 2933aa276781SNishanth Menon * if an error pointer was passed, it returns the error value back, 2934aa276781SNishanth Menon * if null was passed, it returns -EINVAL; 2935aa276781SNishanth Menon */ 2936aa276781SNishanth Menon int ti_sci_put_handle(const struct ti_sci_handle *handle) 2937aa276781SNishanth Menon { 2938aa276781SNishanth Menon struct ti_sci_info *info; 2939aa276781SNishanth Menon 2940aa276781SNishanth Menon if (IS_ERR(handle)) 2941aa276781SNishanth Menon return PTR_ERR(handle); 2942aa276781SNishanth Menon if (!handle) 2943aa276781SNishanth Menon return -EINVAL; 2944aa276781SNishanth Menon 2945aa276781SNishanth Menon info = handle_to_ti_sci_info(handle); 2946aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 2947aa276781SNishanth Menon if (!WARN_ON(!info->users)) 2948aa276781SNishanth Menon info->users--; 2949aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 2950aa276781SNishanth Menon 2951aa276781SNishanth Menon return 0; 2952aa276781SNishanth Menon } 2953aa276781SNishanth Menon EXPORT_SYMBOL_GPL(ti_sci_put_handle); 2954aa276781SNishanth Menon 2955aa276781SNishanth Menon static void devm_ti_sci_release(struct device *dev, void *res) 2956aa276781SNishanth Menon { 2957aa276781SNishanth Menon const struct ti_sci_handle **ptr = res; 2958aa276781SNishanth Menon const struct ti_sci_handle *handle = *ptr; 2959aa276781SNishanth Menon int ret; 2960aa276781SNishanth Menon 2961aa276781SNishanth Menon ret = ti_sci_put_handle(handle); 2962aa276781SNishanth Menon if (ret) 2963aa276781SNishanth Menon dev_err(dev, "failed to put handle %d\n", ret); 2964aa276781SNishanth Menon } 2965aa276781SNishanth Menon 2966aa276781SNishanth Menon /** 2967aa276781SNishanth Menon * devm_ti_sci_get_handle() - Managed get handle 2968aa276781SNishanth Menon * @dev: device for which we want SCI handle for. 2969aa276781SNishanth Menon * 2970aa276781SNishanth Menon * NOTE: This releases the handle once the device resources are 2971aa276781SNishanth Menon * no longer needed. MUST NOT BE released with ti_sci_put_handle. 2972aa276781SNishanth Menon * The function does not track individual clients of the framework 2973aa276781SNishanth Menon * and is expected to be maintained by caller of TI SCI protocol library. 2974aa276781SNishanth Menon * 2975aa276781SNishanth Menon * Return: 0 if all went fine, else corresponding error. 2976aa276781SNishanth Menon */ 2977aa276781SNishanth Menon const struct ti_sci_handle *devm_ti_sci_get_handle(struct device *dev) 2978aa276781SNishanth Menon { 2979aa276781SNishanth Menon const struct ti_sci_handle **ptr; 2980aa276781SNishanth Menon const struct ti_sci_handle *handle; 2981aa276781SNishanth Menon 2982aa276781SNishanth Menon ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL); 2983aa276781SNishanth Menon if (!ptr) 2984aa276781SNishanth Menon return ERR_PTR(-ENOMEM); 2985aa276781SNishanth Menon handle = ti_sci_get_handle(dev); 2986aa276781SNishanth Menon 2987aa276781SNishanth Menon if (!IS_ERR(handle)) { 2988aa276781SNishanth Menon *ptr = handle; 2989aa276781SNishanth Menon devres_add(dev, ptr); 2990aa276781SNishanth Menon } else { 2991aa276781SNishanth Menon devres_free(ptr); 2992aa276781SNishanth Menon } 2993aa276781SNishanth Menon 2994aa276781SNishanth Menon return handle; 2995aa276781SNishanth Menon } 2996aa276781SNishanth Menon EXPORT_SYMBOL_GPL(devm_ti_sci_get_handle); 2997aa276781SNishanth Menon 2998905c3047SGrygorii Strashko /** 2999905c3047SGrygorii Strashko * ti_sci_get_by_phandle() - Get the TI SCI handle using DT phandle 3000905c3047SGrygorii Strashko * @np: device node 3001905c3047SGrygorii Strashko * @property: property name containing phandle on TISCI node 3002905c3047SGrygorii Strashko * 3003905c3047SGrygorii Strashko * NOTE: The function does not track individual clients of the framework 3004905c3047SGrygorii Strashko * and is expected to be maintained by caller of TI SCI protocol library. 3005905c3047SGrygorii Strashko * ti_sci_put_handle must be balanced with successful ti_sci_get_by_phandle 3006905c3047SGrygorii Strashko * Return: pointer to handle if successful, else: 3007905c3047SGrygorii Strashko * -EPROBE_DEFER if the instance is not ready 3008905c3047SGrygorii Strashko * -ENODEV if the required node handler is missing 3009905c3047SGrygorii Strashko * -EINVAL if invalid conditions are encountered. 3010905c3047SGrygorii Strashko */ 3011905c3047SGrygorii Strashko const struct ti_sci_handle *ti_sci_get_by_phandle(struct device_node *np, 3012905c3047SGrygorii Strashko const char *property) 3013905c3047SGrygorii Strashko { 3014905c3047SGrygorii Strashko struct ti_sci_handle *handle = NULL; 3015905c3047SGrygorii Strashko struct device_node *ti_sci_np; 3016905c3047SGrygorii Strashko struct ti_sci_info *info; 3017905c3047SGrygorii Strashko struct list_head *p; 3018905c3047SGrygorii Strashko 3019905c3047SGrygorii Strashko if (!np) { 3020905c3047SGrygorii Strashko pr_err("I need a device pointer\n"); 3021905c3047SGrygorii Strashko return ERR_PTR(-EINVAL); 3022905c3047SGrygorii Strashko } 3023905c3047SGrygorii Strashko 3024905c3047SGrygorii Strashko ti_sci_np = of_parse_phandle(np, property, 0); 3025905c3047SGrygorii Strashko if (!ti_sci_np) 3026905c3047SGrygorii Strashko return ERR_PTR(-ENODEV); 3027905c3047SGrygorii Strashko 3028905c3047SGrygorii Strashko mutex_lock(&ti_sci_list_mutex); 3029905c3047SGrygorii Strashko list_for_each(p, &ti_sci_list) { 3030905c3047SGrygorii Strashko info = list_entry(p, struct ti_sci_info, node); 3031905c3047SGrygorii Strashko if (ti_sci_np == info->dev->of_node) { 3032905c3047SGrygorii Strashko handle = &info->handle; 3033905c3047SGrygorii Strashko info->users++; 3034905c3047SGrygorii Strashko break; 3035905c3047SGrygorii Strashko } 3036905c3047SGrygorii Strashko } 3037905c3047SGrygorii Strashko mutex_unlock(&ti_sci_list_mutex); 3038905c3047SGrygorii Strashko of_node_put(ti_sci_np); 3039905c3047SGrygorii Strashko 3040905c3047SGrygorii Strashko if (!handle) 3041905c3047SGrygorii Strashko return ERR_PTR(-EPROBE_DEFER); 3042905c3047SGrygorii Strashko 3043905c3047SGrygorii Strashko return handle; 3044905c3047SGrygorii Strashko } 3045905c3047SGrygorii Strashko EXPORT_SYMBOL_GPL(ti_sci_get_by_phandle); 3046905c3047SGrygorii Strashko 3047905c3047SGrygorii Strashko /** 3048905c3047SGrygorii Strashko * devm_ti_sci_get_by_phandle() - Managed get handle using phandle 3049905c3047SGrygorii Strashko * @dev: Device pointer requesting TISCI handle 3050905c3047SGrygorii Strashko * @property: property name containing phandle on TISCI node 3051905c3047SGrygorii Strashko * 3052905c3047SGrygorii Strashko * NOTE: This releases the handle once the device resources are 3053905c3047SGrygorii Strashko * no longer needed. MUST NOT BE released with ti_sci_put_handle. 3054905c3047SGrygorii Strashko * The function does not track individual clients of the framework 3055905c3047SGrygorii Strashko * and is expected to be maintained by caller of TI SCI protocol library. 3056905c3047SGrygorii Strashko * 3057905c3047SGrygorii Strashko * Return: 0 if all went fine, else corresponding error. 3058905c3047SGrygorii Strashko */ 3059905c3047SGrygorii Strashko const struct ti_sci_handle *devm_ti_sci_get_by_phandle(struct device *dev, 3060905c3047SGrygorii Strashko const char *property) 3061905c3047SGrygorii Strashko { 3062905c3047SGrygorii Strashko const struct ti_sci_handle *handle; 3063905c3047SGrygorii Strashko const struct ti_sci_handle **ptr; 3064905c3047SGrygorii Strashko 3065905c3047SGrygorii Strashko ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL); 3066905c3047SGrygorii Strashko if (!ptr) 3067905c3047SGrygorii Strashko return ERR_PTR(-ENOMEM); 3068905c3047SGrygorii Strashko handle = ti_sci_get_by_phandle(dev_of_node(dev), property); 3069905c3047SGrygorii Strashko 3070905c3047SGrygorii Strashko if (!IS_ERR(handle)) { 3071905c3047SGrygorii Strashko *ptr = handle; 3072905c3047SGrygorii Strashko devres_add(dev, ptr); 3073905c3047SGrygorii Strashko } else { 3074905c3047SGrygorii Strashko devres_free(ptr); 3075905c3047SGrygorii Strashko } 3076905c3047SGrygorii Strashko 3077905c3047SGrygorii Strashko return handle; 3078905c3047SGrygorii Strashko } 3079905c3047SGrygorii Strashko EXPORT_SYMBOL_GPL(devm_ti_sci_get_by_phandle); 3080905c3047SGrygorii Strashko 3081032a1ec5SLokesh Vutla /** 3082032a1ec5SLokesh Vutla * ti_sci_get_free_resource() - Get a free resource from TISCI resource. 3083032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3084032a1ec5SLokesh Vutla * 3085032a1ec5SLokesh Vutla * Return: resource num if all went ok else TI_SCI_RESOURCE_NULL. 3086032a1ec5SLokesh Vutla */ 3087032a1ec5SLokesh Vutla u16 ti_sci_get_free_resource(struct ti_sci_resource *res) 3088032a1ec5SLokesh Vutla { 3089032a1ec5SLokesh Vutla unsigned long flags; 3090032a1ec5SLokesh Vutla u16 set, free_bit; 3091032a1ec5SLokesh Vutla 3092032a1ec5SLokesh Vutla raw_spin_lock_irqsave(&res->lock, flags); 3093032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) { 3094519c5c0cSPeter Ujfalusi struct ti_sci_resource_desc *desc = &res->desc[set]; 3095519c5c0cSPeter Ujfalusi int res_count = desc->num + desc->num_sec; 3096519c5c0cSPeter Ujfalusi 3097519c5c0cSPeter Ujfalusi free_bit = find_first_zero_bit(desc->res_map, res_count); 3098519c5c0cSPeter Ujfalusi if (free_bit != res_count) { 3099*4dc38832SChristophe JAILLET __set_bit(free_bit, desc->res_map); 3100032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3101519c5c0cSPeter Ujfalusi 3102519c5c0cSPeter Ujfalusi if (desc->num && free_bit < desc->num) 3103519c5c0cSPeter Ujfalusi return desc->start + free_bit; 3104519c5c0cSPeter Ujfalusi else 3105519c5c0cSPeter Ujfalusi return desc->start_sec + free_bit; 3106032a1ec5SLokesh Vutla } 3107032a1ec5SLokesh Vutla } 3108032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3109032a1ec5SLokesh Vutla 3110032a1ec5SLokesh Vutla return TI_SCI_RESOURCE_NULL; 3111032a1ec5SLokesh Vutla } 3112032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_get_free_resource); 3113032a1ec5SLokesh Vutla 3114032a1ec5SLokesh Vutla /** 3115032a1ec5SLokesh Vutla * ti_sci_release_resource() - Release a resource from TISCI resource. 3116032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3117032a1ec5SLokesh Vutla * @id: Resource id to be released. 3118032a1ec5SLokesh Vutla */ 3119032a1ec5SLokesh Vutla void ti_sci_release_resource(struct ti_sci_resource *res, u16 id) 3120032a1ec5SLokesh Vutla { 3121032a1ec5SLokesh Vutla unsigned long flags; 3122032a1ec5SLokesh Vutla u16 set; 3123032a1ec5SLokesh Vutla 3124032a1ec5SLokesh Vutla raw_spin_lock_irqsave(&res->lock, flags); 3125032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) { 3126519c5c0cSPeter Ujfalusi struct ti_sci_resource_desc *desc = &res->desc[set]; 3127519c5c0cSPeter Ujfalusi 3128519c5c0cSPeter Ujfalusi if (desc->num && desc->start <= id && 3129519c5c0cSPeter Ujfalusi (desc->start + desc->num) > id) 3130*4dc38832SChristophe JAILLET __clear_bit(id - desc->start, desc->res_map); 3131519c5c0cSPeter Ujfalusi else if (desc->num_sec && desc->start_sec <= id && 3132519c5c0cSPeter Ujfalusi (desc->start_sec + desc->num_sec) > id) 3133*4dc38832SChristophe JAILLET __clear_bit(id - desc->start_sec, desc->res_map); 3134032a1ec5SLokesh Vutla } 3135032a1ec5SLokesh Vutla raw_spin_unlock_irqrestore(&res->lock, flags); 3136032a1ec5SLokesh Vutla } 3137032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_release_resource); 3138032a1ec5SLokesh Vutla 3139032a1ec5SLokesh Vutla /** 3140032a1ec5SLokesh Vutla * ti_sci_get_num_resources() - Get the number of resources in TISCI resource 3141032a1ec5SLokesh Vutla * @res: Pointer to the TISCI resource 3142032a1ec5SLokesh Vutla * 3143032a1ec5SLokesh Vutla * Return: Total number of available resources. 3144032a1ec5SLokesh Vutla */ 3145032a1ec5SLokesh Vutla u32 ti_sci_get_num_resources(struct ti_sci_resource *res) 3146032a1ec5SLokesh Vutla { 3147032a1ec5SLokesh Vutla u32 set, count = 0; 3148032a1ec5SLokesh Vutla 3149032a1ec5SLokesh Vutla for (set = 0; set < res->sets; set++) 3150519c5c0cSPeter Ujfalusi count += res->desc[set].num + res->desc[set].num_sec; 3151032a1ec5SLokesh Vutla 3152032a1ec5SLokesh Vutla return count; 3153032a1ec5SLokesh Vutla } 3154032a1ec5SLokesh Vutla EXPORT_SYMBOL_GPL(ti_sci_get_num_resources); 3155032a1ec5SLokesh Vutla 3156032a1ec5SLokesh Vutla /** 315753bf2b0eSLokesh Vutla * devm_ti_sci_get_resource_sets() - Get a TISCI resources assigned to a device 3158032a1ec5SLokesh Vutla * @handle: TISCI handle 3159032a1ec5SLokesh Vutla * @dev: Device pointer to which the resource is assigned 3160032a1ec5SLokesh Vutla * @dev_id: TISCI device id to which the resource is assigned 316153bf2b0eSLokesh Vutla * @sub_types: Array of sub_types assigned corresponding to device 316253bf2b0eSLokesh Vutla * @sets: Number of sub_types 3163032a1ec5SLokesh Vutla * 3164032a1ec5SLokesh Vutla * Return: Pointer to ti_sci_resource if all went well else appropriate 3165032a1ec5SLokesh Vutla * error pointer. 3166032a1ec5SLokesh Vutla */ 316753bf2b0eSLokesh Vutla static struct ti_sci_resource * 316853bf2b0eSLokesh Vutla devm_ti_sci_get_resource_sets(const struct ti_sci_handle *handle, 316953bf2b0eSLokesh Vutla struct device *dev, u32 dev_id, u32 *sub_types, 317053bf2b0eSLokesh Vutla u32 sets) 3171032a1ec5SLokesh Vutla { 3172032a1ec5SLokesh Vutla struct ti_sci_resource *res; 3173fa42da11SPeter Ujfalusi bool valid_set = false; 3174519c5c0cSPeter Ujfalusi int i, ret, res_count; 3175032a1ec5SLokesh Vutla 3176032a1ec5SLokesh Vutla res = devm_kzalloc(dev, sizeof(*res), GFP_KERNEL); 3177032a1ec5SLokesh Vutla if (!res) 3178032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3179032a1ec5SLokesh Vutla 318053bf2b0eSLokesh Vutla res->sets = sets; 3181032a1ec5SLokesh Vutla res->desc = devm_kcalloc(dev, res->sets, sizeof(*res->desc), 3182032a1ec5SLokesh Vutla GFP_KERNEL); 3183032a1ec5SLokesh Vutla if (!res->desc) 3184032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3185032a1ec5SLokesh Vutla 3186032a1ec5SLokesh Vutla for (i = 0; i < res->sets; i++) { 3187032a1ec5SLokesh Vutla ret = handle->ops.rm_core_ops.get_range(handle, dev_id, 318853bf2b0eSLokesh Vutla sub_types[i], 3189967a020bSPeter Ujfalusi &res->desc[i]); 3190032a1ec5SLokesh Vutla if (ret) { 3191fa42da11SPeter Ujfalusi dev_dbg(dev, "dev = %d subtype %d not allocated for this host\n", 319253bf2b0eSLokesh Vutla dev_id, sub_types[i]); 3193519c5c0cSPeter Ujfalusi memset(&res->desc[i], 0, sizeof(res->desc[i])); 3194fa42da11SPeter Ujfalusi continue; 3195032a1ec5SLokesh Vutla } 3196032a1ec5SLokesh Vutla 3197519c5c0cSPeter Ujfalusi dev_dbg(dev, "dev/sub_type: %d/%d, start/num: %d/%d | %d/%d\n", 319853bf2b0eSLokesh Vutla dev_id, sub_types[i], res->desc[i].start, 3199519c5c0cSPeter Ujfalusi res->desc[i].num, res->desc[i].start_sec, 3200519c5c0cSPeter Ujfalusi res->desc[i].num_sec); 3201032a1ec5SLokesh Vutla 3202fa42da11SPeter Ujfalusi valid_set = true; 3203519c5c0cSPeter Ujfalusi res_count = res->desc[i].num + res->desc[i].num_sec; 32042f9b0402SChristophe JAILLET res->desc[i].res_map = devm_bitmap_zalloc(dev, res_count, 32052f9b0402SChristophe JAILLET GFP_KERNEL); 3206032a1ec5SLokesh Vutla if (!res->desc[i].res_map) 3207032a1ec5SLokesh Vutla return ERR_PTR(-ENOMEM); 3208032a1ec5SLokesh Vutla } 3209032a1ec5SLokesh Vutla raw_spin_lock_init(&res->lock); 3210032a1ec5SLokesh Vutla 3211fa42da11SPeter Ujfalusi if (valid_set) 3212032a1ec5SLokesh Vutla return res; 3213fa42da11SPeter Ujfalusi 3214fa42da11SPeter Ujfalusi return ERR_PTR(-EINVAL); 3215032a1ec5SLokesh Vutla } 3216032a1ec5SLokesh Vutla 321753bf2b0eSLokesh Vutla /** 321853bf2b0eSLokesh Vutla * devm_ti_sci_get_of_resource() - Get a TISCI resource assigned to a device 321953bf2b0eSLokesh Vutla * @handle: TISCI handle 322053bf2b0eSLokesh Vutla * @dev: Device pointer to which the resource is assigned 322153bf2b0eSLokesh Vutla * @dev_id: TISCI device id to which the resource is assigned 322253bf2b0eSLokesh Vutla * @of_prop: property name by which the resource are represented 322353bf2b0eSLokesh Vutla * 322453bf2b0eSLokesh Vutla * Return: Pointer to ti_sci_resource if all went well else appropriate 322553bf2b0eSLokesh Vutla * error pointer. 322653bf2b0eSLokesh Vutla */ 322753bf2b0eSLokesh Vutla struct ti_sci_resource * 322853bf2b0eSLokesh Vutla devm_ti_sci_get_of_resource(const struct ti_sci_handle *handle, 322953bf2b0eSLokesh Vutla struct device *dev, u32 dev_id, char *of_prop) 323053bf2b0eSLokesh Vutla { 323153bf2b0eSLokesh Vutla struct ti_sci_resource *res; 323253bf2b0eSLokesh Vutla u32 *sub_types; 323353bf2b0eSLokesh Vutla int sets; 323453bf2b0eSLokesh Vutla 323553bf2b0eSLokesh Vutla sets = of_property_count_elems_of_size(dev_of_node(dev), of_prop, 323653bf2b0eSLokesh Vutla sizeof(u32)); 323753bf2b0eSLokesh Vutla if (sets < 0) { 323853bf2b0eSLokesh Vutla dev_err(dev, "%s resource type ids not available\n", of_prop); 323953bf2b0eSLokesh Vutla return ERR_PTR(sets); 324053bf2b0eSLokesh Vutla } 324153bf2b0eSLokesh Vutla 324253bf2b0eSLokesh Vutla sub_types = kcalloc(sets, sizeof(*sub_types), GFP_KERNEL); 324353bf2b0eSLokesh Vutla if (!sub_types) 324453bf2b0eSLokesh Vutla return ERR_PTR(-ENOMEM); 324553bf2b0eSLokesh Vutla 324653bf2b0eSLokesh Vutla of_property_read_u32_array(dev_of_node(dev), of_prop, sub_types, sets); 324753bf2b0eSLokesh Vutla res = devm_ti_sci_get_resource_sets(handle, dev, dev_id, sub_types, 324853bf2b0eSLokesh Vutla sets); 324953bf2b0eSLokesh Vutla 325053bf2b0eSLokesh Vutla kfree(sub_types); 325153bf2b0eSLokesh Vutla return res; 325253bf2b0eSLokesh Vutla } 325353bf2b0eSLokesh Vutla EXPORT_SYMBOL_GPL(devm_ti_sci_get_of_resource); 325453bf2b0eSLokesh Vutla 325553bf2b0eSLokesh Vutla /** 325653bf2b0eSLokesh Vutla * devm_ti_sci_get_resource() - Get a resource range assigned to the device 325753bf2b0eSLokesh Vutla * @handle: TISCI handle 325853bf2b0eSLokesh Vutla * @dev: Device pointer to which the resource is assigned 325953bf2b0eSLokesh Vutla * @dev_id: TISCI device id to which the resource is assigned 326053bf2b0eSLokesh Vutla * @suub_type: TISCI resource subytpe representing the resource. 326153bf2b0eSLokesh Vutla * 326253bf2b0eSLokesh Vutla * Return: Pointer to ti_sci_resource if all went well else appropriate 326353bf2b0eSLokesh Vutla * error pointer. 326453bf2b0eSLokesh Vutla */ 326553bf2b0eSLokesh Vutla struct ti_sci_resource * 326653bf2b0eSLokesh Vutla devm_ti_sci_get_resource(const struct ti_sci_handle *handle, struct device *dev, 326753bf2b0eSLokesh Vutla u32 dev_id, u32 sub_type) 326853bf2b0eSLokesh Vutla { 326953bf2b0eSLokesh Vutla return devm_ti_sci_get_resource_sets(handle, dev, dev_id, &sub_type, 1); 327053bf2b0eSLokesh Vutla } 327153bf2b0eSLokesh Vutla EXPORT_SYMBOL_GPL(devm_ti_sci_get_resource); 327253bf2b0eSLokesh Vutla 3273912cffb4SNishanth Menon static int tisci_reboot_handler(struct notifier_block *nb, unsigned long mode, 3274912cffb4SNishanth Menon void *cmd) 3275912cffb4SNishanth Menon { 3276912cffb4SNishanth Menon struct ti_sci_info *info = reboot_to_ti_sci_info(nb); 3277912cffb4SNishanth Menon const struct ti_sci_handle *handle = &info->handle; 3278912cffb4SNishanth Menon 3279912cffb4SNishanth Menon ti_sci_cmd_core_reboot(handle); 3280912cffb4SNishanth Menon 3281912cffb4SNishanth Menon /* call fail OR pass, we should not be here in the first place */ 3282912cffb4SNishanth Menon return NOTIFY_BAD; 3283912cffb4SNishanth Menon } 3284912cffb4SNishanth Menon 3285b9e8a7d9SDave Gerlach static void ti_sci_set_is_suspending(struct ti_sci_info *info, bool is_suspending) 3286b9e8a7d9SDave Gerlach { 3287b9e8a7d9SDave Gerlach info->is_suspending = is_suspending; 3288b9e8a7d9SDave Gerlach } 3289b9e8a7d9SDave Gerlach 3290b9e8a7d9SDave Gerlach static int ti_sci_suspend(struct device *dev) 3291b9e8a7d9SDave Gerlach { 3292b9e8a7d9SDave Gerlach struct ti_sci_info *info = dev_get_drvdata(dev); 3293b9e8a7d9SDave Gerlach /* 3294b9e8a7d9SDave Gerlach * We must switch operation to polled mode now as drivers and the genpd 3295b9e8a7d9SDave Gerlach * layer may make late TI SCI calls to change clock and device states 3296b9e8a7d9SDave Gerlach * from the noirq phase of suspend. 3297b9e8a7d9SDave Gerlach */ 3298b9e8a7d9SDave Gerlach ti_sci_set_is_suspending(info, true); 3299b9e8a7d9SDave Gerlach 3300b9e8a7d9SDave Gerlach return 0; 3301b9e8a7d9SDave Gerlach } 3302b9e8a7d9SDave Gerlach 3303b9e8a7d9SDave Gerlach static int ti_sci_resume(struct device *dev) 3304b9e8a7d9SDave Gerlach { 3305b9e8a7d9SDave Gerlach struct ti_sci_info *info = dev_get_drvdata(dev); 3306b9e8a7d9SDave Gerlach 3307b9e8a7d9SDave Gerlach ti_sci_set_is_suspending(info, false); 3308b9e8a7d9SDave Gerlach 3309b9e8a7d9SDave Gerlach return 0; 3310b9e8a7d9SDave Gerlach } 3311b9e8a7d9SDave Gerlach 3312b9e8a7d9SDave Gerlach static DEFINE_SIMPLE_DEV_PM_OPS(ti_sci_pm_ops, ti_sci_suspend, ti_sci_resume); 3313b9e8a7d9SDave Gerlach 3314aa276781SNishanth Menon /* Description for K2G */ 3315aa276781SNishanth Menon static const struct ti_sci_desc ti_sci_pmmc_k2g_desc = { 3316e69a3553SNishanth Menon .default_host_id = 2, 3317aa276781SNishanth Menon /* Conservative duration */ 3318aa276781SNishanth Menon .max_rx_timeout_ms = 1000, 3319aa276781SNishanth Menon /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */ 3320aa276781SNishanth Menon .max_msgs = 20, 3321aa276781SNishanth Menon .max_msg_size = 64, 3322754c9477SPeter Ujfalusi }; 3323754c9477SPeter Ujfalusi 3324754c9477SPeter Ujfalusi /* Description for AM654 */ 3325754c9477SPeter Ujfalusi static const struct ti_sci_desc ti_sci_pmmc_am654_desc = { 3326754c9477SPeter Ujfalusi .default_host_id = 12, 3327754c9477SPeter Ujfalusi /* Conservative duration */ 3328754c9477SPeter Ujfalusi .max_rx_timeout_ms = 10000, 3329754c9477SPeter Ujfalusi /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */ 3330754c9477SPeter Ujfalusi .max_msgs = 20, 3331754c9477SPeter Ujfalusi .max_msg_size = 60, 3332aa276781SNishanth Menon }; 3333aa276781SNishanth Menon 3334aa276781SNishanth Menon static const struct of_device_id ti_sci_of_match[] = { 3335aa276781SNishanth Menon {.compatible = "ti,k2g-sci", .data = &ti_sci_pmmc_k2g_desc}, 3336754c9477SPeter Ujfalusi {.compatible = "ti,am654-sci", .data = &ti_sci_pmmc_am654_desc}, 3337aa276781SNishanth Menon { /* Sentinel */ }, 3338aa276781SNishanth Menon }; 3339aa276781SNishanth Menon MODULE_DEVICE_TABLE(of, ti_sci_of_match); 3340aa276781SNishanth Menon 3341aa276781SNishanth Menon static int ti_sci_probe(struct platform_device *pdev) 3342aa276781SNishanth Menon { 3343aa276781SNishanth Menon struct device *dev = &pdev->dev; 3344aa276781SNishanth Menon const struct of_device_id *of_id; 3345aa276781SNishanth Menon const struct ti_sci_desc *desc; 3346aa276781SNishanth Menon struct ti_sci_xfer *xfer; 3347aa276781SNishanth Menon struct ti_sci_info *info = NULL; 3348aa276781SNishanth Menon struct ti_sci_xfers_info *minfo; 3349aa276781SNishanth Menon struct mbox_client *cl; 3350aa276781SNishanth Menon int ret = -EINVAL; 3351aa276781SNishanth Menon int i; 3352912cffb4SNishanth Menon int reboot = 0; 3353e69a3553SNishanth Menon u32 h_id; 3354aa276781SNishanth Menon 3355aa276781SNishanth Menon of_id = of_match_device(ti_sci_of_match, dev); 3356aa276781SNishanth Menon if (!of_id) { 3357aa276781SNishanth Menon dev_err(dev, "OF data missing\n"); 3358aa276781SNishanth Menon return -EINVAL; 3359aa276781SNishanth Menon } 3360aa276781SNishanth Menon desc = of_id->data; 3361aa276781SNishanth Menon 3362aa276781SNishanth Menon info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL); 3363aa276781SNishanth Menon if (!info) 3364aa276781SNishanth Menon return -ENOMEM; 3365aa276781SNishanth Menon 3366aa276781SNishanth Menon info->dev = dev; 3367aa276781SNishanth Menon info->desc = desc; 3368e69a3553SNishanth Menon ret = of_property_read_u32(dev->of_node, "ti,host-id", &h_id); 3369e69a3553SNishanth Menon /* if the property is not present in DT, use a default from desc */ 3370e69a3553SNishanth Menon if (ret < 0) { 3371e69a3553SNishanth Menon info->host_id = info->desc->default_host_id; 3372e69a3553SNishanth Menon } else { 3373e69a3553SNishanth Menon if (!h_id) { 3374e69a3553SNishanth Menon dev_warn(dev, "Host ID 0 is reserved for firmware\n"); 3375e69a3553SNishanth Menon info->host_id = info->desc->default_host_id; 3376e69a3553SNishanth Menon } else { 3377e69a3553SNishanth Menon info->host_id = h_id; 3378e69a3553SNishanth Menon } 3379e69a3553SNishanth Menon } 3380e69a3553SNishanth Menon 3381912cffb4SNishanth Menon reboot = of_property_read_bool(dev->of_node, 3382912cffb4SNishanth Menon "ti,system-reboot-controller"); 3383aa276781SNishanth Menon INIT_LIST_HEAD(&info->node); 3384aa276781SNishanth Menon minfo = &info->minfo; 3385aa276781SNishanth Menon 3386aa276781SNishanth Menon /* 3387aa276781SNishanth Menon * Pre-allocate messages 3388aa276781SNishanth Menon * NEVER allocate more than what we can indicate in hdr.seq 3389aa276781SNishanth Menon * if we have data description bug, force a fix.. 3390aa276781SNishanth Menon */ 3391aa276781SNishanth Menon if (WARN_ON(desc->max_msgs >= 3392aa276781SNishanth Menon 1 << 8 * sizeof(((struct ti_sci_msg_hdr *)0)->seq))) 3393aa276781SNishanth Menon return -EINVAL; 3394aa276781SNishanth Menon 3395aa276781SNishanth Menon minfo->xfer_block = devm_kcalloc(dev, 3396aa276781SNishanth Menon desc->max_msgs, 3397aa276781SNishanth Menon sizeof(*minfo->xfer_block), 3398aa276781SNishanth Menon GFP_KERNEL); 3399aa276781SNishanth Menon if (!minfo->xfer_block) 3400aa276781SNishanth Menon return -ENOMEM; 3401aa276781SNishanth Menon 3402a86854d0SKees Cook minfo->xfer_alloc_table = devm_kcalloc(dev, 3403a86854d0SKees Cook BITS_TO_LONGS(desc->max_msgs), 3404a86854d0SKees Cook sizeof(unsigned long), 3405aa276781SNishanth Menon GFP_KERNEL); 3406aa276781SNishanth Menon if (!minfo->xfer_alloc_table) 3407aa276781SNishanth Menon return -ENOMEM; 3408aa276781SNishanth Menon bitmap_zero(minfo->xfer_alloc_table, desc->max_msgs); 3409aa276781SNishanth Menon 3410aa276781SNishanth Menon /* Pre-initialize the buffer pointer to pre-allocated buffers */ 3411aa276781SNishanth Menon for (i = 0, xfer = minfo->xfer_block; i < desc->max_msgs; i++, xfer++) { 3412aa276781SNishanth Menon xfer->xfer_buf = devm_kcalloc(dev, 1, desc->max_msg_size, 3413aa276781SNishanth Menon GFP_KERNEL); 3414aa276781SNishanth Menon if (!xfer->xfer_buf) 3415aa276781SNishanth Menon return -ENOMEM; 3416aa276781SNishanth Menon 3417aa276781SNishanth Menon xfer->tx_message.buf = xfer->xfer_buf; 3418aa276781SNishanth Menon init_completion(&xfer->done); 3419aa276781SNishanth Menon } 3420aa276781SNishanth Menon 3421aa276781SNishanth Menon ret = ti_sci_debugfs_create(pdev, info); 3422aa276781SNishanth Menon if (ret) 3423aa276781SNishanth Menon dev_warn(dev, "Failed to create debug file\n"); 3424aa276781SNishanth Menon 3425aa276781SNishanth Menon platform_set_drvdata(pdev, info); 3426aa276781SNishanth Menon 3427aa276781SNishanth Menon cl = &info->cl; 3428aa276781SNishanth Menon cl->dev = dev; 3429aa276781SNishanth Menon cl->tx_block = false; 3430aa276781SNishanth Menon cl->rx_callback = ti_sci_rx_callback; 3431aa276781SNishanth Menon cl->knows_txdone = true; 3432aa276781SNishanth Menon 3433aa276781SNishanth Menon spin_lock_init(&minfo->xfer_lock); 3434aa276781SNishanth Menon sema_init(&minfo->sem_xfer_count, desc->max_msgs); 3435aa276781SNishanth Menon 3436aa276781SNishanth Menon info->chan_rx = mbox_request_channel_byname(cl, "rx"); 3437aa276781SNishanth Menon if (IS_ERR(info->chan_rx)) { 3438aa276781SNishanth Menon ret = PTR_ERR(info->chan_rx); 3439aa276781SNishanth Menon goto out; 3440aa276781SNishanth Menon } 3441aa276781SNishanth Menon 3442aa276781SNishanth Menon info->chan_tx = mbox_request_channel_byname(cl, "tx"); 3443aa276781SNishanth Menon if (IS_ERR(info->chan_tx)) { 3444aa276781SNishanth Menon ret = PTR_ERR(info->chan_tx); 3445aa276781SNishanth Menon goto out; 3446aa276781SNishanth Menon } 3447aa276781SNishanth Menon ret = ti_sci_cmd_get_revision(info); 3448aa276781SNishanth Menon if (ret) { 3449aa276781SNishanth Menon dev_err(dev, "Unable to communicate with TISCI(%d)\n", ret); 3450aa276781SNishanth Menon goto out; 3451aa276781SNishanth Menon } 3452aa276781SNishanth Menon 34539e7d756dSNishanth Menon ti_sci_setup_ops(info); 34549e7d756dSNishanth Menon 3455912cffb4SNishanth Menon if (reboot) { 3456912cffb4SNishanth Menon info->nb.notifier_call = tisci_reboot_handler; 3457912cffb4SNishanth Menon info->nb.priority = 128; 3458912cffb4SNishanth Menon 3459912cffb4SNishanth Menon ret = register_restart_handler(&info->nb); 3460912cffb4SNishanth Menon if (ret) { 3461912cffb4SNishanth Menon dev_err(dev, "reboot registration fail(%d)\n", ret); 3462a181bcfcSPeiwei Hu goto out; 3463912cffb4SNishanth Menon } 3464912cffb4SNishanth Menon } 3465912cffb4SNishanth Menon 3466aa276781SNishanth Menon dev_info(dev, "ABI: %d.%d (firmware rev 0x%04x '%s')\n", 3467aa276781SNishanth Menon info->handle.version.abi_major, info->handle.version.abi_minor, 3468aa276781SNishanth Menon info->handle.version.firmware_revision, 3469aa276781SNishanth Menon info->handle.version.firmware_description); 3470aa276781SNishanth Menon 3471aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 3472aa276781SNishanth Menon list_add_tail(&info->node, &ti_sci_list); 3473aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 3474aa276781SNishanth Menon 3475aa276781SNishanth Menon return of_platform_populate(dev->of_node, NULL, NULL, dev); 3476aa276781SNishanth Menon out: 3477aa276781SNishanth Menon if (!IS_ERR(info->chan_tx)) 3478aa276781SNishanth Menon mbox_free_channel(info->chan_tx); 3479aa276781SNishanth Menon if (!IS_ERR(info->chan_rx)) 3480aa276781SNishanth Menon mbox_free_channel(info->chan_rx); 3481aa276781SNishanth Menon debugfs_remove(info->d); 3482aa276781SNishanth Menon return ret; 3483aa276781SNishanth Menon } 3484aa276781SNishanth Menon 3485aa276781SNishanth Menon static int ti_sci_remove(struct platform_device *pdev) 3486aa276781SNishanth Menon { 3487aa276781SNishanth Menon struct ti_sci_info *info; 3488aa276781SNishanth Menon struct device *dev = &pdev->dev; 3489aa276781SNishanth Menon int ret = 0; 3490aa276781SNishanth Menon 3491aa276781SNishanth Menon of_platform_depopulate(dev); 3492aa276781SNishanth Menon 3493aa276781SNishanth Menon info = platform_get_drvdata(pdev); 3494aa276781SNishanth Menon 3495912cffb4SNishanth Menon if (info->nb.notifier_call) 3496912cffb4SNishanth Menon unregister_restart_handler(&info->nb); 3497912cffb4SNishanth Menon 3498aa276781SNishanth Menon mutex_lock(&ti_sci_list_mutex); 3499aa276781SNishanth Menon if (info->users) 3500aa276781SNishanth Menon ret = -EBUSY; 3501aa276781SNishanth Menon else 3502aa276781SNishanth Menon list_del(&info->node); 3503aa276781SNishanth Menon mutex_unlock(&ti_sci_list_mutex); 3504aa276781SNishanth Menon 3505aa276781SNishanth Menon if (!ret) { 3506aa276781SNishanth Menon ti_sci_debugfs_destroy(pdev, info); 3507aa276781SNishanth Menon 3508aa276781SNishanth Menon /* Safe to free channels since no more users */ 3509aa276781SNishanth Menon mbox_free_channel(info->chan_tx); 3510aa276781SNishanth Menon mbox_free_channel(info->chan_rx); 3511aa276781SNishanth Menon } 3512aa276781SNishanth Menon 3513aa276781SNishanth Menon return ret; 3514aa276781SNishanth Menon } 3515aa276781SNishanth Menon 3516aa276781SNishanth Menon static struct platform_driver ti_sci_driver = { 3517aa276781SNishanth Menon .probe = ti_sci_probe, 3518aa276781SNishanth Menon .remove = ti_sci_remove, 3519aa276781SNishanth Menon .driver = { 3520aa276781SNishanth Menon .name = "ti-sci", 3521aa276781SNishanth Menon .of_match_table = of_match_ptr(ti_sci_of_match), 3522b9e8a7d9SDave Gerlach .pm = &ti_sci_pm_ops, 3523aa276781SNishanth Menon }, 3524aa276781SNishanth Menon }; 3525aa276781SNishanth Menon module_platform_driver(ti_sci_driver); 3526aa276781SNishanth Menon 3527aa276781SNishanth Menon MODULE_LICENSE("GPL v2"); 3528aa276781SNishanth Menon MODULE_DESCRIPTION("TI System Control Interface(SCI) driver"); 3529aa276781SNishanth Menon MODULE_AUTHOR("Nishanth Menon"); 3530aa276781SNishanth Menon MODULE_ALIAS("platform:ti-sci"); 3531