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