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