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