blob: 4671a5e3a8a6ee3e2c5125654254af85c758a315 [file] [log] [blame]
Lokesh Vutla5af02db2018-08-27 15:57:32 +05301// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Texas Instruments System Control Interface Protocol Driver
4 * Based on drivers/firmware/ti_sci.c from Linux.
5 *
6 * Copyright (C) 2018 Texas Instruments Incorporated - http://www.ti.com/
7 * Lokesh Vutla <lokeshvutla@ti.com>
8 */
9
10#include <common.h>
11#include <dm.h>
12#include <errno.h>
Simon Glass0f2af882020-05-10 11:40:05 -060013#include <log.h>
Lokesh Vutla5af02db2018-08-27 15:57:32 +053014#include <mailbox.h>
Simon Glass9bc15642020-02-03 07:36:16 -070015#include <malloc.h>
Lokesh Vutla5af02db2018-08-27 15:57:32 +053016#include <dm/device.h>
Simon Glass9bc15642020-02-03 07:36:16 -070017#include <dm/device_compat.h>
Simon Glassd66c5f72020-02-03 07:36:15 -070018#include <dm/devres.h>
Simon Glass4dcacfc2020-05-10 11:40:13 -060019#include <linux/bitops.h>
Grygorii Strashkod64c5b22019-02-05 17:31:21 +053020#include <linux/compat.h>
Lokesh Vutla5af02db2018-08-27 15:57:32 +053021#include <linux/err.h>
22#include <linux/soc/ti/k3-sec-proxy.h>
23#include <linux/soc/ti/ti_sci_protocol.h>
24
25#include "ti_sci.h"
26
27/* List of all TI SCI devices active in system */
28static LIST_HEAD(ti_sci_list);
29
30/**
31 * struct ti_sci_xfer - Structure representing a message flow
32 * @tx_message: Transmit message
33 * @rx_len: Receive message length
34 */
35struct ti_sci_xfer {
36 struct k3_sec_proxy_msg tx_message;
37 u8 rx_len;
38};
39
40/**
Grygorii Strashkod64c5b22019-02-05 17:31:21 +053041 * struct ti_sci_rm_type_map - Structure representing TISCI Resource
42 * management representation of dev_ids.
43 * @dev_id: TISCI device ID
44 * @type: Corresponding id as identified by TISCI RM.
45 *
46 * Note: This is used only as a work around for using RM range apis
47 * for AM654 SoC. For future SoCs dev_id will be used as type
48 * for RM range APIs. In order to maintain ABI backward compatibility
49 * type is not being changed for AM654 SoC.
50 */
51struct ti_sci_rm_type_map {
52 u32 dev_id;
53 u16 type;
54};
55
56/**
Lokesh Vutla5af02db2018-08-27 15:57:32 +053057 * struct ti_sci_desc - Description of SoC integration
Grygorii Strashkod64c5b22019-02-05 17:31:21 +053058 * @default_host_id: Host identifier representing the compute entity
59 * @max_rx_timeout_ms: Timeout for communication with SoC (in Milliseconds)
60 * @max_msgs: Maximum number of messages that can be pending
61 * simultaneously in the system
62 * @max_msg_size: Maximum size of data per message that can be handled.
Lokesh Vutla5af02db2018-08-27 15:57:32 +053063 */
64struct ti_sci_desc {
Grygorii Strashkod64c5b22019-02-05 17:31:21 +053065 u8 default_host_id;
66 int max_rx_timeout_ms;
67 int max_msgs;
Lokesh Vutla5af02db2018-08-27 15:57:32 +053068 int max_msg_size;
69};
70
71/**
72 * struct ti_sci_info - Structure representing a TI SCI instance
73 * @dev: Device pointer
74 * @desc: SoC description for this instance
75 * @handle: Instance of TI SCI handle to send to clients.
76 * @chan_tx: Transmit mailbox channel
77 * @chan_rx: Receive mailbox channel
78 * @xfer: xfer info
79 * @list: list head
80 * @is_secure: Determines if the communication is through secure threads.
81 * @host_id: Host identifier representing the compute entity
82 * @seq: Seq id used for verification for tx and rx message.
83 */
84struct ti_sci_info {
85 struct udevice *dev;
86 const struct ti_sci_desc *desc;
87 struct ti_sci_handle handle;
88 struct mbox_chan chan_tx;
89 struct mbox_chan chan_rx;
90 struct mbox_chan chan_notify;
91 struct ti_sci_xfer xfer;
92 struct list_head list;
Lokesh Vutla0d0412a2019-06-07 19:24:41 +053093 struct list_head dev_list;
Lokesh Vutla5af02db2018-08-27 15:57:32 +053094 bool is_secure;
95 u8 host_id;
96 u8 seq;
97};
98
Lokesh Vutla0d0412a2019-06-07 19:24:41 +053099struct ti_sci_exclusive_dev {
100 u32 id;
101 u32 count;
102 struct list_head list;
103};
104
Lokesh Vutla5af02db2018-08-27 15:57:32 +0530105#define handle_to_ti_sci_info(h) container_of(h, struct ti_sci_info, handle)
106
107/**
108 * ti_sci_setup_one_xfer() - Setup one message type
109 * @info: Pointer to SCI entity information
110 * @msg_type: Message type
111 * @msg_flags: Flag to set for the message
112 * @buf: Buffer to be send to mailbox channel
113 * @tx_message_size: transmit message size
Andreas Dannenbergca08cb32019-06-07 19:24:40 +0530114 * @rx_message_size: receive message size. may be set to zero for send-only
115 * transactions.
Lokesh Vutla5af02db2018-08-27 15:57:32 +0530116 *
117 * Helper function which is used by various command functions that are
118 * exposed to clients of this driver for allocating a message traffic event.
119 *
120 * Return: Corresponding ti_sci_xfer pointer if all went fine,
121 * else appropriate error pointer.
122 */
123static struct ti_sci_xfer *ti_sci_setup_one_xfer(struct ti_sci_info *info,
124 u16 msg_type, u32 msg_flags,
125 u32 *buf,
126 size_t tx_message_size,
127 size_t rx_message_size)
128{
129 struct ti_sci_xfer *xfer = &info->xfer;
130 struct ti_sci_msg_hdr *hdr;
131
132 /* Ensure we have sane transfer sizes */
133 if (rx_message_size > info->desc->max_msg_size ||
134 tx_message_size > info->desc->max_msg_size ||
Andreas Dannenbergca08cb32019-06-07 19:24:40 +0530135 (rx_message_size > 0 && rx_message_size < sizeof(*hdr)) ||
136 tx_message_size < sizeof(*hdr))
Lokesh Vutla5af02db2018-08-27 15:57:32 +0530137 return ERR_PTR(-ERANGE);
138
139 info->seq = ~info->seq;
140 xfer->tx_message.buf = buf;
141 xfer->tx_message.len = tx_message_size;
142 xfer->rx_len = (u8)rx_message_size;
143
144 hdr = (struct ti_sci_msg_hdr *)buf;
145 hdr->seq = info->seq;
146 hdr->type = msg_type;
147 hdr->host = info->host_id;
148 hdr->flags = msg_flags;
149
150 return xfer;
151}
152
153/**
154 * ti_sci_get_response() - Receive response from mailbox channel
155 * @info: Pointer to SCI entity information
156 * @xfer: Transfer to initiate and wait for response
157 * @chan: Channel to receive the response
158 *
159 * Return: -ETIMEDOUT in case of no response, if transmit error,
160 * return corresponding error, else if all goes well,
161 * return 0.
162 */
163static inline int ti_sci_get_response(struct ti_sci_info *info,
164 struct ti_sci_xfer *xfer,
165 struct mbox_chan *chan)
166{
167 struct k3_sec_proxy_msg *msg = &xfer->tx_message;
168 struct ti_sci_secure_msg_hdr *secure_hdr;
169 struct ti_sci_msg_hdr *hdr;
170 int ret;
171
172 /* Receive the response */
Andreas Dannenberg607d4ca2019-04-24 14:20:08 -0500173 ret = mbox_recv(chan, msg, info->desc->max_rx_timeout_ms * 1000);
Lokesh Vutla5af02db2018-08-27 15:57:32 +0530174 if (ret) {
175 dev_err(info->dev, "%s: Message receive failed. ret = %d\n",
176 __func__, ret);
177 return ret;
178 }
179
180 /* ToDo: Verify checksum */
181 if (info->is_secure) {
182 secure_hdr = (struct ti_sci_secure_msg_hdr *)msg->buf;
183 msg->buf = (u32 *)((void *)msg->buf + sizeof(*secure_hdr));
184 }
185
186 /* msg is updated by mailbox driver */
187 hdr = (struct ti_sci_msg_hdr *)msg->buf;
188
189 /* Sanity check for message response */
190 if (hdr->seq != info->seq) {
191 dev_dbg(info->dev, "%s: Message for %d is not expected\n",
192 __func__, hdr->seq);
193 return ret;
194 }
195
196 if (msg->len > info->desc->max_msg_size) {
197 dev_err(info->dev, "%s: Unable to handle %zu xfer (max %d)\n",
198 __func__, msg->len, info->desc->max_msg_size);
199 return -EINVAL;
200 }
201
202 if (msg->len < xfer->rx_len) {
203 dev_err(info->dev, "%s: Recv xfer %zu < expected %d length\n",
204 __func__, msg->len, xfer->rx_len);
205 }
206
207 return ret;
208}
209
210/**
211 * ti_sci_do_xfer() - Do one transfer
212 * @info: Pointer to SCI entity information
213 * @xfer: Transfer to initiate and wait for response
214 *
215 * Return: 0 if all went fine, else return appropriate error.
216 */
217static inline int ti_sci_do_xfer(struct ti_sci_info *info,
218 struct ti_sci_xfer *xfer)
219{
220 struct k3_sec_proxy_msg *msg = &xfer->tx_message;
221 u8 secure_buf[info->desc->max_msg_size];
222 struct ti_sci_secure_msg_hdr secure_hdr;
223 int ret;
224
225 if (info->is_secure) {
226 /* ToDo: get checksum of the entire message */
227 secure_hdr.checksum = 0;
228 secure_hdr.reserved = 0;
229 memcpy(&secure_buf[sizeof(secure_hdr)], xfer->tx_message.buf,
230 xfer->tx_message.len);
231
232 xfer->tx_message.buf = (u32 *)secure_buf;
233 xfer->tx_message.len += sizeof(secure_hdr);
Andreas Dannenbergca08cb32019-06-07 19:24:40 +0530234
235 if (xfer->rx_len)
236 xfer->rx_len += sizeof(secure_hdr);
Lokesh Vutla5af02db2018-08-27 15:57:32 +0530237 }
238
239 /* Send the message */
240 ret = mbox_send(&info->chan_tx, msg);
241 if (ret) {
242 dev_err(info->dev, "%s: Message sending failed. ret = %d\n",
243 __func__, ret);
244 return ret;
245 }
246
Andreas Dannenbergca08cb32019-06-07 19:24:40 +0530247 /* Get response if requested */
248 if (xfer->rx_len)
249 ret = ti_sci_get_response(info, xfer, &info->chan_rx);
250
251 return ret;
Lokesh Vutla5af02db2018-08-27 15:57:32 +0530252}
253
254/**
255 * ti_sci_cmd_get_revision() - command to get the revision of the SCI entity
256 * @handle: pointer to TI SCI handle
257 *
258 * Updates the SCI information in the internal data structure.
259 *
260 * Return: 0 if all went fine, else return appropriate error.
261 */
262static int ti_sci_cmd_get_revision(struct ti_sci_handle *handle)
263{
264 struct ti_sci_msg_resp_version *rev_info;
265 struct ti_sci_version_info *ver;
266 struct ti_sci_msg_hdr hdr;
267 struct ti_sci_info *info;
268 struct ti_sci_xfer *xfer;
269 int ret;
270
271 if (IS_ERR(handle))
272 return PTR_ERR(handle);
273 if (!handle)
274 return -EINVAL;
275
276 info = handle_to_ti_sci_info(handle);
277
Andrew F. Davis8928fbd2019-04-29 09:04:11 -0400278 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_VERSION,
279 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
Lokesh Vutla5af02db2018-08-27 15:57:32 +0530280 (u32 *)&hdr, sizeof(struct ti_sci_msg_hdr),
281 sizeof(*rev_info));
282 if (IS_ERR(xfer)) {
283 ret = PTR_ERR(xfer);
284 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
285 return ret;
286 }
287
288 ret = ti_sci_do_xfer(info, xfer);
289 if (ret) {
290 dev_err(info->dev, "Mbox communication fail %d\n", ret);
291 return ret;
292 }
293
294 rev_info = (struct ti_sci_msg_resp_version *)xfer->tx_message.buf;
295
296 ver = &handle->version;
297 ver->abi_major = rev_info->abi_major;
298 ver->abi_minor = rev_info->abi_minor;
299 ver->firmware_revision = rev_info->firmware_revision;
300 strncpy(ver->firmware_description, rev_info->firmware_description,
301 sizeof(ver->firmware_description));
302
303 return 0;
304}
305
306/**
307 * ti_sci_is_response_ack() - Generic ACK/NACK message checkup
308 * @r: pointer to response buffer
309 *
310 * Return: true if the response was an ACK, else returns false.
311 */
312static inline bool ti_sci_is_response_ack(void *r)
313{
314 struct ti_sci_msg_hdr *hdr = r;
315
316 return hdr->flags & TI_SCI_FLAG_RESP_GENERIC_ACK ? true : false;
317}
318
319/**
Andreas Dannenberg5299c4c2018-08-27 15:57:33 +0530320 * cmd_set_board_config_using_msg() - Common command to send board configuration
321 * message
322 * @handle: pointer to TI SCI handle
323 * @msg_type: One of the TISCI message types to set board configuration
324 * @addr: Address where the board config structure is located
325 * @size: Size of the board config structure
326 *
327 * Return: 0 if all went well, else returns appropriate error value.
328 */
329static int cmd_set_board_config_using_msg(const struct ti_sci_handle *handle,
330 u16 msg_type, u64 addr, u32 size)
331{
332 struct ti_sci_msg_board_config req;
333 struct ti_sci_msg_hdr *resp;
334 struct ti_sci_info *info;
335 struct ti_sci_xfer *xfer;
336 int ret = 0;
337
338 if (IS_ERR(handle))
339 return PTR_ERR(handle);
340 if (!handle)
341 return -EINVAL;
342
343 info = handle_to_ti_sci_info(handle);
344
345 xfer = ti_sci_setup_one_xfer(info, msg_type,
346 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
347 (u32 *)&req, sizeof(req), sizeof(*resp));
348 if (IS_ERR(xfer)) {
349 ret = PTR_ERR(xfer);
350 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
351 return ret;
352 }
353 req.boardcfgp_high = (addr >> 32) & 0xffffffff;
354 req.boardcfgp_low = addr & 0xffffffff;
355 req.boardcfg_size = size;
356
357 ret = ti_sci_do_xfer(info, xfer);
358 if (ret) {
359 dev_err(info->dev, "Mbox send fail %d\n", ret);
360 return ret;
361 }
362
363 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
364
365 if (!ti_sci_is_response_ack(resp))
366 return -ENODEV;
367
368 return ret;
369}
370
371/**
372 * ti_sci_cmd_set_board_config() - Command to send board configuration message
373 * @handle: pointer to TI SCI handle
374 * @addr: Address where the board config structure is located
375 * @size: Size of the board config structure
376 *
377 * Return: 0 if all went well, else returns appropriate error value.
378 */
379static int ti_sci_cmd_set_board_config(const struct ti_sci_handle *handle,
380 u64 addr, u32 size)
381{
382 return cmd_set_board_config_using_msg(handle,
383 TI_SCI_MSG_BOARD_CONFIG,
384 addr, size);
385}
386
387/**
388 * ti_sci_cmd_set_board_config_rm() - Command to send board resource
389 * management configuration
390 * @handle: pointer to TI SCI handle
391 * @addr: Address where the board RM config structure is located
392 * @size: Size of the RM config structure
393 *
394 * Return: 0 if all went well, else returns appropriate error value.
395 */
396static
397int ti_sci_cmd_set_board_config_rm(const struct ti_sci_handle *handle,
398 u64 addr, u32 size)
399{
400 return cmd_set_board_config_using_msg(handle,
401 TI_SCI_MSG_BOARD_CONFIG_RM,
402 addr, size);
403}
404
405/**
406 * ti_sci_cmd_set_board_config_security() - Command to send board security
407 * configuration message
408 * @handle: pointer to TI SCI handle
409 * @addr: Address where the board security config structure is located
410 * @size: Size of the security config structure
411 *
412 * Return: 0 if all went well, else returns appropriate error value.
413 */
414static
415int ti_sci_cmd_set_board_config_security(const struct ti_sci_handle *handle,
416 u64 addr, u32 size)
417{
418 return cmd_set_board_config_using_msg(handle,
419 TI_SCI_MSG_BOARD_CONFIG_SECURITY,
420 addr, size);
421}
422
423/**
424 * ti_sci_cmd_set_board_config_pm() - Command to send board power and clock
425 * configuration message
426 * @handle: pointer to TI SCI handle
427 * @addr: Address where the board PM config structure is located
428 * @size: Size of the PM config structure
429 *
430 * Return: 0 if all went well, else returns appropriate error value.
431 */
432static int ti_sci_cmd_set_board_config_pm(const struct ti_sci_handle *handle,
433 u64 addr, u32 size)
434{
435 return cmd_set_board_config_using_msg(handle,
436 TI_SCI_MSG_BOARD_CONFIG_PM,
437 addr, size);
438}
439
Lokesh Vutla0d0412a2019-06-07 19:24:41 +0530440static struct ti_sci_exclusive_dev
441*ti_sci_get_exclusive_dev(struct list_head *dev_list, u32 id)
442{
443 struct ti_sci_exclusive_dev *dev;
444
445 list_for_each_entry(dev, dev_list, list)
446 if (dev->id == id)
447 return dev;
448
449 return NULL;
450}
451
452static void ti_sci_add_exclusive_dev(struct ti_sci_info *info, u32 id)
453{
454 struct ti_sci_exclusive_dev *dev;
455
456 dev = ti_sci_get_exclusive_dev(&info->dev_list, id);
457 if (dev) {
458 dev->count++;
459 return;
460 }
461
462 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
463 dev->id = id;
464 dev->count = 1;
465 INIT_LIST_HEAD(&dev->list);
466 list_add_tail(&dev->list, &info->dev_list);
467}
468
469static void ti_sci_delete_exclusive_dev(struct ti_sci_info *info, u32 id)
470{
471 struct ti_sci_exclusive_dev *dev;
472
473 dev = ti_sci_get_exclusive_dev(&info->dev_list, id);
474 if (!dev)
475 return;
476
477 if (dev->count > 0)
478 dev->count--;
479}
480
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530481/**
482 * ti_sci_set_device_state() - Set device state helper
483 * @handle: pointer to TI SCI handle
484 * @id: Device identifier
485 * @flags: flags to setup for the device
486 * @state: State to move the device to
487 *
488 * Return: 0 if all went well, else returns appropriate error value.
489 */
490static int ti_sci_set_device_state(const struct ti_sci_handle *handle,
491 u32 id, u32 flags, u8 state)
492{
493 struct ti_sci_msg_req_set_device_state req;
494 struct ti_sci_msg_hdr *resp;
495 struct ti_sci_info *info;
496 struct ti_sci_xfer *xfer;
497 int ret = 0;
498
499 if (IS_ERR(handle))
500 return PTR_ERR(handle);
501 if (!handle)
502 return -EINVAL;
503
504 info = handle_to_ti_sci_info(handle);
505
506 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_SET_DEVICE_STATE,
507 flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
508 (u32 *)&req, sizeof(req), sizeof(*resp));
509 if (IS_ERR(xfer)) {
510 ret = PTR_ERR(xfer);
511 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
512 return ret;
513 }
514 req.id = id;
515 req.state = state;
516
517 ret = ti_sci_do_xfer(info, xfer);
518 if (ret) {
519 dev_err(info->dev, "Mbox send fail %d\n", ret);
520 return ret;
521 }
522
523 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
524
525 if (!ti_sci_is_response_ack(resp))
526 return -ENODEV;
527
Lokesh Vutla0d0412a2019-06-07 19:24:41 +0530528 if (state == MSG_DEVICE_SW_STATE_AUTO_OFF)
529 ti_sci_delete_exclusive_dev(info, id);
530 else if (flags & MSG_FLAG_DEVICE_EXCLUSIVE)
531 ti_sci_add_exclusive_dev(info, id);
532
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530533 return ret;
534}
535
536/**
Andreas Dannenbergca08cb32019-06-07 19:24:40 +0530537 * ti_sci_set_device_state_no_wait() - Set device state helper without
538 * requesting or waiting for a response.
539 * @handle: pointer to TI SCI handle
540 * @id: Device identifier
541 * @flags: flags to setup for the device
542 * @state: State to move the device to
543 *
544 * Return: 0 if all went well, else returns appropriate error value.
545 */
546static int ti_sci_set_device_state_no_wait(const struct ti_sci_handle *handle,
547 u32 id, u32 flags, u8 state)
548{
549 struct ti_sci_msg_req_set_device_state req;
550 struct ti_sci_info *info;
551 struct ti_sci_xfer *xfer;
552 int ret = 0;
553
554 if (IS_ERR(handle))
555 return PTR_ERR(handle);
556 if (!handle)
557 return -EINVAL;
558
559 info = handle_to_ti_sci_info(handle);
560
561 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_SET_DEVICE_STATE,
562 flags | TI_SCI_FLAG_REQ_GENERIC_NORESPONSE,
563 (u32 *)&req, sizeof(req), 0);
564 if (IS_ERR(xfer)) {
565 ret = PTR_ERR(xfer);
566 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
567 return ret;
568 }
569 req.id = id;
570 req.state = state;
571
572 ret = ti_sci_do_xfer(info, xfer);
573 if (ret)
574 dev_err(info->dev, "Mbox send fail %d\n", ret);
575
576 return ret;
577}
578
579/**
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530580 * ti_sci_get_device_state() - Get device state helper
581 * @handle: Handle to the device
582 * @id: Device Identifier
583 * @clcnt: Pointer to Context Loss Count
584 * @resets: pointer to resets
585 * @p_state: pointer to p_state
586 * @c_state: pointer to c_state
587 *
588 * Return: 0 if all went fine, else return appropriate error.
589 */
590static int ti_sci_get_device_state(const struct ti_sci_handle *handle,
591 u32 id, u32 *clcnt, u32 *resets,
592 u8 *p_state, u8 *c_state)
593{
594 struct ti_sci_msg_resp_get_device_state *resp;
595 struct ti_sci_msg_req_get_device_state req;
596 struct ti_sci_info *info;
597 struct ti_sci_xfer *xfer;
598 int ret = 0;
599
600 if (IS_ERR(handle))
601 return PTR_ERR(handle);
602 if (!handle)
603 return -EINVAL;
604
605 if (!clcnt && !resets && !p_state && !c_state)
606 return -EINVAL;
607
608 info = handle_to_ti_sci_info(handle);
609
Andrew F. Davis8928fbd2019-04-29 09:04:11 -0400610 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_GET_DEVICE_STATE,
611 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530612 (u32 *)&req, sizeof(req), sizeof(*resp));
613 if (IS_ERR(xfer)) {
614 ret = PTR_ERR(xfer);
615 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
616 return ret;
617 }
618 req.id = id;
619
620 ret = ti_sci_do_xfer(info, xfer);
621 if (ret) {
Sean Anderson405dc242020-09-15 10:44:38 -0400622 dev_err(info->dev, "Mbox send fail %d\n", ret);
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530623 return ret;
624 }
625
626 resp = (struct ti_sci_msg_resp_get_device_state *)xfer->tx_message.buf;
627 if (!ti_sci_is_response_ack(resp))
628 return -ENODEV;
629
630 if (clcnt)
631 *clcnt = resp->context_loss_count;
632 if (resets)
633 *resets = resp->resets;
634 if (p_state)
635 *p_state = resp->programmed_state;
636 if (c_state)
637 *c_state = resp->current_state;
638
639 return ret;
640}
641
642/**
643 * ti_sci_cmd_get_device() - command to request for device managed by TISCI
644 * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle
645 * @id: Device Identifier
646 *
647 * Request for the device - NOTE: the client MUST maintain integrity of
648 * usage count by balancing get_device with put_device. No refcounting is
649 * managed by driver for that purpose.
650 *
651 * NOTE: The request is for exclusive access for the processor.
652 *
653 * Return: 0 if all went fine, else return appropriate error.
654 */
655static int ti_sci_cmd_get_device(const struct ti_sci_handle *handle, u32 id)
656{
Lokesh Vutlaf5613002019-06-07 19:24:39 +0530657 return ti_sci_set_device_state(handle, id, 0,
658 MSG_DEVICE_SW_STATE_ON);
659}
660
661static int ti_sci_cmd_get_device_exclusive(const struct ti_sci_handle *handle,
662 u32 id)
663{
664 return ti_sci_set_device_state(handle, id, MSG_FLAG_DEVICE_EXCLUSIVE,
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530665 MSG_DEVICE_SW_STATE_ON);
666}
667
668/**
669 * ti_sci_cmd_idle_device() - Command to idle a device managed by TISCI
670 * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle
671 * @id: Device Identifier
672 *
673 * Request for the device - NOTE: the client MUST maintain integrity of
674 * usage count by balancing get_device with put_device. No refcounting is
675 * managed by driver for that purpose.
676 *
677 * Return: 0 if all went fine, else return appropriate error.
678 */
679static int ti_sci_cmd_idle_device(const struct ti_sci_handle *handle, u32 id)
680{
681 return ti_sci_set_device_state(handle, id,
Lokesh Vutlaf5613002019-06-07 19:24:39 +0530682 0,
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530683 MSG_DEVICE_SW_STATE_RETENTION);
684}
685
Lokesh Vutlaf5613002019-06-07 19:24:39 +0530686static int ti_sci_cmd_idle_device_exclusive(const struct ti_sci_handle *handle,
687 u32 id)
688{
689 return ti_sci_set_device_state(handle, id, MSG_FLAG_DEVICE_EXCLUSIVE,
690 MSG_DEVICE_SW_STATE_RETENTION);
691}
692
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530693/**
694 * ti_sci_cmd_put_device() - command to release a device managed by TISCI
695 * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle
696 * @id: Device Identifier
697 *
698 * Request for the device - NOTE: the client MUST maintain integrity of
699 * usage count by balancing get_device with put_device. No refcounting is
700 * managed by driver for that purpose.
701 *
702 * Return: 0 if all went fine, else return appropriate error.
703 */
704static int ti_sci_cmd_put_device(const struct ti_sci_handle *handle, u32 id)
705{
Lokesh Vutlaf5613002019-06-07 19:24:39 +0530706 return ti_sci_set_device_state(handle, id, 0,
707 MSG_DEVICE_SW_STATE_AUTO_OFF);
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530708}
709
Lokesh Vutla0d0412a2019-06-07 19:24:41 +0530710static
711int ti_sci_cmd_release_exclusive_devices(const struct ti_sci_handle *handle)
712{
713 struct ti_sci_exclusive_dev *dev, *tmp;
714 struct ti_sci_info *info;
715 int i, cnt;
716
717 info = handle_to_ti_sci_info(handle);
718
719 list_for_each_entry_safe(dev, tmp, &info->dev_list, list) {
720 cnt = dev->count;
721 debug("%s: id = %d, cnt = %d\n", __func__, dev->id, cnt);
722 for (i = 0; i < cnt; i++)
723 ti_sci_cmd_put_device(handle, dev->id);
724 }
725
726 return 0;
727}
728
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +0530729/**
730 * ti_sci_cmd_dev_is_valid() - Is the device valid
731 * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle
732 * @id: Device Identifier
733 *
734 * Return: 0 if all went fine and the device ID is valid, else return
735 * appropriate error.
736 */
737static int ti_sci_cmd_dev_is_valid(const struct ti_sci_handle *handle, u32 id)
738{
739 u8 unused;
740
741 /* check the device state which will also tell us if the ID is valid */
742 return ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &unused);
743}
744
745/**
746 * ti_sci_cmd_dev_get_clcnt() - Get context loss counter
747 * @handle: Pointer to TISCI handle
748 * @id: Device Identifier
749 * @count: Pointer to Context Loss counter to populate
750 *
751 * Return: 0 if all went fine, else return appropriate error.
752 */
753static int ti_sci_cmd_dev_get_clcnt(const struct ti_sci_handle *handle, u32 id,
754 u32 *count)
755{
756 return ti_sci_get_device_state(handle, id, count, NULL, NULL, NULL);
757}
758
759/**
760 * ti_sci_cmd_dev_is_idle() - Check if the device is requested to be idle
761 * @handle: Pointer to TISCI handle
762 * @id: Device Identifier
763 * @r_state: true if requested to be idle
764 *
765 * Return: 0 if all went fine, else return appropriate error.
766 */
767static int ti_sci_cmd_dev_is_idle(const struct ti_sci_handle *handle, u32 id,
768 bool *r_state)
769{
770 int ret;
771 u8 state;
772
773 if (!r_state)
774 return -EINVAL;
775
776 ret = ti_sci_get_device_state(handle, id, NULL, NULL, &state, NULL);
777 if (ret)
778 return ret;
779
780 *r_state = (state == MSG_DEVICE_SW_STATE_RETENTION);
781
782 return 0;
783}
784
785/**
786 * ti_sci_cmd_dev_is_stop() - Check if the device is requested to be stopped
787 * @handle: Pointer to TISCI handle
788 * @id: Device Identifier
789 * @r_state: true if requested to be stopped
790 * @curr_state: true if currently stopped.
791 *
792 * Return: 0 if all went fine, else return appropriate error.
793 */
794static int ti_sci_cmd_dev_is_stop(const struct ti_sci_handle *handle, u32 id,
795 bool *r_state, bool *curr_state)
796{
797 int ret;
798 u8 p_state, c_state;
799
800 if (!r_state && !curr_state)
801 return -EINVAL;
802
803 ret =
804 ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state);
805 if (ret)
806 return ret;
807
808 if (r_state)
809 *r_state = (p_state == MSG_DEVICE_SW_STATE_AUTO_OFF);
810 if (curr_state)
811 *curr_state = (c_state == MSG_DEVICE_HW_STATE_OFF);
812
813 return 0;
814}
815
816/**
817 * ti_sci_cmd_dev_is_on() - Check if the device is requested to be ON
818 * @handle: Pointer to TISCI handle
819 * @id: Device Identifier
820 * @r_state: true if requested to be ON
821 * @curr_state: true if currently ON and active
822 *
823 * Return: 0 if all went fine, else return appropriate error.
824 */
825static int ti_sci_cmd_dev_is_on(const struct ti_sci_handle *handle, u32 id,
826 bool *r_state, bool *curr_state)
827{
828 int ret;
829 u8 p_state, c_state;
830
831 if (!r_state && !curr_state)
832 return -EINVAL;
833
834 ret =
835 ti_sci_get_device_state(handle, id, NULL, NULL, &p_state, &c_state);
836 if (ret)
837 return ret;
838
839 if (r_state)
840 *r_state = (p_state == MSG_DEVICE_SW_STATE_ON);
841 if (curr_state)
842 *curr_state = (c_state == MSG_DEVICE_HW_STATE_ON);
843
844 return 0;
845}
846
847/**
848 * ti_sci_cmd_dev_is_trans() - Check if the device is currently transitioning
849 * @handle: Pointer to TISCI handle
850 * @id: Device Identifier
851 * @curr_state: true if currently transitioning.
852 *
853 * Return: 0 if all went fine, else return appropriate error.
854 */
855static int ti_sci_cmd_dev_is_trans(const struct ti_sci_handle *handle, u32 id,
856 bool *curr_state)
857{
858 int ret;
859 u8 state;
860
861 if (!curr_state)
862 return -EINVAL;
863
864 ret = ti_sci_get_device_state(handle, id, NULL, NULL, NULL, &state);
865 if (ret)
866 return ret;
867
868 *curr_state = (state == MSG_DEVICE_HW_STATE_TRANS);
869
870 return 0;
871}
872
873/**
874 * ti_sci_cmd_set_device_resets() - command to set resets for device managed
875 * by TISCI
876 * @handle: Pointer to TISCI handle as retrieved by *ti_sci_get_handle
877 * @id: Device Identifier
878 * @reset_state: Device specific reset bit field
879 *
880 * Return: 0 if all went fine, else return appropriate error.
881 */
882static int ti_sci_cmd_set_device_resets(const struct ti_sci_handle *handle,
883 u32 id, u32 reset_state)
884{
885 struct ti_sci_msg_req_set_device_resets req;
886 struct ti_sci_msg_hdr *resp;
887 struct ti_sci_info *info;
888 struct ti_sci_xfer *xfer;
889 int ret = 0;
890
891 if (IS_ERR(handle))
892 return PTR_ERR(handle);
893 if (!handle)
894 return -EINVAL;
895
896 info = handle_to_ti_sci_info(handle);
897
898 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_SET_DEVICE_RESETS,
899 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
900 (u32 *)&req, sizeof(req), sizeof(*resp));
901 if (IS_ERR(xfer)) {
902 ret = PTR_ERR(xfer);
903 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
904 return ret;
905 }
906 req.id = id;
907 req.resets = reset_state;
908
909 ret = ti_sci_do_xfer(info, xfer);
910 if (ret) {
911 dev_err(info->dev, "Mbox send fail %d\n", ret);
912 return ret;
913 }
914
915 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
916
917 if (!ti_sci_is_response_ack(resp))
918 return -ENODEV;
919
920 return ret;
921}
922
923/**
924 * ti_sci_cmd_get_device_resets() - Get reset state for device managed
925 * by TISCI
926 * @handle: Pointer to TISCI handle
927 * @id: Device Identifier
928 * @reset_state: Pointer to reset state to populate
929 *
930 * Return: 0 if all went fine, else return appropriate error.
931 */
932static int ti_sci_cmd_get_device_resets(const struct ti_sci_handle *handle,
933 u32 id, u32 *reset_state)
934{
935 return ti_sci_get_device_state(handle, id, NULL, reset_state, NULL,
936 NULL);
937}
938
Lokesh Vutlad10c80c2018-08-27 15:57:35 +0530939/**
940 * ti_sci_set_clock_state() - Set clock state helper
941 * @handle: pointer to TI SCI handle
942 * @dev_id: Device identifier this request is for
943 * @clk_id: Clock identifier for the device for this request.
944 * Each device has it's own set of clock inputs. This indexes
945 * which clock input to modify.
946 * @flags: Header flags as needed
947 * @state: State to request for the clock.
948 *
949 * Return: 0 if all went well, else returns appropriate error value.
950 */
951static int ti_sci_set_clock_state(const struct ti_sci_handle *handle,
952 u32 dev_id, u8 clk_id,
953 u32 flags, u8 state)
954{
955 struct ti_sci_msg_req_set_clock_state req;
956 struct ti_sci_msg_hdr *resp;
957 struct ti_sci_info *info;
958 struct ti_sci_xfer *xfer;
959 int ret = 0;
960
961 if (IS_ERR(handle))
962 return PTR_ERR(handle);
963 if (!handle)
964 return -EINVAL;
965
966 info = handle_to_ti_sci_info(handle);
967
968 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_SET_CLOCK_STATE,
969 flags | TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
970 (u32 *)&req, sizeof(req), sizeof(*resp));
971 if (IS_ERR(xfer)) {
972 ret = PTR_ERR(xfer);
973 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
974 return ret;
975 }
976 req.dev_id = dev_id;
977 req.clk_id = clk_id;
978 req.request_state = state;
979
980 ret = ti_sci_do_xfer(info, xfer);
981 if (ret) {
982 dev_err(info->dev, "Mbox send fail %d\n", ret);
983 return ret;
984 }
985
986 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
987
988 if (!ti_sci_is_response_ack(resp))
989 return -ENODEV;
990
991 return ret;
992}
993
994/**
995 * ti_sci_cmd_get_clock_state() - Get clock state helper
996 * @handle: pointer to TI SCI handle
997 * @dev_id: Device identifier this request is for
998 * @clk_id: Clock identifier for the device for this request.
999 * Each device has it's own set of clock inputs. This indexes
1000 * which clock input to modify.
1001 * @programmed_state: State requested for clock to move to
1002 * @current_state: State that the clock is currently in
1003 *
1004 * Return: 0 if all went well, else returns appropriate error value.
1005 */
1006static int ti_sci_cmd_get_clock_state(const struct ti_sci_handle *handle,
1007 u32 dev_id, u8 clk_id,
1008 u8 *programmed_state, u8 *current_state)
1009{
1010 struct ti_sci_msg_resp_get_clock_state *resp;
1011 struct ti_sci_msg_req_get_clock_state req;
1012 struct ti_sci_info *info;
1013 struct ti_sci_xfer *xfer;
1014 int ret = 0;
1015
1016 if (IS_ERR(handle))
1017 return PTR_ERR(handle);
1018 if (!handle)
1019 return -EINVAL;
1020
1021 if (!programmed_state && !current_state)
1022 return -EINVAL;
1023
1024 info = handle_to_ti_sci_info(handle);
1025
1026 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_GET_CLOCK_STATE,
1027 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1028 (u32 *)&req, sizeof(req), sizeof(*resp));
1029 if (IS_ERR(xfer)) {
1030 ret = PTR_ERR(xfer);
1031 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1032 return ret;
1033 }
1034 req.dev_id = dev_id;
1035 req.clk_id = clk_id;
1036
1037 ret = ti_sci_do_xfer(info, xfer);
1038 if (ret) {
1039 dev_err(info->dev, "Mbox send fail %d\n", ret);
1040 return ret;
1041 }
1042
1043 resp = (struct ti_sci_msg_resp_get_clock_state *)xfer->tx_message.buf;
1044
1045 if (!ti_sci_is_response_ack(resp))
1046 return -ENODEV;
1047
1048 if (programmed_state)
1049 *programmed_state = resp->programmed_state;
1050 if (current_state)
1051 *current_state = resp->current_state;
1052
1053 return ret;
1054}
1055
1056/**
1057 * ti_sci_cmd_get_clock() - Get control of a clock from TI SCI
1058 * @handle: pointer to TI SCI handle
1059 * @dev_id: Device identifier this request is for
1060 * @clk_id: Clock identifier for the device for this request.
1061 * Each device has it's own set of clock inputs. This indexes
1062 * which clock input to modify.
1063 * @needs_ssc: 'true' if Spread Spectrum clock is desired, else 'false'
1064 * @can_change_freq: 'true' if frequency change is desired, else 'false'
1065 * @enable_input_term: 'true' if input termination is desired, else 'false'
1066 *
1067 * Return: 0 if all went well, else returns appropriate error value.
1068 */
1069static int ti_sci_cmd_get_clock(const struct ti_sci_handle *handle, u32 dev_id,
1070 u8 clk_id, bool needs_ssc, bool can_change_freq,
1071 bool enable_input_term)
1072{
1073 u32 flags = 0;
1074
1075 flags |= needs_ssc ? MSG_FLAG_CLOCK_ALLOW_SSC : 0;
1076 flags |= can_change_freq ? MSG_FLAG_CLOCK_ALLOW_FREQ_CHANGE : 0;
1077 flags |= enable_input_term ? MSG_FLAG_CLOCK_INPUT_TERM : 0;
1078
1079 return ti_sci_set_clock_state(handle, dev_id, clk_id, flags,
1080 MSG_CLOCK_SW_STATE_REQ);
1081}
1082
1083/**
1084 * ti_sci_cmd_idle_clock() - Idle a clock which is in our control
1085 * @handle: pointer to TI SCI handle
1086 * @dev_id: Device identifier this request is for
1087 * @clk_id: Clock identifier for the device for this request.
1088 * Each device has it's own set of clock inputs. This indexes
1089 * which clock input to modify.
1090 *
1091 * NOTE: This clock must have been requested by get_clock previously.
1092 *
1093 * Return: 0 if all went well, else returns appropriate error value.
1094 */
1095static int ti_sci_cmd_idle_clock(const struct ti_sci_handle *handle,
1096 u32 dev_id, u8 clk_id)
1097{
1098 return ti_sci_set_clock_state(handle, dev_id, clk_id, 0,
1099 MSG_CLOCK_SW_STATE_UNREQ);
1100}
1101
1102/**
1103 * ti_sci_cmd_put_clock() - Release a clock from our control back to TISCI
1104 * @handle: pointer to TI SCI handle
1105 * @dev_id: Device identifier this request is for
1106 * @clk_id: Clock identifier for the device for this request.
1107 * Each device has it's own set of clock inputs. This indexes
1108 * which clock input to modify.
1109 *
1110 * NOTE: This clock must have been requested by get_clock previously.
1111 *
1112 * Return: 0 if all went well, else returns appropriate error value.
1113 */
1114static int ti_sci_cmd_put_clock(const struct ti_sci_handle *handle,
1115 u32 dev_id, u8 clk_id)
1116{
1117 return ti_sci_set_clock_state(handle, dev_id, clk_id, 0,
1118 MSG_CLOCK_SW_STATE_AUTO);
1119}
1120
1121/**
1122 * ti_sci_cmd_clk_is_auto() - Is the clock being auto managed
1123 * @handle: pointer to TI SCI handle
1124 * @dev_id: Device identifier this request is for
1125 * @clk_id: Clock identifier for the device for this request.
1126 * Each device has it's own set of clock inputs. This indexes
1127 * which clock input to modify.
1128 * @req_state: state indicating if the clock is auto managed
1129 *
1130 * Return: 0 if all went well, else returns appropriate error value.
1131 */
1132static int ti_sci_cmd_clk_is_auto(const struct ti_sci_handle *handle,
1133 u32 dev_id, u8 clk_id, bool *req_state)
1134{
1135 u8 state = 0;
1136 int ret;
1137
1138 if (!req_state)
1139 return -EINVAL;
1140
1141 ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id, &state, NULL);
1142 if (ret)
1143 return ret;
1144
1145 *req_state = (state == MSG_CLOCK_SW_STATE_AUTO);
1146 return 0;
1147}
1148
1149/**
1150 * ti_sci_cmd_clk_is_on() - Is the clock ON
1151 * @handle: pointer to TI SCI handle
1152 * @dev_id: Device identifier this request is for
1153 * @clk_id: Clock identifier for the device for this request.
1154 * Each device has it's own set of clock inputs. This indexes
1155 * which clock input to modify.
1156 * @req_state: state indicating if the clock is managed by us and enabled
1157 * @curr_state: state indicating if the clock is ready for operation
1158 *
1159 * Return: 0 if all went well, else returns appropriate error value.
1160 */
1161static int ti_sci_cmd_clk_is_on(const struct ti_sci_handle *handle, u32 dev_id,
1162 u8 clk_id, bool *req_state, bool *curr_state)
1163{
1164 u8 c_state = 0, r_state = 0;
1165 int ret;
1166
1167 if (!req_state && !curr_state)
1168 return -EINVAL;
1169
1170 ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id,
1171 &r_state, &c_state);
1172 if (ret)
1173 return ret;
1174
1175 if (req_state)
1176 *req_state = (r_state == MSG_CLOCK_SW_STATE_REQ);
1177 if (curr_state)
1178 *curr_state = (c_state == MSG_CLOCK_HW_STATE_READY);
1179 return 0;
1180}
1181
1182/**
1183 * ti_sci_cmd_clk_is_off() - Is the clock OFF
1184 * @handle: pointer to TI SCI handle
1185 * @dev_id: Device identifier this request is for
1186 * @clk_id: Clock identifier for the device for this request.
1187 * Each device has it's own set of clock inputs. This indexes
1188 * which clock input to modify.
1189 * @req_state: state indicating if the clock is managed by us and disabled
1190 * @curr_state: state indicating if the clock is NOT ready for operation
1191 *
1192 * Return: 0 if all went well, else returns appropriate error value.
1193 */
1194static int ti_sci_cmd_clk_is_off(const struct ti_sci_handle *handle, u32 dev_id,
1195 u8 clk_id, bool *req_state, bool *curr_state)
1196{
1197 u8 c_state = 0, r_state = 0;
1198 int ret;
1199
1200 if (!req_state && !curr_state)
1201 return -EINVAL;
1202
1203 ret = ti_sci_cmd_get_clock_state(handle, dev_id, clk_id,
1204 &r_state, &c_state);
1205 if (ret)
1206 return ret;
1207
1208 if (req_state)
1209 *req_state = (r_state == MSG_CLOCK_SW_STATE_UNREQ);
1210 if (curr_state)
1211 *curr_state = (c_state == MSG_CLOCK_HW_STATE_NOT_READY);
1212 return 0;
1213}
1214
1215/**
1216 * ti_sci_cmd_clk_set_parent() - Set the clock source of a specific device clock
1217 * @handle: pointer to TI SCI handle
1218 * @dev_id: Device identifier this request is for
1219 * @clk_id: Clock identifier for the device for this request.
1220 * Each device has it's own set of clock inputs. This indexes
1221 * which clock input to modify.
1222 * @parent_id: Parent clock identifier to set
1223 *
1224 * Return: 0 if all went well, else returns appropriate error value.
1225 */
1226static int ti_sci_cmd_clk_set_parent(const struct ti_sci_handle *handle,
1227 u32 dev_id, u8 clk_id, u8 parent_id)
1228{
1229 struct ti_sci_msg_req_set_clock_parent req;
1230 struct ti_sci_msg_hdr *resp;
1231 struct ti_sci_info *info;
1232 struct ti_sci_xfer *xfer;
1233 int ret = 0;
1234
1235 if (IS_ERR(handle))
1236 return PTR_ERR(handle);
1237 if (!handle)
1238 return -EINVAL;
1239
1240 info = handle_to_ti_sci_info(handle);
1241
1242 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_SET_CLOCK_PARENT,
1243 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1244 (u32 *)&req, sizeof(req), sizeof(*resp));
1245 if (IS_ERR(xfer)) {
1246 ret = PTR_ERR(xfer);
1247 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1248 return ret;
1249 }
1250 req.dev_id = dev_id;
1251 req.clk_id = clk_id;
1252 req.parent_id = parent_id;
1253
1254 ret = ti_sci_do_xfer(info, xfer);
1255 if (ret) {
1256 dev_err(info->dev, "Mbox send fail %d\n", ret);
1257 return ret;
1258 }
1259
1260 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
1261
1262 if (!ti_sci_is_response_ack(resp))
1263 return -ENODEV;
1264
1265 return ret;
1266}
1267
1268/**
1269 * ti_sci_cmd_clk_get_parent() - Get current parent clock source
1270 * @handle: pointer to TI SCI handle
1271 * @dev_id: Device identifier this request is for
1272 * @clk_id: Clock identifier for the device for this request.
1273 * Each device has it's own set of clock inputs. This indexes
1274 * which clock input to modify.
1275 * @parent_id: Current clock parent
1276 *
1277 * Return: 0 if all went well, else returns appropriate error value.
1278 */
1279static int ti_sci_cmd_clk_get_parent(const struct ti_sci_handle *handle,
1280 u32 dev_id, u8 clk_id, u8 *parent_id)
1281{
1282 struct ti_sci_msg_resp_get_clock_parent *resp;
1283 struct ti_sci_msg_req_get_clock_parent req;
1284 struct ti_sci_info *info;
1285 struct ti_sci_xfer *xfer;
1286 int ret = 0;
1287
1288 if (IS_ERR(handle))
1289 return PTR_ERR(handle);
1290 if (!handle || !parent_id)
1291 return -EINVAL;
1292
1293 info = handle_to_ti_sci_info(handle);
1294
1295 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_GET_CLOCK_PARENT,
1296 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1297 (u32 *)&req, sizeof(req), sizeof(*resp));
1298 if (IS_ERR(xfer)) {
1299 ret = PTR_ERR(xfer);
1300 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1301 return ret;
1302 }
1303 req.dev_id = dev_id;
1304 req.clk_id = clk_id;
1305
1306 ret = ti_sci_do_xfer(info, xfer);
1307 if (ret) {
1308 dev_err(info->dev, "Mbox send fail %d\n", ret);
1309 return ret;
1310 }
1311
1312 resp = (struct ti_sci_msg_resp_get_clock_parent *)xfer->tx_message.buf;
1313
1314 if (!ti_sci_is_response_ack(resp))
1315 ret = -ENODEV;
1316 else
1317 *parent_id = resp->parent_id;
1318
1319 return ret;
1320}
1321
1322/**
1323 * ti_sci_cmd_clk_get_num_parents() - Get num parents of the current clk source
1324 * @handle: pointer to TI SCI handle
1325 * @dev_id: Device identifier this request is for
1326 * @clk_id: Clock identifier for the device for this request.
1327 * Each device has it's own set of clock inputs. This indexes
1328 * which clock input to modify.
1329 * @num_parents: Returns he number of parents to the current clock.
1330 *
1331 * Return: 0 if all went well, else returns appropriate error value.
1332 */
1333static int ti_sci_cmd_clk_get_num_parents(const struct ti_sci_handle *handle,
1334 u32 dev_id, u8 clk_id,
1335 u8 *num_parents)
1336{
1337 struct ti_sci_msg_resp_get_clock_num_parents *resp;
1338 struct ti_sci_msg_req_get_clock_num_parents req;
1339 struct ti_sci_info *info;
1340 struct ti_sci_xfer *xfer;
1341 int ret = 0;
1342
1343 if (IS_ERR(handle))
1344 return PTR_ERR(handle);
1345 if (!handle || !num_parents)
1346 return -EINVAL;
1347
1348 info = handle_to_ti_sci_info(handle);
1349
1350 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_GET_NUM_CLOCK_PARENTS,
1351 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1352 (u32 *)&req, sizeof(req), sizeof(*resp));
1353 if (IS_ERR(xfer)) {
1354 ret = PTR_ERR(xfer);
1355 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1356 return ret;
1357 }
1358 req.dev_id = dev_id;
1359 req.clk_id = clk_id;
1360
1361 ret = ti_sci_do_xfer(info, xfer);
1362 if (ret) {
1363 dev_err(info->dev, "Mbox send fail %d\n", ret);
1364 return ret;
1365 }
1366
1367 resp = (struct ti_sci_msg_resp_get_clock_num_parents *)
1368 xfer->tx_message.buf;
1369
1370 if (!ti_sci_is_response_ack(resp))
1371 ret = -ENODEV;
1372 else
1373 *num_parents = resp->num_parents;
1374
1375 return ret;
1376}
1377
1378/**
1379 * ti_sci_cmd_clk_get_match_freq() - Find a good match for frequency
1380 * @handle: pointer to TI SCI handle
1381 * @dev_id: Device identifier this request is for
1382 * @clk_id: Clock identifier for the device for this request.
1383 * Each device has it's own set of clock inputs. This indexes
1384 * which clock input to modify.
1385 * @min_freq: The minimum allowable frequency in Hz. This is the minimum
1386 * allowable programmed frequency and does not account for clock
1387 * tolerances and jitter.
1388 * @target_freq: The target clock frequency in Hz. A frequency will be
1389 * processed as close to this target frequency as possible.
1390 * @max_freq: The maximum allowable frequency in Hz. This is the maximum
1391 * allowable programmed frequency and does not account for clock
1392 * tolerances and jitter.
1393 * @match_freq: Frequency match in Hz response.
1394 *
1395 * Return: 0 if all went well, else returns appropriate error value.
1396 */
1397static int ti_sci_cmd_clk_get_match_freq(const struct ti_sci_handle *handle,
1398 u32 dev_id, u8 clk_id, u64 min_freq,
1399 u64 target_freq, u64 max_freq,
1400 u64 *match_freq)
1401{
1402 struct ti_sci_msg_resp_query_clock_freq *resp;
1403 struct ti_sci_msg_req_query_clock_freq req;
1404 struct ti_sci_info *info;
1405 struct ti_sci_xfer *xfer;
1406 int ret = 0;
1407
1408 if (IS_ERR(handle))
1409 return PTR_ERR(handle);
1410 if (!handle || !match_freq)
1411 return -EINVAL;
1412
1413 info = handle_to_ti_sci_info(handle);
1414
1415 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_QUERY_CLOCK_FREQ,
1416 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1417 (u32 *)&req, sizeof(req), sizeof(*resp));
1418 if (IS_ERR(xfer)) {
1419 ret = PTR_ERR(xfer);
1420 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1421 return ret;
1422 }
1423 req.dev_id = dev_id;
1424 req.clk_id = clk_id;
1425 req.min_freq_hz = min_freq;
1426 req.target_freq_hz = target_freq;
1427 req.max_freq_hz = max_freq;
1428
1429 ret = ti_sci_do_xfer(info, xfer);
1430 if (ret) {
1431 dev_err(info->dev, "Mbox send fail %d\n", ret);
1432 return ret;
1433 }
1434
1435 resp = (struct ti_sci_msg_resp_query_clock_freq *)xfer->tx_message.buf;
1436
1437 if (!ti_sci_is_response_ack(resp))
1438 ret = -ENODEV;
1439 else
1440 *match_freq = resp->freq_hz;
1441
1442 return ret;
1443}
1444
1445/**
1446 * ti_sci_cmd_clk_set_freq() - Set a frequency for clock
1447 * @handle: pointer to TI SCI handle
1448 * @dev_id: Device identifier this request is for
1449 * @clk_id: Clock identifier for the device for this request.
1450 * Each device has it's own set of clock inputs. This indexes
1451 * which clock input to modify.
1452 * @min_freq: The minimum allowable frequency in Hz. This is the minimum
1453 * allowable programmed frequency and does not account for clock
1454 * tolerances and jitter.
1455 * @target_freq: The target clock frequency in Hz. A frequency will be
1456 * processed as close to this target frequency as possible.
1457 * @max_freq: The maximum allowable frequency in Hz. This is the maximum
1458 * allowable programmed frequency and does not account for clock
1459 * tolerances and jitter.
1460 *
1461 * Return: 0 if all went well, else returns appropriate error value.
1462 */
1463static int ti_sci_cmd_clk_set_freq(const struct ti_sci_handle *handle,
1464 u32 dev_id, u8 clk_id, u64 min_freq,
1465 u64 target_freq, u64 max_freq)
1466{
1467 struct ti_sci_msg_req_set_clock_freq req;
1468 struct ti_sci_msg_hdr *resp;
1469 struct ti_sci_info *info;
1470 struct ti_sci_xfer *xfer;
1471 int ret = 0;
1472
1473 if (IS_ERR(handle))
1474 return PTR_ERR(handle);
1475 if (!handle)
1476 return -EINVAL;
1477
1478 info = handle_to_ti_sci_info(handle);
1479
1480 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_SET_CLOCK_FREQ,
1481 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1482 (u32 *)&req, sizeof(req), sizeof(*resp));
1483 if (IS_ERR(xfer)) {
1484 ret = PTR_ERR(xfer);
1485 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1486 return ret;
1487 }
1488 req.dev_id = dev_id;
1489 req.clk_id = clk_id;
1490 req.min_freq_hz = min_freq;
1491 req.target_freq_hz = target_freq;
1492 req.max_freq_hz = max_freq;
1493
1494 ret = ti_sci_do_xfer(info, xfer);
1495 if (ret) {
1496 dev_err(info->dev, "Mbox send fail %d\n", ret);
1497 return ret;
1498 }
1499
1500 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
1501
1502 if (!ti_sci_is_response_ack(resp))
1503 return -ENODEV;
1504
1505 return ret;
1506}
1507
1508/**
1509 * ti_sci_cmd_clk_get_freq() - Get current frequency
1510 * @handle: pointer to TI SCI handle
1511 * @dev_id: Device identifier this request is for
1512 * @clk_id: Clock identifier for the device for this request.
1513 * Each device has it's own set of clock inputs. This indexes
1514 * which clock input to modify.
1515 * @freq: Currently frequency in Hz
1516 *
1517 * Return: 0 if all went well, else returns appropriate error value.
1518 */
1519static int ti_sci_cmd_clk_get_freq(const struct ti_sci_handle *handle,
1520 u32 dev_id, u8 clk_id, u64 *freq)
1521{
1522 struct ti_sci_msg_resp_get_clock_freq *resp;
1523 struct ti_sci_msg_req_get_clock_freq req;
1524 struct ti_sci_info *info;
1525 struct ti_sci_xfer *xfer;
1526 int ret = 0;
1527
1528 if (IS_ERR(handle))
1529 return PTR_ERR(handle);
1530 if (!handle || !freq)
1531 return -EINVAL;
1532
1533 info = handle_to_ti_sci_info(handle);
1534
1535 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_GET_CLOCK_FREQ,
1536 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1537 (u32 *)&req, sizeof(req), sizeof(*resp));
1538 if (IS_ERR(xfer)) {
1539 ret = PTR_ERR(xfer);
1540 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1541 return ret;
1542 }
1543 req.dev_id = dev_id;
1544 req.clk_id = clk_id;
1545
1546 ret = ti_sci_do_xfer(info, xfer);
1547 if (ret) {
1548 dev_err(info->dev, "Mbox send fail %d\n", ret);
1549 return ret;
1550 }
1551
1552 resp = (struct ti_sci_msg_resp_get_clock_freq *)xfer->tx_message.buf;
1553
1554 if (!ti_sci_is_response_ack(resp))
1555 ret = -ENODEV;
1556 else
1557 *freq = resp->freq_hz;
1558
1559 return ret;
1560}
1561
Andreas Dannenberg5bd08372018-08-27 15:57:36 +05301562/**
1563 * ti_sci_cmd_core_reboot() - Command to request system reset
1564 * @handle: pointer to TI SCI handle
1565 *
1566 * Return: 0 if all went well, else returns appropriate error value.
1567 */
1568static int ti_sci_cmd_core_reboot(const struct ti_sci_handle *handle)
1569{
1570 struct ti_sci_msg_req_reboot req;
1571 struct ti_sci_msg_hdr *resp;
1572 struct ti_sci_info *info;
1573 struct ti_sci_xfer *xfer;
1574 int ret = 0;
1575
1576 if (IS_ERR(handle))
1577 return PTR_ERR(handle);
1578 if (!handle)
1579 return -EINVAL;
1580
1581 info = handle_to_ti_sci_info(handle);
1582
1583 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_SYS_RESET,
1584 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1585 (u32 *)&req, sizeof(req), sizeof(*resp));
1586 if (IS_ERR(xfer)) {
1587 ret = PTR_ERR(xfer);
1588 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1589 return ret;
1590 }
Dave Gerlach366df4e2021-05-13 20:10:55 -05001591 req.domain = 0;
Andreas Dannenberg5bd08372018-08-27 15:57:36 +05301592
1593 ret = ti_sci_do_xfer(info, xfer);
1594 if (ret) {
Sean Anderson405dc242020-09-15 10:44:38 -04001595 dev_err(info->dev, "Mbox send fail %d\n", ret);
Andreas Dannenberg5bd08372018-08-27 15:57:36 +05301596 return ret;
1597 }
1598
1599 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
1600
1601 if (!ti_sci_is_response_ack(resp))
1602 return -ENODEV;
1603
1604 return ret;
1605}
1606
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05301607/**
1608 * ti_sci_get_resource_range - Helper to get a range of resources assigned
1609 * to a host. Resource is uniquely identified by
1610 * type and subtype.
1611 * @handle: Pointer to TISCI handle.
1612 * @dev_id: TISCI device ID.
1613 * @subtype: Resource assignment subtype that is being requested
1614 * from the given device.
1615 * @s_host: Host processor ID to which the resources are allocated
1616 * @range_start: Start index of the resource range
1617 * @range_num: Number of resources in the range
1618 *
1619 * Return: 0 if all went fine, else return appropriate error.
1620 */
1621static int ti_sci_get_resource_range(const struct ti_sci_handle *handle,
1622 u32 dev_id, u8 subtype, u8 s_host,
1623 u16 *range_start, u16 *range_num)
1624{
1625 struct ti_sci_msg_resp_get_resource_range *resp;
1626 struct ti_sci_msg_req_get_resource_range req;
1627 struct ti_sci_xfer *xfer;
1628 struct ti_sci_info *info;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05301629 int ret = 0;
1630
1631 if (IS_ERR(handle))
1632 return PTR_ERR(handle);
1633 if (!handle)
1634 return -EINVAL;
1635
1636 info = handle_to_ti_sci_info(handle);
1637
1638 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_GET_RESOURCE_RANGE,
1639 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1640 (u32 *)&req, sizeof(req), sizeof(*resp));
1641 if (IS_ERR(xfer)) {
1642 ret = PTR_ERR(xfer);
Sean Anderson405dc242020-09-15 10:44:38 -04001643 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05301644 return ret;
1645 }
1646
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05301647 req.secondary_host = s_host;
Lokesh Vutla0acf1dc2020-08-17 11:00:48 +05301648 req.type = dev_id & MSG_RM_RESOURCE_TYPE_MASK;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05301649 req.subtype = subtype & MSG_RM_RESOURCE_SUBTYPE_MASK;
1650
1651 ret = ti_sci_do_xfer(info, xfer);
1652 if (ret) {
Sean Anderson405dc242020-09-15 10:44:38 -04001653 dev_err(info->dev, "Mbox send fail %d\n", ret);
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05301654 goto fail;
1655 }
1656
1657 resp = (struct ti_sci_msg_resp_get_resource_range *)xfer->tx_message.buf;
1658 if (!ti_sci_is_response_ack(resp)) {
1659 ret = -ENODEV;
1660 } else if (!resp->range_start && !resp->range_num) {
1661 ret = -ENODEV;
1662 } else {
1663 *range_start = resp->range_start;
1664 *range_num = resp->range_num;
1665 };
1666
1667fail:
1668 return ret;
1669}
1670
1671/**
1672 * ti_sci_cmd_get_resource_range - Get a range of resources assigned to host
1673 * that is same as ti sci interface host.
1674 * @handle: Pointer to TISCI handle.
1675 * @dev_id: TISCI device ID.
1676 * @subtype: Resource assignment subtype that is being requested
1677 * from the given device.
1678 * @range_start: Start index of the resource range
1679 * @range_num: Number of resources in the range
1680 *
1681 * Return: 0 if all went fine, else return appropriate error.
1682 */
1683static int ti_sci_cmd_get_resource_range(const struct ti_sci_handle *handle,
1684 u32 dev_id, u8 subtype,
1685 u16 *range_start, u16 *range_num)
1686{
1687 return ti_sci_get_resource_range(handle, dev_id, subtype,
1688 TI_SCI_IRQ_SECONDARY_HOST_INVALID,
1689 range_start, range_num);
1690}
1691
1692/**
1693 * ti_sci_cmd_get_resource_range_from_shost - Get a range of resources
1694 * assigned to a specified host.
1695 * @handle: Pointer to TISCI handle.
1696 * @dev_id: TISCI device ID.
1697 * @subtype: Resource assignment subtype that is being requested
1698 * from the given device.
1699 * @s_host: Host processor ID to which the resources are allocated
1700 * @range_start: Start index of the resource range
1701 * @range_num: Number of resources in the range
1702 *
1703 * Return: 0 if all went fine, else return appropriate error.
1704 */
1705static
1706int ti_sci_cmd_get_resource_range_from_shost(const struct ti_sci_handle *handle,
1707 u32 dev_id, u8 subtype, u8 s_host,
1708 u16 *range_start, u16 *range_num)
1709{
1710 return ti_sci_get_resource_range(handle, dev_id, subtype, s_host,
1711 range_start, range_num);
1712}
1713
Lokesh Vutlab8856af2018-08-27 15:57:37 +05301714/**
Lokesh Vutla032dce82019-03-08 11:47:32 +05301715 * ti_sci_cmd_query_msmc() - Command to query currently available msmc memory
1716 * @handle: pointer to TI SCI handle
1717 * @msms_start: MSMC start as returned by tisci
1718 * @msmc_end: MSMC end as returned by tisci
1719 *
1720 * Return: 0 if all went well, else returns appropriate error value.
1721 */
1722static int ti_sci_cmd_query_msmc(const struct ti_sci_handle *handle,
1723 u64 *msmc_start, u64 *msmc_end)
1724{
1725 struct ti_sci_msg_resp_query_msmc *resp;
1726 struct ti_sci_msg_hdr req;
1727 struct ti_sci_info *info;
1728 struct ti_sci_xfer *xfer;
1729 int ret = 0;
1730
1731 if (IS_ERR(handle))
1732 return PTR_ERR(handle);
1733 if (!handle)
1734 return -EINVAL;
1735
1736 info = handle_to_ti_sci_info(handle);
1737
1738 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_QUERY_MSMC,
1739 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1740 (u32 *)&req, sizeof(req), sizeof(*resp));
1741 if (IS_ERR(xfer)) {
1742 ret = PTR_ERR(xfer);
1743 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1744 return ret;
1745 }
1746
1747 ret = ti_sci_do_xfer(info, xfer);
1748 if (ret) {
Sean Anderson405dc242020-09-15 10:44:38 -04001749 dev_err(info->dev, "Mbox send fail %d\n", ret);
Lokesh Vutla032dce82019-03-08 11:47:32 +05301750 return ret;
1751 }
1752
1753 resp = (struct ti_sci_msg_resp_query_msmc *)xfer->tx_message.buf;
1754
1755 if (!ti_sci_is_response_ack(resp))
1756 return -ENODEV;
1757
1758 *msmc_start = ((u64)resp->msmc_start_high << TISCI_ADDR_HIGH_SHIFT) |
1759 resp->msmc_start_low;
1760 *msmc_end = ((u64)resp->msmc_end_high << TISCI_ADDR_HIGH_SHIFT) |
1761 resp->msmc_end_low;
1762
1763 return ret;
1764}
1765
1766/**
Lokesh Vutlab8856af2018-08-27 15:57:37 +05301767 * ti_sci_cmd_proc_request() - Command to request a physical processor control
1768 * @handle: Pointer to TI SCI handle
1769 * @proc_id: Processor ID this request is for
1770 *
1771 * Return: 0 if all went well, else returns appropriate error value.
1772 */
1773static int ti_sci_cmd_proc_request(const struct ti_sci_handle *handle,
1774 u8 proc_id)
1775{
1776 struct ti_sci_msg_req_proc_request req;
1777 struct ti_sci_msg_hdr *resp;
1778 struct ti_sci_info *info;
1779 struct ti_sci_xfer *xfer;
1780 int ret = 0;
1781
1782 if (IS_ERR(handle))
1783 return PTR_ERR(handle);
1784 if (!handle)
1785 return -EINVAL;
1786
1787 info = handle_to_ti_sci_info(handle);
1788
1789 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_PROC_REQUEST,
1790 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1791 (u32 *)&req, sizeof(req), sizeof(*resp));
1792 if (IS_ERR(xfer)) {
1793 ret = PTR_ERR(xfer);
1794 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1795 return ret;
1796 }
1797 req.processor_id = proc_id;
1798
1799 ret = ti_sci_do_xfer(info, xfer);
1800 if (ret) {
1801 dev_err(info->dev, "Mbox send fail %d\n", ret);
1802 return ret;
1803 }
1804
1805 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
1806
1807 if (!ti_sci_is_response_ack(resp))
1808 ret = -ENODEV;
1809
1810 return ret;
1811}
1812
1813/**
1814 * ti_sci_cmd_proc_release() - Command to release a physical processor control
1815 * @handle: Pointer to TI SCI handle
1816 * @proc_id: Processor ID this request is for
1817 *
1818 * Return: 0 if all went well, else returns appropriate error value.
1819 */
1820static int ti_sci_cmd_proc_release(const struct ti_sci_handle *handle,
1821 u8 proc_id)
1822{
1823 struct ti_sci_msg_req_proc_release req;
1824 struct ti_sci_msg_hdr *resp;
1825 struct ti_sci_info *info;
1826 struct ti_sci_xfer *xfer;
1827 int ret = 0;
1828
1829 if (IS_ERR(handle))
1830 return PTR_ERR(handle);
1831 if (!handle)
1832 return -EINVAL;
1833
1834 info = handle_to_ti_sci_info(handle);
1835
1836 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_PROC_RELEASE,
1837 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1838 (u32 *)&req, sizeof(req), sizeof(*resp));
1839 if (IS_ERR(xfer)) {
1840 ret = PTR_ERR(xfer);
1841 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1842 return ret;
1843 }
1844 req.processor_id = proc_id;
1845
1846 ret = ti_sci_do_xfer(info, xfer);
1847 if (ret) {
1848 dev_err(info->dev, "Mbox send fail %d\n", ret);
1849 return ret;
1850 }
1851
1852 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
1853
1854 if (!ti_sci_is_response_ack(resp))
1855 ret = -ENODEV;
1856
1857 return ret;
1858}
1859
1860/**
1861 * ti_sci_cmd_proc_handover() - Command to handover a physical processor
1862 * control to a host in the processor's access
1863 * control list.
1864 * @handle: Pointer to TI SCI handle
1865 * @proc_id: Processor ID this request is for
1866 * @host_id: Host ID to get the control of the processor
1867 *
1868 * Return: 0 if all went well, else returns appropriate error value.
1869 */
1870static int ti_sci_cmd_proc_handover(const struct ti_sci_handle *handle,
1871 u8 proc_id, u8 host_id)
1872{
1873 struct ti_sci_msg_req_proc_handover req;
1874 struct ti_sci_msg_hdr *resp;
1875 struct ti_sci_info *info;
1876 struct ti_sci_xfer *xfer;
1877 int ret = 0;
1878
1879 if (IS_ERR(handle))
1880 return PTR_ERR(handle);
1881 if (!handle)
1882 return -EINVAL;
1883
1884 info = handle_to_ti_sci_info(handle);
1885
1886 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_PROC_HANDOVER,
1887 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1888 (u32 *)&req, sizeof(req), sizeof(*resp));
1889 if (IS_ERR(xfer)) {
1890 ret = PTR_ERR(xfer);
1891 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1892 return ret;
1893 }
1894 req.processor_id = proc_id;
1895 req.host_id = host_id;
1896
1897 ret = ti_sci_do_xfer(info, xfer);
1898 if (ret) {
1899 dev_err(info->dev, "Mbox send fail %d\n", ret);
1900 return ret;
1901 }
1902
1903 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
1904
1905 if (!ti_sci_is_response_ack(resp))
1906 ret = -ENODEV;
1907
1908 return ret;
1909}
1910
1911/**
1912 * ti_sci_cmd_set_proc_boot_cfg() - Command to set the processor boot
1913 * configuration flags
1914 * @handle: Pointer to TI SCI handle
1915 * @proc_id: Processor ID this request is for
1916 * @config_flags_set: Configuration flags to be set
1917 * @config_flags_clear: Configuration flags to be cleared.
1918 *
1919 * Return: 0 if all went well, else returns appropriate error value.
1920 */
1921static int ti_sci_cmd_set_proc_boot_cfg(const struct ti_sci_handle *handle,
1922 u8 proc_id, u64 bootvector,
1923 u32 config_flags_set,
1924 u32 config_flags_clear)
1925{
1926 struct ti_sci_msg_req_set_proc_boot_config req;
1927 struct ti_sci_msg_hdr *resp;
1928 struct ti_sci_info *info;
1929 struct ti_sci_xfer *xfer;
1930 int ret = 0;
1931
1932 if (IS_ERR(handle))
1933 return PTR_ERR(handle);
1934 if (!handle)
1935 return -EINVAL;
1936
1937 info = handle_to_ti_sci_info(handle);
1938
1939 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_SET_PROC_BOOT_CONFIG,
1940 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1941 (u32 *)&req, sizeof(req), sizeof(*resp));
1942 if (IS_ERR(xfer)) {
1943 ret = PTR_ERR(xfer);
1944 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
1945 return ret;
1946 }
1947 req.processor_id = proc_id;
1948 req.bootvector_low = bootvector & TISCI_ADDR_LOW_MASK;
1949 req.bootvector_high = (bootvector & TISCI_ADDR_HIGH_MASK) >>
1950 TISCI_ADDR_HIGH_SHIFT;
1951 req.config_flags_set = config_flags_set;
1952 req.config_flags_clear = config_flags_clear;
1953
1954 ret = ti_sci_do_xfer(info, xfer);
1955 if (ret) {
1956 dev_err(info->dev, "Mbox send fail %d\n", ret);
1957 return ret;
1958 }
1959
1960 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
1961
1962 if (!ti_sci_is_response_ack(resp))
1963 ret = -ENODEV;
1964
1965 return ret;
1966}
1967
1968/**
1969 * ti_sci_cmd_set_proc_boot_ctrl() - Command to set the processor boot
1970 * control flags
1971 * @handle: Pointer to TI SCI handle
1972 * @proc_id: Processor ID this request is for
1973 * @control_flags_set: Control flags to be set
1974 * @control_flags_clear: Control flags to be cleared
1975 *
1976 * Return: 0 if all went well, else returns appropriate error value.
1977 */
1978static int ti_sci_cmd_set_proc_boot_ctrl(const struct ti_sci_handle *handle,
1979 u8 proc_id, u32 control_flags_set,
1980 u32 control_flags_clear)
1981{
1982 struct ti_sci_msg_req_set_proc_boot_ctrl req;
1983 struct ti_sci_msg_hdr *resp;
1984 struct ti_sci_info *info;
1985 struct ti_sci_xfer *xfer;
1986 int ret = 0;
1987
1988 if (IS_ERR(handle))
1989 return PTR_ERR(handle);
1990 if (!handle)
1991 return -EINVAL;
1992
1993 info = handle_to_ti_sci_info(handle);
1994
1995 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_SET_PROC_BOOT_CTRL,
1996 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
1997 (u32 *)&req, sizeof(req), sizeof(*resp));
1998 if (IS_ERR(xfer)) {
1999 ret = PTR_ERR(xfer);
2000 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
2001 return ret;
2002 }
2003 req.processor_id = proc_id;
2004 req.control_flags_set = control_flags_set;
2005 req.control_flags_clear = control_flags_clear;
2006
2007 ret = ti_sci_do_xfer(info, xfer);
2008 if (ret) {
2009 dev_err(info->dev, "Mbox send fail %d\n", ret);
2010 return ret;
2011 }
2012
2013 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2014
2015 if (!ti_sci_is_response_ack(resp))
2016 ret = -ENODEV;
2017
2018 return ret;
2019}
2020
2021/**
2022 * ti_sci_cmd_proc_auth_boot_image() - Command to authenticate and load the
2023 * image and then set the processor configuration flags.
2024 * @handle: Pointer to TI SCI handle
Andrew F. Davis7aa9a082019-04-12 12:54:44 -04002025 * @image_addr: Memory address at which payload image and certificate is
2026 * located in memory, this is updated if the image data is
2027 * moved during authentication.
2028 * @image_size: This is updated with the final size of the image after
2029 * authentication.
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302030 *
2031 * Return: 0 if all went well, else returns appropriate error value.
2032 */
2033static int ti_sci_cmd_proc_auth_boot_image(const struct ti_sci_handle *handle,
Andrew F. Davis7aa9a082019-04-12 12:54:44 -04002034 u64 *image_addr, u32 *image_size)
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302035{
2036 struct ti_sci_msg_req_proc_auth_boot_image req;
Andrew F. Davis7aa9a082019-04-12 12:54:44 -04002037 struct ti_sci_msg_resp_proc_auth_boot_image *resp;
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302038 struct ti_sci_info *info;
2039 struct ti_sci_xfer *xfer;
2040 int ret = 0;
2041
2042 if (IS_ERR(handle))
2043 return PTR_ERR(handle);
2044 if (!handle)
2045 return -EINVAL;
2046
2047 info = handle_to_ti_sci_info(handle);
2048
2049 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_PROC_AUTH_BOOT_IMIAGE,
2050 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2051 (u32 *)&req, sizeof(req), sizeof(*resp));
2052 if (IS_ERR(xfer)) {
2053 ret = PTR_ERR(xfer);
2054 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
2055 return ret;
2056 }
Andrew F. Davis7aa9a082019-04-12 12:54:44 -04002057 req.cert_addr_low = *image_addr & TISCI_ADDR_LOW_MASK;
2058 req.cert_addr_high = (*image_addr & TISCI_ADDR_HIGH_MASK) >>
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302059 TISCI_ADDR_HIGH_SHIFT;
2060
2061 ret = ti_sci_do_xfer(info, xfer);
2062 if (ret) {
2063 dev_err(info->dev, "Mbox send fail %d\n", ret);
2064 return ret;
2065 }
2066
Andrew F. Davis7aa9a082019-04-12 12:54:44 -04002067 resp = (struct ti_sci_msg_resp_proc_auth_boot_image *)xfer->tx_message.buf;
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302068
2069 if (!ti_sci_is_response_ack(resp))
Andrew F. Davis7aa9a082019-04-12 12:54:44 -04002070 return -ENODEV;
2071
2072 *image_addr = (resp->image_addr_low & TISCI_ADDR_LOW_MASK) |
2073 (((u64)resp->image_addr_high <<
2074 TISCI_ADDR_HIGH_SHIFT) & TISCI_ADDR_HIGH_MASK);
2075 *image_size = resp->image_size;
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302076
2077 return ret;
2078}
2079
2080/**
2081 * ti_sci_cmd_get_proc_boot_status() - Command to get the processor boot status
2082 * @handle: Pointer to TI SCI handle
2083 * @proc_id: Processor ID this request is for
2084 *
2085 * Return: 0 if all went well, else returns appropriate error value.
2086 */
2087static int ti_sci_cmd_get_proc_boot_status(const struct ti_sci_handle *handle,
2088 u8 proc_id, u64 *bv, u32 *cfg_flags,
2089 u32 *ctrl_flags, u32 *sts_flags)
2090{
2091 struct ti_sci_msg_resp_get_proc_boot_status *resp;
2092 struct ti_sci_msg_req_get_proc_boot_status req;
2093 struct ti_sci_info *info;
2094 struct ti_sci_xfer *xfer;
2095 int ret = 0;
2096
2097 if (IS_ERR(handle))
2098 return PTR_ERR(handle);
2099 if (!handle)
2100 return -EINVAL;
2101
2102 info = handle_to_ti_sci_info(handle);
2103
2104 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_GET_PROC_BOOT_STATUS,
2105 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2106 (u32 *)&req, sizeof(req), sizeof(*resp));
2107 if (IS_ERR(xfer)) {
2108 ret = PTR_ERR(xfer);
2109 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
2110 return ret;
2111 }
2112 req.processor_id = proc_id;
2113
2114 ret = ti_sci_do_xfer(info, xfer);
2115 if (ret) {
2116 dev_err(info->dev, "Mbox send fail %d\n", ret);
2117 return ret;
2118 }
2119
2120 resp = (struct ti_sci_msg_resp_get_proc_boot_status *)
2121 xfer->tx_message.buf;
2122
2123 if (!ti_sci_is_response_ack(resp))
2124 return -ENODEV;
2125 *bv = (resp->bootvector_low & TISCI_ADDR_LOW_MASK) |
2126 (((u64)resp->bootvector_high <<
2127 TISCI_ADDR_HIGH_SHIFT) & TISCI_ADDR_HIGH_MASK);
2128 *cfg_flags = resp->config_flags;
2129 *ctrl_flags = resp->control_flags;
2130 *sts_flags = resp->status_flags;
2131
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302132 return ret;
2133}
2134
2135/**
Andreas Dannenbergca08cb32019-06-07 19:24:40 +05302136 * ti_sci_proc_wait_boot_status_no_wait() - Helper function to wait for a
2137 * processor boot status without requesting or
2138 * waiting for a response.
2139 * @proc_id: Processor ID this request is for
2140 * @num_wait_iterations: Total number of iterations we will check before
2141 * we will timeout and give up
2142 * @num_match_iterations: How many iterations should we have continued
2143 * status to account for status bits glitching.
2144 * This is to make sure that match occurs for
2145 * consecutive checks. This implies that the
2146 * worst case should consider that the stable
2147 * time should at the worst be num_wait_iterations
2148 * num_match_iterations to prevent timeout.
2149 * @delay_per_iteration_us: Specifies how long to wait (in micro seconds)
2150 * between each status checks. This is the minimum
2151 * duration, and overhead of register reads and
2152 * checks are on top of this and can vary based on
2153 * varied conditions.
2154 * @delay_before_iterations_us: Specifies how long to wait (in micro seconds)
2155 * before the very first check in the first
2156 * iteration of status check loop. This is the
2157 * minimum duration, and overhead of register
2158 * reads and checks are.
2159 * @status_flags_1_set_all_wait:If non-zero, Specifies that all bits of the
2160 * status matching this field requested MUST be 1.
2161 * @status_flags_1_set_any_wait:If non-zero, Specifies that at least one of the
2162 * bits matching this field requested MUST be 1.
2163 * @status_flags_1_clr_all_wait:If non-zero, Specifies that all bits of the
2164 * status matching this field requested MUST be 0.
2165 * @status_flags_1_clr_any_wait:If non-zero, Specifies that at least one of the
2166 * bits matching this field requested MUST be 0.
2167 *
2168 * Return: 0 if all goes well, else appropriate error message
2169 */
2170static int
2171ti_sci_proc_wait_boot_status_no_wait(const struct ti_sci_handle *handle,
2172 u8 proc_id,
2173 u8 num_wait_iterations,
2174 u8 num_match_iterations,
2175 u8 delay_per_iteration_us,
2176 u8 delay_before_iterations_us,
2177 u32 status_flags_1_set_all_wait,
2178 u32 status_flags_1_set_any_wait,
2179 u32 status_flags_1_clr_all_wait,
2180 u32 status_flags_1_clr_any_wait)
2181{
2182 struct ti_sci_msg_req_wait_proc_boot_status req;
2183 struct ti_sci_info *info;
2184 struct ti_sci_xfer *xfer;
2185 int ret = 0;
2186
2187 if (IS_ERR(handle))
2188 return PTR_ERR(handle);
2189 if (!handle)
2190 return -EINVAL;
2191
2192 info = handle_to_ti_sci_info(handle);
2193
2194 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_WAIT_PROC_BOOT_STATUS,
2195 TI_SCI_FLAG_REQ_GENERIC_NORESPONSE,
2196 (u32 *)&req, sizeof(req), 0);
2197 if (IS_ERR(xfer)) {
2198 ret = PTR_ERR(xfer);
2199 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
2200 return ret;
2201 }
2202 req.processor_id = proc_id;
2203 req.num_wait_iterations = num_wait_iterations;
2204 req.num_match_iterations = num_match_iterations;
2205 req.delay_per_iteration_us = delay_per_iteration_us;
2206 req.delay_before_iterations_us = delay_before_iterations_us;
2207 req.status_flags_1_set_all_wait = status_flags_1_set_all_wait;
2208 req.status_flags_1_set_any_wait = status_flags_1_set_any_wait;
2209 req.status_flags_1_clr_all_wait = status_flags_1_clr_all_wait;
2210 req.status_flags_1_clr_any_wait = status_flags_1_clr_any_wait;
2211
2212 ret = ti_sci_do_xfer(info, xfer);
2213 if (ret)
2214 dev_err(info->dev, "Mbox send fail %d\n", ret);
2215
2216 return ret;
2217}
2218
2219/**
2220 * ti_sci_cmd_proc_shutdown_no_wait() - Command to shutdown a core without
2221 * requesting or waiting for a response. Note that this API call
2222 * should be followed by placing the respective processor into
2223 * either WFE or WFI mode.
2224 * @handle: Pointer to TI SCI handle
2225 * @proc_id: Processor ID this request is for
2226 *
2227 * Return: 0 if all went well, else returns appropriate error value.
2228 */
2229static int ti_sci_cmd_proc_shutdown_no_wait(const struct ti_sci_handle *handle,
2230 u8 proc_id)
2231{
2232 int ret;
Sean Anderson405dc242020-09-15 10:44:38 -04002233 struct ti_sci_info *info;
2234
2235 if (IS_ERR(handle))
2236 return PTR_ERR(handle);
2237 if (!handle)
2238 return -EINVAL;
2239
2240 info = handle_to_ti_sci_info(handle);
Andreas Dannenbergca08cb32019-06-07 19:24:40 +05302241
2242 /*
2243 * Send the core boot status wait message waiting for either WFE or
2244 * WFI without requesting or waiting for a TISCI response with the
2245 * maximum wait time to give us the best chance to get to the WFE/WFI
2246 * command that should follow the invocation of this API before the
2247 * DMSC-internal processing of this command times out. Note that
2248 * waiting for the R5 WFE/WFI flags will also work on an ARMV8 type
2249 * core as the related flag bit positions are the same.
2250 */
2251 ret = ti_sci_proc_wait_boot_status_no_wait(handle, proc_id,
2252 U8_MAX, 100, U8_MAX, U8_MAX,
2253 0, PROC_BOOT_STATUS_FLAG_R5_WFE | PROC_BOOT_STATUS_FLAG_R5_WFI,
2254 0, 0);
2255 if (ret) {
2256 dev_err(info->dev, "Sending core %u wait message fail %d\n",
2257 proc_id, ret);
2258 return ret;
2259 }
2260
2261 /*
2262 * Release a processor managed by TISCI without requesting or waiting
2263 * for a response.
2264 */
2265 ret = ti_sci_set_device_state_no_wait(handle, proc_id, 0,
2266 MSG_DEVICE_SW_STATE_AUTO_OFF);
2267 if (ret)
2268 dev_err(info->dev, "Sending core %u shutdown message fail %d\n",
2269 proc_id, ret);
2270
2271 return ret;
2272}
2273
2274/**
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302275 * ti_sci_cmd_ring_config() - configure RA ring
2276 * @handle: pointer to TI SCI handle
2277 * @valid_params: Bitfield defining validity of ring configuration parameters.
2278 * @nav_id: Device ID of Navigator Subsystem from which the ring is allocated
2279 * @index: Ring index.
2280 * @addr_lo: The ring base address lo 32 bits
2281 * @addr_hi: The ring base address hi 32 bits
2282 * @count: Number of ring elements.
2283 * @mode: The mode of the ring
2284 * @size: The ring element size.
2285 * @order_id: Specifies the ring's bus order ID.
2286 *
2287 * Return: 0 if all went well, else returns appropriate error value.
2288 *
2289 * See @ti_sci_msg_rm_ring_cfg_req for more info.
2290 */
2291static int ti_sci_cmd_ring_config(const struct ti_sci_handle *handle,
2292 u32 valid_params, u16 nav_id, u16 index,
2293 u32 addr_lo, u32 addr_hi, u32 count,
2294 u8 mode, u8 size, u8 order_id)
2295{
2296 struct ti_sci_msg_rm_ring_cfg_resp *resp;
2297 struct ti_sci_msg_rm_ring_cfg_req req;
2298 struct ti_sci_xfer *xfer;
2299 struct ti_sci_info *info;
2300 int ret = 0;
2301
2302 if (IS_ERR(handle))
2303 return PTR_ERR(handle);
2304 if (!handle)
2305 return -EINVAL;
2306
2307 info = handle_to_ti_sci_info(handle);
2308
2309 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_RM_RING_CFG,
2310 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2311 (u32 *)&req, sizeof(req), sizeof(*resp));
2312 if (IS_ERR(xfer)) {
2313 ret = PTR_ERR(xfer);
2314 dev_err(info->dev, "RM_RA:Message config failed(%d)\n", ret);
2315 return ret;
2316 }
2317 req.valid_params = valid_params;
2318 req.nav_id = nav_id;
2319 req.index = index;
2320 req.addr_lo = addr_lo;
2321 req.addr_hi = addr_hi;
2322 req.count = count;
2323 req.mode = mode;
2324 req.size = size;
2325 req.order_id = order_id;
2326
2327 ret = ti_sci_do_xfer(info, xfer);
2328 if (ret) {
2329 dev_err(info->dev, "RM_RA:Mbox config send fail %d\n", ret);
2330 goto fail;
2331 }
2332
2333 resp = (struct ti_sci_msg_rm_ring_cfg_resp *)xfer->tx_message.buf;
2334
2335 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2336
2337fail:
2338 dev_dbg(info->dev, "RM_RA:config ring %u ret:%d\n", index, ret);
2339 return ret;
2340}
2341
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302342static int ti_sci_cmd_rm_psil_pair(const struct ti_sci_handle *handle,
2343 u32 nav_id, u32 src_thread, u32 dst_thread)
2344{
2345 struct ti_sci_msg_hdr *resp;
2346 struct ti_sci_msg_psil_pair req;
2347 struct ti_sci_xfer *xfer;
2348 struct ti_sci_info *info;
2349 int ret = 0;
2350
2351 if (IS_ERR(handle))
2352 return PTR_ERR(handle);
2353 if (!handle)
2354 return -EINVAL;
2355
2356 info = handle_to_ti_sci_info(handle);
2357
2358 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_RM_PSIL_PAIR,
2359 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2360 (u32 *)&req, sizeof(req), sizeof(*resp));
2361 if (IS_ERR(xfer)) {
2362 ret = PTR_ERR(xfer);
2363 dev_err(info->dev, "RM_PSIL:Message alloc failed(%d)\n", ret);
2364 return ret;
2365 }
2366 req.nav_id = nav_id;
2367 req.src_thread = src_thread;
2368 req.dst_thread = dst_thread;
2369
2370 ret = ti_sci_do_xfer(info, xfer);
2371 if (ret) {
2372 dev_err(info->dev, "RM_PSIL:Mbox send fail %d\n", ret);
2373 goto fail;
2374 }
2375
2376 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2377 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2378
2379fail:
2380 dev_dbg(info->dev, "RM_PSIL: nav: %u link pair %u->%u ret:%u\n",
2381 nav_id, src_thread, dst_thread, ret);
2382 return ret;
2383}
2384
2385static int ti_sci_cmd_rm_psil_unpair(const struct ti_sci_handle *handle,
2386 u32 nav_id, u32 src_thread, u32 dst_thread)
2387{
2388 struct ti_sci_msg_hdr *resp;
2389 struct ti_sci_msg_psil_unpair req;
2390 struct ti_sci_xfer *xfer;
2391 struct ti_sci_info *info;
2392 int ret = 0;
2393
2394 if (IS_ERR(handle))
2395 return PTR_ERR(handle);
2396 if (!handle)
2397 return -EINVAL;
2398
2399 info = handle_to_ti_sci_info(handle);
2400
2401 xfer = ti_sci_setup_one_xfer(info, TI_SCI_MSG_RM_PSIL_UNPAIR,
2402 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2403 (u32 *)&req, sizeof(req), sizeof(*resp));
2404 if (IS_ERR(xfer)) {
2405 ret = PTR_ERR(xfer);
2406 dev_err(info->dev, "RM_PSIL:Message alloc failed(%d)\n", ret);
2407 return ret;
2408 }
2409 req.nav_id = nav_id;
2410 req.src_thread = src_thread;
2411 req.dst_thread = dst_thread;
2412
2413 ret = ti_sci_do_xfer(info, xfer);
2414 if (ret) {
2415 dev_err(info->dev, "RM_PSIL:Mbox send fail %d\n", ret);
2416 goto fail;
2417 }
2418
2419 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2420 ret = ti_sci_is_response_ack(resp) ? 0 : -ENODEV;
2421
2422fail:
2423 dev_dbg(info->dev, "RM_PSIL: link unpair %u->%u ret:%u\n",
2424 src_thread, dst_thread, ret);
2425 return ret;
2426}
2427
2428static int ti_sci_cmd_rm_udmap_tx_ch_cfg(
2429 const struct ti_sci_handle *handle,
2430 const struct ti_sci_msg_rm_udmap_tx_ch_cfg *params)
2431{
2432 struct ti_sci_msg_rm_udmap_tx_ch_cfg_resp *resp;
2433 struct ti_sci_msg_rm_udmap_tx_ch_cfg_req req;
2434 struct ti_sci_xfer *xfer;
2435 struct ti_sci_info *info;
2436 int ret = 0;
2437
2438 if (IS_ERR(handle))
2439 return PTR_ERR(handle);
2440 if (!handle)
2441 return -EINVAL;
2442
2443 info = handle_to_ti_sci_info(handle);
2444
2445 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_RM_UDMAP_TX_CH_CFG,
2446 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2447 (u32 *)&req, sizeof(req), sizeof(*resp));
2448 if (IS_ERR(xfer)) {
2449 ret = PTR_ERR(xfer);
2450 dev_err(info->dev, "Message TX_CH_CFG alloc failed(%d)\n", ret);
2451 return ret;
2452 }
2453 req.valid_params = params->valid_params;
2454 req.nav_id = params->nav_id;
2455 req.index = params->index;
2456 req.tx_pause_on_err = params->tx_pause_on_err;
2457 req.tx_filt_einfo = params->tx_filt_einfo;
2458 req.tx_filt_pswords = params->tx_filt_pswords;
2459 req.tx_atype = params->tx_atype;
2460 req.tx_chan_type = params->tx_chan_type;
2461 req.tx_supr_tdpkt = params->tx_supr_tdpkt;
2462 req.tx_fetch_size = params->tx_fetch_size;
2463 req.tx_credit_count = params->tx_credit_count;
2464 req.txcq_qnum = params->txcq_qnum;
2465 req.tx_priority = params->tx_priority;
2466 req.tx_qos = params->tx_qos;
2467 req.tx_orderid = params->tx_orderid;
2468 req.fdepth = params->fdepth;
2469 req.tx_sched_priority = params->tx_sched_priority;
Vignesh Raghavendraa8a2b8a2021-05-10 20:06:02 +05302470 req.tx_burst_size = params->tx_burst_size;
2471 req.tx_tdtype = params->tx_tdtype;
2472 req.extended_ch_type = params->extended_ch_type;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302473
2474 ret = ti_sci_do_xfer(info, xfer);
2475 if (ret) {
2476 dev_err(info->dev, "Mbox send TX_CH_CFG fail %d\n", ret);
2477 goto fail;
2478 }
2479
2480 resp =
2481 (struct ti_sci_msg_rm_udmap_tx_ch_cfg_resp *)xfer->tx_message.buf;
2482 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2483
2484fail:
2485 dev_dbg(info->dev, "TX_CH_CFG: chn %u ret:%u\n", params->index, ret);
2486 return ret;
2487}
2488
2489static int ti_sci_cmd_rm_udmap_rx_ch_cfg(
2490 const struct ti_sci_handle *handle,
2491 const struct ti_sci_msg_rm_udmap_rx_ch_cfg *params)
2492{
2493 struct ti_sci_msg_rm_udmap_rx_ch_cfg_resp *resp;
2494 struct ti_sci_msg_rm_udmap_rx_ch_cfg_req req;
2495 struct ti_sci_xfer *xfer;
2496 struct ti_sci_info *info;
2497 int ret = 0;
2498
2499 if (IS_ERR(handle))
2500 return PTR_ERR(handle);
2501 if (!handle)
2502 return -EINVAL;
2503
2504 info = handle_to_ti_sci_info(handle);
2505
2506 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_RM_UDMAP_RX_CH_CFG,
2507 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2508 (u32 *)&req, sizeof(req), sizeof(*resp));
2509 if (IS_ERR(xfer)) {
2510 ret = PTR_ERR(xfer);
2511 dev_err(info->dev, "Message RX_CH_CFG alloc failed(%d)\n", ret);
2512 return ret;
2513 }
2514
2515 req.valid_params = params->valid_params;
2516 req.nav_id = params->nav_id;
2517 req.index = params->index;
2518 req.rx_fetch_size = params->rx_fetch_size;
2519 req.rxcq_qnum = params->rxcq_qnum;
2520 req.rx_priority = params->rx_priority;
2521 req.rx_qos = params->rx_qos;
2522 req.rx_orderid = params->rx_orderid;
2523 req.rx_sched_priority = params->rx_sched_priority;
2524 req.flowid_start = params->flowid_start;
2525 req.flowid_cnt = params->flowid_cnt;
2526 req.rx_pause_on_err = params->rx_pause_on_err;
2527 req.rx_atype = params->rx_atype;
2528 req.rx_chan_type = params->rx_chan_type;
2529 req.rx_ignore_short = params->rx_ignore_short;
2530 req.rx_ignore_long = params->rx_ignore_long;
2531
2532 ret = ti_sci_do_xfer(info, xfer);
2533 if (ret) {
2534 dev_err(info->dev, "Mbox send RX_CH_CFG fail %d\n", ret);
2535 goto fail;
2536 }
2537
2538 resp =
2539 (struct ti_sci_msg_rm_udmap_rx_ch_cfg_resp *)xfer->tx_message.buf;
2540 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2541
2542fail:
2543 dev_dbg(info->dev, "RX_CH_CFG: chn %u ret:%d\n", params->index, ret);
2544 return ret;
2545}
2546
2547static int ti_sci_cmd_rm_udmap_rx_flow_cfg(
2548 const struct ti_sci_handle *handle,
2549 const struct ti_sci_msg_rm_udmap_flow_cfg *params)
2550{
2551 struct ti_sci_msg_rm_udmap_flow_cfg_resp *resp;
2552 struct ti_sci_msg_rm_udmap_flow_cfg_req req;
2553 struct ti_sci_xfer *xfer;
2554 struct ti_sci_info *info;
2555 int ret = 0;
2556
2557 if (IS_ERR(handle))
2558 return PTR_ERR(handle);
2559 if (!handle)
2560 return -EINVAL;
2561
2562 info = handle_to_ti_sci_info(handle);
2563
2564 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_RM_UDMAP_FLOW_CFG,
2565 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2566 (u32 *)&req, sizeof(req), sizeof(*resp));
2567 if (IS_ERR(xfer)) {
2568 ret = PTR_ERR(xfer);
Sean Anderson405dc242020-09-15 10:44:38 -04002569 dev_err(info->dev, "RX_FL_CFG: Message alloc failed(%d)\n",
2570 ret);
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302571 return ret;
2572 }
2573
2574 req.valid_params = params->valid_params;
2575 req.nav_id = params->nav_id;
2576 req.flow_index = params->flow_index;
2577 req.rx_einfo_present = params->rx_einfo_present;
2578 req.rx_psinfo_present = params->rx_psinfo_present;
2579 req.rx_error_handling = params->rx_error_handling;
2580 req.rx_desc_type = params->rx_desc_type;
2581 req.rx_sop_offset = params->rx_sop_offset;
2582 req.rx_dest_qnum = params->rx_dest_qnum;
2583 req.rx_src_tag_hi = params->rx_src_tag_hi;
2584 req.rx_src_tag_lo = params->rx_src_tag_lo;
2585 req.rx_dest_tag_hi = params->rx_dest_tag_hi;
2586 req.rx_dest_tag_lo = params->rx_dest_tag_lo;
2587 req.rx_src_tag_hi_sel = params->rx_src_tag_hi_sel;
2588 req.rx_src_tag_lo_sel = params->rx_src_tag_lo_sel;
2589 req.rx_dest_tag_hi_sel = params->rx_dest_tag_hi_sel;
2590 req.rx_dest_tag_lo_sel = params->rx_dest_tag_lo_sel;
2591 req.rx_fdq0_sz0_qnum = params->rx_fdq0_sz0_qnum;
2592 req.rx_fdq1_qnum = params->rx_fdq1_qnum;
2593 req.rx_fdq2_qnum = params->rx_fdq2_qnum;
2594 req.rx_fdq3_qnum = params->rx_fdq3_qnum;
2595 req.rx_ps_location = params->rx_ps_location;
2596
2597 ret = ti_sci_do_xfer(info, xfer);
2598 if (ret) {
Sean Anderson405dc242020-09-15 10:44:38 -04002599 dev_err(info->dev, "RX_FL_CFG: Mbox send fail %d\n", ret);
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302600 goto fail;
2601 }
2602
2603 resp =
2604 (struct ti_sci_msg_rm_udmap_flow_cfg_resp *)xfer->tx_message.buf;
2605 ret = ti_sci_is_response_ack(resp) ? 0 : -EINVAL;
2606
2607fail:
2608 dev_dbg(info->dev, "RX_FL_CFG: %u ret:%d\n", params->flow_index, ret);
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302609 return ret;
2610}
2611
Andrew F. Davis2aafc0c2019-04-12 12:54:43 -04002612/**
2613 * ti_sci_cmd_set_fwl_region() - Request for configuring a firewall region
2614 * @handle: pointer to TI SCI handle
2615 * @region: region configuration parameters
2616 *
2617 * Return: 0 if all went well, else returns appropriate error value.
2618 */
2619static int ti_sci_cmd_set_fwl_region(const struct ti_sci_handle *handle,
2620 const struct ti_sci_msg_fwl_region *region)
2621{
2622 struct ti_sci_msg_fwl_set_firewall_region_req req;
2623 struct ti_sci_msg_hdr *resp;
2624 struct ti_sci_info *info;
2625 struct ti_sci_xfer *xfer;
2626 int ret = 0;
2627
2628 if (IS_ERR(handle))
2629 return PTR_ERR(handle);
2630 if (!handle)
2631 return -EINVAL;
2632
2633 info = handle_to_ti_sci_info(handle);
2634
2635 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_FWL_SET,
2636 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2637 (u32 *)&req, sizeof(req), sizeof(*resp));
2638 if (IS_ERR(xfer)) {
2639 ret = PTR_ERR(xfer);
2640 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
2641 return ret;
2642 }
2643
2644 req.fwl_id = region->fwl_id;
2645 req.region = region->region;
2646 req.n_permission_regs = region->n_permission_regs;
2647 req.control = region->control;
2648 req.permissions[0] = region->permissions[0];
2649 req.permissions[1] = region->permissions[1];
2650 req.permissions[2] = region->permissions[2];
2651 req.start_address = region->start_address;
2652 req.end_address = region->end_address;
2653
2654 ret = ti_sci_do_xfer(info, xfer);
2655 if (ret) {
2656 dev_err(info->dev, "Mbox send fail %d\n", ret);
2657 return ret;
2658 }
2659
2660 resp = (struct ti_sci_msg_hdr *)xfer->tx_message.buf;
2661
2662 if (!ti_sci_is_response_ack(resp))
2663 return -ENODEV;
2664
2665 return 0;
2666}
2667
2668/**
2669 * ti_sci_cmd_get_fwl_region() - Request for getting a firewall region
2670 * @handle: pointer to TI SCI handle
2671 * @region: region configuration parameters
2672 *
2673 * Return: 0 if all went well, else returns appropriate error value.
2674 */
2675static int ti_sci_cmd_get_fwl_region(const struct ti_sci_handle *handle,
2676 struct ti_sci_msg_fwl_region *region)
2677{
2678 struct ti_sci_msg_fwl_get_firewall_region_req req;
2679 struct ti_sci_msg_fwl_get_firewall_region_resp *resp;
2680 struct ti_sci_info *info;
2681 struct ti_sci_xfer *xfer;
2682 int ret = 0;
2683
2684 if (IS_ERR(handle))
2685 return PTR_ERR(handle);
2686 if (!handle)
2687 return -EINVAL;
2688
2689 info = handle_to_ti_sci_info(handle);
2690
2691 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_FWL_GET,
2692 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
2693 (u32 *)&req, sizeof(req), sizeof(*resp));
2694 if (IS_ERR(xfer)) {
2695 ret = PTR_ERR(xfer);
2696 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
2697 return ret;
2698 }
2699
2700 req.fwl_id = region->fwl_id;
2701 req.region = region->region;
2702 req.n_permission_regs = region->n_permission_regs;
2703
2704 ret = ti_sci_do_xfer(info, xfer);
2705 if (ret) {
2706 dev_err(info->dev, "Mbox send fail %d\n", ret);
2707 return ret;
2708 }
2709
2710 resp = (struct ti_sci_msg_fwl_get_firewall_region_resp *)xfer->tx_message.buf;
2711
2712 if (!ti_sci_is_response_ack(resp))
2713 return -ENODEV;
2714
2715 region->fwl_id = resp->fwl_id;
2716 region->region = resp->region;
2717 region->n_permission_regs = resp->n_permission_regs;
2718 region->control = resp->control;
2719 region->permissions[0] = resp->permissions[0];
2720 region->permissions[1] = resp->permissions[1];
2721 region->permissions[2] = resp->permissions[2];
2722 region->start_address = resp->start_address;
2723 region->end_address = resp->end_address;
2724
2725 return 0;
2726}
2727
2728/**
2729 * ti_sci_cmd_change_fwl_owner() - Request for changing a firewall owner
2730 * @handle: pointer to TI SCI handle
2731 * @region: region configuration parameters
2732 *
2733 * Return: 0 if all went well, else returns appropriate error value.
2734 */
2735static int ti_sci_cmd_change_fwl_owner(const struct ti_sci_handle *handle,
2736 struct ti_sci_msg_fwl_owner *owner)
2737{
2738 struct ti_sci_msg_fwl_change_owner_info_req req;
2739 struct ti_sci_msg_fwl_change_owner_info_resp *resp;
2740 struct ti_sci_info *info;
2741 struct ti_sci_xfer *xfer;
2742 int ret = 0;
2743
2744 if (IS_ERR(handle))
2745 return PTR_ERR(handle);
2746 if (!handle)
2747 return -EINVAL;
2748
2749 info = handle_to_ti_sci_info(handle);
2750
Andrew F. Davis8928fbd2019-04-29 09:04:11 -04002751 xfer = ti_sci_setup_one_xfer(info, TISCI_MSG_FWL_CHANGE_OWNER,
2752 TI_SCI_FLAG_REQ_ACK_ON_PROCESSED,
Andrew F. Davis2aafc0c2019-04-12 12:54:43 -04002753 (u32 *)&req, sizeof(req), sizeof(*resp));
2754 if (IS_ERR(xfer)) {
2755 ret = PTR_ERR(xfer);
2756 dev_err(info->dev, "Message alloc failed(%d)\n", ret);
2757 return ret;
2758 }
2759
2760 req.fwl_id = owner->fwl_id;
2761 req.region = owner->region;
2762 req.owner_index = owner->owner_index;
2763
2764 ret = ti_sci_do_xfer(info, xfer);
2765 if (ret) {
2766 dev_err(info->dev, "Mbox send fail %d\n", ret);
2767 return ret;
2768 }
2769
2770 resp = (struct ti_sci_msg_fwl_change_owner_info_resp *)xfer->tx_message.buf;
2771
2772 if (!ti_sci_is_response_ack(resp))
2773 return -ENODEV;
2774
2775 owner->fwl_id = resp->fwl_id;
2776 owner->region = resp->region;
2777 owner->owner_index = resp->owner_index;
2778 owner->owner_privid = resp->owner_privid;
2779 owner->owner_permission_bits = resp->owner_permission_bits;
2780
2781 return ret;
2782}
2783
Andreas Dannenberg5299c4c2018-08-27 15:57:33 +05302784/*
2785 * ti_sci_setup_ops() - Setup the operations structures
2786 * @info: pointer to TISCI pointer
2787 */
2788static void ti_sci_setup_ops(struct ti_sci_info *info)
2789{
2790 struct ti_sci_ops *ops = &info->handle.ops;
2791 struct ti_sci_board_ops *bops = &ops->board_ops;
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +05302792 struct ti_sci_dev_ops *dops = &ops->dev_ops;
Lokesh Vutlad10c80c2018-08-27 15:57:35 +05302793 struct ti_sci_clk_ops *cops = &ops->clk_ops;
Andreas Dannenberg5bd08372018-08-27 15:57:36 +05302794 struct ti_sci_core_ops *core_ops = &ops->core_ops;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302795 struct ti_sci_rm_core_ops *rm_core_ops = &ops->rm_core_ops;
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302796 struct ti_sci_proc_ops *pops = &ops->proc_ops;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302797 struct ti_sci_rm_ringacc_ops *rops = &ops->rm_ring_ops;
2798 struct ti_sci_rm_psil_ops *psilops = &ops->rm_psil_ops;
2799 struct ti_sci_rm_udmap_ops *udmap_ops = &ops->rm_udmap_ops;
Andrew F. Davis2aafc0c2019-04-12 12:54:43 -04002800 struct ti_sci_fwl_ops *fwl_ops = &ops->fwl_ops;
Andreas Dannenberg5299c4c2018-08-27 15:57:33 +05302801
2802 bops->board_config = ti_sci_cmd_set_board_config;
2803 bops->board_config_rm = ti_sci_cmd_set_board_config_rm;
2804 bops->board_config_security = ti_sci_cmd_set_board_config_security;
2805 bops->board_config_pm = ti_sci_cmd_set_board_config_pm;
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +05302806
2807 dops->get_device = ti_sci_cmd_get_device;
Lokesh Vutlaf5613002019-06-07 19:24:39 +05302808 dops->get_device_exclusive = ti_sci_cmd_get_device_exclusive;
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +05302809 dops->idle_device = ti_sci_cmd_idle_device;
Lokesh Vutlaf5613002019-06-07 19:24:39 +05302810 dops->idle_device_exclusive = ti_sci_cmd_idle_device_exclusive;
Andreas Dannenberg24a4d5e2018-08-27 15:57:34 +05302811 dops->put_device = ti_sci_cmd_put_device;
2812 dops->is_valid = ti_sci_cmd_dev_is_valid;
2813 dops->get_context_loss_count = ti_sci_cmd_dev_get_clcnt;
2814 dops->is_idle = ti_sci_cmd_dev_is_idle;
2815 dops->is_stop = ti_sci_cmd_dev_is_stop;
2816 dops->is_on = ti_sci_cmd_dev_is_on;
2817 dops->is_transitioning = ti_sci_cmd_dev_is_trans;
2818 dops->set_device_resets = ti_sci_cmd_set_device_resets;
2819 dops->get_device_resets = ti_sci_cmd_get_device_resets;
Lokesh Vutla0d0412a2019-06-07 19:24:41 +05302820 dops->release_exclusive_devices = ti_sci_cmd_release_exclusive_devices;
Lokesh Vutlad10c80c2018-08-27 15:57:35 +05302821
2822 cops->get_clock = ti_sci_cmd_get_clock;
2823 cops->idle_clock = ti_sci_cmd_idle_clock;
2824 cops->put_clock = ti_sci_cmd_put_clock;
2825 cops->is_auto = ti_sci_cmd_clk_is_auto;
2826 cops->is_on = ti_sci_cmd_clk_is_on;
2827 cops->is_off = ti_sci_cmd_clk_is_off;
2828
2829 cops->set_parent = ti_sci_cmd_clk_set_parent;
2830 cops->get_parent = ti_sci_cmd_clk_get_parent;
2831 cops->get_num_parents = ti_sci_cmd_clk_get_num_parents;
2832
2833 cops->get_best_match_freq = ti_sci_cmd_clk_get_match_freq;
2834 cops->set_freq = ti_sci_cmd_clk_set_freq;
2835 cops->get_freq = ti_sci_cmd_clk_get_freq;
Andreas Dannenberg5bd08372018-08-27 15:57:36 +05302836
2837 core_ops->reboot_device = ti_sci_cmd_core_reboot;
Lokesh Vutla032dce82019-03-08 11:47:32 +05302838 core_ops->query_msmc = ti_sci_cmd_query_msmc;
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302839
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302840 rm_core_ops->get_range = ti_sci_cmd_get_resource_range;
2841 rm_core_ops->get_range_from_shost =
2842 ti_sci_cmd_get_resource_range_from_shost;
2843
Lokesh Vutlab8856af2018-08-27 15:57:37 +05302844 pops->proc_request = ti_sci_cmd_proc_request;
2845 pops->proc_release = ti_sci_cmd_proc_release;
2846 pops->proc_handover = ti_sci_cmd_proc_handover;
2847 pops->set_proc_boot_cfg = ti_sci_cmd_set_proc_boot_cfg;
2848 pops->set_proc_boot_ctrl = ti_sci_cmd_set_proc_boot_ctrl;
2849 pops->proc_auth_boot_image = ti_sci_cmd_proc_auth_boot_image;
2850 pops->get_proc_boot_status = ti_sci_cmd_get_proc_boot_status;
Andreas Dannenbergca08cb32019-06-07 19:24:40 +05302851 pops->proc_shutdown_no_wait = ti_sci_cmd_proc_shutdown_no_wait;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302852
2853 rops->config = ti_sci_cmd_ring_config;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302854
2855 psilops->pair = ti_sci_cmd_rm_psil_pair;
2856 psilops->unpair = ti_sci_cmd_rm_psil_unpair;
2857
2858 udmap_ops->tx_ch_cfg = ti_sci_cmd_rm_udmap_tx_ch_cfg;
2859 udmap_ops->rx_ch_cfg = ti_sci_cmd_rm_udmap_rx_ch_cfg;
2860 udmap_ops->rx_flow_cfg = ti_sci_cmd_rm_udmap_rx_flow_cfg;
Andrew F. Davis2aafc0c2019-04-12 12:54:43 -04002861
2862 fwl_ops->set_fwl_region = ti_sci_cmd_set_fwl_region;
2863 fwl_ops->get_fwl_region = ti_sci_cmd_get_fwl_region;
2864 fwl_ops->change_fwl_owner = ti_sci_cmd_change_fwl_owner;
Andreas Dannenberg5299c4c2018-08-27 15:57:33 +05302865}
2866
2867/**
Lokesh Vutla5af02db2018-08-27 15:57:32 +05302868 * ti_sci_get_handle_from_sysfw() - Get the TI SCI handle of the SYSFW
2869 * @dev: Pointer to the SYSFW device
2870 *
2871 * Return: pointer to handle if successful, else EINVAL if invalid conditions
2872 * are encountered.
2873 */
2874const
2875struct ti_sci_handle *ti_sci_get_handle_from_sysfw(struct udevice *sci_dev)
2876{
2877 if (!sci_dev)
2878 return ERR_PTR(-EINVAL);
2879
2880 struct ti_sci_info *info = dev_get_priv(sci_dev);
2881
2882 if (!info)
2883 return ERR_PTR(-EINVAL);
2884
2885 struct ti_sci_handle *handle = &info->handle;
2886
2887 if (!handle)
2888 return ERR_PTR(-EINVAL);
2889
2890 return handle;
2891}
2892
2893/**
2894 * ti_sci_get_handle() - Get the TI SCI handle for a device
2895 * @dev: Pointer to device for which we want SCI handle
2896 *
2897 * Return: pointer to handle if successful, else EINVAL if invalid conditions
2898 * are encountered.
2899 */
2900const struct ti_sci_handle *ti_sci_get_handle(struct udevice *dev)
2901{
2902 if (!dev)
2903 return ERR_PTR(-EINVAL);
2904
2905 struct udevice *sci_dev = dev_get_parent(dev);
2906
2907 return ti_sci_get_handle_from_sysfw(sci_dev);
2908}
2909
2910/**
2911 * ti_sci_get_by_phandle() - Get the TI SCI handle using DT phandle
2912 * @dev: device node
2913 * @propname: property name containing phandle on TISCI node
2914 *
2915 * Return: pointer to handle if successful, else appropriate error value.
2916 */
2917const struct ti_sci_handle *ti_sci_get_by_phandle(struct udevice *dev,
2918 const char *property)
2919{
2920 struct ti_sci_info *entry, *info = NULL;
2921 u32 phandle, err;
2922 ofnode node;
2923
2924 err = ofnode_read_u32(dev_ofnode(dev), property, &phandle);
2925 if (err)
2926 return ERR_PTR(err);
2927
2928 node = ofnode_get_by_phandle(phandle);
2929 if (!ofnode_valid(node))
2930 return ERR_PTR(-EINVAL);
2931
2932 list_for_each_entry(entry, &ti_sci_list, list)
2933 if (ofnode_equal(dev_ofnode(entry->dev), node)) {
2934 info = entry;
2935 break;
2936 }
2937
2938 if (!info)
2939 return ERR_PTR(-ENODEV);
2940
2941 return &info->handle;
2942}
2943
2944/**
2945 * ti_sci_of_to_info() - generate private data from device tree
2946 * @dev: corresponding system controller interface device
2947 * @info: pointer to driver specific private data
2948 *
2949 * Return: 0 if all goes good, else appropriate error message.
2950 */
2951static int ti_sci_of_to_info(struct udevice *dev, struct ti_sci_info *info)
2952{
2953 int ret;
2954
2955 ret = mbox_get_by_name(dev, "tx", &info->chan_tx);
2956 if (ret) {
2957 dev_err(dev, "%s: Acquiring Tx channel failed. ret = %d\n",
2958 __func__, ret);
2959 return ret;
2960 }
2961
2962 ret = mbox_get_by_name(dev, "rx", &info->chan_rx);
2963 if (ret) {
2964 dev_err(dev, "%s: Acquiring Rx channel failed. ret = %d\n",
2965 __func__, ret);
2966 return ret;
2967 }
2968
2969 /* Notify channel is optional. Enable only if populated */
2970 ret = mbox_get_by_name(dev, "notify", &info->chan_notify);
2971 if (ret) {
2972 dev_dbg(dev, "%s: Acquiring notify channel failed. ret = %d\n",
2973 __func__, ret);
2974 }
2975
2976 info->host_id = dev_read_u32_default(dev, "ti,host-id",
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05302977 info->desc->default_host_id);
Lokesh Vutla5af02db2018-08-27 15:57:32 +05302978
2979 info->is_secure = dev_read_bool(dev, "ti,secure-host");
2980
2981 return 0;
2982}
2983
2984/**
2985 * ti_sci_probe() - Basic probe
2986 * @dev: corresponding system controller interface device
2987 *
2988 * Return: 0 if all goes good, else appropriate error message.
2989 */
2990static int ti_sci_probe(struct udevice *dev)
2991{
2992 struct ti_sci_info *info;
2993 int ret;
2994
2995 debug("%s(dev=%p)\n", __func__, dev);
2996
2997 info = dev_get_priv(dev);
2998 info->desc = (void *)dev_get_driver_data(dev);
2999
3000 ret = ti_sci_of_to_info(dev, info);
3001 if (ret) {
3002 dev_err(dev, "%s: Probe failed with error %d\n", __func__, ret);
3003 return ret;
3004 }
3005
3006 info->dev = dev;
3007 info->seq = 0xA;
3008
3009 list_add_tail(&info->list, &ti_sci_list);
Andreas Dannenberg5299c4c2018-08-27 15:57:33 +05303010 ti_sci_setup_ops(info);
Lokesh Vutla5af02db2018-08-27 15:57:32 +05303011
3012 ret = ti_sci_cmd_get_revision(&info->handle);
3013
Lokesh Vutla0d0412a2019-06-07 19:24:41 +05303014 INIT_LIST_HEAD(&info->dev_list);
3015
Lokesh Vutla5af02db2018-08-27 15:57:32 +05303016 return ret;
3017}
3018
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303019/*
3020 * ti_sci_get_free_resource() - Get a free resource from TISCI resource.
3021 * @res: Pointer to the TISCI resource
3022 *
3023 * Return: resource num if all went ok else TI_SCI_RESOURCE_NULL.
3024 */
3025u16 ti_sci_get_free_resource(struct ti_sci_resource *res)
3026{
3027 u16 set, free_bit;
3028
3029 for (set = 0; set < res->sets; set++) {
3030 free_bit = find_first_zero_bit(res->desc[set].res_map,
3031 res->desc[set].num);
3032 if (free_bit != res->desc[set].num) {
3033 set_bit(free_bit, res->desc[set].res_map);
3034 return res->desc[set].start + free_bit;
3035 }
3036 }
3037
3038 return TI_SCI_RESOURCE_NULL;
3039}
3040
3041/**
3042 * ti_sci_release_resource() - Release a resource from TISCI resource.
3043 * @res: Pointer to the TISCI resource
3044 */
3045void ti_sci_release_resource(struct ti_sci_resource *res, u16 id)
3046{
3047 u16 set;
3048
3049 for (set = 0; set < res->sets; set++) {
3050 if (res->desc[set].start <= id &&
3051 (res->desc[set].num + res->desc[set].start) > id)
3052 clear_bit(id - res->desc[set].start,
3053 res->desc[set].res_map);
3054 }
3055}
3056
3057/**
3058 * devm_ti_sci_get_of_resource() - Get a TISCI resource assigned to a device
3059 * @handle: TISCI handle
3060 * @dev: Device pointer to which the resource is assigned
3061 * @of_prop: property name by which the resource are represented
3062 *
3063 * Note: This function expects of_prop to be in the form of tuples
3064 * <type, subtype>. Allocates and initializes ti_sci_resource structure
3065 * for each of_prop. Client driver can directly call
3066 * ti_sci_(get_free, release)_resource apis for handling the resource.
3067 *
3068 * Return: Pointer to ti_sci_resource if all went well else appropriate
3069 * error pointer.
3070 */
3071struct ti_sci_resource *
3072devm_ti_sci_get_of_resource(const struct ti_sci_handle *handle,
3073 struct udevice *dev, u32 dev_id, char *of_prop)
3074{
3075 u32 resource_subtype;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303076 struct ti_sci_resource *res;
Vignesh Raghavendrae1164dd2019-08-05 12:26:44 -05003077 bool valid_set = false;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303078 int sets, i, ret;
3079 u32 *temp;
3080
3081 res = devm_kzalloc(dev, sizeof(*res), GFP_KERNEL);
3082 if (!res)
3083 return ERR_PTR(-ENOMEM);
3084
3085 sets = dev_read_size(dev, of_prop);
3086 if (sets < 0) {
3087 dev_err(dev, "%s resource type ids not available\n", of_prop);
3088 return ERR_PTR(sets);
3089 }
3090 temp = malloc(sets);
3091 sets /= sizeof(u32);
3092 res->sets = sets;
3093
3094 res->desc = devm_kcalloc(dev, res->sets, sizeof(*res->desc),
3095 GFP_KERNEL);
3096 if (!res->desc)
3097 return ERR_PTR(-ENOMEM);
3098
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303099 ret = dev_read_u32_array(dev, of_prop, temp, res->sets);
3100 if (ret)
3101 return ERR_PTR(-EINVAL);
3102
3103 for (i = 0; i < res->sets; i++) {
3104 resource_subtype = temp[i];
3105 ret = handle->ops.rm_core_ops.get_range(handle, dev_id,
3106 resource_subtype,
3107 &res->desc[i].start,
3108 &res->desc[i].num);
3109 if (ret) {
Vignesh Raghavendrae1164dd2019-08-05 12:26:44 -05003110 dev_dbg(dev, "type %d subtype %d not allocated for host %d\n",
Lokesh Vutla0acf1dc2020-08-17 11:00:48 +05303111 dev_id, resource_subtype,
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303112 handle_to_ti_sci_info(handle)->host_id);
Vignesh Raghavendrae1164dd2019-08-05 12:26:44 -05003113 res->desc[i].start = 0;
3114 res->desc[i].num = 0;
3115 continue;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303116 }
3117
Vignesh Raghavendrae1164dd2019-08-05 12:26:44 -05003118 valid_set = true;
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303119 dev_dbg(dev, "res type = %d, subtype = %d, start = %d, num = %d\n",
Lokesh Vutla0acf1dc2020-08-17 11:00:48 +05303120 dev_id, resource_subtype, res->desc[i].start,
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303121 res->desc[i].num);
3122
3123 res->desc[i].res_map =
3124 devm_kzalloc(dev, BITS_TO_LONGS(res->desc[i].num) *
3125 sizeof(*res->desc[i].res_map), GFP_KERNEL);
3126 if (!res->desc[i].res_map)
3127 return ERR_PTR(-ENOMEM);
3128 }
3129
Vignesh Raghavendrae1164dd2019-08-05 12:26:44 -05003130 if (valid_set)
3131 return res;
3132
3133 return ERR_PTR(-EINVAL);
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303134}
3135
3136/* Description for K2G */
3137static const struct ti_sci_desc ti_sci_pmmc_k2g_desc = {
3138 .default_host_id = 2,
3139 /* Conservative duration */
3140 .max_rx_timeout_ms = 10000,
3141 /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */
3142 .max_msgs = 20,
3143 .max_msg_size = 64,
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303144};
3145
Lokesh Vutla5af02db2018-08-27 15:57:32 +05303146/* Description for AM654 */
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303147static const struct ti_sci_desc ti_sci_pmmc_am654_desc = {
3148 .default_host_id = 12,
3149 /* Conservative duration */
3150 .max_rx_timeout_ms = 10000,
3151 /* Limited by MBOX_TX_QUEUE_LEN. K2G can handle upto 128 messages! */
3152 .max_msgs = 20,
Lokesh Vutla5af02db2018-08-27 15:57:32 +05303153 .max_msg_size = 60,
3154};
3155
3156static const struct udevice_id ti_sci_ids[] = {
3157 {
3158 .compatible = "ti,k2g-sci",
Grygorii Strashkod64c5b22019-02-05 17:31:21 +05303159 .data = (ulong)&ti_sci_pmmc_k2g_desc
3160 },
3161 {
3162 .compatible = "ti,am654-sci",
3163 .data = (ulong)&ti_sci_pmmc_am654_desc
Lokesh Vutla5af02db2018-08-27 15:57:32 +05303164 },
3165 { /* Sentinel */ },
3166};
3167
3168U_BOOT_DRIVER(ti_sci) = {
3169 .name = "ti_sci",
3170 .id = UCLASS_FIRMWARE,
3171 .of_match = ti_sci_ids,
3172 .probe = ti_sci_probe,
Simon Glass8a2b47f2020-12-03 16:55:17 -07003173 .priv_auto = sizeof(struct ti_sci_info),
Lokesh Vutla5af02db2018-08-27 15:57:32 +05303174};