Merge tag 'io_uring-5.11-2021-01-16' of git://git.kernel.dk/linux-block
[linux/fpc-iii.git] / drivers / firmware / ti_sci.c
blob235c7e7869aa721f4ef3b503916d56ab6c18400d
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Texas Instruments System Control Interface Protocol Driver
5 * Copyright (C) 2015-2016 Texas Instruments Incorporated - https://www.ti.com/
6 * Nishanth Menon
7 */
9 #define pr_fmt(fmt) "%s: " fmt, __func__
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>
25 #include "ti_sci.h"
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);
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
42 struct ti_sci_xfer {
43 struct ti_msgmgr_message tx_message;
44 u8 rx_len;
45 u8 *xfer_buf;
46 struct completion done;
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
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;
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.
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;
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
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;
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)
124 #ifdef CONFIG_DEBUG_FS
127 * ti_sci_debug_show() - Helper to dump the debug log
128 * @s: sequence file pointer
129 * @unused: unused.
131 * Return: 0
133 static int ti_sci_debug_show(struct seq_file *s, void *unused)
135 struct ti_sci_info *info = s->private;
137 memcpy_fromio(info->debug_buffer, info->debug_region,
138 info->debug_region_size);
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.
145 seq_puts(s, info->debug_buffer);
146 return 0;
149 /* Provide the log file operations interface*/
150 DEFINE_SHOW_ATTRIBUTE(ti_sci_debug);
153 * ti_sci_debugfs_create() - Create log debug file
154 * @pdev: platform device pointer
155 * @info: Pointer to SCI entity information
157 * Return: 0 if all went fine, else corresponding error.
159 static int ti_sci_debugfs_create(struct platform_device *pdev,
160 struct ti_sci_info *info)
162 struct device *dev = &pdev->dev;
163 struct resource *res;
164 char debug_name[50] = "ti_sci_debug@";
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);
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;
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);
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;
194 * ti_sci_debugfs_destroy() - clean up log debug file
195 * @pdev: platform device pointer
196 * @info: Pointer to SCI entity information
198 static void ti_sci_debugfs_destroy(struct platform_device *pdev,
199 struct ti_sci_info *info)
201 if (IS_ERR(info->debug_region))
202 return;
204 debugfs_remove(info->d);
206 #else /* CONFIG_DEBUG_FS */
207 static inline int ti_sci_debugfs_create(struct platform_device *dev,
208 struct ti_sci_info *info)
210 return 0;
213 static inline void ti_sci_debugfs_destroy(struct platform_device *dev,
214 struct ti_sci_info *info)
217 #endif /* CONFIG_DEBUG_FS */
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.
224 static inline void ti_sci_dump_header_dbg(struct device *dev,
225 struct ti_sci_msg_hdr *hdr)
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);
232 * ti_sci_rx_callback() - mailbox client callback for receive messages
233 * @cl: client pointer
234 * @m: mailbox message
236 * Processes one received message to appropriate transfer information and
237 * signals completion of the transfer.
239 * NOTE: This function will be invoked in IRQ context, hence should be
240 * as optimal as possible.
242 static void ti_sci_rx_callback(struct mbox_client *cl, void *m)
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;
252 xfer_id = hdr->seq;
255 * Are we even expecting this?
256 * NOTE: barriers were implicit in locks used for modifying the bitmap
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;
263 xfer = &minfo->xfer_block[xfer_id];
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;
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;
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);
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
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.
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.
300 * Return: 0 if all went fine, else corresponding error.
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)
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;
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);
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..
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);
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);
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..
346 xfer_id = (u8)bit_pos;
348 xfer = &minfo->xfer_block[xfer_id];
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;
354 reinit_completion(&xfer->done);
356 hdr->seq = xfer_id;
357 hdr->type = msg_type;
358 hdr->host = info->host_id;
359 hdr->flags = msg_flags;
361 return xfer;
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
369 * This holds a spinlock to maintain integrity of internal data structures.
371 static void ti_sci_put_one_xfer(struct ti_sci_xfers_info *minfo,
372 struct ti_sci_xfer *xfer)
374 unsigned long flags;
375 struct ti_sci_msg_hdr *hdr;
376 u8 xfer_id;
378 hdr = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
379 xfer_id = hdr->seq;
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.
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);
390 /* Increment the count for the next user to get through */
391 up(&minfo->sem_xfer_count);
395 * ti_sci_do_xfer() - Do one transfer
396 * @info: Pointer to SCI entity information
397 * @xfer: Transfer to initiate and wait for response
399 * Return: -ETIMEDOUT in case of no response, if transmit error,
400 * return corresponding error, else if all goes well,
401 * return 0.
403 static inline int ti_sci_do_xfer(struct ti_sci_info *info,
404 struct ti_sci_xfer *xfer)
406 int ret;
407 int timeout;
408 struct device *dev = info->dev;
410 ret = mbox_send_message(info->chan_tx, &xfer->tx_message);
411 if (ret < 0)
412 return ret;
414 ret = 0;
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;
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.
429 mbox_client_txdone(info->chan_tx, ret);
431 return ret;
435 * ti_sci_cmd_get_revision() - command to get the revision of the SCI entity
436 * @info: Pointer to SCI entity information
438 * Updates the SCI information in the internal data structure.
440 * Return: 0 if all went fine, else return appropriate error.
442 static int ti_sci_cmd_get_revision(struct ti_sci_info *info)
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;
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;
461 rev_info = (struct ti_sci_msg_resp_version *)xfer->xfer_buf;
463 ret = ti_sci_do_xfer(info, xfer);
464 if (ret) {
465 dev_err(dev, "Mbox send fail %d\n", ret);
466 goto fail;
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));
475 fail:
476 ti_sci_put_one_xfer(&info->minfo, xfer);
477 return ret;
481 * ti_sci_is_response_ack() - Generic ACK/NACK message checkup
482 * @r: pointer to response buffer
484 * Return: true if the response was an ACK, else returns false.
486 static inline bool ti_sci_is_response_ack(void *r)
488 struct ti_sci_msg_hdr *hdr = r;
490 return hdr->flags & TI_SCI_FLAG_RESP_GENERIC_ACK ? true : false;
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
500 * Return: 0 if all went well, else returns appropriate error value.
502 static int ti_sci_set_device_state(const struct ti_sci_handle *handle,
503 u32 id, u32 flags, u8 state)
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;
512 if (IS_ERR(handle))
513 return PTR_ERR(handle);
514 if (!handle)
515 return -EINVAL;
517 info = handle_to_ti_sci_info(handle);
518 dev = info->dev;
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;
528 req = (struct ti_sci_msg_req_set_device_state *)xfer->xfer_buf;
529 req->id = id;
530 req->state = state;
532 ret = ti_sci_do_xfer(info, xfer);
533 if (ret) {
534 dev_err(dev, "Mbox send fail %d\n", ret);
535 goto fail;
538 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
540 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
542 fail:
543 ti_sci_put_one_xfer(&info->minfo, xfer);
545 return ret;
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
557 * Return: 0 if all went fine, else return appropriate error.
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)
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;
570 if (IS_ERR(handle))
571 return PTR_ERR(handle);
572 if (!handle)
573 return -EINVAL;
575 if (!clcnt && !resets && !p_state && !c_state)
576 return -EINVAL;
578 info = handle_to_ti_sci_info(handle);
579 dev = info->dev;
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;
589 req = (struct ti_sci_msg_req_get_device_state *)xfer->xfer_buf;
590 req->id = id;
592 ret = ti_sci_do_xfer(info, xfer);
593 if (ret) {
594 dev_err(dev, "Mbox send fail %d\n", ret);
595 goto fail;
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;
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);
615 return ret;
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
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.
628 * Return: 0 if all went fine, else return appropriate error.
630 static int ti_sci_cmd_get_device(const struct ti_sci_handle *handle, u32 id)
632 return ti_sci_set_device_state(handle, id, 0,
633 MSG_DEVICE_SW_STATE_ON);
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
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.
647 * Return: 0 if all went fine, else return appropriate error.
649 static int ti_sci_cmd_get_device_exclusive(const struct ti_sci_handle *handle,
650 u32 id)
652 return ti_sci_set_device_state(handle, id,
653 MSG_FLAG_DEVICE_EXCLUSIVE,
654 MSG_DEVICE_SW_STATE_ON);
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
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.
666 * Return: 0 if all went fine, else return appropriate error.
668 static int ti_sci_cmd_idle_device(const struct ti_sci_handle *handle, u32 id)
670 return ti_sci_set_device_state(handle, id, 0,
671 MSG_DEVICE_SW_STATE_RETENTION);
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
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.
685 * Return: 0 if all went fine, else return appropriate error.
687 static int ti_sci_cmd_idle_device_exclusive(const struct ti_sci_handle *handle,
688 u32 id)
690 return ti_sci_set_device_state(handle, id,
691 MSG_FLAG_DEVICE_EXCLUSIVE,
692 MSG_DEVICE_SW_STATE_RETENTION);
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
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.
704 * Return: 0 if all went fine, else return appropriate error.
706 static int ti_sci_cmd_put_device(const struct ti_sci_handle *handle, u32 id)
708 return ti_sci_set_device_state(handle, id,
709 0, MSG_DEVICE_SW_STATE_AUTO_OFF);
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
717 * Return: 0 if all went fine and the device ID is valid, else return
718 * appropriate error.
720 static int ti_sci_cmd_dev_is_valid(const struct ti_sci_handle *handle, u32 id)
722 u8 unused;
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);
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
734 * Return: 0 if all went fine, else return appropriate error.
736 static int ti_sci_cmd_dev_get_clcnt(const struct ti_sci_handle *handle, u32 id,
737 u32 *count)
739 return ti_sci_get_device_state(handle, id, count, NULL, NULL, NULL);
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
748 * Return: 0 if all went fine, else return appropriate error.
750 static int ti_sci_cmd_dev_is_idle(const struct ti_sci_handle *handle, u32 id,
751 bool *r_state)
753 int ret;
754 u8 state;
756 if (!r_state)
757 return -EINVAL;
759 ret = ti_sci_get_device_state(handle, id, NULL, NULL, &state, NULL);
760 if (ret)
761 return ret;
763 *r_state = (state == MSG_DEVICE_SW_STATE_RETENTION);
765 return 0;
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.
775 * Return: 0 if all went fine, else return appropriate error.
777 static int ti_sci_cmd_dev_is_stop(const struct ti_sci_handle *handle, u32 id,
778 bool *r_state, bool *curr_state)
780 int ret;
781 u8 p_state, c_state;
783 if (!r_state && !curr_state)
784 return -EINVAL;
786 ret =
787 ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state);
788 if (ret)
789 return ret;
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);
796 return 0;
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
806 * Return: 0 if all went fine, else return appropriate error.
808 static int ti_sci_cmd_dev_is_on(const struct ti_sci_handle *handle, u32 id,
809 bool *r_state, bool *curr_state)
811 int ret;
812 u8 p_state, c_state;
814 if (!r_state && !curr_state)
815 return -EINVAL;
817 ret =
818 ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state);
819 if (ret)
820 return ret;
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);
827 return 0;
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.
836 * Return: 0 if all went fine, else return appropriate error.
838 static int ti_sci_cmd_dev_is_trans(const struct ti_sci_handle *handle, u32 id,
839 bool *curr_state)
841 int ret;
842 u8 state;
844 if (!curr_state)
845 return -EINVAL;
847 ret = ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &state);
848 if (ret)
849 return ret;
851 *curr_state = (state == MSG_DEVICE_HW_STATE_TRANS);
853 return 0;
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
863 * Return: 0 if all went fine, else return appropriate error.
865 static int ti_sci_cmd_set_device_resets(const struct ti_sci_handle *handle,
866 u32 id, u32 reset_state)
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;
875 if (IS_ERR(handle))
876 return PTR_ERR(handle);
877 if (!handle)
878 return -EINVAL;
880 info = handle_to_ti_sci_info(handle);
881 dev = info->dev;
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;
891 req = (struct ti_sci_msg_req_set_device_resets *)xfer->xfer_buf;
892 req->id = id;
893 req->resets = reset_state;
895 ret = ti_sci_do_xfer(info, xfer);
896 if (ret) {
897 dev_err(dev, "Mbox send fail %d\n", ret);
898 goto fail;
901 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
903 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
905 fail:
906 ti_sci_put_one_xfer(&info->minfo, xfer);
908 return ret;
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
918 * Return: 0 if all went fine, else return appropriate error.
920 static int ti_sci_cmd_get_device_resets(const struct ti_sci_handle *handle,
921 u32 id, u32 *reset_state)
923 return ti_sci_get_device_state(handle, id, NULL, reset_state, NULL,
924 NULL);
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.
937 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
950 if (IS_ERR(handle))
951 return PTR_ERR(handle);
952 if (!handle)
953 return -EINVAL;
955 info = handle_to_ti_sci_info(handle);
956 dev = info->dev;
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;
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;
974 req->request_state = state;
976 ret = ti_sci_do_xfer(info, xfer);
977 if (ret) {
978 dev_err(dev, "Mbox send fail %d\n", ret);
979 goto fail;
982 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
984 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
986 fail:
987 ti_sci_put_one_xfer(&info->minfo, xfer);
989 return ret;
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
1002 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
1015 if (IS_ERR(handle))
1016 return PTR_ERR(handle);
1017 if (!handle)
1018 return -EINVAL;
1020 if (!programmed_state && !current_state)
1021 return -EINVAL;
1023 info = handle_to_ti_sci_info(handle);
1024 dev = info->dev;
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;
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;
1043 ret = ti_sci_do_xfer(info, xfer);
1044 if (ret) {
1045 dev_err(dev, "Mbox send fail %d\n", ret);
1046 goto fail;
1049 resp = (struct ti_sci_msg_resp_get_clock_state *)xfer->xfer_buf;
1051 if (!ti_sci_is_response_ack(resp)) {
1052 ret = -ENODEV;
1053 goto fail;
1056 if (programmed_state)
1057 *programmed_state = resp->programmed_state;
1058 if (current_state)
1059 *current_state = resp->current_state;
1061 fail:
1062 ti_sci_put_one_xfer(&info->minfo, xfer);
1064 return ret;
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'
1078 * Return: 0 if all went well, else returns appropriate error value.
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)
1084 u32 flags = 0;
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;
1090 return ti_sci_set_clock_state(handle, dev_id, clk_id, flags,
1091 MSG_CLOCK_SW_STATE_REQ);
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.
1102 * NOTE: This clock must have been requested by get_clock previously.
1104 * Return: 0 if all went well, else returns appropriate error value.
1106 static int ti_sci_cmd_idle_clock(const struct ti_sci_handle *handle,
1107 u32 dev_id, u32 clk_id)
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);
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.
1122 * NOTE: This clock must have been requested by get_clock previously.
1124 * Return: 0 if all went well, else returns appropriate error value.
1126 static int ti_sci_cmd_put_clock(const struct ti_sci_handle *handle,
1127 u32 dev_id, u32 clk_id)
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);
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
1143 * Return: 0 if all went well, else returns appropriate error value.
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)
1148 u8 state = 0;
1149 int ret;
1151 if (!req_state)
1152 return -EINVAL;
1154 ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, &state, NULL);
1155 if (ret)
1156 return ret;
1158 *req_state = (state == MSG_CLOCK_SW_STATE_AUTO);
1159 return 0;
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
1172 * Return: 0 if all went well, else returns appropriate error value.
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)
1177 u8 c_state = 0, r_state = 0;
1178 int ret;
1180 if (!req_state && !curr_state)
1181 return -EINVAL;
1183 ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id,
1184 &r_state, &c_state);
1185 if (ret)
1186 return ret;
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;
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
1205 * Return: 0 if all went well, else returns appropriate error value.
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)
1210 u8 c_state = 0, r_state = 0;
1211 int ret;
1213 if (!req_state && !curr_state)
1214 return -EINVAL;
1216 ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id,
1217 &r_state, &c_state);
1218 if (ret)
1219 return ret;
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;
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
1237 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
1249 if (IS_ERR(handle))
1250 return PTR_ERR(handle);
1251 if (!handle)
1252 return -EINVAL;
1254 info = handle_to_ti_sci_info(handle);
1255 dev = info->dev;
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;
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;
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;
1280 ret = ti_sci_do_xfer(info, xfer);
1281 if (ret) {
1282 dev_err(dev, "Mbox send fail %d\n", ret);
1283 goto fail;
1286 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1288 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
1290 fail:
1291 ti_sci_put_one_xfer(&info->minfo, xfer);
1293 return ret;
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
1305 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
1317 if (IS_ERR(handle))
1318 return PTR_ERR(handle);
1319 if (!handle || !parent_id)
1320 return -EINVAL;
1322 info = handle_to_ti_sci_info(handle);
1323 dev = info->dev;
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;
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;
1342 ret = ti_sci_do_xfer(info, xfer);
1343 if (ret) {
1344 dev_err(dev, "Mbox send fail %d\n", ret);
1345 goto fail;
1348 resp = (struct ti_sci_msg_resp_get_clock_parent *)xfer->xfer_buf;
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;
1359 fail:
1360 ti_sci_put_one_xfer(&info->minfo, xfer);
1362 return ret;
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.
1374 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
1387 if (IS_ERR(handle))
1388 return PTR_ERR(handle);
1389 if (!handle || !num_parents)
1390 return -EINVAL;
1392 info = handle_to_ti_sci_info(handle);
1393 dev = info->dev;
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;
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;
1412 ret = ti_sci_do_xfer(info, xfer);
1413 if (ret) {
1414 dev_err(dev, "Mbox send fail %d\n", ret);
1415 goto fail;
1418 resp = (struct ti_sci_msg_resp_get_clock_num_parents *)xfer->xfer_buf;
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;
1429 fail:
1430 ti_sci_put_one_xfer(&info->minfo, xfer);
1432 return ret;
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.
1452 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
1466 if (IS_ERR(handle))
1467 return PTR_ERR(handle);
1468 if (!handle || !match_freq)
1469 return -EINVAL;
1471 info = handle_to_ti_sci_info(handle);
1472 dev = info->dev;
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;
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;
1490 req->min_freq_hz = min_freq;
1491 req->target_freq_hz = target_freq;
1492 req->max_freq_hz = max_freq;
1494 ret = ti_sci_do_xfer(info, xfer);
1495 if (ret) {
1496 dev_err(dev, "Mbox send fail %d\n", ret);
1497 goto fail;
1500 resp = (struct ti_sci_msg_resp_query_clock_freq *)xfer->xfer_buf;
1502 if (!ti_sci_is_response_ack(resp))
1503 ret = -ENODEV;
1504 else
1505 *match_freq = resp->freq_hz;
1507 fail:
1508 ti_sci_put_one_xfer(&info->minfo, xfer);
1510 return ret;
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.
1529 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
1542 if (IS_ERR(handle))
1543 return PTR_ERR(handle);
1544 if (!handle)
1545 return -EINVAL;
1547 info = handle_to_ti_sci_info(handle);
1548 dev = info->dev;
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;
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;
1566 req->min_freq_hz = min_freq;
1567 req->target_freq_hz = target_freq;
1568 req->max_freq_hz = max_freq;
1570 ret = ti_sci_do_xfer(info, xfer);
1571 if (ret) {
1572 dev_err(dev, "Mbox send fail %d\n", ret);
1573 goto fail;
1576 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1578 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
1580 fail:
1581 ti_sci_put_one_xfer(&info->minfo, xfer);
1583 return ret;
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
1595 * Return: 0 if all went well, else returns appropriate error value.
1597 static int ti_sci_cmd_clk_get_freq(const struct ti_sci_handle *handle,
1598 u32 dev_id, u32 clk_id, u64 *freq)
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;
1607 if (IS_ERR(handle))
1608 return PTR_ERR(handle);
1609 if (!handle || !freq)
1610 return -EINVAL;
1612 info = handle_to_ti_sci_info(handle);
1613 dev = info->dev;
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;
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;
1632 ret = ti_sci_do_xfer(info, xfer);
1633 if (ret) {
1634 dev_err(dev, "Mbox send fail %d\n", ret);
1635 goto fail;
1638 resp = (struct ti_sci_msg_resp_get_clock_freq *)xfer->xfer_buf;
1640 if (!ti_sci_is_response_ack(resp))
1641 ret = -ENODEV;
1642 else
1643 *freq = resp->freq_hz;
1645 fail:
1646 ti_sci_put_one_xfer(&info->minfo, xfer);
1648 return ret;
1651 static int ti_sci_cmd_core_reboot(const struct ti_sci_handle *handle)
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;
1660 if (IS_ERR(handle))
1661 return PTR_ERR(handle);
1662 if (!handle)
1663 return -EINVAL;
1665 info = handle_to_ti_sci_info(handle);
1666 dev = info->dev;
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;
1676 req = (struct ti_sci_msg_req_reboot *)xfer->xfer_buf;
1678 ret = ti_sci_do_xfer(info, xfer);
1679 if (ret) {
1680 dev_err(dev, "Mbox send fail %d\n", ret);
1681 goto fail;
1684 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1686 if (!ti_sci_is_response_ack(resp))
1687 ret = -ENODEV;
1688 else
1689 ret = 0;
1691 fail:
1692 ti_sci_put_one_xfer(&info->minfo, xfer);
1694 return ret;
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
1709 * Return: 0 if all went fine, else return appropriate error.
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)
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;
1722 if (IS_ERR(handle))
1723 return PTR_ERR(handle);
1724 if (!handle || !desc)
1725 return -EINVAL;
1727 info = handle_to_ti_sci_info(handle);
1728 dev = info->dev;
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;
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;
1744 ret = ti_sci_do_xfer(info, xfer);
1745 if (ret) {
1746 dev_err(dev, "Mbox send fail %d\n", ret);
1747 goto fail;
1750 resp = (struct ti_sci_msg_resp_get_resource_range *)xfer->xfer_buf;
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;
1764 fail:
1765 ti_sci_put_one_xfer(&info->minfo, xfer);
1767 return ret;
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
1780 * Return: 0 if all went fine, else return appropriate error.
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)
1786 return ti_sci_get_resource_range(handle, dev_id, subtype,
1787 TI_SCI_IRQ_SECONDARY_HOST_INVALID,
1788 desc);
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
1802 * Return: 0 if all went fine, else return appropriate error.
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)
1809 return ti_sci_get_resource_range(handle, dev_id, subtype, s_host, desc);
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.
1829 * Return: 0 if all went fine, else return appropriate error.
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)
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;
1844 if (IS_ERR(handle))
1845 return PTR_ERR(handle);
1846 if (!handle)
1847 return -EINVAL;
1849 info = handle_to_ti_sci_info(handle);
1850 dev = info->dev;
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;
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;
1871 ret = ti_sci_do_xfer(info, xfer);
1872 if (ret) {
1873 dev_err(dev, "Mbox send fail %d\n", ret);
1874 goto fail;
1877 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
1879 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
1881 fail:
1882 ti_sci_put_one_xfer(&info->minfo, xfer);
1884 return ret;
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.
1903 * Return: 0 if all went fine, else return appropriate error.
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)
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);
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);
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.
1937 * Return: 0 if all went fine, else return appropriate error.
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)
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);
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);
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.
1966 * Return: 0 if all went fine, else return appropriate error.
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)
1971 u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID;
1973 return ti_sci_set_irq(handle, valid_params, src_id, src_index, dst_id,
1974 dst_host_irq, 0, 0, 0, 0, 0);
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
1988 * Return: 0 if all went fine, else return appropriate error.
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)
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;
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);
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.
2014 * Return: 0 if all went fine, else return appropriate error.
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)
2019 u32 valid_params = MSG_FLAG_DST_ID_VALID | MSG_FLAG_DST_HOST_IRQ_VALID;
2021 return ti_sci_free_irq(handle, valid_params, src_id, src_index, dst_id,
2022 dst_host_irq, 0, 0, 0, 0, 0);
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
2036 * Return: 0 if all went fine, else return appropriate error.
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)
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;
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);
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
2056 * Return: 0 if all went well, else returns appropriate error value.
2058 * See @ti_sci_msg_rm_ring_cfg and @ti_sci_msg_rm_ring_cfg_req for
2059 * more info.
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)
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;
2071 if (IS_ERR_OR_NULL(handle))
2072 return -EINVAL;
2074 info = handle_to_ti_sci_info(handle);
2075 dev = info->dev;
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;
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;
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;
2104 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2105 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
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;
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
2121 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
2133 if (IS_ERR(handle))
2134 return PTR_ERR(handle);
2135 if (!handle)
2136 return -EINVAL;
2138 info = handle_to_ti_sci_info(handle);
2139 dev = info->dev;
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;
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;
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;
2160 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2161 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2163 fail:
2164 ti_sci_put_one_xfer(&info->minfo, xfer);
2166 return ret;
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
2177 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
2189 if (IS_ERR(handle))
2190 return PTR_ERR(handle);
2191 if (!handle)
2192 return -EINVAL;
2194 info = handle_to_ti_sci_info(handle);
2195 dev = info->dev;
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;
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;
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;
2216 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2217 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2219 fail:
2220 ti_sci_put_one_xfer(&info->minfo, xfer);
2222 return ret;
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
2231 * Return: 0 if all went well, else returns appropriate error value.
2233 * See @ti_sci_msg_rm_udmap_tx_ch_cfg and @ti_sci_msg_rm_udmap_tx_ch_cfg_req for
2234 * more info.
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)
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;
2246 if (IS_ERR_OR_NULL(handle))
2247 return -EINVAL;
2249 info = handle_to_ti_sci_info(handle);
2250 dev = info->dev;
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;
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;
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;
2288 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2289 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
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;
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
2303 * Return: 0 if all went well, else returns appropriate error value.
2305 * See @ti_sci_msg_rm_udmap_rx_ch_cfg and @ti_sci_msg_rm_udmap_rx_ch_cfg_req for
2306 * more info.
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)
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;
2318 if (IS_ERR_OR_NULL(handle))
2319 return -EINVAL;
2321 info = handle_to_ti_sci_info(handle);
2322 dev = info->dev;
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;
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;
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;
2357 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2358 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
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;
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
2372 * Return: 0 if all went well, else returns appropriate error value.
2374 * See @ti_sci_msg_rm_udmap_flow_cfg and @ti_sci_msg_rm_udmap_flow_cfg_req for
2375 * more info.
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)
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;
2387 if (IS_ERR_OR_NULL(handle))
2388 return -EINVAL;
2390 info = handle_to_ti_sci_info(handle);
2391 dev = info->dev;
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;
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;
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;
2431 resp = (struct ti_sci_msg_hdr *)xfer->xfer_buf;
2432 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
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;
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
2445 * Return: 0 if all went well, else returns appropriate error value.
2447 static int ti_sci_cmd_proc_request(const struct ti_sci_handle *handle,
2448 u8 proc_id)
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;
2457 if (!handle)
2458 return -EINVAL;
2459 if (IS_ERR(handle))
2460 return PTR_ERR(handle);
2462 info = handle_to_ti_sci_info(handle);
2463 dev = info->dev;
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;
2473 req = (struct ti_sci_msg_req_proc_request *)xfer->xfer_buf;
2474 req->processor_id = proc_id;
2476 ret = ti_sci_do_xfer(info, xfer);
2477 if (ret) {
2478 dev_err(dev, "Mbox send fail %d\n", ret);
2479 goto fail;
2482 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2484 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2486 fail:
2487 ti_sci_put_one_xfer(&info->minfo, xfer);
2489 return ret;
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
2497 * Return: 0 if all went well, else returns appropriate error value.
2499 static int ti_sci_cmd_proc_release(const struct ti_sci_handle *handle,
2500 u8 proc_id)
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;
2509 if (!handle)
2510 return -EINVAL;
2511 if (IS_ERR(handle))
2512 return PTR_ERR(handle);
2514 info = handle_to_ti_sci_info(handle);
2515 dev = info->dev;
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;
2525 req = (struct ti_sci_msg_req_proc_release *)xfer->xfer_buf;
2526 req->processor_id = proc_id;
2528 ret = ti_sci_do_xfer(info, xfer);
2529 if (ret) {
2530 dev_err(dev, "Mbox send fail %d\n", ret);
2531 goto fail;
2534 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2536 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2538 fail:
2539 ti_sci_put_one_xfer(&info->minfo, xfer);
2541 return ret;
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
2552 * Return: 0 if all went well, else returns appropriate error value.
2554 static int ti_sci_cmd_proc_handover(const struct ti_sci_handle *handle,
2555 u8 proc_id, u8 host_id)
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;
2564 if (!handle)
2565 return -EINVAL;
2566 if (IS_ERR(handle))
2567 return PTR_ERR(handle);
2569 info = handle_to_ti_sci_info(handle);
2570 dev = info->dev;
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;
2580 req = (struct ti_sci_msg_req_proc_handover *)xfer->xfer_buf;
2581 req->processor_id = proc_id;
2582 req->host_id = host_id;
2584 ret = ti_sci_do_xfer(info, xfer);
2585 if (ret) {
2586 dev_err(dev, "Mbox send fail %d\n", ret);
2587 goto fail;
2590 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2592 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2594 fail:
2595 ti_sci_put_one_xfer(&info->minfo, xfer);
2597 return ret;
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.
2608 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
2622 if (!handle)
2623 return -EINVAL;
2624 if (IS_ERR(handle))
2625 return PTR_ERR(handle);
2627 info = handle_to_ti_sci_info(handle);
2628 dev = info->dev;
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;
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;
2646 ret = ti_sci_do_xfer(info, xfer);
2647 if (ret) {
2648 dev_err(dev, "Mbox send fail %d\n", ret);
2649 goto fail;
2652 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2654 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2656 fail:
2657 ti_sci_put_one_xfer(&info->minfo, xfer);
2659 return ret;
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
2670 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
2683 if (!handle)
2684 return -EINVAL;
2685 if (IS_ERR(handle))
2686 return PTR_ERR(handle);
2688 info = handle_to_ti_sci_info(handle);
2689 dev = info->dev;
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;
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;
2704 ret = ti_sci_do_xfer(info, xfer);
2705 if (ret) {
2706 dev_err(dev, "Mbox send fail %d\n", ret);
2707 goto fail;
2710 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2712 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2714 fail:
2715 ti_sci_put_one_xfer(&info->minfo, xfer);
2717 return ret;
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
2725 * Return: 0 if all went well, else returns appropriate error value.
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)
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;
2738 if (!handle)
2739 return -EINVAL;
2740 if (IS_ERR(handle))
2741 return PTR_ERR(handle);
2743 info = handle_to_ti_sci_info(handle);
2744 dev = info->dev;
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;
2754 req = (struct ti_sci_msg_req_get_status *)xfer->xfer_buf;
2755 req->processor_id = proc_id;
2757 ret = ti_sci_do_xfer(info, xfer);
2758 if (ret) {
2759 dev_err(dev, "Mbox send fail %d\n", ret);
2760 goto fail;
2763 resp = (struct ti_sci_msg_resp_get_status *)xfer->tx_message.buf;
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;
2776 fail:
2777 ti_sci_put_one_xfer(&info->minfo, xfer);
2779 return ret;
2783 * ti_sci_setup_ops() - Setup the operations structures
2784 * @info: pointer to TISCI pointer
2786 static void ti_sci_setup_ops(struct ti_sci_info *info)
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;
2799 core_ops->reboot_device = ti_sci_cmd_core_reboot;
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;
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;
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;
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;
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;
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;
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;
2840 rops->set_cfg = ti_sci_cmd_rm_ring_cfg;
2842 psilops->pair = ti_sci_cmd_rm_psil_pair;
2843 psilops->unpair = ti_sci_cmd_rm_psil_unpair;
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;
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;
2858 * ti_sci_get_handle() - Get the TI SCI handle for a device
2859 * @dev: Pointer to device for which we want SCI handle
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.
2869 const struct ti_sci_handle *ti_sci_get_handle(struct device *dev)
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;
2876 if (!dev) {
2877 pr_err("I need a device pointer\n");
2878 return ERR_PTR(-EINVAL);
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);
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;
2895 mutex_unlock(&ti_sci_list_mutex);
2896 of_node_put(ti_sci_np);
2898 if (!handle)
2899 return ERR_PTR(-EPROBE_DEFER);
2901 return handle;
2903 EXPORT_SYMBOL_GPL(ti_sci_get_handle);
2906 * ti_sci_put_handle() - Release the handle acquired by ti_sci_get_handle
2907 * @handle: Handle acquired by ti_sci_get_handle
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
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;
2917 int ti_sci_put_handle(const struct ti_sci_handle *handle)
2919 struct ti_sci_info *info;
2921 if (IS_ERR(handle))
2922 return PTR_ERR(handle);
2923 if (!handle)
2924 return -EINVAL;
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);
2932 return 0;
2934 EXPORT_SYMBOL_GPL(ti_sci_put_handle);
2936 static void devm_ti_sci_release(struct device *dev, void *res)
2938 const struct ti_sci_handle **ptr = res;
2939 const struct ti_sci_handle *handle = *ptr;
2940 int ret;
2942 ret = ti_sci_put_handle(handle);
2943 if (ret)
2944 dev_err(dev, "failed to put handle %d\n", ret);
2948 * devm_ti_sci_get_handle() - Managed get handle
2949 * @dev: device for which we want SCI handle for.
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.
2956 * Return: 0 if all went fine, else corresponding error.
2958 const struct ti_sci_handle *devm_ti_sci_get_handle(struct device *dev)
2960 const struct ti_sci_handle **ptr;
2961 const struct ti_sci_handle *handle;
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);
2968 if (!IS_ERR(handle)) {
2969 *ptr = handle;
2970 devres_add(dev, ptr);
2971 } else {
2972 devres_free(ptr);
2975 return handle;
2977 EXPORT_SYMBOL_GPL(devm_ti_sci_get_handle);
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
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.
2992 const struct ti_sci_handle *ti_sci_get_by_phandle(struct device_node *np,
2993 const char *property)
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;
3000 if (!np) {
3001 pr_err("I need a device pointer\n");
3002 return ERR_PTR(-EINVAL);
3005 ti_sci_np = of_parse_phandle(np, property, 0);
3006 if (!ti_sci_np)
3007 return ERR_PTR(-ENODEV);
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;
3018 mutex_unlock(&ti_sci_list_mutex);
3019 of_node_put(ti_sci_np);
3021 if (!handle)
3022 return ERR_PTR(-EPROBE_DEFER);
3024 return handle;
3026 EXPORT_SYMBOL_GPL(ti_sci_get_by_phandle);
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
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.
3038 * Return: 0 if all went fine, else corresponding error.
3040 const struct ti_sci_handle *devm_ti_sci_get_by_phandle(struct device *dev,
3041 const char *property)
3043 const struct ti_sci_handle *handle;
3044 const struct ti_sci_handle **ptr;
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);
3051 if (!IS_ERR(handle)) {
3052 *ptr = handle;
3053 devres_add(dev, ptr);
3054 } else {
3055 devres_free(ptr);
3058 return handle;
3060 EXPORT_SYMBOL_GPL(devm_ti_sci_get_by_phandle);
3063 * ti_sci_get_free_resource() - Get a free resource from TISCI resource.
3064 * @res: Pointer to the TISCI resource
3066 * Return: resource num if all went ok else TI_SCI_RESOURCE_NULL.
3068 u16 ti_sci_get_free_resource(struct ti_sci_resource *res)
3070 unsigned long flags;
3071 u16 set, free_bit;
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;
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);
3083 if (desc->num && free_bit < desc->num)
3084 return desc->start + free_bit;
3085 else
3086 return desc->start_sec + free_bit;
3089 raw_spin_unlock_irqrestore(&res->lock, flags);
3091 return TI_SCI_RESOURCE_NULL;
3093 EXPORT_SYMBOL_GPL(ti_sci_get_free_resource);
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.
3100 void ti_sci_release_resource(struct ti_sci_resource *res, u16 id)
3102 unsigned long flags;
3103 u16 set;
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];
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);
3116 raw_spin_unlock_irqrestore(&res->lock, flags);
3118 EXPORT_SYMBOL_GPL(ti_sci_release_resource);
3121 * ti_sci_get_num_resources() - Get the number of resources in TISCI resource
3122 * @res: Pointer to the TISCI resource
3124 * Return: Total number of available resources.
3126 u32 ti_sci_get_num_resources(struct ti_sci_resource *res)
3128 u32 set, count = 0;
3130 for (set = 0; set < res->sets; set++)
3131 count += res->desc[set].num + res->desc[set].num_sec;
3133 return count;
3135 EXPORT_SYMBOL_GPL(ti_sci_get_num_resources);
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
3145 * Return: Pointer to ti_sci_resource if all went well else appropriate
3146 * error pointer.
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)
3153 struct ti_sci_resource *res;
3154 bool valid_set = false;
3155 int i, ret, res_count;
3157 res = devm_kzalloc(dev, sizeof(*res), GFP_KERNEL);
3158 if (!res)
3159 return ERR_PTR(-ENOMEM);
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);
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;
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);
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);
3191 raw_spin_lock_init(&res->lock);
3193 if (valid_set)
3194 return res;
3196 return ERR_PTR(-EINVAL);
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
3206 * Return: Pointer to ti_sci_resource if all went well else appropriate
3207 * error pointer.
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)
3213 struct ti_sci_resource *res;
3214 u32 *sub_types;
3215 int sets;
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);
3224 sub_types = kcalloc(sets, sizeof(*sub_types), GFP_KERNEL);
3225 if (!sub_types)
3226 return ERR_PTR(-ENOMEM);
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);
3232 kfree(sub_types);
3233 return res;
3235 EXPORT_SYMBOL_GPL(devm_ti_sci_get_of_resource);
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.
3244 * Return: Pointer to ti_sci_resource if all went well else appropriate
3245 * error pointer.
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)
3251 return devm_ti_sci_get_resource_sets(handle, dev, dev_id, &sub_type, 1);
3253 EXPORT_SYMBOL_GPL(devm_ti_sci_get_resource);
3255 static int tisci_reboot_handler(struct notifier_block *nb, unsigned long mode,
3256 void *cmd)
3258 struct ti_sci_info *info = reboot_to_ti_sci_info(nb);
3259 const struct ti_sci_handle *handle = &info->handle;
3261 ti_sci_cmd_core_reboot(handle);
3263 /* call fail OR pass, we should not be here in the first place */
3264 return NOTIFY_BAD;
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,
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,
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 */ },
3292 MODULE_DEVICE_TABLE(of, ti_sci_of_match);
3294 static int ti_sci_probe(struct platform_device *pdev)
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;
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;
3313 desc = of_id->data;
3315 info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
3316 if (!info)
3317 return -ENOMEM;
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;
3334 reboot = of_property_read_bool(dev->of_node,
3335 "ti,system-reboot-controller");
3336 INIT_LIST_HEAD(&info->node);
3337 minfo = &info->minfo;
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..
3344 if (WARN_ON(desc->max_msgs >=
3345 1 << 8 * sizeof(((struct ti_sci_msg_hdr *)0)->seq)))
3346 return -EINVAL;
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;
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);
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;
3370 xfer->tx_message.buf = xfer->xfer_buf;
3371 init_completion(&xfer->done);
3374 ret = ti_sci_debugfs_create(pdev, info);
3375 if (ret)
3376 dev_warn(dev, "Failed to create debug file\n");
3378 platform_set_drvdata(pdev, info);
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;
3386 spin_lock_init(&minfo->xfer_lock);
3387 sema_init(&minfo->sem_xfer_count, desc->max_msgs);
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;
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;
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;
3406 ti_sci_setup_ops(info);
3408 if (reboot) {
3409 info->nb.notifier_call = tisci_reboot_handler;
3410 info->nb.priority = 128;
3412 ret = register_restart_handler(&info->nb);
3413 if (ret) {
3414 dev_err(dev, "reboot registration fail(%d)\n", ret);
3415 return ret;
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);
3424 mutex_lock(&ti_sci_list_mutex);
3425 list_add_tail(&info->node, &ti_sci_list);
3426 mutex_unlock(&ti_sci_list_mutex);
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;
3438 static int ti_sci_remove(struct platform_device *pdev)
3440 struct ti_sci_info *info;
3441 struct device *dev = &pdev->dev;
3442 int ret = 0;
3444 of_platform_depopulate(dev);
3446 info = platform_get_drvdata(pdev);
3448 if (info->nb.notifier_call)
3449 unregister_restart_handler(&info->nb);
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);
3458 if (!ret) {
3459 ti_sci_debugfs_destroy(pdev, info);
3461 /* Safe to free channels since no more users */
3462 mbox_free_channel(info->chan_tx);
3463 mbox_free_channel(info->chan_rx);
3466 return ret;
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),
3477 module_platform_driver(ti_sci_driver);
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");