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