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