linux/drivers/firmware/ti_sci.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * Texas Instruments System Control Interface Protocol Driver
   4 *
   5 * Copyright (C) 2015-2016 Texas Instruments Incorporated - https://www.ti.com/
   6 *      Nishanth Menon
   7 */
   8
   9#define pr_fmt(fmt) "%s: " fmt, __func__
  10
  11#include <linux/bitmap.h>
  12#include <linux/debugfs.h>
  13#include <linux/export.h>
  14#include <linux/io.h>
  15#include <linux/kernel.h>
  16#include <linux/mailbox_client.h>
  17#include <linux/module.h>
  18#include <linux/of_device.h>
  19#include <linux/semaphore.h>
  20#include <linux/slab.h>
  21#include <linux/soc/ti/ti-msgmgr.h>
  22#include <linux/soc/ti/ti_sci_protocol.h>
  23#include <linux/reboot.h>
  24
  25#include "ti_sci.h"
  26
  27/* List of all TI SCI devices active in system */
  28static LIST_HEAD(ti_sci_list);
  29/* Protection for the entire list */
  30static DEFINE_MUTEX(ti_sci_list_mutex);
  31
  32/**
  33 * struct ti_sci_xfer - Structure representing a message flow
  34 * @tx_message: Transmit message
  35 * @rx_len:     Receive message length
  36 * @xfer_buf:   Preallocated buffer to store receive message
  37 *              Since we work with request-ACK protocol, we can
  38 *              reuse the same buffer for the rx path as we
  39 *              use for the tx path.
  40 * @done:       completion event
  41 */
  42struct ti_sci_xfer {
  43        struct ti_msgmgr_message tx_message;
  44        u8 rx_len;
  45        u8 *xfer_buf;
  46        struct completion done;
  47};
  48
  49/**
  50 * struct ti_sci_xfers_info - Structure to manage transfer information
  51 * @sem_xfer_count:     Counting Semaphore for managing max simultaneous
  52 *                      Messages.
  53 * @xfer_block:         Preallocated Message array
  54 * @xfer_alloc_table:   Bitmap table for allocated messages.
  55 *                      Index of this bitmap table is also used for message
  56 *                      sequence identifier.
  57 * @xfer_lock:          Protection for message allocation
  58 */
  59struct ti_sci_xfers_info {
  60        struct semaphore sem_xfer_count;
  61        struct ti_sci_xfer *xfer_block;
  62        unsigned long *xfer_alloc_table;
  63        /* protect transfer allocation */
  64        spinlock_t xfer_lock;
  65};
  66
  67/**
  68 * struct ti_sci_desc - Description of SoC integration
  69 * @default_host_id:    Host identifier representing the compute entity
  70 * @max_rx_timeout_ms:  Timeout for communication with SoC (in Milliseconds)
  71 * @max_msgs: Maximum number of messages that can be pending
  72 *                simultaneously in the system
  73 * @max_msg_size: Maximum size of data per message that can be handled.
  74 */
  75struct ti_sci_desc {
  76        u8 default_host_id;
  77        int max_rx_timeout_ms;
  78        int max_msgs;
  79        int max_msg_size;
  80};
  81
  82/**
  83 * struct ti_sci_info - Structure representing a TI SCI instance
  84 * @dev:        Device pointer
  85 * @desc:       SoC description for this instance
  86 * @nb: Reboot Notifier block
  87 * @d:          Debugfs file entry
  88 * @debug_region: Memory region where the debug message are available
  89 * @debug_region_size: Debug region size
  90 * @debug_buffer: Buffer allocated to copy debug messages.
  91 * @handle:     Instance of TI SCI handle to send to clients.
  92 * @cl:         Mailbox Client
  93 * @chan_tx:    Transmit mailbox channel
  94 * @chan_rx:    Receive mailbox channel
  95 * @minfo:      Message info
  96 * @node:       list head
  97 * @host_id:    Host ID
  98 * @users:      Number of users of this instance
  99 */
 100struct ti_sci_info {
 101        struct device *dev;
 102        struct notifier_block nb;
 103        const struct ti_sci_desc *desc;
 104        struct dentry *d;
 105        void __iomem *debug_region;
 106        char *debug_buffer;
 107        size_t debug_region_size;
 108        struct ti_sci_handle handle;
 109        struct mbox_client cl;
 110        struct mbox_chan *chan_tx;
 111        struct mbox_chan *chan_rx;
 112        struct ti_sci_xfers_info minfo;
 113        struct list_head node;
 114        u8 host_id;
 115        /* protected by ti_sci_list_mutex */
 116        int users;
 117
 118};
 119
 120#define cl_to_ti_sci_info(c)    container_of(c, struct ti_sci_info, cl)
 121#define handle_to_ti_sci_info(h) container_of(h, struct ti_sci_info, handle)
 122#define reboot_to_ti_sci_info(n) container_of(n, struct ti_sci_info, nb)
 123
 124#ifdef CONFIG_DEBUG_FS
 125
 126/**
 127 * ti_sci_debug_show() - Helper to dump the debug log
 128 * @s:  sequence file pointer
 129 * @unused:     unused.
 130 *
 131 * Return: 0
 132 */
 133static int ti_sci_debug_show(struct seq_file *s, void *unused)
 134{
 135        struct ti_sci_info *info = s->private;
 136
 137        memcpy_fromio(info->debug_buffer, info->debug_region,
 138                      info->debug_region_size);
 139        /*
 140         * We don't trust firmware to leave NULL terminated last byte (hence
 141         * we have allocated 1 extra 0 byte). Since we cannot guarantee any
 142         * specific data format for debug messages, We just present the data
 143         * in the buffer as is - we expect the messages to be self explanatory.
 144         */
 145        seq_puts(s, info->debug_buffer);
 146        return 0;
 147}
 148
 149/* Provide the log file operations interface*/
 150DEFINE_SHOW_ATTRIBUTE(ti_sci_debug);
 151
 152/**
 153 * ti_sci_debugfs_create() - Create log debug file
 154 * @pdev:       platform device pointer
 155 * @info:       Pointer to SCI entity information
 156 *
 157 * Return: 0 if all went fine, else corresponding error.
 158 */
 159static int ti_sci_debugfs_create(struct platform_device *pdev,
 160                                 struct ti_sci_info *info)
 161{
 162        struct device *dev = &pdev->dev;
 163        struct resource *res;
 164        char debug_name[50] = "ti_sci_debug@";
 165
 166        /* Debug region is optional */
 167        res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
 168                                           "debug_messages");
 169        info->debug_region = devm_ioremap_resource(dev, res);
 170        if (IS_ERR(info->debug_region))
 171                return 0;
 172        info->debug_region_size = resource_size(res);
 173
 174        info->debug_buffer = devm_kcalloc(dev, info->debug_region_size + 1,
 175                                          sizeof(char), GFP_KERNEL);
 176        if (!info->debug_buffer)
 177                return -ENOMEM;
 178        /* Setup NULL termination */
 179        info->debug_buffer[info->debug_region_size] = 0;
 180
 181        info->d = debugfs_create_file(strncat(debug_name, dev_name(dev),
 182                                              sizeof(debug_name) -
 183                                              sizeof("ti_sci_debug@")),
 184                                      0444, NULL, info, &ti_sci_debug_fops);
 185        if (IS_ERR(info->d))
 186                return PTR_ERR(info->d);
 187
 188        dev_dbg(dev, "Debug region => %p, size = %zu bytes, resource: %pr\n",
 189                info->debug_region, info->debug_region_size, res);
 190        return 0;
 191}
 192
 193/**
 194 * ti_sci_debugfs_destroy() - clean up log debug file
 195 * @pdev:       platform device pointer
 196 * @info:       Pointer to SCI entity information
 197 */
 198static void ti_sci_debugfs_destroy(struct platform_device *pdev,
 199                                   struct ti_sci_info *info)
 200{
 201        if (IS_ERR(info->debug_region))
 202                return;
 203
 204        debugfs_remove(info->d);
 205}
 206#else /* CONFIG_DEBUG_FS */
 207static inline int ti_sci_debugfs_create(struct platform_device *dev,
 208                                        struct ti_sci_info *info)
 209{
 210        return 0;
 211}
 212
 213static inline void ti_sci_debugfs_destroy(struct platform_device *dev,
 214                                          struct ti_sci_info *info)
 215{
 216}
 217#endif /* CONFIG_DEBUG_FS */
 218
 219/**
 220 * ti_sci_dump_header_dbg() - Helper to dump a message header.
 221 * @dev:        Device pointer corresponding to the SCI entity
 222 * @hdr:        pointer to header.
 223 */
 224static inline void ti_sci_dump_header_dbg(struct device *dev,
 225                                          struct ti_sci_msg_hdr *hdr)
 226{
 227        dev_dbg(dev, "MSGHDR:type=0x%04x host=0x%02x seq=0x%02x flags=0x%08x\n",
 228                hdr->type, hdr->host, hdr->seq, hdr->flags);
 229}
 230
 231/**
 232 * ti_sci_rx_callback() - mailbox client callback for receive messages
 233 * @cl: client pointer
 234 * @m:  mailbox message
 235 *
 236 * Processes one received message to appropriate transfer information and
 237 * signals completion of the transfer.
 238 *
 239 * NOTE: This function will be invoked in IRQ context, hence should be
 240 * as optimal as possible.
 241 */
 242static void ti_sci_rx_callback(struct mbox_client *cl, void *m)
 243{
 244        struct ti_sci_info *info = cl_to_ti_sci_info(cl);
 245        struct device *dev = info->dev;
 246        struct ti_sci_xfers_info *minfo = &info->minfo;
 247        struct ti_msgmgr_message *mbox_msg = m;
 248        struct ti_sci_msg_hdr *hdr = (struct ti_sci_msg_hdr *)mbox_msg->buf;
 249        struct ti_sci_xfer *xfer;
 250        u8 xfer_id;
 251
 252        xfer_id = hdr->seq;
 253
 254        /*
 255         * Are we even expecting this?
 256         * NOTE: barriers were implicit in locks used for modifying the bitmap
 257         */
 258        if (!test_bit(xfer_id, minfo->xfer_alloc_table)) {
 259                dev_err(dev, "Message for %d is not expected!\n", xfer_id);
 260                return;
 261        }
 262
 263        xfer = &minfo->xfer_block[xfer_id];
 264
 265        /* Is the message of valid length? */
 266        if (mbox_msg->len > info->desc->max_msg_size) {
 267                dev_err(dev, "Unable to handle %zu xfer(max %d)\n",
 268                        mbox_msg->len, info->desc->max_msg_size);
 269                ti_sci_dump_header_dbg(dev, hdr);
 270                return;
 271        }
 272        if (mbox_msg->len < xfer->rx_len) {
 273                dev_err(dev, "Recv xfer %zu < expected %d length\n",
 274                        mbox_msg->len, xfer->rx_len);
 275                ti_sci_dump_header_dbg(dev, hdr);
 276                return;
 277        }
 278
 279        ti_sci_dump_header_dbg(dev, hdr);
 280        /* Take a copy to the rx buffer.. */
 281        memcpy(xfer->xfer_buf, mbox_msg->buf, xfer->rx_len);
 282        complete(&xfer->done);
 283}
 284
 285/**
 286 * ti_sci_get_one_xfer() - Allocate one message
 287 * @info:       Pointer to SCI entity information
 288 * @msg_type:   Message type
 289 * @msg_flags:  Flag to set for the message
 290 * @tx_message_size: transmit message size
 291 * @rx_message_size: receive message size
 292 *
 293 * Helper function which is used by various command functions that are
 294 * exposed to clients of this driver for allocating a message traffic event.
 295 *
 296 * This function can sleep depending on pending requests already in the system
 297 * for the SCI entity. Further, this also holds a spinlock to maintain integrity
 298 * of internal data structures.
 299 *
 300 * Return: 0 if all went fine, else corresponding error.
 301 */
 302static struct ti_sci_xfer *ti_sci_get_one_xfer(struct ti_sci_info *info,
 303                                               u16 msg_type, u32 msg_flags,
 304                                               size_t tx_message_size,
 305                                               size_t rx_message_size)
 306{
 307        struct ti_sci_xfers_info *minfo = &info->minfo;
 308        struct ti_sci_xfer *xfer;
 309        struct ti_sci_msg_hdr *hdr;
 310        unsigned long flags;
 311        unsigned long bit_pos;
 312        u8 xfer_id;
 313        int ret;
 314        int timeout;
 315
 316        /* Ensure we have sane transfer sizes */
 317        if (rx_message_size > info->desc->max_msg_size ||
 318            tx_message_size > info->desc->max_msg_size ||
 319            rx_message_size < sizeof(*hdr) || tx_message_size < sizeof(*hdr))
 320                return ERR_PTR(-ERANGE);
 321
 322        /*
 323         * Ensure we have only controlled number of pending messages.
 324         * Ideally, we might just have to wait a single message, be
 325         * conservative and wait 5 times that..
 326         */
 327        timeout = msecs_to_jiffies(info->desc->max_rx_timeout_ms) * 5;
 328        ret = down_timeout(&minfo->sem_xfer_count, timeout);
 329        if (ret < 0)
 330                return ERR_PTR(ret);
 331
 332        /* Keep the locked section as small as possible */
 333        spin_lock_irqsave(&minfo->xfer_lock, flags);
 334        bit_pos = find_first_zero_bit(minfo->xfer_alloc_table,
 335                                      info->desc->max_msgs);
 336        set_bit(bit_pos, minfo->xfer_alloc_table);
 337        spin_unlock_irqrestore(&minfo->xfer_lock, flags);
 338
 339        /*
 340         * We already ensured in probe that we can have max messages that can
 341         * fit in  hdr.seq - NOTE: this improves access latencies
 342         * to predictable O(1) access, BUT, it opens us to risk if
 343         * remote misbehaves with corrupted message sequence responses.
 344         * If that happens, we are going to be messed up anyways..
 345         */
 346        xfer_id = (u8)bit_pos;
 347
 348        xfer = &minfo->xfer_block[xfer_id];
 349
 350        hdr = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
 351        xfer->tx_message.len = tx_message_size;
 352        xfer->rx_len = (u8)rx_message_size;
 353
 354        reinit_completion(&xfer->done);
 355
 356        hdr->seq = xfer_id;
 357        hdr->type = msg_type;
 358        hdr->host = info->host_id;
 359        hdr->flags = msg_flags;
 360
 361        return xfer;
 362}
 363
 364/**
 365 * ti_sci_put_one_xfer() - Release a message
 366 * @minfo:      transfer info pointer
 367 * @xfer:       message that was reserved by ti_sci_get_one_xfer
 368 *
 369 * This holds a spinlock to maintain integrity of internal data structures.
 370 */
 371static void ti_sci_put_one_xfer(struct ti_sci_xfers_info *minfo,
 372                                struct ti_sci_xfer *xfer)
 373{
 374        unsigned long flags;
 375        struct ti_sci_msg_hdr *hdr;
 376        u8 xfer_id;
 377
 378        hdr = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
 379        xfer_id = hdr->seq;
 380
 381        /*
 382         * Keep the locked section as small as possible
 383         * NOTE: we might escape with smp_mb and no lock here..
 384         * but just be conservative and symmetric.
 385         */
 386        spin_lock_irqsave(&minfo->xfer_lock, flags);
 387        clear_bit(xfer_id, minfo->xfer_alloc_table);
 388        spin_unlock_irqrestore(&minfo->xfer_lock, flags);
 389
 390        /* Increment the count for the next user to get through */
 391        up(&minfo->sem_xfer_count);
 392}
 393
 394/**
 395 * ti_sci_do_xfer() - Do one transfer
 396 * @info:       Pointer to SCI entity information
 397 * @xfer:       Transfer to initiate and wait for response
 398 *
 399 * Return: -ETIMEDOUT in case of no response, if transmit error,
 400 *         return corresponding error, else if all goes well,
 401 *         return 0.
 402 */
 403static inline int ti_sci_do_xfer(struct ti_sci_info *info,
 404                                 struct ti_sci_xfer *xfer)
 405{
 406        int ret;
 407        int timeout;
 408        struct device *dev = info->dev;
 409
 410        ret = mbox_send_message(info->chan_tx, &xfer->tx_message);
 411        if (ret < 0)
 412                return ret;
 413
 414        ret = 0;
 415
 416        /* And we wait for the response. */
 417        timeout = msecs_to_jiffies(info->desc->max_rx_timeout_ms);
 418        if (!wait_for_completion_timeout(&xfer->done, timeout)) {
 419                dev_err(dev, "Mbox timedout in resp(caller: %pS)\n",
 420                        (void *)_RET_IP_);
 421                ret = -ETIMEDOUT;
 422        }
 423        /*
 424         * NOTE: we might prefer not to need the mailbox ticker to manage the
 425         * transfer queueing since the protocol layer queues things by itself.
 426         * Unfortunately, we have to kick the mailbox framework after we have
 427         * received our message.
 428         */
 429        mbox_client_txdone(info->chan_tx, ret);
 430
 431        return ret;
 432}
 433
 434/**
 435 * ti_sci_cmd_get_revision() - command to get the revision of the SCI entity
 436 * @info:       Pointer to SCI entity information
 437 *
 438 * Updates the SCI information in the internal data structure.
 439 *
 440 * Return: 0 if all went fine, else return appropriate error.
 441 */
 442static int ti_sci_cmd_get_revision(struct ti_sci_info *info)
 443{
 444        struct device *dev = info->dev;
 445        struct ti_sci_handle *handle = &info->handle;
 446        struct ti_sci_version_info *ver = &handle->version;
 447        struct ti_sci_msg_resp_version *rev_info;
 448        struct ti_sci_xfer *xfer;
 449        int ret;
 450
 451        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_VERSION,
 452                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
 453                                   sizeof(struct ti_sci_msg_hdr),
 454                                   sizeof(*rev_info));
 455        if (IS_ERR(xfer)) {
 456                ret = PTR_ERR(xfer);
 457                dev_err(dev, "Message alloc failed(%d)\n", ret);
 458                return ret;
 459        }
 460
 461        rev_info = (struct ti_sci_msg_resp_version *)xfer->xfer_buf;
 462
 463        ret = ti_sci_do_xfer(info, xfer);
 464        if (ret) {
 465                dev_err(dev, "Mbox send fail %d\n", ret);
 466                goto fail;
 467        }
 468
 469        ver->abi_major = rev_info->abi_major;
 470        ver->abi_minor = rev_info->abi_minor;
 471        ver->firmware_revision = rev_info->firmware_revision;
 472        strncpy(ver->firmware_description, rev_info->firmware_description,
 473                sizeof(ver->firmware_description));
 474
 475fail:
 476        ti_sci_put_one_xfer(&info->minfo, xfer);
 477        return ret;
 478}
 479
 480/**
 481 * ti_sci_is_response_ack() - Generic ACK/NACK message checkup
 482 * @r:  pointer to response buffer
 483 *
 484 * Return: true if the response was an ACK, else returns false.
 485 */
 486static inline bool ti_sci_is_response_ack(void *r)
 487{
 488        struct ti_sci_msg_hdr *hdr = r;
 489
 490        return hdr->flags & TI_SCI_FLAG_RESP_GENERIC_ACK ? true : false;
 491}
 492
 493/**
 494 * ti_sci_set_device_state() - Set device state helper
 495 * @handle:     pointer to TI SCI handle
 496 * @id:         Device identifier
 497 * @flags:      flags to setup for the device
 498 * @state:      State to move the device to
 499 *
 500 * Return: 0 if all went well, else returns appropriate error value.
 501 */
 502static int ti_sci_set_device_state(const struct ti_sci_handle *handle,
 503                                   u32 id, u32 flags, u8 state)
 504{
 505        struct ti_sci_info *info;
 506        struct ti_sci_msg_req_set_device_state *req;
 507        struct ti_sci_msg_hdr *resp;
 508        struct ti_sci_xfer *xfer;
 509        struct device *dev;
 510        int ret = 0;
 511
 512        if (IS_ERR(handle))
 513                return PTR_ERR(handle);
 514        if (!handle)
 515                return -EINVAL;
 516
 517        info = handle_to_ti_sci_info(handle);
 518        dev = info->dev;
 519
 520        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_STATE,
 521                                   flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
 522                                   sizeof(*req), sizeof(*resp));
 523        if (IS_ERR(xfer)) {
 524                ret = PTR_ERR(xfer);
 525                dev_err(dev, "Message alloc failed(%d)\n", ret);
 526                return ret;
 527        }
 528        req = (struct ti_sci_msg_req_set_device_state *)xfer->xfer_buf;
 529        req->id = id;
 530        req->state = state;
 531
 532        ret = ti_sci_do_xfer(info, xfer);
 533        if (ret) {
 534                dev_err(dev, "Mbox send fail %d\n", ret);
 535                goto fail;
 536        }
 537
 538        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
 539
 540        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
 541
 542fail:
 543        ti_sci_put_one_xfer(&info->minfo, xfer);
 544
 545        return ret;
 546}
 547
 548/**
 549 * ti_sci_get_device_state() - Get device state helper
 550 * @handle:     Handle to the device
 551 * @id:         Device Identifier
 552 * @clcnt:      Pointer to Context Loss Count
 553 * @resets:     pointer to resets
 554 * @p_state:    pointer to p_state
 555 * @c_state:    pointer to c_state
 556 *
 557 * Return: 0 if all went fine, else return appropriate error.
 558 */
 559static int ti_sci_get_device_state(const struct ti_sci_handle *handle,
 560                                   u32 id,  u32 *clcnt,  u32 *resets,
 561                                    u8 *p_state,  u8 *c_state)
 562{
 563        struct ti_sci_info *info;
 564        struct ti_sci_msg_req_get_device_state *req;
 565        struct ti_sci_msg_resp_get_device_state *resp;
 566        struct ti_sci_xfer *xfer;
 567        struct device *dev;
 568        int ret = 0;
 569
 570        if (IS_ERR(handle))
 571                return PTR_ERR(handle);
 572        if (!handle)
 573                return -EINVAL;
 574
 575        if (!clcnt && !resets && !p_state && !c_state)
 576                return -EINVAL;
 577
 578        info = handle_to_ti_sci_info(handle);
 579        dev = info->dev;
 580
 581        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_DEVICE_STATE,
 582                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
 583                                   sizeof(*req), sizeof(*resp));
 584        if (IS_ERR(xfer)) {
 585                ret = PTR_ERR(xfer);
 586                dev_err(dev, "Message alloc failed(%d)\n", ret);
 587                return ret;
 588        }
 589        req = (struct ti_sci_msg_req_get_device_state *)xfer->xfer_buf;
 590        req->id = id;
 591
 592        ret = ti_sci_do_xfer(info, xfer);
 593        if (ret) {
 594                dev_err(dev, "Mbox send fail %d\n", ret);
 595                goto fail;
 596        }
 597
 598        resp = (struct ti_sci_msg_resp_get_device_state *)xfer->xfer_buf;
 599        if (!ti_sci_is_response_ack(resp)) {
 600                ret = -ENODEV;
 601                goto fail;
 602        }
 603
 604        if (clcnt)
 605                *clcnt = resp->context_loss_count;
 606        if (resets)
 607                *resets = resp->resets;
 608        if (p_state)
 609                *p_state = resp->programmed_state;
 610        if (c_state)
 611                *c_state = resp->current_state;
 612fail:
 613        ti_sci_put_one_xfer(&info->minfo, xfer);
 614
 615        return ret;
 616}
 617
 618/**
 619 * ti_sci_cmd_get_device() - command to request for device managed by TISCI
 620 *                           that can be shared with other hosts.
 621 * @handle:     Pointer to TISCI handle as retrieved by *ti_sci_get_handle
 622 * @id:         Device Identifier
 623 *
 624 * Request for the device - NOTE: the client MUST maintain integrity of
 625 * usage count by balancing get_device with put_device. No refcounting is
 626 * managed by driver for that purpose.
 627 *
 628 * Return: 0 if all went fine, else return appropriate error.
 629 */
 630static int ti_sci_cmd_get_device(const struct ti_sci_handle *handle, u32 id)
 631{
 632        return ti_sci_set_device_state(handle, id, 0,
 633                                       MSG_DEVICE_SW_STATE_ON);
 634}
 635
 636/**
 637 * ti_sci_cmd_get_device_exclusive() - command to request for device managed by
 638 *                                     TISCI that is exclusively owned by the
 639 *                                     requesting host.
 640 * @handle:     Pointer to TISCI handle as retrieved by *ti_sci_get_handle
 641 * @id:         Device Identifier
 642 *
 643 * Request for the device - NOTE: the client MUST maintain integrity of
 644 * usage count by balancing get_device with put_device. No refcounting is
 645 * managed by driver for that purpose.
 646 *
 647 * Return: 0 if all went fine, else return appropriate error.
 648 */
 649static int ti_sci_cmd_get_device_exclusive(const struct ti_sci_handle *handle,
 650                                           u32 id)
 651{
 652        return ti_sci_set_device_state(handle, id,
 653                                       MSG_FLAG_DEVICE_EXCLUSIVE,
 654                                       MSG_DEVICE_SW_STATE_ON);
 655}
 656
 657/**
 658 * ti_sci_cmd_idle_device() - Command to idle a device managed by TISCI
 659 * @handle:     Pointer to TISCI handle as retrieved by *ti_sci_get_handle
 660 * @id:         Device Identifier
 661 *
 662 * Request for the device - NOTE: the client MUST maintain integrity of
 663 * usage count by balancing get_device with put_device. No refcounting is
 664 * managed by driver for that purpose.
 665 *
 666 * Return: 0 if all went fine, else return appropriate error.
 667 */
 668static int ti_sci_cmd_idle_device(const struct ti_sci_handle *handle, u32 id)
 669{
 670        return ti_sci_set_device_state(handle, id, 0,
 671                                       MSG_DEVICE_SW_STATE_RETENTION);
 672}
 673
 674/**
 675 * ti_sci_cmd_idle_device_exclusive() - Command to idle a device managed by
 676 *                                      TISCI that is exclusively owned by
 677 *                                      requesting host.
 678 * @handle:     Pointer to TISCI handle as retrieved by *ti_sci_get_handle
 679 * @id:         Device Identifier
 680 *
 681 * Request for the device - NOTE: the client MUST maintain integrity of
 682 * usage count by balancing get_device with put_device. No refcounting is
 683 * managed by driver for that purpose.
 684 *
 685 * Return: 0 if all went fine, else return appropriate error.
 686 */
 687static int ti_sci_cmd_idle_device_exclusive(const struct ti_sci_handle *handle,
 688                                            u32 id)
 689{
 690        return ti_sci_set_device_state(handle, id,
 691                                       MSG_FLAG_DEVICE_EXCLUSIVE,
 692                                       MSG_DEVICE_SW_STATE_RETENTION);
 693}
 694
 695/**
 696 * ti_sci_cmd_put_device() - command to release a device managed by TISCI
 697 * @handle:     Pointer to TISCI handle as retrieved by *ti_sci_get_handle
 698 * @id:         Device Identifier
 699 *
 700 * Request for the device - NOTE: the client MUST maintain integrity of
 701 * usage count by balancing get_device with put_device. No refcounting is
 702 * managed by driver for that purpose.
 703 *
 704 * Return: 0 if all went fine, else return appropriate error.
 705 */
 706static int ti_sci_cmd_put_device(const struct ti_sci_handle *handle, u32 id)
 707{
 708        return ti_sci_set_device_state(handle, id,
 709                                       0, MSG_DEVICE_SW_STATE_AUTO_OFF);
 710}
 711
 712/**
 713 * ti_sci_cmd_dev_is_valid() - Is the device valid
 714 * @handle:     Pointer to TISCI handle as retrieved by *ti_sci_get_handle
 715 * @id:         Device Identifier
 716 *
 717 * Return: 0 if all went fine and the device ID is valid, else return
 718 * appropriate error.
 719 */
 720static int ti_sci_cmd_dev_is_valid(const struct ti_sci_handle *handle, u32 id)
 721{
 722        u8 unused;
 723
 724        /* check the device state which will also tell us if the ID is valid */
 725        return ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &unused);
 726}
 727
 728/**
 729 * ti_sci_cmd_dev_get_clcnt() - Get context loss counter
 730 * @handle:     Pointer to TISCI handle
 731 * @id:         Device Identifier
 732 * @count:      Pointer to Context Loss counter to populate
 733 *
 734 * Return: 0 if all went fine, else return appropriate error.
 735 */
 736static int ti_sci_cmd_dev_get_clcnt(const struct ti_sci_handle *handle, u32 id,
 737                                    u32 *count)
 738{
 739        return ti_sci_get_device_state(handle, id, count, NULL, NULL, NULL);
 740}
 741
 742/**
 743 * ti_sci_cmd_dev_is_idle() - Check if the device is requested to be idle
 744 * @handle:     Pointer to TISCI handle
 745 * @id:         Device Identifier
 746 * @r_state:    true if requested to be idle
 747 *
 748 * Return: 0 if all went fine, else return appropriate error.
 749 */
 750static int ti_sci_cmd_dev_is_idle(const struct ti_sci_handle *handle, u32 id,
 751                                  bool *r_state)
 752{
 753        int ret;
 754        u8 state;
 755
 756        if (!r_state)
 757                return -EINVAL;
 758
 759        ret = ti_sci_get_device_state(handle, id, NULL, NULL, &state, NULL);
 760        if (ret)
 761                return ret;
 762
 763        *r_state = (state == MSG_DEVICE_SW_STATE_RETENTION);
 764
 765        return 0;
 766}
 767
 768/**
 769 * ti_sci_cmd_dev_is_stop() - Check if the device is requested to be stopped
 770 * @handle:     Pointer to TISCI handle
 771 * @id:         Device Identifier
 772 * @r_state:    true if requested to be stopped
 773 * @curr_state: true if currently stopped.
 774 *
 775 * Return: 0 if all went fine, else return appropriate error.
 776 */
 777static int ti_sci_cmd_dev_is_stop(const struct ti_sci_handle *handle, u32 id,
 778                                  bool *r_state,  bool *curr_state)
 779{
 780        int ret;
 781        u8 p_state, c_state;
 782
 783        if (!r_state && !curr_state)
 784                return -EINVAL;
 785
 786        ret =
 787            ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state);
 788        if (ret)
 789                return ret;
 790
 791        if (r_state)
 792                *r_state = (p_state == MSG_DEVICE_SW_STATE_AUTO_OFF);
 793        if (curr_state)
 794                *curr_state = (c_state == MSG_DEVICE_HW_STATE_OFF);
 795
 796        return 0;
 797}
 798
 799/**
 800 * ti_sci_cmd_dev_is_on() - Check if the device is requested to be ON
 801 * @handle:     Pointer to TISCI handle
 802 * @id:         Device Identifier
 803 * @r_state:    true if requested to be ON
 804 * @curr_state: true if currently ON and active
 805 *
 806 * Return: 0 if all went fine, else return appropriate error.
 807 */
 808static int ti_sci_cmd_dev_is_on(const struct ti_sci_handle *handle, u32 id,
 809                                bool *r_state,  bool *curr_state)
 810{
 811        int ret;
 812        u8 p_state, c_state;
 813
 814        if (!r_state && !curr_state)
 815                return -EINVAL;
 816
 817        ret =
 818            ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state);
 819        if (ret)
 820                return ret;
 821
 822        if (r_state)
 823                *r_state = (p_state == MSG_DEVICE_SW_STATE_ON);
 824        if (curr_state)
 825                *curr_state = (c_state == MSG_DEVICE_HW_STATE_ON);
 826
 827        return 0;
 828}
 829
 830/**
 831 * ti_sci_cmd_dev_is_trans() - Check if the device is currently transitioning
 832 * @handle:     Pointer to TISCI handle
 833 * @id:         Device Identifier
 834 * @curr_state: true if currently transitioning.
 835 *
 836 * Return: 0 if all went fine, else return appropriate error.
 837 */
 838static int ti_sci_cmd_dev_is_trans(const struct ti_sci_handle *handle, u32 id,
 839                                   bool *curr_state)
 840{
 841        int ret;
 842        u8 state;
 843
 844        if (!curr_state)
 845                return -EINVAL;
 846
 847        ret = ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &state);
 848        if (ret)
 849                return ret;
 850
 851        *curr_state = (state == MSG_DEVICE_HW_STATE_TRANS);
 852
 853        return 0;
 854}
 855
 856/**
 857 * ti_sci_cmd_set_device_resets() - command to set resets for device managed
 858 *                                  by TISCI
 859 * @handle:     Pointer to TISCI handle as retrieved by *ti_sci_get_handle
 860 * @id:         Device Identifier
 861 * @reset_state: Device specific reset bit field
 862 *
 863 * Return: 0 if all went fine, else return appropriate error.
 864 */
 865static int ti_sci_cmd_set_device_resets(const struct ti_sci_handle *handle,
 866                                        u32 id, u32 reset_state)
 867{
 868        struct ti_sci_info *info;
 869        struct ti_sci_msg_req_set_device_resets *req;
 870        struct ti_sci_msg_hdr *resp;
 871        struct ti_sci_xfer *xfer;
 872        struct device *dev;
 873        int ret = 0;
 874
 875        if (IS_ERR(handle))
 876                return PTR_ERR(handle);
 877        if (!handle)
 878                return -EINVAL;
 879
 880        info = handle_to_ti_sci_info(handle);
 881        dev = info->dev;
 882
 883        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_DEVICE_RESETS,
 884                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
 885                                   sizeof(*req), sizeof(*resp));
 886        if (IS_ERR(xfer)) {
 887                ret = PTR_ERR(xfer);
 888                dev_err(dev, "Message alloc failed(%d)\n", ret);
 889                return ret;
 890        }
 891        req = (struct ti_sci_msg_req_set_device_resets *)xfer->xfer_buf;
 892        req->id = id;
 893        req->resets = reset_state;
 894
 895        ret = ti_sci_do_xfer(info, xfer);
 896        if (ret) {
 897                dev_err(dev, "Mbox send fail %d\n", ret);
 898                goto fail;
 899        }
 900
 901        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
 902
 903        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
 904
 905fail:
 906        ti_sci_put_one_xfer(&info->minfo, xfer);
 907
 908        return ret;
 909}
 910
 911/**
 912 * ti_sci_cmd_get_device_resets() - Get reset state for device managed
 913 *                                  by TISCI
 914 * @handle:             Pointer to TISCI handle
 915 * @id:                 Device Identifier
 916 * @reset_state:        Pointer to reset state to populate
 917 *
 918 * Return: 0 if all went fine, else return appropriate error.
 919 */
 920static int ti_sci_cmd_get_device_resets(const struct ti_sci_handle *handle,
 921                                        u32 id, u32 *reset_state)
 922{
 923        return ti_sci_get_device_state(handle, id, NULL, reset_state, NULL,
 924                                       NULL);
 925}
 926
 927/**
 928 * ti_sci_set_clock_state() - Set clock state helper
 929 * @handle:     pointer to TI SCI handle
 930 * @dev_id:     Device identifier this request is for
 931 * @clk_id:     Clock identifier for the device for this request.
 932 *              Each device has it's own set of clock inputs. This indexes
 933 *              which clock input to modify.
 934 * @flags:      Header flags as needed
 935 * @state:      State to request for the clock.
 936 *
 937 * Return: 0 if all went well, else returns appropriate error value.
 938 */
 939static int ti_sci_set_clock_state(const struct ti_sci_handle *handle,
 940                                  u32 dev_id, u32 clk_id,
 941                                  u32 flags, u8 state)
 942{
 943        struct ti_sci_info *info;
 944        struct ti_sci_msg_req_set_clock_state *req;
 945        struct ti_sci_msg_hdr *resp;
 946        struct ti_sci_xfer *xfer;
 947        struct device *dev;
 948        int ret = 0;
 949
 950        if (IS_ERR(handle))
 951                return PTR_ERR(handle);
 952        if (!handle)
 953                return -EINVAL;
 954
 955        info = handle_to_ti_sci_info(handle);
 956        dev = info->dev;
 957
 958        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_STATE,
 959                                   flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
 960                                   sizeof(*req), sizeof(*resp));
 961        if (IS_ERR(xfer)) {
 962                ret = PTR_ERR(xfer);
 963                dev_err(dev, "Message alloc failed(%d)\n", ret);
 964                return ret;
 965        }
 966        req = (struct ti_sci_msg_req_set_clock_state *)xfer->xfer_buf;
 967        req->dev_id = dev_id;
 968        if (clk_id < 255) {
 969                req->clk_id = clk_id;
 970        } else {
 971                req->clk_id = 255;
 972                req->clk_id_32 = clk_id;
 973        }
 974        req->request_state = state;
 975
 976        ret = ti_sci_do_xfer(info, xfer);
 977        if (ret) {
 978                dev_err(dev, "Mbox send fail %d\n", ret);
 979                goto fail;
 980        }
 981
 982        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
 983
 984        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
 985
 986fail:
 987        ti_sci_put_one_xfer(&info->minfo, xfer);
 988
 989        return ret;
 990}
 991
 992/**
 993 * ti_sci_cmd_get_clock_state() - Get clock state helper
 994 * @handle:     pointer to TI SCI handle
 995 * @dev_id:     Device identifier this request is for
 996 * @clk_id:     Clock identifier for the device for this request.
 997 *              Each device has it's own set of clock inputs. This indexes
 998 *              which clock input to modify.
 999 * @programmed_state:   State requested for clock to move to
1000 * @current_state:      State that the clock is currently in
1001 *
1002 * Return: 0 if all went well, else returns appropriate error value.
1003 */
1004static int ti_sci_cmd_get_clock_state(const struct ti_sci_handle *handle,
1005                                      u32 dev_id, u32 clk_id,
1006                                      u8 *programmed_state, u8 *current_state)
1007{
1008        struct ti_sci_info *info;
1009        struct ti_sci_msg_req_get_clock_state *req;
1010        struct ti_sci_msg_resp_get_clock_state *resp;
1011        struct ti_sci_xfer *xfer;
1012        struct device *dev;
1013        int ret = 0;
1014
1015        if (IS_ERR(handle))
1016                return PTR_ERR(handle);
1017        if (!handle)
1018                return -EINVAL;
1019
1020        if (!programmed_state && !current_state)
1021                return -EINVAL;
1022
1023        info = handle_to_ti_sci_info(handle);
1024        dev = info->dev;
1025
1026        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_STATE,
1027                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1028                                   sizeof(*req), sizeof(*resp));
1029        if (IS_ERR(xfer)) {
1030                ret = PTR_ERR(xfer);
1031                dev_err(dev, "Message alloc failed(%d)\n", ret);
1032                return ret;
1033        }
1034        req = (struct ti_sci_msg_req_get_clock_state *)xfer->xfer_buf;
1035        req->dev_id = dev_id;
1036        if (clk_id < 255) {
1037                req->clk_id = clk_id;
1038        } else {
1039                req->clk_id = 255;
1040                req->clk_id_32 = clk_id;
1041        }
1042
1043        ret = ti_sci_do_xfer(info, xfer);
1044        if (ret) {
1045                dev_err(dev, "Mbox send fail %d\n", ret);
1046                goto fail;
1047        }
1048
1049        resp = (struct ti_sci_msg_resp_get_clock_state *)xfer->xfer_buf;
1050
1051        if (!ti_sci_is_response_ack(resp)) {
1052                ret = -ENODEV;
1053                goto fail;
1054        }
1055
1056        if (programmed_state)
1057                *programmed_state = resp->programmed_state;
1058        if (current_state)
1059                *current_state = resp->current_state;
1060
1061fail:
1062        ti_sci_put_one_xfer(&info->minfo, xfer);
1063
1064        return ret;
1065}
1066
1067/**
1068 * ti_sci_cmd_get_clock() - Get control of a clock from TI SCI
1069 * @handle:     pointer to TI SCI handle
1070 * @dev_id:     Device identifier this request is for
1071 * @clk_id:     Clock identifier for the device for this request.
1072 *              Each device has it's own set of clock inputs. This indexes
1073 *              which clock input to modify.
1074 * @needs_ssc: 'true' if Spread Spectrum clock is desired, else 'false'
1075 * @can_change_freq: 'true' if frequency change is desired, else 'false'
1076 * @enable_input_term: 'true' if input termination is desired, else 'false'
1077 *
1078 * Return: 0 if all went well, else returns appropriate error value.
1079 */
1080static int ti_sci_cmd_get_clock(const struct ti_sci_handle *handle, u32 dev_id,
1081                                u32 clk_id, bool needs_ssc,
1082                                bool can_change_freq, bool enable_input_term)
1083{
1084        u32 flags = 0;
1085
1086        flags |= needs_ssc ? MSG_FLAG_CLOCK_ALLOW_SSC : 0;
1087        flags |= can_change_freq ? MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE : 0;
1088        flags |= enable_input_term ? MSG_FLAG_CLOCK_INPUT_TERM : 0;
1089
1090        return ti_sci_set_clock_state(handle, dev_id, clk_id, flags,
1091                                      MSG_CLOCK_SW_STATE_REQ);
1092}
1093
1094/**
1095 * ti_sci_cmd_idle_clock() - Idle a clock which is in our control
1096 * @handle:     pointer to TI SCI handle
1097 * @dev_id:     Device identifier this request is for
1098 * @clk_id:     Clock identifier for the device for this request.
1099 *              Each device has it's own set of clock inputs. This indexes
1100 *              which clock input to modify.
1101 *
1102 * NOTE: This clock must have been requested by get_clock previously.
1103 *
1104 * Return: 0 if all went well, else returns appropriate error value.
1105 */
1106static int ti_sci_cmd_idle_clock(const struct ti_sci_handle *handle,
1107                                 u32 dev_id, u32 clk_id)
1108{
1109        return ti_sci_set_clock_state(handle, dev_id, clk_id,
1110                                      MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE,
1111                                      MSG_CLOCK_SW_STATE_UNREQ);
1112}
1113
1114/**
1115 * ti_sci_cmd_put_clock() - Release a clock from our control back to TISCI
1116 * @handle:     pointer to TI SCI handle
1117 * @dev_id:     Device identifier this request is for
1118 * @clk_id:     Clock identifier for the device for this request.
1119 *              Each device has it's own set of clock inputs. This indexes
1120 *              which clock input to modify.
1121 *
1122 * NOTE: This clock must have been requested by get_clock previously.
1123 *
1124 * Return: 0 if all went well, else returns appropriate error value.
1125 */
1126static int ti_sci_cmd_put_clock(const struct ti_sci_handle *handle,
1127                                u32 dev_id, u32 clk_id)
1128{
1129        return ti_sci_set_clock_state(handle, dev_id, clk_id,
1130                                      MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE,
1131                                      MSG_CLOCK_SW_STATE_AUTO);
1132}
1133
1134/**
1135 * ti_sci_cmd_clk_is_auto() - Is the clock being auto managed
1136 * @handle:     pointer to TI SCI handle
1137 * @dev_id:     Device identifier this request is for
1138 * @clk_id:     Clock identifier for the device for this request.
1139 *              Each device has it's own set of clock inputs. This indexes
1140 *              which clock input to modify.
1141 * @req_state: state indicating if the clock is auto managed
1142 *
1143 * Return: 0 if all went well, else returns appropriate error value.
1144 */
1145static int ti_sci_cmd_clk_is_auto(const struct ti_sci_handle *handle,
1146                                  u32 dev_id, u32 clk_id, bool *req_state)
1147{
1148        u8 state = 0;
1149        int ret;
1150
1151        if (!req_state)
1152                return -EINVAL;
1153
1154        ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, &state, NULL);
1155        if (ret)
1156                return ret;
1157
1158        *req_state = (state == MSG_CLOCK_SW_STATE_AUTO);
1159        return 0;
1160}
1161
1162/**
1163 * ti_sci_cmd_clk_is_on() - Is the clock ON
1164 * @handle:     pointer to TI SCI handle
1165 * @dev_id:     Device identifier this request is for
1166 * @clk_id:     Clock identifier for the device for this request.
1167 *              Each device has it's own set of clock inputs. This indexes
1168 *              which clock input to modify.
1169 * @req_state: state indicating if the clock is managed by us and enabled
1170 * @curr_state: state indicating if the clock is ready for operation
1171 *
1172 * Return: 0 if all went well, else returns appropriate error value.
1173 */
1174static int ti_sci_cmd_clk_is_on(const struct ti_sci_handle *handle, u32 dev_id,
1175                                u32 clk_id, bool *req_state, bool *curr_state)
1176{
1177        u8 c_state = 0, r_state = 0;
1178        int ret;
1179
1180        if (!req_state && !curr_state)
1181                return -EINVAL;
1182
1183        ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id,
1184                                         &r_state, &c_state);
1185        if (ret)
1186                return ret;
1187
1188        if (req_state)
1189                *req_state = (r_state == MSG_CLOCK_SW_STATE_REQ);
1190        if (curr_state)
1191                *curr_state = (c_state == MSG_CLOCK_HW_STATE_READY);
1192        return 0;
1193}
1194
1195/**
1196 * ti_sci_cmd_clk_is_off() - Is the clock OFF
1197 * @handle:     pointer to TI SCI handle
1198 * @dev_id:     Device identifier this request is for
1199 * @clk_id:     Clock identifier for the device for this request.
1200 *              Each device has it's own set of clock inputs. This indexes
1201 *              which clock input to modify.
1202 * @req_state: state indicating if the clock is managed by us and disabled
1203 * @curr_state: state indicating if the clock is NOT ready for operation
1204 *
1205 * Return: 0 if all went well, else returns appropriate error value.
1206 */
1207static int ti_sci_cmd_clk_is_off(const struct ti_sci_handle *handle, u32 dev_id,
1208                                 u32 clk_id, bool *req_state, bool *curr_state)
1209{
1210        u8 c_state = 0, r_state = 0;
1211        int ret;
1212
1213        if (!req_state && !curr_state)
1214                return -EINVAL;
1215
1216        ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id,
1217                                         &r_state, &c_state);
1218        if (ret)
1219                return ret;
1220
1221        if (req_state)
1222                *req_state = (r_state == MSG_CLOCK_SW_STATE_UNREQ);
1223        if (curr_state)
1224                *curr_state = (c_state == MSG_CLOCK_HW_STATE_NOT_READY);
1225        return 0;
1226}
1227
1228/**
1229 * ti_sci_cmd_clk_set_parent() - Set the clock source of a specific device clock
1230 * @handle:     pointer to TI SCI handle
1231 * @dev_id:     Device identifier this request is for
1232 * @clk_id:     Clock identifier for the device for this request.
1233 *              Each device has it's own set of clock inputs. This indexes
1234 *              which clock input to modify.
1235 * @parent_id:  Parent clock identifier to set
1236 *
1237 * Return: 0 if all went well, else returns appropriate error value.
1238 */
1239static int ti_sci_cmd_clk_set_parent(const struct ti_sci_handle *handle,
1240                                     u32 dev_id, u32 clk_id, u32 parent_id)
1241{
1242        struct ti_sci_info *info;
1243        struct ti_sci_msg_req_set_clock_parent *req;
1244        struct ti_sci_msg_hdr *resp;
1245        struct ti_sci_xfer *xfer;
1246        struct device *dev;
1247        int ret = 0;
1248
1249        if (IS_ERR(handle))
1250                return PTR_ERR(handle);
1251        if (!handle)
1252                return -EINVAL;
1253
1254        info = handle_to_ti_sci_info(handle);
1255        dev = info->dev;
1256
1257        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_PARENT,
1258                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1259                                   sizeof(*req), sizeof(*resp));
1260        if (IS_ERR(xfer)) {
1261                ret = PTR_ERR(xfer);
1262                dev_err(dev, "Message alloc failed(%d)\n", ret);
1263                return ret;
1264        }
1265        req = (struct ti_sci_msg_req_set_clock_parent *)xfer->xfer_buf;
1266        req->dev_id = dev_id;
1267        if (clk_id < 255) {
1268                req->clk_id = clk_id;
1269        } else {
1270                req->clk_id = 255;
1271                req->clk_id_32 = clk_id;
1272        }
1273        if (parent_id < 255) {
1274                req->parent_id = parent_id;
1275        } else {
1276                req->parent_id = 255;
1277                req->parent_id_32 = parent_id;
1278        }
1279
1280        ret = ti_sci_do_xfer(info, xfer);
1281        if (ret) {
1282                dev_err(dev, "Mbox send fail %d\n", ret);
1283                goto fail;
1284        }
1285
1286        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1287
1288        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
1289
1290fail:
1291        ti_sci_put_one_xfer(&info->minfo, xfer);
1292
1293        return ret;
1294}
1295
1296/**
1297 * ti_sci_cmd_clk_get_parent() - Get current parent clock source
1298 * @handle:     pointer to TI SCI handle
1299 * @dev_id:     Device identifier this request is for
1300 * @clk_id:     Clock identifier for the device for this request.
1301 *              Each device has it's own set of clock inputs. This indexes
1302 *              which clock input to modify.
1303 * @parent_id:  Current clock parent
1304 *
1305 * Return: 0 if all went well, else returns appropriate error value.
1306 */
1307static int ti_sci_cmd_clk_get_parent(const struct ti_sci_handle *handle,
1308                                     u32 dev_id, u32 clk_id, u32 *parent_id)
1309{
1310        struct ti_sci_info *info;
1311        struct ti_sci_msg_req_get_clock_parent *req;
1312        struct ti_sci_msg_resp_get_clock_parent *resp;
1313        struct ti_sci_xfer *xfer;
1314        struct device *dev;
1315        int ret = 0;
1316
1317        if (IS_ERR(handle))
1318                return PTR_ERR(handle);
1319        if (!handle || !parent_id)
1320                return -EINVAL;
1321
1322        info = handle_to_ti_sci_info(handle);
1323        dev = info->dev;
1324
1325        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_PARENT,
1326                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1327                                   sizeof(*req), sizeof(*resp));
1328        if (IS_ERR(xfer)) {
1329                ret = PTR_ERR(xfer);
1330                dev_err(dev, "Message alloc failed(%d)\n", ret);
1331                return ret;
1332        }
1333        req = (struct ti_sci_msg_req_get_clock_parent *)xfer->xfer_buf;
1334        req->dev_id = dev_id;
1335        if (clk_id < 255) {
1336                req->clk_id = clk_id;
1337        } else {
1338                req->clk_id = 255;
1339                req->clk_id_32 = clk_id;
1340        }
1341
1342        ret = ti_sci_do_xfer(info, xfer);
1343        if (ret) {
1344                dev_err(dev, "Mbox send fail %d\n", ret);
1345                goto fail;
1346        }
1347
1348        resp = (struct ti_sci_msg_resp_get_clock_parent *)xfer->xfer_buf;
1349
1350        if (!ti_sci_is_response_ack(resp)) {
1351                ret = -ENODEV;
1352        } else {
1353                if (resp->parent_id < 255)
1354                        *parent_id = resp->parent_id;
1355                else
1356                        *parent_id = resp->parent_id_32;
1357        }
1358
1359fail:
1360        ti_sci_put_one_xfer(&info->minfo, xfer);
1361
1362        return ret;
1363}
1364
1365/**
1366 * ti_sci_cmd_clk_get_num_parents() - Get num parents of the current clk source
1367 * @handle:     pointer to TI SCI handle
1368 * @dev_id:     Device identifier this request is for
1369 * @clk_id:     Clock identifier for the device for this request.
1370 *              Each device has it's own set of clock inputs. This indexes
1371 *              which clock input to modify.
1372 * @num_parents: Returns he number of parents to the current clock.
1373 *
1374 * Return: 0 if all went well, else returns appropriate error value.
1375 */
1376static int ti_sci_cmd_clk_get_num_parents(const struct ti_sci_handle *handle,
1377                                          u32 dev_id, u32 clk_id,
1378                                          u32 *num_parents)
1379{
1380        struct ti_sci_info *info;
1381        struct ti_sci_msg_req_get_clock_num_parents *req;
1382        struct ti_sci_msg_resp_get_clock_num_parents *resp;
1383        struct ti_sci_xfer *xfer;
1384        struct device *dev;
1385        int ret = 0;
1386
1387        if (IS_ERR(handle))
1388                return PTR_ERR(handle);
1389        if (!handle || !num_parents)
1390                return -EINVAL;
1391
1392        info = handle_to_ti_sci_info(handle);
1393        dev = info->dev;
1394
1395        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_NUM_CLOCK_PARENTS,
1396                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1397                                   sizeof(*req), sizeof(*resp));
1398        if (IS_ERR(xfer)) {
1399                ret = PTR_ERR(xfer);
1400                dev_err(dev, "Message alloc failed(%d)\n", ret);
1401                return ret;
1402        }
1403        req = (struct ti_sci_msg_req_get_clock_num_parents *)xfer->xfer_buf;
1404        req->dev_id = dev_id;
1405        if (clk_id < 255) {
1406                req->clk_id = clk_id;
1407        } else {
1408                req->clk_id = 255;
1409                req->clk_id_32 = clk_id;
1410        }
1411
1412        ret = ti_sci_do_xfer(info, xfer);
1413        if (ret) {
1414                dev_err(dev, "Mbox send fail %d\n", ret);
1415                goto fail;
1416        }
1417
1418        resp = (struct ti_sci_msg_resp_get_clock_num_parents *)xfer->xfer_buf;
1419
1420        if (!ti_sci_is_response_ack(resp)) {
1421                ret = -ENODEV;
1422        } else {
1423                if (resp->num_parents < 255)
1424                        *num_parents = resp->num_parents;
1425                else
1426                        *num_parents = resp->num_parents_32;
1427        }
1428
1429fail:
1430        ti_sci_put_one_xfer(&info->minfo, xfer);
1431
1432        return ret;
1433}
1434
1435/**
1436 * ti_sci_cmd_clk_get_match_freq() - Find a good match for frequency
1437 * @handle:     pointer to TI SCI handle
1438 * @dev_id:     Device identifier this request is for
1439 * @clk_id:     Clock identifier for the device for this request.
1440 *              Each device has it's own set of clock inputs. This indexes
1441 *              which clock input to modify.
1442 * @min_freq:   The minimum allowable frequency in Hz. This is the minimum
1443 *              allowable programmed frequency and does not account for clock
1444 *              tolerances and jitter.
1445 * @target_freq: The target clock frequency in Hz. A frequency will be
1446 *              processed as close to this target frequency as possible.
1447 * @max_freq:   The maximum allowable frequency in Hz. This is the maximum
1448 *              allowable programmed frequency and does not account for clock
1449 *              tolerances and jitter.
1450 * @match_freq: Frequency match in Hz response.
1451 *
1452 * Return: 0 if all went well, else returns appropriate error value.
1453 */
1454static int ti_sci_cmd_clk_get_match_freq(const struct ti_sci_handle *handle,
1455                                         u32 dev_id, u32 clk_id, u64 min_freq,
1456                                         u64 target_freq, u64 max_freq,
1457                                         u64 *match_freq)
1458{
1459        struct ti_sci_info *info;
1460        struct ti_sci_msg_req_query_clock_freq *req;
1461        struct ti_sci_msg_resp_query_clock_freq *resp;
1462        struct ti_sci_xfer *xfer;
1463        struct device *dev;
1464        int ret = 0;
1465
1466        if (IS_ERR(handle))
1467                return PTR_ERR(handle);
1468        if (!handle || !match_freq)
1469                return -EINVAL;
1470
1471        info = handle_to_ti_sci_info(handle);
1472        dev = info->dev;
1473
1474        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_QUERY_CLOCK_FREQ,
1475                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1476                                   sizeof(*req), sizeof(*resp));
1477        if (IS_ERR(xfer)) {
1478                ret = PTR_ERR(xfer);
1479                dev_err(dev, "Message alloc failed(%d)\n", ret);
1480                return ret;
1481        }
1482        req = (struct ti_sci_msg_req_query_clock_freq *)xfer->xfer_buf;
1483        req->dev_id = dev_id;
1484        if (clk_id < 255) {
1485                req->clk_id = clk_id;
1486        } else {
1487                req->clk_id = 255;
1488                req->clk_id_32 = clk_id;
1489        }
1490        req->min_freq_hz = min_freq;
1491        req->target_freq_hz = target_freq;
1492        req->max_freq_hz = max_freq;
1493
1494        ret = ti_sci_do_xfer(info, xfer);
1495        if (ret) {
1496                dev_err(dev, "Mbox send fail %d\n", ret);
1497                goto fail;
1498        }
1499
1500        resp = (struct ti_sci_msg_resp_query_clock_freq *)xfer->xfer_buf;
1501
1502        if (!ti_sci_is_response_ack(resp))
1503                ret = -ENODEV;
1504        else
1505                *match_freq = resp->freq_hz;
1506
1507fail:
1508        ti_sci_put_one_xfer(&info->minfo, xfer);
1509
1510        return ret;
1511}
1512
1513/**
1514 * ti_sci_cmd_clk_set_freq() - Set a frequency for clock
1515 * @handle:     pointer to TI SCI handle
1516 * @dev_id:     Device identifier this request is for
1517 * @clk_id:     Clock identifier for the device for this request.
1518 *              Each device has it's own set of clock inputs. This indexes
1519 *              which clock input to modify.
1520 * @min_freq:   The minimum allowable frequency in Hz. This is the minimum
1521 *              allowable programmed frequency and does not account for clock
1522 *              tolerances and jitter.
1523 * @target_freq: The target clock frequency in Hz. A frequency will be
1524 *              processed as close to this target frequency as possible.
1525 * @max_freq:   The maximum allowable frequency in Hz. This is the maximum
1526 *              allowable programmed frequency and does not account for clock
1527 *              tolerances and jitter.
1528 *
1529 * Return: 0 if all went well, else returns appropriate error value.
1530 */
1531static int ti_sci_cmd_clk_set_freq(const struct ti_sci_handle *handle,
1532                                   u32 dev_id, u32 clk_id, u64 min_freq,
1533                                   u64 target_freq, u64 max_freq)
1534{
1535        struct ti_sci_info *info;
1536        struct ti_sci_msg_req_set_clock_freq *req;
1537        struct ti_sci_msg_hdr *resp;
1538        struct ti_sci_xfer *xfer;
1539        struct device *dev;
1540        int ret = 0;
1541
1542        if (IS_ERR(handle))
1543                return PTR_ERR(handle);
1544        if (!handle)
1545                return -EINVAL;
1546
1547        info = handle_to_ti_sci_info(handle);
1548        dev = info->dev;
1549
1550        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CLOCK_FREQ,
1551                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1552                                   sizeof(*req), sizeof(*resp));
1553        if (IS_ERR(xfer)) {
1554                ret = PTR_ERR(xfer);
1555                dev_err(dev, "Message alloc failed(%d)\n", ret);
1556                return ret;
1557        }
1558        req = (struct ti_sci_msg_req_set_clock_freq *)xfer->xfer_buf;
1559        req->dev_id = dev_id;
1560        if (clk_id < 255) {
1561                req->clk_id = clk_id;
1562        } else {
1563                req->clk_id = 255;
1564                req->clk_id_32 = clk_id;
1565        }
1566        req->min_freq_hz = min_freq;
1567        req->target_freq_hz = target_freq;
1568        req->max_freq_hz = max_freq;
1569
1570        ret = ti_sci_do_xfer(info, xfer);
1571        if (ret) {
1572                dev_err(dev, "Mbox send fail %d\n", ret);
1573                goto fail;
1574        }
1575
1576        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1577
1578        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
1579
1580fail:
1581        ti_sci_put_one_xfer(&info->minfo, xfer);
1582
1583        return ret;
1584}
1585
1586/**
1587 * ti_sci_cmd_clk_get_freq() - Get current frequency
1588 * @handle:     pointer to TI SCI handle
1589 * @dev_id:     Device identifier this request is for
1590 * @clk_id:     Clock identifier for the device for this request.
1591 *              Each device has it's own set of clock inputs. This indexes
1592 *              which clock input to modify.
1593 * @freq:       Currently frequency in Hz
1594 *
1595 * Return: 0 if all went well, else returns appropriate error value.
1596 */
1597static int ti_sci_cmd_clk_get_freq(const struct ti_sci_handle *handle,
1598                                   u32 dev_id, u32 clk_id, u64 *freq)
1599{
1600        struct ti_sci_info *info;
1601        struct ti_sci_msg_req_get_clock_freq *req;
1602        struct ti_sci_msg_resp_get_clock_freq *resp;
1603        struct ti_sci_xfer *xfer;
1604        struct device *dev;
1605        int ret = 0;
1606
1607        if (IS_ERR(handle))
1608                return PTR_ERR(handle);
1609        if (!handle || !freq)
1610                return -EINVAL;
1611
1612        info = handle_to_ti_sci_info(handle);
1613        dev = info->dev;
1614
1615        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_CLOCK_FREQ,
1616                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1617                                   sizeof(*req), sizeof(*resp));
1618        if (IS_ERR(xfer)) {
1619                ret = PTR_ERR(xfer);
1620                dev_err(dev, "Message alloc failed(%d)\n", ret);
1621                return ret;
1622        }
1623        req = (struct ti_sci_msg_req_get_clock_freq *)xfer->xfer_buf;
1624        req->dev_id = dev_id;
1625        if (clk_id < 255) {
1626                req->clk_id = clk_id;
1627        } else {
1628                req->clk_id = 255;
1629                req->clk_id_32 = clk_id;
1630        }
1631
1632        ret = ti_sci_do_xfer(info, xfer);
1633        if (ret) {
1634                dev_err(dev, "Mbox send fail %d\n", ret);
1635                goto fail;
1636        }
1637
1638        resp = (struct ti_sci_msg_resp_get_clock_freq *)xfer->xfer_buf;
1639
1640        if (!ti_sci_is_response_ack(resp))
1641                ret = -ENODEV;
1642        else
1643                *freq = resp->freq_hz;
1644
1645fail:
1646        ti_sci_put_one_xfer(&info->minfo, xfer);
1647
1648        return ret;
1649}
1650
1651static int ti_sci_cmd_core_reboot(const struct ti_sci_handle *handle)
1652{
1653        struct ti_sci_info *info;
1654        struct ti_sci_msg_req_reboot *req;
1655        struct ti_sci_msg_hdr *resp;
1656        struct ti_sci_xfer *xfer;
1657        struct device *dev;
1658        int ret = 0;
1659
1660        if (IS_ERR(handle))
1661                return PTR_ERR(handle);
1662        if (!handle)
1663                return -EINVAL;
1664
1665        info = handle_to_ti_sci_info(handle);
1666        dev = info->dev;
1667
1668        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SYS_RESET,
1669                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1670                                   sizeof(*req), sizeof(*resp));
1671        if (IS_ERR(xfer)) {
1672                ret = PTR_ERR(xfer);
1673                dev_err(dev, "Message alloc failed(%d)\n", ret);
1674                return ret;
1675        }
1676        req = (struct ti_sci_msg_req_reboot *)xfer->xfer_buf;
1677
1678        ret = ti_sci_do_xfer(info, xfer);
1679        if (ret) {
1680                dev_err(dev, "Mbox send fail %d\n", ret);
1681                goto fail;
1682        }
1683
1684        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1685
1686        if (!ti_sci_is_response_ack(resp))
1687                ret = -ENODEV;
1688        else
1689                ret = 0;
1690
1691fail:
1692        ti_sci_put_one_xfer(&info->minfo, xfer);
1693
1694        return ret;
1695}
1696
1697/**
1698 * ti_sci_get_resource_range - Helper to get a range of resources assigned
1699 *                             to a host. Resource is uniquely identified by
1700 *                             type and subtype.
1701 * @handle:             Pointer to TISCI handle.
1702 * @dev_id:             TISCI device ID.
1703 * @subtype:            Resource assignment subtype that is being requested
1704 *                      from the given device.
1705 * @s_host:             Host processor ID to which the resources are allocated
1706 * @desc:               Pointer to ti_sci_resource_desc to be updated with the
1707 *                      resource range start index and number of resources
1708 *
1709 * Return: 0 if all went fine, else return appropriate error.
1710 */
1711static int ti_sci_get_resource_range(const struct ti_sci_handle *handle,
1712                                     u32 dev_id, u8 subtype, u8 s_host,
1713                                     struct ti_sci_resource_desc *desc)
1714{
1715        struct ti_sci_msg_resp_get_resource_range *resp;
1716        struct ti_sci_msg_req_get_resource_range *req;
1717        struct ti_sci_xfer *xfer;
1718        struct ti_sci_info *info;
1719        struct device *dev;
1720        int ret = 0;
1721
1722        if (IS_ERR(handle))
1723                return PTR_ERR(handle);
1724        if (!handle || !desc)
1725                return -EINVAL;
1726
1727        info = handle_to_ti_sci_info(handle);
1728        dev = info->dev;
1729
1730        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_RESOURCE_RANGE,
1731                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1732                                   sizeof(*req), sizeof(*resp));
1733        if (IS_ERR(xfer)) {
1734                ret = PTR_ERR(xfer);
1735                dev_err(dev, "Message alloc failed(%d)\n", ret);
1736                return ret;
1737        }
1738
1739        req = (struct ti_sci_msg_req_get_resource_range *)xfer->xfer_buf;
1740        req->secondary_host = s_host;
1741        req->type = dev_id & MSG_RM_RESOURCE_TYPE_MASK;
1742        req->subtype = subtype & MSG_RM_RESOURCE_SUBTYPE_MASK;
1743
1744        ret = ti_sci_do_xfer(info, xfer);
1745        if (ret) {
1746                dev_err(dev, "Mbox send fail %d\n", ret);
1747                goto fail;
1748        }
1749
1750        resp = (struct ti_sci_msg_resp_get_resource_range *)xfer->xfer_buf;
1751
1752        if (!ti_sci_is_response_ack(resp)) {
1753                ret = -ENODEV;
1754        } else if (!resp->range_num && !resp->range_num_sec) {
1755                /* Neither of the two resource range is valid */
1756                ret = -ENODEV;
1757        } else {
1758                desc->start = resp->range_start;
1759                desc->num = resp->range_num;
1760                desc->start_sec = resp->range_start_sec;
1761                desc->num_sec = resp->range_num_sec;
1762        };
1763
1764fail:
1765        ti_sci_put_one_xfer(&info->minfo, xfer);
1766
1767        return ret;
1768}
1769
1770/**
1771 * ti_sci_cmd_get_resource_range - Get a range of resources assigned to host
1772 *                                 that is same as ti sci interface host.
1773 * @handle:             Pointer to TISCI handle.
1774 * @dev_id:             TISCI device ID.
1775 * @subtype:            Resource assignment subtype that is being requested
1776 *                      from the given device.
1777 * @desc:               Pointer to ti_sci_resource_desc to be updated with the
1778 *                      resource range start index and number of resources
1779 *
1780 * Return: 0 if all went fine, else return appropriate error.
1781 */
1782static int ti_sci_cmd_get_resource_range(const struct ti_sci_handle *handle,
1783                                         u32 dev_id, u8 subtype,
1784                                         struct ti_sci_resource_desc *desc)
1785{
1786        return ti_sci_get_resource_range(handle, dev_id, subtype,
1787                                         TI_SCI_IRQ_SECONDARY_HOST_INVALID,
1788                                         desc);
1789}
1790
1791/**
1792 * ti_sci_cmd_get_resource_range_from_shost - Get a range of resources
1793 *                                            assigned to a specified host.
1794 * @handle:             Pointer to TISCI handle.
1795 * @dev_id:             TISCI device ID.
1796 * @subtype:            Resource assignment subtype that is being requested
1797 *                      from the given device.
1798 * @s_host:             Host processor ID to which the resources are allocated
1799 * @desc:               Pointer to ti_sci_resource_desc to be updated with the
1800 *                      resource range start index and number of resources
1801 *
1802 * Return: 0 if all went fine, else return appropriate error.
1803 */
1804static
1805int ti_sci_cmd_get_resource_range_from_shost(const struct ti_sci_handle *handle,
1806                                             u32 dev_id, u8 subtype, u8 s_host,
1807                                             struct ti_sci_resource_desc *desc)
1808{
1809        return ti_sci_get_resource_range(handle, dev_id, subtype, s_host, desc);
1810}
1811
1812/**
1813 * ti_sci_manage_irq() - Helper api to configure/release the irq route between
1814 *                       the requested source and destination
1815 * @handle:             Pointer to TISCI handle.
1816 * @valid_params:       Bit fields defining the validity of certain params
1817 * @src_id:             Device ID of the IRQ source
1818 * @src_index:          IRQ source index within the source device
1819 * @dst_id:             Device ID of the IRQ destination
1820 * @dst_host_irq:       IRQ number of the destination device
1821 * @ia_id:              Device ID of the IA, if the IRQ flows through this IA
1822 * @vint:               Virtual interrupt to be used within the IA
1823 * @global_event:       Global event number to be used for the requesting event
1824 * @vint_status_bit:    Virtual interrupt status bit to be used for the event
1825 * @s_host:             Secondary host ID to which the irq/event is being
1826 *                      requested for.
1827 * @type:               Request type irq set or release.
1828 *
1829 * Return: 0 if all went fine, else return appropriate error.
1830 */
1831static int ti_sci_manage_irq(const struct ti_sci_handle *handle,
1832                             u32 valid_params, u16 src_id, u16 src_index,
1833                             u16 dst_id, u16 dst_host_irq, u16 ia_id, u16 vint,
1834                             u16 global_event, u8 vint_status_bit, u8 s_host,
1835                             u16 type)
1836{
1837        struct ti_sci_msg_req_manage_irq *req;
1838        struct ti_sci_msg_hdr *resp;
1839        struct ti_sci_xfer *xfer;
1840        struct ti_sci_info *info;
1841        struct device *dev;
1842        int ret = 0;
1843
1844        if (IS_ERR(handle))
1845                return PTR_ERR(handle);
1846        if (!handle)
1847                return -EINVAL;
1848
1849        info = handle_to_ti_sci_info(handle);
1850        dev = info->dev;
1851
1852        xfer = ti_sci_get_one_xfer(info, type, TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1853                                   sizeof(*req), sizeof(*resp));
1854        if (IS_ERR(xfer)) {
1855                ret = PTR_ERR(xfer);
1856                dev_err(dev, "Message alloc failed(%d)\n", ret);
1857                return ret;
1858        }
1859        req = (struct ti_sci_msg_req_manage_irq *)xfer->xfer_buf;
1860        req->valid_params = valid_params;
1861        req->src_id = src_id;
1862        req->src_index = src_index;
1863        req->dst_id = dst_id;
1864        req->dst_host_irq = dst_host_irq;
1865        req->ia_id = ia_id;
1866        req->vint = vint;
1867        req->global_event = global_event;
1868        req->vint_status_bit = vint_status_bit;
1869        req->secondary_host = s_host;
1870
1871        ret = ti_sci_do_xfer(info, xfer);
1872        if (ret) {
1873                dev_err(dev, "Mbox send fail %d\n", ret);
1874                goto fail;
1875        }
1876
1877        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1878
1879        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
1880
1881fail:
1882        ti_sci_put_one_xfer(&info->minfo, xfer);
1883
1884        return ret;
1885}
1886
1887/**
1888 * ti_sci_set_irq() - Helper api to configure the irq route between the
1889 *                    requested source and destination
1890 * @handle:             Pointer to TISCI handle.
1891 * @valid_params:       Bit fields defining the validity of certain params
1892 * @src_id:             Device ID of the IRQ source
1893 * @src_index:          IRQ source index within the source device
1894 * @dst_id:             Device ID of the IRQ destination
1895 * @dst_host_irq:       IRQ number of the destination device
1896 * @ia_id:              Device ID of the IA, if the IRQ flows through this IA
1897 * @vint:               Virtual interrupt to be used within the IA
1898 * @global_event:       Global event number to be used for the requesting event
1899 * @vint_status_bit:    Virtual interrupt status bit to be used for the event
1900 * @s_host:             Secondary host ID to which the irq/event is being
1901 *                      requested for.
1902 *
1903 * Return: 0 if all went fine, else return appropriate error.
1904 */
1905static int ti_sci_set_irq(const struct ti_sci_handle *handle, u32 valid_params,
1906                          u16 src_id, u16 src_index, u16 dst_id,
1907                          u16 dst_host_irq, u16 ia_id, u16 vint,
1908                          u16 global_event, u8 vint_status_bit, u8 s_host)
1909{
1910        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",
1911                 __func__, valid_params, src_id, src_index,
1912                 dst_id, dst_host_irq, ia_id, vint, global_event,
1913                 vint_status_bit);
1914
1915        return ti_sci_manage_irq(handle, valid_params, src_id, src_index,
1916                                 dst_id, dst_host_irq, ia_id, vint,
1917                                 global_event, vint_status_bit, s_host,
1918                                 TI_SCI_MSG_SET_IRQ);
1919}
1920
1921/**
1922 * ti_sci_free_irq() - Helper api to free the irq route between the
1923 *                         requested source and destination
1924 * @handle:             Pointer to TISCI handle.
1925 * @valid_params:       Bit fields defining the validity of certain params
1926 * @src_id:             Device ID of the IRQ source
1927 * @src_index:          IRQ source index within the source device
1928 * @dst_id:             Device ID of the IRQ destination
1929 * @dst_host_irq:       IRQ number of the destination device
1930 * @ia_id:              Device ID of the IA, if the IRQ flows through this IA
1931 * @vint:               Virtual interrupt to be used within the IA
1932 * @global_event:       Global event number to be used for the requesting event
1933 * @vint_status_bit:    Virtual interrupt status bit to be used for the event
1934 * @s_host:             Secondary host ID to which the irq/event is being
1935 *                      requested for.
1936 *
1937 * Return: 0 if all went fine, else return appropriate error.
1938 */
1939static int ti_sci_free_irq(const struct ti_sci_handle *handle, u32 valid_params,
1940                           u16 src_id, u16 src_index, u16 dst_id,
1941                           u16 dst_host_irq, u16 ia_id, u16 vint,
1942                           u16 global_event, u8 vint_status_bit, u8 s_host)
1943{
1944        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",
1945                 __func__, valid_params, src_id, src_index,
1946                 dst_id, dst_host_irq, ia_id, vint, global_event,
1947                 vint_status_bit);
1948
1949        return ti_sci_manage_irq(handle, valid_params, src_id, src_index,
1950                                 dst_id, dst_host_irq, ia_id, vint,
1951                                 global_event, vint_status_bit, s_host,
1952                                 TI_SCI_MSG_FREE_IRQ);
1953}
1954
1955/**
1956 * ti_sci_cmd_set_irq() - Configure a host irq route between the requested
1957 *                        source and destination.
1958 * @handle:             Pointer to TISCI handle.
1959 * @src_id:             Device ID of the IRQ source
1960 * @src_index:          IRQ source index within the source device
1961 * @dst_id:             Device ID of the IRQ destination
1962 * @dst_host_irq:       IRQ number of the destination device
1963 * @vint_irq:           Boolean specifying if this interrupt belongs to
1964 *                      Interrupt Aggregator.
1965 *
1966 * Return: 0 if all went fine, else return appropriate error.
1967 */
1968static int ti_sci_cmd_set_irq(const struct ti_sci_handle *handle, u16 src_id,
1969                              u16 src_index, u16 dst_id, u16 dst_host_irq)
1970{
1971        u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID;
1972
1973        return ti_sci_set_irq(handle, valid_params, src_id, src_index, dst_id,
1974                              dst_host_irq, 0, 0, 0, 0, 0);
1975}
1976
1977/**
1978 * ti_sci_cmd_set_event_map() - Configure an event based irq route between the
1979 *                              requested source and Interrupt Aggregator.
1980 * @handle:             Pointer to TISCI handle.
1981 * @src_id:             Device ID of the IRQ source
1982 * @src_index:          IRQ source index within the source device
1983 * @ia_id:              Device ID of the IA, if the IRQ flows through this IA
1984 * @vint:               Virtual interrupt to be used within the IA
1985 * @global_event:       Global event number to be used for the requesting event
1986 * @vint_status_bit:    Virtual interrupt status bit to be used for the event
1987 *
1988 * Return: 0 if all went fine, else return appropriate error.
1989 */
1990static int ti_sci_cmd_set_event_map(const struct ti_sci_handle *handle,
1991                                    u16 src_id, u16 src_index, u16 ia_id,
1992                                    u16 vint, u16 global_event,
1993                                    u8 vint_status_bit)
1994{
1995        u32 valid_params = MSG_FLAG_IA_ID_VALID | MSG_FLAG_VINT_VALID |
1996                           MSG_FLAG_GLB_EVNT_VALID |
1997                           MSG_FLAG_VINT_STS_BIT_VALID;
1998
1999        return ti_sci_set_irq(handle, valid_params, src_id, src_index, 0, 0,
2000                              ia_id, vint, global_event, vint_status_bit, 0);
2001}
2002
2003/**
2004 * ti_sci_cmd_free_irq() - Free a host irq route between the between the
2005 *                         requested source and destination.
2006 * @handle:             Pointer to TISCI handle.
2007 * @src_id:             Device ID of the IRQ source
2008 * @src_index:          IRQ source index within the source device
2009 * @dst_id:             Device ID of the IRQ destination
2010 * @dst_host_irq:       IRQ number of the destination device
2011 * @vint_irq:           Boolean specifying if this interrupt belongs to
2012 *                      Interrupt Aggregator.
2013 *
2014 * Return: 0 if all went fine, else return appropriate error.
2015 */
2016static int ti_sci_cmd_free_irq(const struct ti_sci_handle *handle, u16 src_id,
2017                               u16 src_index, u16 dst_id, u16 dst_host_irq)
2018{
2019        u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID;
2020
2021        return ti_sci_free_irq(handle, valid_params, src_id, src_index, dst_id,
2022                               dst_host_irq, 0, 0, 0, 0, 0);
2023}
2024
2025/**
2026 * ti_sci_cmd_free_event_map() - Free an event map between the requested source
2027 *                               and Interrupt Aggregator.
2028 * @handle:             Pointer to TISCI handle.
2029 * @src_id:             Device ID of the IRQ source
2030 * @src_index:          IRQ source index within the source device
2031 * @ia_id:              Device ID of the IA, if the IRQ flows through this IA
2032 * @vint:               Virtual interrupt to be used within the IA
2033 * @global_event:       Global event number to be used for the requesting event
2034 * @vint_status_bit:    Virtual interrupt status bit to be used for the event
2035 *
2036 * Return: 0 if all went fine, else return appropriate error.
2037 */
2038static int ti_sci_cmd_free_event_map(const struct ti_sci_handle *handle,
2039                                     u16 src_id, u16 src_index, u16 ia_id,
2040                                     u16 vint, u16 global_event,
2041                                     u8 vint_status_bit)
2042{
2043        u32 valid_params = MSG_FLAG_IA_ID_VALID |
2044                           MSG_FLAG_VINT_VALID | MSG_FLAG_GLB_EVNT_VALID |
2045                           MSG_FLAG_VINT_STS_BIT_VALID;
2046
2047        return ti_sci_free_irq(handle, valid_params, src_id, src_index, 0, 0,
2048                               ia_id, vint, global_event, vint_status_bit, 0);
2049}
2050
2051/**
2052 * ti_sci_cmd_rm_ring_cfg() - Configure a NAVSS ring
2053 * @handle:     Pointer to TI SCI handle.
2054 * @params:     Pointer to ti_sci_msg_rm_ring_cfg ring config structure
2055 *
2056 * Return: 0 if all went well, else returns appropriate error value.
2057 *
2058 * See @ti_sci_msg_rm_ring_cfg and @ti_sci_msg_rm_ring_cfg_req for
2059 * more info.
2060 */
2061static int ti_sci_cmd_rm_ring_cfg(const struct ti_sci_handle *handle,
2062                                  const struct ti_sci_msg_rm_ring_cfg *params)
2063{
2064        struct ti_sci_msg_rm_ring_cfg_req *req;
2065        struct ti_sci_msg_hdr *resp;
2066        struct ti_sci_xfer *xfer;
2067        struct ti_sci_info *info;
2068        struct device *dev;
2069        int ret = 0;
2070
2071        if (IS_ERR_OR_NULL(handle))
2072                return -EINVAL;
2073
2074        info = handle_to_ti_sci_info(handle);
2075        dev = info->dev;
2076
2077        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_RING_CFG,
2078                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2079                                   sizeof(*req), sizeof(*resp));
2080        if (IS_ERR(xfer)) {
2081                ret = PTR_ERR(xfer);
2082                dev_err(dev, "RM_RA:Message config failed(%d)\n", ret);
2083                return ret;
2084        }
2085        req = (struct ti_sci_msg_rm_ring_cfg_req *)xfer->xfer_buf;
2086        req->valid_params = params->valid_params;
2087        req->nav_id = params->nav_id;
2088        req->index = params->index;
2089        req->addr_lo = params->addr_lo;
2090        req->addr_hi = params->addr_hi;
2091        req->count = params->count;
2092        req->mode = params->mode;
2093        req->size = params->size;
2094        req->order_id = params->order_id;
2095        req->virtid = params->virtid;
2096        req->asel = params->asel;
2097
2098        ret = ti_sci_do_xfer(info, xfer);
2099        if (ret) {
2100                dev_err(dev, "RM_RA:Mbox config send fail %d\n", ret);
2101                goto fail;
2102        }
2103
2104        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2105        ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2106
2107fail:
2108        ti_sci_put_one_xfer(&info->minfo, xfer);
2109        dev_dbg(dev, "RM_RA:config ring %u ret:%d\n", params->index, ret);
2110        return ret;
2111}
2112
2113/**
2114 * ti_sci_cmd_rm_psil_pair() - Pair PSI-L source to destination thread
2115 * @handle:     Pointer to TI SCI handle.
2116 * @nav_id:     Device ID of Navigator Subsystem which should be used for
2117 *              pairing
2118 * @src_thread: Source PSI-L thread ID
2119 * @dst_thread: Destination PSI-L thread ID
2120 *
2121 * Return: 0 if all went well, else returns appropriate error value.
2122 */
2123static int ti_sci_cmd_rm_psil_pair(const struct ti_sci_handle *handle,
2124                                   u32 nav_id, u32 src_thread, u32 dst_thread)
2125{
2126        struct ti_sci_msg_psil_pair *req;
2127        struct ti_sci_msg_hdr *resp;
2128        struct ti_sci_xfer *xfer;
2129        struct ti_sci_info *info;
2130        struct device *dev;
2131        int ret = 0;
2132
2133        if (IS_ERR(handle))
2134                return PTR_ERR(handle);
2135        if (!handle)
2136                return -EINVAL;
2137
2138        info = handle_to_ti_sci_info(handle);
2139        dev = info->dev;
2140
2141        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_PAIR,
2142                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2143                                   sizeof(*req), sizeof(*resp));
2144        if (IS_ERR(xfer)) {
2145                ret = PTR_ERR(xfer);
2146                dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret);
2147                return ret;
2148        }
2149        req = (struct ti_sci_msg_psil_pair *)xfer->xfer_buf;
2150        req->nav_id = nav_id;
2151        req->src_thread = src_thread;
2152        req->dst_thread = dst_thread;
2153
2154        ret = ti_sci_do_xfer(info, xfer);
2155        if (ret) {
2156                dev_err(dev, "RM_PSIL:Mbox send fail %d\n", ret);
2157                goto fail;
2158        }
2159
2160        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2161        ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2162
2163fail:
2164        ti_sci_put_one_xfer(&info->minfo, xfer);
2165
2166        return ret;
2167}
2168
2169/**
2170 * ti_sci_cmd_rm_psil_unpair() - Unpair PSI-L source from destination thread
2171 * @handle:     Pointer to TI SCI handle.
2172 * @nav_id:     Device ID of Navigator Subsystem which should be used for
2173 *              unpairing
2174 * @src_thread: Source PSI-L thread ID
2175 * @dst_thread: Destination PSI-L thread ID
2176 *
2177 * Return: 0 if all went well, else returns appropriate error value.
2178 */
2179static int ti_sci_cmd_rm_psil_unpair(const struct ti_sci_handle *handle,
2180                                     u32 nav_id, u32 src_thread, u32 dst_thread)
2181{
2182        struct ti_sci_msg_psil_unpair *req;
2183        struct ti_sci_msg_hdr *resp;
2184        struct ti_sci_xfer *xfer;
2185        struct ti_sci_info *info;
2186        struct device *dev;
2187        int ret = 0;
2188
2189        if (IS_ERR(handle))
2190                return PTR_ERR(handle);
2191        if (!handle)
2192                return -EINVAL;
2193
2194        info = handle_to_ti_sci_info(handle);
2195        dev = info->dev;
2196
2197        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_RM_PSIL_UNPAIR,
2198                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2199                                   sizeof(*req), sizeof(*resp));
2200        if (IS_ERR(xfer)) {
2201                ret = PTR_ERR(xfer);
2202                dev_err(dev, "RM_PSIL:Message reconfig failed(%d)\n", ret);
2203                return ret;
2204        }
2205        req = (struct ti_sci_msg_psil_unpair *)xfer->xfer_buf;
2206        req->nav_id = nav_id;
2207        req->src_thread = src_thread;
2208        req->dst_thread = dst_thread;
2209
2210        ret = ti_sci_do_xfer(info, xfer);
2211        if (ret) {
2212                dev_err(dev, "RM_PSIL:Mbox send fail %d\n", ret);
2213                goto fail;
2214        }
2215
2216        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2217        ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2218
2219fail:
2220        ti_sci_put_one_xfer(&info->minfo, xfer);
2221
2222        return ret;
2223}
2224
2225/**
2226 * ti_sci_cmd_rm_udmap_tx_ch_cfg() - Configure a UDMAP TX channel
2227 * @handle:     Pointer to TI SCI handle.
2228 * @params:     Pointer to ti_sci_msg_rm_udmap_tx_ch_cfg TX channel config
2229 *              structure
2230 *
2231 * Return: 0 if all went well, else returns appropriate error value.
2232 *
2233 * See @ti_sci_msg_rm_udmap_tx_ch_cfg and @ti_sci_msg_rm_udmap_tx_ch_cfg_req for
2234 * more info.
2235 */
2236static int ti_sci_cmd_rm_udmap_tx_ch_cfg(const struct ti_sci_handle *handle,
2237                        const struct ti_sci_msg_rm_udmap_tx_ch_cfg *params)
2238{
2239        struct ti_sci_msg_rm_udmap_tx_ch_cfg_req *req;
2240        struct ti_sci_msg_hdr *resp;
2241        struct ti_sci_xfer *xfer;
2242        struct ti_sci_info *info;
2243        struct device *dev;
2244        int ret = 0;
2245
2246        if (IS_ERR_OR_NULL(handle))
2247                return -EINVAL;
2248
2249        info = handle_to_ti_sci_info(handle);
2250        dev = info->dev;
2251
2252        xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_TX_CH_CFG,
2253                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2254                                   sizeof(*req), sizeof(*resp));
2255        if (IS_ERR(xfer)) {
2256                ret = PTR_ERR(xfer);
2257                dev_err(dev, "Message TX_CH_CFG alloc failed(%d)\n", ret);
2258                return ret;
2259        }
2260        req = (struct ti_sci_msg_rm_udmap_tx_ch_cfg_req *)xfer->xfer_buf;
2261        req->valid_params = params->valid_params;
2262        req->nav_id = params->nav_id;
2263        req->index = params->index;
2264        req->tx_pause_on_err = params->tx_pause_on_err;
2265        req->tx_filt_einfo = params->tx_filt_einfo;
2266        req->tx_filt_pswords = params->tx_filt_pswords;
2267        req->tx_atype = params->tx_atype;
2268        req->tx_chan_type = params->tx_chan_type;
2269        req->tx_supr_tdpkt = params->tx_supr_tdpkt;
2270        req->tx_fetch_size = params->tx_fetch_size;
2271        req->tx_credit_count = params->tx_credit_count;
2272        req->txcq_qnum = params->txcq_qnum;
2273        req->tx_priority = params->tx_priority;
2274        req->tx_qos = params->tx_qos;
2275        req->tx_orderid = params->tx_orderid;
2276        req->fdepth = params->fdepth;
2277        req->tx_sched_priority = params->tx_sched_priority;
2278        req->tx_burst_size = params->tx_burst_size;
2279        req->tx_tdtype = params->tx_tdtype;
2280        req->extended_ch_type = params->extended_ch_type;
2281
2282        ret = ti_sci_do_xfer(info, xfer);
2283        if (ret) {
2284                dev_err(dev, "Mbox send TX_CH_CFG fail %d\n", ret);
2285                goto fail;
2286        }
2287
2288        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2289        ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2290
2291fail:
2292        ti_sci_put_one_xfer(&info->minfo, xfer);
2293        dev_dbg(dev, "TX_CH_CFG: chn %u ret:%u\n", params->index, ret);
2294        return ret;
2295}
2296
2297/**
2298 * ti_sci_cmd_rm_udmap_rx_ch_cfg() - Configure a UDMAP RX channel
2299 * @handle:     Pointer to TI SCI handle.
2300 * @params:     Pointer to ti_sci_msg_rm_udmap_rx_ch_cfg RX channel config
2301 *              structure
2302 *
2303 * Return: 0 if all went well, else returns appropriate error value.
2304 *
2305 * See @ti_sci_msg_rm_udmap_rx_ch_cfg and @ti_sci_msg_rm_udmap_rx_ch_cfg_req for
2306 * more info.
2307 */
2308static int ti_sci_cmd_rm_udmap_rx_ch_cfg(const struct ti_sci_handle *handle,
2309                        const struct ti_sci_msg_rm_udmap_rx_ch_cfg *params)
2310{
2311        struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *req;
2312        struct ti_sci_msg_hdr *resp;
2313        struct ti_sci_xfer *xfer;
2314        struct ti_sci_info *info;
2315        struct device *dev;
2316        int ret = 0;
2317
2318        if (IS_ERR_OR_NULL(handle))
2319                return -EINVAL;
2320
2321        info = handle_to_ti_sci_info(handle);
2322        dev = info->dev;
2323
2324        xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_RX_CH_CFG,
2325                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2326                                   sizeof(*req), sizeof(*resp));
2327        if (IS_ERR(xfer)) {
2328                ret = PTR_ERR(xfer);
2329                dev_err(dev, "Message RX_CH_CFG alloc failed(%d)\n", ret);
2330                return ret;
2331        }
2332        req = (struct ti_sci_msg_rm_udmap_rx_ch_cfg_req *)xfer->xfer_buf;
2333        req->valid_params = params->valid_params;
2334        req->nav_id = params->nav_id;
2335        req->index = params->index;
2336        req->rx_fetch_size = params->rx_fetch_size;
2337        req->rxcq_qnum = params->rxcq_qnum;
2338        req->rx_priority = params->rx_priority;
2339        req->rx_qos = params->rx_qos;
2340        req->rx_orderid = params->rx_orderid;
2341        req->rx_sched_priority = params->rx_sched_priority;
2342        req->flowid_start = params->flowid_start;
2343        req->flowid_cnt = params->flowid_cnt;
2344        req->rx_pause_on_err = params->rx_pause_on_err;
2345        req->rx_atype = params->rx_atype;
2346        req->rx_chan_type = params->rx_chan_type;
2347        req->rx_ignore_short = params->rx_ignore_short;
2348        req->rx_ignore_long = params->rx_ignore_long;
2349        req->rx_burst_size = params->rx_burst_size;
2350
2351        ret = ti_sci_do_xfer(info, xfer);
2352        if (ret) {
2353                dev_err(dev, "Mbox send RX_CH_CFG fail %d\n", ret);
2354                goto fail;
2355        }
2356
2357        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2358        ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2359
2360fail:
2361        ti_sci_put_one_xfer(&info->minfo, xfer);
2362        dev_dbg(dev, "RX_CH_CFG: chn %u ret:%d\n", params->index, ret);
2363        return ret;
2364}
2365
2366/**
2367 * ti_sci_cmd_rm_udmap_rx_flow_cfg() - Configure UDMAP RX FLOW
2368 * @handle:     Pointer to TI SCI handle.
2369 * @params:     Pointer to ti_sci_msg_rm_udmap_flow_cfg RX FLOW config
2370 *              structure
2371 *
2372 * Return: 0 if all went well, else returns appropriate error value.
2373 *
2374 * See @ti_sci_msg_rm_udmap_flow_cfg and @ti_sci_msg_rm_udmap_flow_cfg_req for
2375 * more info.
2376 */
2377static int ti_sci_cmd_rm_udmap_rx_flow_cfg(const struct ti_sci_handle *handle,
2378                        const struct ti_sci_msg_rm_udmap_flow_cfg *params)
2379{
2380        struct ti_sci_msg_rm_udmap_flow_cfg_req *req;
2381        struct ti_sci_msg_hdr *resp;
2382        struct ti_sci_xfer *xfer;
2383        struct ti_sci_info *info;
2384        struct device *dev;
2385        int ret = 0;
2386
2387        if (IS_ERR_OR_NULL(handle))
2388                return -EINVAL;
2389
2390        info = handle_to_ti_sci_info(handle);
2391        dev = info->dev;
2392
2393        xfer = ti_sci_get_one_xfer(info, TISCI_MSG_RM_UDMAP_FLOW_CFG,
2394                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2395                                   sizeof(*req), sizeof(*resp));
2396        if (IS_ERR(xfer)) {
2397                ret = PTR_ERR(xfer);
2398                dev_err(dev, "RX_FL_CFG: Message alloc failed(%d)\n", ret);
2399                return ret;
2400        }
2401        req = (struct ti_sci_msg_rm_udmap_flow_cfg_req *)xfer->xfer_buf;
2402        req->valid_params = params->valid_params;
2403        req->nav_id = params->nav_id;
2404        req->flow_index = params->flow_index;
2405        req->rx_einfo_present = params->rx_einfo_present;
2406        req->rx_psinfo_present = params->rx_psinfo_present;
2407        req->rx_error_handling = params->rx_error_handling;
2408        req->rx_desc_type = params->rx_desc_type;
2409        req->rx_sop_offset = params->rx_sop_offset;
2410        req->rx_dest_qnum = params->rx_dest_qnum;
2411        req->rx_src_tag_hi = params->rx_src_tag_hi;
2412        req->rx_src_tag_lo = params->rx_src_tag_lo;
2413        req->rx_dest_tag_hi = params->rx_dest_tag_hi;
2414        req->rx_dest_tag_lo = params->rx_dest_tag_lo;
2415        req->rx_src_tag_hi_sel = params->rx_src_tag_hi_sel;
2416        req->rx_src_tag_lo_sel = params->rx_src_tag_lo_sel;
2417        req->rx_dest_tag_hi_sel = params->rx_dest_tag_hi_sel;
2418        req->rx_dest_tag_lo_sel = params->rx_dest_tag_lo_sel;
2419        req->rx_fdq0_sz0_qnum = params->rx_fdq0_sz0_qnum;
2420        req->rx_fdq1_qnum = params->rx_fdq1_qnum;
2421        req->rx_fdq2_qnum = params->rx_fdq2_qnum;
2422        req->rx_fdq3_qnum = params->rx_fdq3_qnum;
2423        req->rx_ps_location = params->rx_ps_location;
2424
2425        ret = ti_sci_do_xfer(info, xfer);
2426        if (ret) {
2427                dev_err(dev, "RX_FL_CFG: Mbox send fail %d\n", ret);
2428                goto fail;
2429        }
2430
2431        resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2432        ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2433
2434fail:
2435        ti_sci_put_one_xfer(&info->minfo, xfer);
2436        dev_dbg(info->dev, "RX_FL_CFG: %u ret:%d\n", params->flow_index, ret);
2437        return ret;
2438}
2439
2440/**
2441 * ti_sci_cmd_proc_request() - Command to request a physical processor control
2442 * @handle:     Pointer to TI SCI handle
2443 * @proc_id:    Processor ID this request is for
2444 *
2445 * Return: 0 if all went well, else returns appropriate error value.
2446 */
2447static int ti_sci_cmd_proc_request(const struct ti_sci_handle *handle,
2448                                   u8 proc_id)
2449{
2450        struct ti_sci_msg_req_proc_request *req;
2451        struct ti_sci_msg_hdr *resp;
2452        struct ti_sci_info *info;
2453        struct ti_sci_xfer *xfer;
2454        struct device *dev;
2455        int ret = 0;
2456
2457        if (!handle)
2458                return -EINVAL;
2459        if (IS_ERR(handle))
2460                return PTR_ERR(handle);
2461
2462        info = handle_to_ti_sci_info(handle);
2463        dev = info->dev;
2464
2465        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_REQUEST,
2466                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2467                                   sizeof(*req), sizeof(*resp));
2468        if (IS_ERR(xfer)) {
2469                ret = PTR_ERR(xfer);
2470                dev_err(dev, "Message alloc failed(%d)\n", ret);
2471                return ret;
2472        }
2473        req = (struct ti_sci_msg_req_proc_request *)xfer->xfer_buf;
2474        req->processor_id = proc_id;
2475
2476        ret = ti_sci_do_xfer(info, xfer);
2477        if (ret) {
2478                dev_err(dev, "Mbox send fail %d\n", ret);
2479                goto fail;
2480        }
2481
2482        resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2483
2484        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2485
2486fail:
2487        ti_sci_put_one_xfer(&info->minfo, xfer);
2488
2489        return ret;
2490}
2491
2492/**
2493 * ti_sci_cmd_proc_release() - Command to release a physical processor control
2494 * @handle:     Pointer to TI SCI handle
2495 * @proc_id:    Processor ID this request is for
2496 *
2497 * Return: 0 if all went well, else returns appropriate error value.
2498 */
2499static int ti_sci_cmd_proc_release(const struct ti_sci_handle *handle,
2500                                   u8 proc_id)
2501{
2502        struct ti_sci_msg_req_proc_release *req;
2503        struct ti_sci_msg_hdr *resp;
2504        struct ti_sci_info *info;
2505        struct ti_sci_xfer *xfer;
2506        struct device *dev;
2507        int ret = 0;
2508
2509        if (!handle)
2510                return -EINVAL;
2511        if (IS_ERR(handle))
2512                return PTR_ERR(handle);
2513
2514        info = handle_to_ti_sci_info(handle);
2515        dev = info->dev;
2516
2517        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_RELEASE,
2518                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2519                                   sizeof(*req), sizeof(*resp));
2520        if (IS_ERR(xfer)) {
2521                ret = PTR_ERR(xfer);
2522                dev_err(dev, "Message alloc failed(%d)\n", ret);
2523                return ret;
2524        }
2525        req = (struct ti_sci_msg_req_proc_release *)xfer->xfer_buf;
2526        req->processor_id = proc_id;
2527
2528        ret = ti_sci_do_xfer(info, xfer);
2529        if (ret) {
2530                dev_err(dev, "Mbox send fail %d\n", ret);
2531                goto fail;
2532        }
2533
2534        resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2535
2536        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2537
2538fail:
2539        ti_sci_put_one_xfer(&info->minfo, xfer);
2540
2541        return ret;
2542}
2543
2544/**
2545 * ti_sci_cmd_proc_handover() - Command to handover a physical processor
2546 *                              control to a host in the processor's access
2547 *                              control list.
2548 * @handle:     Pointer to TI SCI handle
2549 * @proc_id:    Processor ID this request is for
2550 * @host_id:    Host ID to get the control of the processor
2551 *
2552 * Return: 0 if all went well, else returns appropriate error value.
2553 */
2554static int ti_sci_cmd_proc_handover(const struct ti_sci_handle *handle,
2555                                    u8 proc_id, u8 host_id)
2556{
2557        struct ti_sci_msg_req_proc_handover *req;
2558        struct ti_sci_msg_hdr *resp;
2559        struct ti_sci_info *info;
2560        struct ti_sci_xfer *xfer;
2561        struct device *dev;
2562        int ret = 0;
2563
2564        if (!handle)
2565                return -EINVAL;
2566        if (IS_ERR(handle))
2567                return PTR_ERR(handle);
2568
2569        info = handle_to_ti_sci_info(handle);
2570        dev = info->dev;
2571
2572        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_PROC_HANDOVER,
2573                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2574                                   sizeof(*req), sizeof(*resp));
2575        if (IS_ERR(xfer)) {
2576                ret = PTR_ERR(xfer);
2577                dev_err(dev, "Message alloc failed(%d)\n", ret);
2578                return ret;
2579        }
2580        req = (struct ti_sci_msg_req_proc_handover *)xfer->xfer_buf;
2581        req->processor_id = proc_id;
2582        req->host_id = host_id;
2583
2584        ret = ti_sci_do_xfer(info, xfer);
2585        if (ret) {
2586                dev_err(dev, "Mbox send fail %d\n", ret);
2587                goto fail;
2588        }
2589
2590        resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2591
2592        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2593
2594fail:
2595        ti_sci_put_one_xfer(&info->minfo, xfer);
2596
2597        return ret;
2598}
2599
2600/**
2601 * ti_sci_cmd_proc_set_config() - Command to set the processor boot
2602 *                                  configuration flags
2603 * @handle:             Pointer to TI SCI handle
2604 * @proc_id:            Processor ID this request is for
2605 * @config_flags_set:   Configuration flags to be set
2606 * @config_flags_clear: Configuration flags to be cleared.
2607 *
2608 * Return: 0 if all went well, else returns appropriate error value.
2609 */
2610static int ti_sci_cmd_proc_set_config(const struct ti_sci_handle *handle,
2611                                      u8 proc_id, u64 bootvector,
2612                                      u32 config_flags_set,
2613                                      u32 config_flags_clear)
2614{
2615        struct ti_sci_msg_req_set_config *req;
2616        struct ti_sci_msg_hdr *resp;
2617        struct ti_sci_info *info;
2618        struct ti_sci_xfer *xfer;
2619        struct device *dev;
2620        int ret = 0;
2621
2622        if (!handle)
2623                return -EINVAL;
2624        if (IS_ERR(handle))
2625                return PTR_ERR(handle);
2626
2627        info = handle_to_ti_sci_info(handle);
2628        dev = info->dev;
2629
2630        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CONFIG,
2631                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2632                                   sizeof(*req), sizeof(*resp));
2633        if (IS_ERR(xfer)) {
2634                ret = PTR_ERR(xfer);
2635                dev_err(dev, "Message alloc failed(%d)\n", ret);
2636                return ret;
2637        }
2638        req = (struct ti_sci_msg_req_set_config *)xfer->xfer_buf;
2639        req->processor_id = proc_id;
2640        req->bootvector_low = bootvector & TI_SCI_ADDR_LOW_MASK;
2641        req->bootvector_high = (bootvector & TI_SCI_ADDR_HIGH_MASK) >>
2642                                TI_SCI_ADDR_HIGH_SHIFT;
2643        req->config_flags_set = config_flags_set;
2644        req->config_flags_clear = config_flags_clear;
2645
2646        ret = ti_sci_do_xfer(info, xfer);
2647        if (ret) {
2648                dev_err(dev, "Mbox send fail %d\n", ret);
2649                goto fail;
2650        }
2651
2652        resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2653
2654        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2655
2656fail:
2657        ti_sci_put_one_xfer(&info->minfo, xfer);
2658
2659        return ret;
2660}
2661
2662/**
2663 * ti_sci_cmd_proc_set_control() - Command to set the processor boot
2664 *                                   control flags
2665 * @handle:                     Pointer to TI SCI handle
2666 * @proc_id:                    Processor ID this request is for
2667 * @control_flags_set:          Control flags to be set
2668 * @control_flags_clear:        Control flags to be cleared
2669 *
2670 * Return: 0 if all went well, else returns appropriate error value.
2671 */
2672static int ti_sci_cmd_proc_set_control(const struct ti_sci_handle *handle,
2673                                       u8 proc_id, u32 control_flags_set,
2674                                       u32 control_flags_clear)
2675{
2676        struct ti_sci_msg_req_set_ctrl *req;
2677        struct ti_sci_msg_hdr *resp;
2678        struct ti_sci_info *info;
2679        struct ti_sci_xfer *xfer;
2680        struct device *dev;
2681        int ret = 0;
2682
2683        if (!handle)
2684                return -EINVAL;
2685        if (IS_ERR(handle))
2686                return PTR_ERR(handle);
2687
2688        info = handle_to_ti_sci_info(handle);
2689        dev = info->dev;
2690
2691        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_SET_CTRL,
2692                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2693                                   sizeof(*req), sizeof(*resp));
2694        if (IS_ERR(xfer)) {
2695                ret = PTR_ERR(xfer);
2696                dev_err(dev, "Message alloc failed(%d)\n", ret);
2697                return ret;
2698        }
2699        req = (struct ti_sci_msg_req_set_ctrl *)xfer->xfer_buf;
2700        req->processor_id = proc_id;
2701        req->control_flags_set = control_flags_set;
2702        req->control_flags_clear = control_flags_clear;
2703
2704        ret = ti_sci_do_xfer(info, xfer);
2705        if (ret) {
2706                dev_err(dev, "Mbox send fail %d\n", ret);
2707                goto fail;
2708        }
2709
2710        resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2711
2712        ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2713
2714fail:
2715        ti_sci_put_one_xfer(&info->minfo, xfer);
2716
2717        return ret;
2718}
2719
2720/**
2721 * ti_sci_cmd_get_boot_status() - Command to get the processor boot status
2722 * @handle:     Pointer to TI SCI handle
2723 * @proc_id:    Processor ID this request is for
2724 *
2725 * Return: 0 if all went well, else returns appropriate error value.
2726 */
2727static int ti_sci_cmd_proc_get_status(const struct ti_sci_handle *handle,
2728                                      u8 proc_id, u64 *bv, u32 *cfg_flags,
2729                                      u32 *ctrl_flags, u32 *sts_flags)
2730{
2731        struct ti_sci_msg_resp_get_status *resp;
2732        struct ti_sci_msg_req_get_status *req;
2733        struct ti_sci_info *info;
2734        struct ti_sci_xfer *xfer;
2735        struct device *dev;
2736        int ret = 0;
2737
2738        if (!handle)
2739                return -EINVAL;
2740        if (IS_ERR(handle))
2741                return PTR_ERR(handle);
2742
2743        info = handle_to_ti_sci_info(handle);
2744        dev = info->dev;
2745
2746        xfer = ti_sci_get_one_xfer(info, TI_SCI_MSG_GET_STATUS,
2747                                   TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2748                                   sizeof(*req), sizeof(*resp));
2749        if (IS_ERR(xfer)) {
2750                ret = PTR_ERR(xfer);
2751                dev_err(dev, "Message alloc failed(%d)\n", ret);
2752                return ret;
2753        }
2754        req = (struct ti_sci_msg_req_get_status *)xfer->xfer_buf;
2755        req->processor_id = proc_id;
2756
2757        ret = ti_sci_do_xfer(info, xfer);
2758        if (ret) {
2759                dev_err(dev, "Mbox send fail %d\n", ret);
2760                goto fail;
2761        }
2762
2763        resp = (struct ti_sci_msg_resp_get_status *)xfer->tx_message.buf;
2764
2765        if (!ti_sci_is_response_ack(resp)) {
2766                ret = -ENODEV;
2767        } else {
2768                *bv = (resp->bootvector_low & TI_SCI_ADDR_LOW_MASK) |
2769                      (((u64)resp->bootvector_high << TI_SCI_ADDR_HIGH_SHIFT) &
2770                       TI_SCI_ADDR_HIGH_MASK);
2771                *cfg_flags = resp->config_flags;
2772                *ctrl_flags = resp->control_flags;
2773                *sts_flags = resp->status_flags;
2774        }
2775
2776fail:
2777        ti_sci_put_one_xfer(&info->minfo, xfer);
2778
2779        return ret;
2780}
2781
2782/*
2783 * ti_sci_setup_ops() - Setup the operations structures
2784 * @info:       pointer to TISCI pointer
2785 */
2786static void ti_sci_setup_ops(struct ti_sci_info *info)
2787{
2788        struct ti_sci_ops *ops = &info->handle.ops;
2789        struct ti_sci_core_ops *core_ops = &ops->core_ops;
2790        struct ti_sci_dev_ops *dops = &ops->dev_ops;
2791        struct ti_sci_clk_ops *cops = &ops->clk_ops;
2792        struct ti_sci_rm_core_ops *rm_core_ops = &ops->rm_core_ops;
2793        struct ti_sci_rm_irq_ops *iops = &ops->rm_irq_ops;
2794        struct ti_sci_rm_ringacc_ops *rops = &ops->rm_ring_ops;
2795        struct ti_sci_rm_psil_ops *psilops = &ops->rm_psil_ops;
2796        struct ti_sci_rm_udmap_ops *udmap_ops = &ops->rm_udmap_ops;
2797        struct ti_sci_proc_ops *pops = &ops->proc_ops;
2798
2799        core_ops->reboot_device = ti_sci_cmd_core_reboot;
2800
2801        dops->get_device = ti_sci_cmd_get_device;
2802        dops->get_device_exclusive = ti_sci_cmd_get_device_exclusive;
2803        dops->idle_device = ti_sci_cmd_idle_device;
2804        dops->idle_device_exclusive = ti_sci_cmd_idle_device_exclusive;
2805        dops->put_device = ti_sci_cmd_put_device;
2806
2807        dops->is_valid = ti_sci_cmd_dev_is_valid;
2808        dops->get_context_loss_count = ti_sci_cmd_dev_get_clcnt;
2809        dops->is_idle = ti_sci_cmd_dev_is_idle;
2810        dops->is_stop = ti_sci_cmd_dev_is_stop;
2811        dops->is_on = ti_sci_cmd_dev_is_on;
2812        dops->is_transitioning = ti_sci_cmd_dev_is_trans;
2813        dops->set_device_resets = ti_sci_cmd_set_device_resets;
2814        dops->get_device_resets = ti_sci_cmd_get_device_resets;
2815
2816        cops->get_clock = ti_sci_cmd_get_clock;
2817        cops->idle_clock = ti_sci_cmd_idle_clock;
2818        cops->put_clock = ti_sci_cmd_put_clock;
2819        cops->is_auto = ti_sci_cmd_clk_is_auto;
2820        cops->is_on = ti_sci_cmd_clk_is_on;
2821        cops->is_off = ti_sci_cmd_clk_is_off;
2822
2823        cops->set_parent = ti_sci_cmd_clk_set_parent;
2824        cops->get_parent = ti_sci_cmd_clk_get_parent;
2825        cops->get_num_parents = ti_sci_cmd_clk_get_num_parents;
2826
2827        cops->get_best_match_freq = ti_sci_cmd_clk_get_match_freq;
2828        cops->set_freq = ti_sci_cmd_clk_set_freq;
2829        cops->get_freq = ti_sci_cmd_clk_get_freq;
2830
2831        rm_core_ops->get_range = ti_sci_cmd_get_resource_range;
2832        rm_core_ops->get_range_from_shost =
2833                                ti_sci_cmd_get_resource_range_from_shost;
2834
2835        iops->set_irq = ti_sci_cmd_set_irq;
2836        iops->set_event_map = ti_sci_cmd_set_event_map;
2837        iops->free_irq = ti_sci_cmd_free_irq;
2838        iops->free_event_map = ti_sci_cmd_free_event_map;
2839
2840        rops->set_cfg = ti_sci_cmd_rm_ring_cfg;
2841
2842        psilops->pair = ti_sci_cmd_rm_psil_pair;
2843        psilops->unpair = ti_sci_cmd_rm_psil_unpair;
2844
2845        udmap_ops->tx_ch_cfg = ti_sci_cmd_rm_udmap_tx_ch_cfg;
2846        udmap_ops->rx_ch_cfg = ti_sci_cmd_rm_udmap_rx_ch_cfg;
2847        udmap_ops->rx_flow_cfg = ti_sci_cmd_rm_udmap_rx_flow_cfg;
2848
2849        pops->request = ti_sci_cmd_proc_request;
2850        pops->release = ti_sci_cmd_proc_release;
2851        pops->handover = ti_sci_cmd_proc_handover;
2852        pops->set_config = ti_sci_cmd_proc_set_config;
2853        pops->set_control = ti_sci_cmd_proc_set_control;
2854        pops->get_status = ti_sci_cmd_proc_get_status;
2855}
2856
2857/**
2858 * ti_sci_get_handle() - Get the TI SCI handle for a device
2859 * @dev:        Pointer to device for which we want SCI handle
2860 *
2861 * NOTE: The function does not track individual clients of the framework
2862 * and is expected to be maintained by caller of TI SCI protocol library.
2863 * ti_sci_put_handle must be balanced with successful ti_sci_get_handle
2864 * Return: pointer to handle if successful, else:
2865 * -EPROBE_DEFER if the instance is not ready
2866 * -ENODEV if the required node handler is missing
2867 * -EINVAL if invalid conditions are encountered.
2868 */
2869const struct ti_sci_handle *ti_sci_get_handle(struct device *dev)
2870{
2871        struct device_node *ti_sci_np;
2872        struct list_head *p;
2873        struct ti_sci_handle *handle = NULL;
2874        struct ti_sci_info *info;
2875
2876        if (!dev) {
2877                pr_err("I need a device pointer\n");
2878                return ERR_PTR(-EINVAL);
2879        }
2880        ti_sci_np = of_get_parent(dev->of_node);
2881        if (!ti_sci_np) {
2882                dev_err(dev, "No OF information\n");
2883                return ERR_PTR(-EINVAL);
2884        }
2885
2886        mutex_lock(&ti_sci_list_mutex);
2887        list_for_each(p, &ti_sci_list) {
2888                info = list_entry(p, struct ti_sci_info, node);
2889                if (ti_sci_np == info->dev->of_node) {
2890                        handle = &info->handle;
2891                        info->users++;
2892                        break;
2893                }
2894        }
2895        mutex_unlock(&ti_sci_list_mutex);
2896        of_node_put(ti_sci_np);
2897
2898        if (!handle)
2899                return ERR_PTR(-EPROBE_DEFER);
2900
2901        return handle;
2902}
2903EXPORT_SYMBOL_GPL(ti_sci_get_handle);
2904
2905/**
2906 * ti_sci_put_handle() - Release the handle acquired by ti_sci_get_handle
2907 * @handle:     Handle acquired by ti_sci_get_handle
2908 *
2909 * NOTE: The function does not track individual clients of the framework
2910 * and is expected to be maintained by caller of TI SCI protocol library.
2911 * ti_sci_put_handle must be balanced with successful ti_sci_get_handle
2912 *
2913 * Return: 0 is successfully released
2914 * if an error pointer was passed, it returns the error value back,
2915 * if null was passed, it returns -EINVAL;
2916 */
2917int ti_sci_put_handle(const struct ti_sci_handle *handle)
2918{
2919        struct ti_sci_info *info;
2920
2921        if (IS_ERR(handle))
2922                return PTR_ERR(handle);
2923        if (!handle)
2924                return -EINVAL;
2925
2926        info = handle_to_ti_sci_info(handle);
2927        mutex_lock(&ti_sci_list_mutex);
2928        if (!WARN_ON(!info->users))
2929                info->users--;
2930        mutex_unlock(&ti_sci_list_mutex);
2931
2932        return 0;
2933}
2934EXPORT_SYMBOL_GPL(ti_sci_put_handle);
2935
2936static void devm_ti_sci_release(struct device *dev, void *res)
2937{
2938        const struct ti_sci_handle **ptr = res;
2939        const struct ti_sci_handle *handle = *ptr;
2940        int ret;
2941
2942        ret = ti_sci_put_handle(handle);
2943        if (ret)
2944                dev_err(dev, "failed to put handle %d\n", ret);
2945}
2946
2947/**
2948 * devm_ti_sci_get_handle() - Managed get handle
2949 * @dev:        device for which we want SCI handle for.
2950 *
2951 * NOTE: This releases the handle once the device resources are
2952 * no longer needed. MUST NOT BE released with ti_sci_put_handle.
2953 * The function does not track individual clients of the framework
2954 * and is expected to be maintained by caller of TI SCI protocol library.
2955 *
2956 * Return: 0 if all went fine, else corresponding error.
2957 */
2958const struct ti_sci_handle *devm_ti_sci_get_handle(struct device *dev)
2959{
2960        const struct ti_sci_handle **ptr;
2961        const struct ti_sci_handle *handle;
2962
2963        ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL);
2964        if (!ptr)
2965                return ERR_PTR(-ENOMEM);
2966        handle = ti_sci_get_handle(dev);
2967
2968        if (!IS_ERR(handle)) {
2969                *ptr = handle;
2970                devres_add(dev, ptr);
2971        } else {
2972                devres_free(ptr);
2973        }
2974
2975        return handle;
2976}
2977EXPORT_SYMBOL_GPL(devm_ti_sci_get_handle);
2978
2979/**
2980 * ti_sci_get_by_phandle() - Get the TI SCI handle using DT phandle
2981 * @np:         device node
2982 * @property:   property name containing phandle on TISCI node
2983 *
2984 * NOTE: The function does not track individual clients of the framework
2985 * and is expected to be maintained by caller of TI SCI protocol library.
2986 * ti_sci_put_handle must be balanced with successful ti_sci_get_by_phandle
2987 * Return: pointer to handle if successful, else:
2988 * -EPROBE_DEFER if the instance is not ready
2989 * -ENODEV if the required node handler is missing
2990 * -EINVAL if invalid conditions are encountered.
2991 */
2992const struct ti_sci_handle *ti_sci_get_by_phandle(struct device_node *np,
2993                                                  const char *property)
2994{
2995        struct ti_sci_handle *handle = NULL;
2996        struct device_node *ti_sci_np;
2997        struct ti_sci_info *info;
2998        struct list_head *p;
2999
3000        if (!np) {
3001                pr_err("I need a device pointer\n");
3002                return ERR_PTR(-EINVAL);
3003        }
3004
3005        ti_sci_np = of_parse_phandle(np, property, 0);
3006        if (!ti_sci_np)
3007                return ERR_PTR(-ENODEV);
3008
3009        mutex_lock(&ti_sci_list_mutex);
3010        list_for_each(p, &ti_sci_list) {
3011                info = list_entry(p, struct ti_sci_info, node);
3012                if (ti_sci_np == info->dev->of_node) {
3013                        handle = &info->handle;
3014                        info->users++;
3015                        break;
3016                }
3017        }
3018        mutex_unlock(&ti_sci_list_mutex);
3019        of_node_put(ti_sci_np);
3020
3021        if (!handle)
3022                return ERR_PTR(-EPROBE_DEFER);
3023
3024        return handle;
3025}
3026EXPORT_SYMBOL_GPL(ti_sci_get_by_phandle);
3027
3028/**
3029 * devm_ti_sci_get_by_phandle() - Managed get handle using phandle
3030 * @dev:        Device pointer requesting TISCI handle
3031 * @property:   property name containing phandle on TISCI node
3032 *
3033 * NOTE: This releases the handle once the device resources are
3034 * no longer needed. MUST NOT BE released with ti_sci_put_handle.
3035 * The function does not track individual clients of the framework
3036 * and is expected to be maintained by caller of TI SCI protocol library.
3037 *
3038 * Return: 0 if all went fine, else corresponding error.
3039 */
3040const struct ti_sci_handle *devm_ti_sci_get_by_phandle(struct device *dev,
3041                                                       const char *property)
3042{
3043        const struct ti_sci_handle *handle;
3044        const struct ti_sci_handle **ptr;
3045
3046        ptr = devres_alloc(devm_ti_sci_release, sizeof(*ptr), GFP_KERNEL);
3047        if (!ptr)
3048                return ERR_PTR(-ENOMEM);
3049        handle = ti_sci_get_by_phandle(dev_of_node(dev), property);
3050
3051        if (!IS_ERR(handle)) {
3052                *ptr = handle;
3053                devres_add(dev, ptr);
3054        } else {
3055                devres_free(ptr);
3056        }
3057
3058        return handle;
3059}
3060EXPORT_SYMBOL_GPL(devm_ti_sci_get_by_phandle);
3061
3062/**
3063 * ti_sci_get_free_resource() - Get a free resource from TISCI resource.
3064 * @res:        Pointer to the TISCI resource
3065 *
3066 * Return: resource num if all went ok else TI_SCI_RESOURCE_NULL.
3067 */
3068u16 ti_sci_get_free_resource(struct ti_sci_resource *res)
3069{
3070        unsigned long flags;
3071        u16 set, free_bit;
3072
3073        raw_spin_lock_irqsave(&res->lock, flags);
3074        for (set = 0; set < res->sets; set++) {
3075                struct ti_sci_resource_desc *desc = &res->desc[set];
3076                int res_count = desc->num + desc->num_sec;
3077
3078                free_bit = find_first_zero_bit(desc->res_map, res_count);
3079                if (free_bit != res_count) {
3080                        set_bit(free_bit, desc->res_map);
3081                        raw_spin_unlock_irqrestore(&res->lock, flags);
3082
3083                        if (desc->num && free_bit < desc->num)
3084                                return desc->start + free_bit;
3085                        else
3086                                return desc->start_sec + free_bit;
3087                }
3088        }
3089        raw_spin_unlock_irqrestore(&res->lock, flags);
3090
3091        return TI_SCI_RESOURCE_NULL;
3092}
3093EXPORT_SYMBOL_GPL(ti_sci_get_free_resource);
3094
3095/**
3096 * ti_sci_release_resource() - Release a resource from TISCI resource.
3097 * @res:        Pointer to the TISCI resource
3098 * @id:         Resource id to be released.
3099 */
3100void ti_sci_release_resource(struct ti_sci_resource *res, u16 id)
3101{
3102        unsigned long flags;
3103        u16 set;
3104
3105        raw_spin_lock_irqsave(&res->lock, flags);
3106        for (set = 0; set < res->sets; set++) {
3107                struct ti_sci_resource_desc *desc = &res->desc[set];
3108
3109                if (desc->num && desc->start <= id &&
3110                    (desc->start + desc->num) > id)
3111                        clear_bit(id - desc->start, desc->res_map);
3112                else if (desc->num_sec && desc->start_sec <= id &&
3113                         (desc->start_sec + desc->num_sec) > id)
3114                        clear_bit(id - desc->start_sec, desc->res_map);
3115        }
3116        raw_spin_unlock_irqrestore(&res->lock, flags);
3117}
3118EXPORT_SYMBOL_GPL(ti_sci_release_resource);
3119
3120/**
3121 * ti_sci_get_num_resources() - Get the number of resources in TISCI resource
3122 * @res:        Pointer to the TISCI resource
3123 *
3124 * Return: Total number of available resources.
3125 */
3126u32 ti_sci_get_num_resources(struct ti_sci_resource *res)
3127{
3128        u32 set, count = 0;
3129
3130        for (set = 0; set < res->sets; set++)
3131                count += res->desc[set].num + res->desc[set].num_sec;
3132
3133        return count;
3134}
3135EXPORT_SYMBOL_GPL(ti_sci_get_num_resources);
3136
3137/**
3138 * devm_ti_sci_get_resource_sets() - Get a TISCI resources assigned to a device
3139 * @handle:     TISCI handle
3140 * @dev:        Device pointer to which the resource is assigned
3141 * @dev_id:     TISCI device id to which the resource is assigned
3142 * @sub_types:  Array of sub_types assigned corresponding to device
3143 * @sets:       Number of sub_types
3144 *
3145 * Return: Pointer to ti_sci_resource if all went well else appropriate
3146 *         error pointer.
3147 */
3148static struct ti_sci_resource *
3149devm_ti_sci_get_resource_sets(const struct ti_sci_handle *handle,
3150                              struct device *dev, u32 dev_id, u32 *sub_types,
3151                              u32 sets)
3152{
3153        struct ti_sci_resource *res;
3154        bool valid_set = false;
3155        int i, ret, res_count;
3156
3157        res = devm_kzalloc(dev, sizeof(*res), GFP_KERNEL);
3158        if (!res)
3159                return ERR_PTR(-ENOMEM);
3160
3161        res->sets = sets;
3162        res->desc = devm_kcalloc(dev, res->sets, sizeof(*res->desc),
3163                                 GFP_KERNEL);
3164        if (!res->desc)
3165                return ERR_PTR(-ENOMEM);
3166
3167        for (i = 0; i < res->sets; i++) {
3168                ret = handle->ops.rm_core_ops.get_range(handle, dev_id,
3169                                                        sub_types[i],
3170                                                        &res->desc[i]);
3171                if (ret) {
3172                        dev_dbg(dev, "dev = %d subtype %d not allocated for this host\n",
3173                                dev_id, sub_types[i]);
3174                        memset(&res->desc[i], 0, sizeof(res->desc[i]));
3175                        continue;
3176                }
3177
3178                dev_dbg(dev, "dev/sub_type: %d/%d, start/num: %d/%d | %d/%d\n",
3179                        dev_id, sub_types[i], res->desc[i].start,
3180                        res->desc[i].num, res->desc[i].start_sec,
3181                        res->desc[i].num_sec);
3182
3183                valid_set = true;
3184                res_count = res->desc[i].num + res->desc[i].num_sec;
3185                res->desc[i].res_map =
3186                        devm_kzalloc(dev, BITS_TO_LONGS(res_count) *
3187                                     sizeof(*res->desc[i].res_map), GFP_KERNEL);
3188                if (!res->desc[i].res_map)
3189                        return ERR_PTR(-ENOMEM);
3190        }
3191        raw_spin_lock_init(&res->lock);
3192
3193        if (valid_set)
3194                return res;
3195
3196        return ERR_PTR(-EINVAL);
3197}
3198
3199/**
3200 * devm_ti_sci_get_of_resource() - Get a TISCI resource assigned to a device
3201 * @handle:     TISCI handle
3202 * @dev:        Device pointer to which the resource is assigned
3203 * @dev_id:     TISCI device id to which the resource is assigned
3204 * @of_prop:    property name by which the resource are represented
3205 *
3206 * Return: Pointer to ti_sci_resource if all went well else appropriate
3207 *         error pointer.
3208 */
3209struct ti_sci_resource *
3210devm_ti_sci_get_of_resource(const struct ti_sci_handle *handle,
3211                            struct device *dev, u32 dev_id, char *of_prop)
3212{
3213        struct ti_sci_resource *res;
3214        u32 *sub_types;
3215        int sets;
3216
3217        sets = of_property_count_elems_of_size(dev_of_node(dev), of_prop,
3218                                               sizeof(u32));
3219        if (sets < 0) {
3220                dev_err(dev, "%s resource type ids not available\n", of_prop);
3221                return ERR_PTR(sets);
3222        }
3223
3224        sub_types = kcalloc(sets, sizeof(*sub_types), GFP_KERNEL);
3225        if (!sub_types)
3226                return ERR_PTR(-ENOMEM);
3227
3228        of_property_read_u32_array(dev_of_node(dev), of_prop, sub_types, sets);
3229        res = devm_ti_sci_get_resource_sets(handle, dev, dev_id, sub_types,
3230                                            sets);
3231
3232        kfree(sub_types);
3233        return res;
3234}
3235EXPORT_SYMBOL_GPL(devm_ti_sci_get_of_resource);
3236
3237/**
3238 * devm_ti_sci_get_resource() - Get a resource range assigned to the device
3239 * @handle:     TISCI handle
3240 * @dev:        Device pointer to which the resource is assigned
3241 * @dev_id:     TISCI device id to which the resource is assigned
3242 * @suub_type:  TISCI resource subytpe representing the resource.
3243 *
3244 * Return: Pointer to ti_sci_resource if all went well else appropriate
3245 *         error pointer.
3246 */
3247struct ti_sci_resource *
3248devm_ti_sci_get_resource(const struct ti_sci_handle *handle, struct device *dev,
3249                         u32 dev_id, u32 sub_type)
3250{
3251        return devm_ti_sci_get_resource_sets(handle, dev, dev_id, &sub_type, 1);
3252}
3253EXPORT_SYMBOL_GPL(devm_ti_sci_get_resource);
3254
3255static int tisci_reboot_handler(struct notifier_block *nb, unsigned long mode,
3256                                void *cmd)
3257{
3258        struct ti_sci_info *info = reboot_to_ti_sci_info(nb);
3259        const struct ti_sci_handle *handle = &info->handle;
3260
3261        ti_sci_cmd_core_reboot(handle);
3262
3263        /* call fail OR pass, we should not be here in the first place */
3264        return NOTIFY_BAD;
3265}
3266
3267/* Description for K2G */
3268static const struct ti_sci_desc ti_sci_pmmc_k2g_desc = {
3269        .default_host_id = 2,
3270        /* Conservative duration */
3271        .max_rx_timeout_ms = 1000,
3272        /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */
3273        .max_msgs = 20,
3274        .max_msg_size = 64,
3275};
3276
3277/* Description for AM654 */
3278static const struct ti_sci_desc ti_sci_pmmc_am654_desc = {
3279        .default_host_id = 12,
3280        /* Conservative duration */
3281        .max_rx_timeout_ms = 10000,
3282        /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */
3283        .max_msgs = 20,
3284        .max_msg_size = 60,
3285};
3286
3287static const struct of_device_id ti_sci_of_match[] = {
3288        {.compatible = "ti,k2g-sci", .data = &ti_sci_pmmc_k2g_desc},
3289        {.compatible = "ti,am654-sci", .data = &ti_sci_pmmc_am654_desc},
3290        { /* Sentinel */ },
3291};
3292MODULE_DEVICE_TABLE(of, ti_sci_of_match);
3293
3294static int ti_sci_probe(struct platform_device *pdev)
3295{
3296        struct device *dev = &pdev->dev;
3297        const struct of_device_id *of_id;
3298        const struct ti_sci_desc *desc;
3299        struct ti_sci_xfer *xfer;
3300        struct ti_sci_info *info = NULL;
3301        struct ti_sci_xfers_info *minfo;
3302        struct mbox_client *cl;
3303        int ret = -EINVAL;
3304        int i;
3305        int reboot = 0;
3306        u32 h_id;
3307
3308        of_id = of_match_device(ti_sci_of_match, dev);
3309        if (!of_id) {
3310                dev_err(dev, "OF data missing\n");
3311                return -EINVAL;
3312        }
3313        desc = of_id->data;
3314
3315        info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
3316        if (!info)
3317                return -ENOMEM;
3318
3319        info->dev = dev;
3320        info->desc = desc;
3321        ret = of_property_read_u32(dev->of_node, "ti,host-id", &h_id);
3322        /* if the property is not present in DT, use a default from desc */
3323        if (ret < 0) {
3324                info->host_id = info->desc->default_host_id;
3325        } else {
3326                if (!h_id) {
3327                        dev_warn(dev, "Host ID 0 is reserved for firmware\n");
3328                        info->host_id = info->desc->default_host_id;
3329                } else {
3330                        info->host_id = h_id;
3331                }
3332        }
3333
3334        reboot = of_property_read_bool(dev->of_node,
3335                                       "ti,system-reboot-controller");
3336        INIT_LIST_HEAD(&info->node);
3337        minfo = &info->minfo;
3338
3339        /*
3340         * Pre-allocate messages
3341         * NEVER allocate more than what we can indicate in hdr.seq
3342         * if we have data description bug, force a fix..
3343         */
3344        if (WARN_ON(desc->max_msgs >=
3345                    1 << 8 * sizeof(((struct ti_sci_msg_hdr *)0)->seq)))
3346                return -EINVAL;
3347
3348        minfo->xfer_block = devm_kcalloc(dev,
3349                                         desc->max_msgs,
3350                                         sizeof(*minfo->xfer_block),
3351                                         GFP_KERNEL);
3352        if (!minfo->xfer_block)
3353                return -ENOMEM;
3354
3355        minfo->xfer_alloc_table = devm_kcalloc(dev,
3356                                               BITS_TO_LONGS(desc->max_msgs),
3357                                               sizeof(unsigned long),
3358                                               GFP_KERNEL);
3359        if (!minfo->xfer_alloc_table)
3360                return -ENOMEM;
3361        bitmap_zero(minfo->xfer_alloc_table, desc->max_msgs);
3362
3363        /* Pre-initialize the buffer pointer to pre-allocated buffers */
3364        for (i = 0, xfer = minfo->xfer_block; i < desc->max_msgs; i++, xfer++) {
3365                xfer->xfer_buf = devm_kcalloc(dev, 1, desc->max_msg_size,
3366                                              GFP_KERNEL);
3367                if (!xfer->xfer_buf)
3368                        return -ENOMEM;
3369
3370                xfer->tx_message.buf = xfer->xfer_buf;
3371                init_completion(&xfer->done);
3372        }
3373
3374        ret = ti_sci_debugfs_create(pdev, info);
3375        if (ret)
3376                dev_warn(dev, "Failed to create debug file\n");
3377
3378        platform_set_drvdata(pdev, info);
3379
3380        cl = &info->cl;
3381        cl->dev = dev;
3382        cl->tx_block = false;
3383        cl->rx_callback = ti_sci_rx_callback;
3384        cl->knows_txdone = true;
3385
3386        spin_lock_init(&minfo->xfer_lock);
3387        sema_init(&minfo->sem_xfer_count, desc->max_msgs);
3388
3389        info->chan_rx = mbox_request_channel_byname(cl, "rx");
3390        if (IS_ERR(info->chan_rx)) {
3391                ret = PTR_ERR(info->chan_rx);
3392                goto out;
3393        }
3394
3395        info->chan_tx = mbox_request_channel_byname(cl, "tx");
3396        if (IS_ERR(info->chan_tx)) {
3397                ret = PTR_ERR(info->chan_tx);
3398                goto out;
3399        }
3400        ret = ti_sci_cmd_get_revision(info);
3401        if (ret) {
3402                dev_err(dev, "Unable to communicate with TISCI(%d)\n", ret);
3403                goto out;
3404        }
3405
3406        ti_sci_setup_ops(info);
3407
3408        if (reboot) {
3409                info->nb.notifier_call = tisci_reboot_handler;
3410                info->nb.priority = 128;
3411
3412                ret = register_restart_handler(&info->nb);
3413                if (ret) {
3414                        dev_err(dev, "reboot registration fail(%d)\n", ret);
3415                        return ret;
3416                }
3417        }
3418
3419        dev_info(dev, "ABI: %d.%d (firmware rev 0x%04x '%s')\n",
3420                 info->handle.version.abi_major, info->handle.version.abi_minor,
3421                 info->handle.version.firmware_revision,
3422                 info->handle.version.firmware_description);
3423
3424        mutex_lock(&ti_sci_list_mutex);
3425        list_add_tail(&info->node, &ti_sci_list);
3426        mutex_unlock(&ti_sci_list_mutex);
3427
3428        return of_platform_populate(dev->of_node, NULL, NULL, dev);
3429out:
3430        if (!IS_ERR(info->chan_tx))
3431                mbox_free_channel(info->chan_tx);
3432        if (!IS_ERR(info->chan_rx))
3433                mbox_free_channel(info->chan_rx);
3434        debugfs_remove(info->d);
3435        return ret;
3436}
3437
3438static int ti_sci_remove(struct platform_device *pdev)
3439{
3440        struct ti_sci_info *info;
3441        struct device *dev = &pdev->dev;
3442        int ret = 0;
3443
3444        of_platform_depopulate(dev);
3445
3446        info = platform_get_drvdata(pdev);
3447
3448        if (info->nb.notifier_call)
3449                unregister_restart_handler(&info->nb);
3450
3451        mutex_lock(&ti_sci_list_mutex);
3452        if (info->users)
3453                ret = -EBUSY;
3454        else
3455                list_del(&info->node);
3456        mutex_unlock(&ti_sci_list_mutex);
3457
3458        if (!ret) {
3459                ti_sci_debugfs_destroy(pdev, info);
3460
3461                /* Safe to free channels since no more users */
3462                mbox_free_channel(info->chan_tx);
3463                mbox_free_channel(info->chan_rx);
3464        }
3465
3466        return ret;
3467}
3468
3469static struct platform_driver ti_sci_driver = {
3470        .probe = ti_sci_probe,
3471        .remove = ti_sci_remove,
3472        .driver = {
3473                   .name = "ti-sci",
3474                   .of_match_table = of_match_ptr(ti_sci_of_match),
3475        },
3476};
3477module_platform_driver(ti_sci_driver);
3478
3479MODULE_LICENSE("GPL v2");
3480MODULE_DESCRIPTION("TI System Control Interface(SCI) driver");
3481MODULE_AUTHOR("Nishanth Menon");
3482MODULE_ALIAS("platform:ti-sci");
3483