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