Lines Matching +full:tcs +full:- +full:wait
1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
23 #include <linux/wait.h>
25 #include <soc/qcom/cmd-db.h>
26 #include <soc/qcom/tcs.h>
27 #include <dt-bindings/soc/qcom,rpmh-rsc.h>
29 #include "rpmh-internal.h"
32 #include "trace-rpmh.h"
42 /* DRV TCS Configuration Information Register */
49 /* Offsets for common TCS Registers, one bit per TCS */
55 * Offsets for per TCS Registers.
58 * Multiply tcs_id by RSC_DRV_TCS_OFFSET to find a given TCS and add one
63 #define RSC_DRV_STATUS 0x18 /* zero if tcs is busy */
67 * Offsets for per command in a TCS.
69 * Commands (up to 16) start at 0x30 in a TCS; multiply command index
81 /* TCS CMD register bit mask */
92 * - The main rpmh-rsc address is the base of a register space that can
94 * (DRV_PRNT_CHLD_CONFIG). Also found within the rpmh-rsc register
95 * space are all the TCS blocks. The offset of the TCS blocks is
96 * specified in the device tree by "qcom,tcs-offset" and used to
98 * - TCS blocks come one after another. Type, count, and order are
99 * specified by the device tree as "qcom,tcs-config".
100 * - Each TCS block has some registers, then space for up to 16 commands.
102 * might be present. See ncpt (num cmds per TCS).
106 * +---------------------------------------------------+
111 * | +-----------------------------------------------+ |
117 * | | +------------------------------------------+ | |
121 * | | +------------------------------------------+ | |
122 * | | +------------------------------------------+ | |
126 * | | +------------------------------------------+ | |
127 * | | +------------------------------------------+ | |
131 * | | +------------------------------------------+ | |
133 * | +-----------------------------------------------+ |
134 * | +-----------------------------------------------+ |
137 * | +-----------------------------------------------+ |
139 * +---------------------------------------------------+
145 return drv->tcs_base + RSC_DRV_TCS_OFFSET * tcs_id + reg; in tcs_reg_addr()
185 * Wait until we read back the same value. Use a counter rather than in write_tcs_reg_sync()
193 pr_err("%s: error writing %#x to %d:%#x\n", drv->name, in write_tcs_reg_sync()
198 * tcs_is_free() - Return if a TCS is totally free.
200 * @tcs_id: The global ID of this TCS.
202 * Returns true if nobody has claimed this TCS (by setting tcs_in_use).
204 * Context: Must be called with the drv->lock held.
206 * Return: true if the given TCS is free.
210 return !test_bit(tcs_id, drv->tcs_in_use); in tcs_is_free()
214 * tcs_invalidate() - Invalidate all TCSes of the given type (sleep or wake).
228 struct tcs_group *tcs = &drv->tcs[type]; in tcs_invalidate() local
231 if (bitmap_empty(tcs->slots, MAX_TCS_SLOTS)) in tcs_invalidate()
234 for (m = tcs->offset; m < tcs->offset + tcs->num_tcs; m++) { in tcs_invalidate()
238 bitmap_zero(tcs->slots, MAX_TCS_SLOTS); in tcs_invalidate()
242 * rpmh_rsc_invalidate() - Invalidate sleep and wake TCSes.
256 * get_tcs_for_msg() - Get the tcs_group used to send the given message.
269 struct tcs_group *tcs; in get_tcs_for_msg() local
271 switch (msg->state) { in get_tcs_for_msg()
282 return ERR_PTR(-EINVAL); in get_tcs_for_msg()
287 * dedicated TCS for active state use, then re-purpose a wake TCS to in get_tcs_for_msg()
288 * send active votes. This is safe because we ensure any active-only in get_tcs_for_msg()
292 tcs = &drv->tcs[type]; in get_tcs_for_msg()
293 if (msg->state == RPMH_ACTIVE_ONLY_STATE && !tcs->num_tcs) in get_tcs_for_msg()
294 tcs = &drv->tcs[WAKE_TCS]; in get_tcs_for_msg()
296 return tcs; in get_tcs_for_msg()
300 * get_req_from_tcs() - Get a stashed request that was xfering on the given TCS.
302 * @tcs_id: The global ID of this TCS.
318 struct tcs_group *tcs; in get_req_from_tcs() local
322 tcs = &drv->tcs[i]; in get_req_from_tcs()
323 if (tcs->mask & BIT(tcs_id)) in get_req_from_tcs()
324 return tcs->req[tcs_id - tcs->offset]; in get_req_from_tcs()
331 * __tcs_set_trigger() - Start xfer on a TCS or unset trigger on a borrowed TCS
333 * @tcs_id: The global ID of this TCS.
337 * transfer. That will un-trigger/disable the TCS from the last transfer
340 * If we borrowed a wake TCS for an active-only transfer we'll also call
341 * this function with "trigger=false" to just do the un-trigger/disable
342 * before using the TCS for wake purposes again.
344 * Note that the AP is only in charge of triggering active-only transfers.
352 * HW req: Clear the DRV_CONTROL and enable TCS again in __tcs_set_trigger()
363 /* Enable the AMC mode on the TCS and then trigger the TCS */ in __tcs_set_trigger()
372 * enable_tcs_irq() - Enable or disable interrupts on the given TCS.
374 * @tcs_id: The global ID of this TCS.
377 * We only ever call this when we borrow a wake TCS for an active-only
378 * transfer. For active-only TCSes interrupts are always left enabled.
384 data = readl_relaxed(drv->tcs_base + RSC_DRV_IRQ_ENABLE); in enable_tcs_irq()
389 writel_relaxed(data, drv->tcs_base + RSC_DRV_IRQ_ENABLE); in enable_tcs_irq()
393 * tcs_tx_done() - TX Done interrupt handler.
410 irq_status = readl_relaxed(drv->tcs_base + RSC_DRV_IRQ_STATUS); in tcs_tx_done()
420 for (j = 0; j < req->num_cmds; j++) { in tcs_tx_done()
423 cmd = &req->cmds[j]; in tcs_tx_done()
426 ((req->wait_for_compl || cmd->wait) && in tcs_tx_done()
429 drv->name, cmd->addr, cmd->data); in tcs_tx_done()
430 err = -EIO; in tcs_tx_done()
437 * If wake tcs was re-purposed for sending active in tcs_tx_done()
439 * disable interrupt for this TCS in tcs_tx_done()
441 if (!drv->tcs[ACTIVE_TCS].num_tcs) in tcs_tx_done()
444 /* Reclaim the TCS */ in tcs_tx_done()
447 writel_relaxed(BIT(i), drv->tcs_base + RSC_DRV_IRQ_CLEAR); in tcs_tx_done()
448 spin_lock(&drv->lock); in tcs_tx_done()
449 clear_bit(i, drv->tcs_in_use); in tcs_tx_done()
451 * Disable interrupt for WAKE TCS to avoid being in tcs_tx_done()
455 if (!drv->tcs[ACTIVE_TCS].num_tcs) in tcs_tx_done()
457 spin_unlock(&drv->lock); in tcs_tx_done()
458 wake_up(&drv->tcs_wait); in tcs_tx_done()
467 * __tcs_buffer_write() - Write to TCS hardware from a request; don't trigger.
469 * @tcs_id: The global ID of this TCS.
470 * @cmd_id: The index within the TCS to start writing.
472 * pairs to program (but few enough that they all fit in one TCS).
486 cmd_msgid |= msg->wait_for_compl ? CMD_MSGID_RESP_REQ : 0; in __tcs_buffer_write()
491 for (i = 0, j = cmd_id; i < msg->num_cmds; i++, j++) { in __tcs_buffer_write()
492 cmd = &msg->cmds[i]; in __tcs_buffer_write()
494 cmd_complete |= cmd->wait << j; in __tcs_buffer_write()
496 msgid |= cmd->wait ? CMD_MSGID_RESP_REQ : 0; in __tcs_buffer_write()
499 write_tcs_cmd(drv, RSC_DRV_CMD_ADDR, tcs_id, j, cmd->addr); in __tcs_buffer_write()
500 write_tcs_cmd(drv, RSC_DRV_CMD_DATA, tcs_id, j, cmd->data); in __tcs_buffer_write()
510 * check_for_req_inflight() - Look to see if conflicting cmds are in flight.
512 * @tcs: A pointer to the tcs_group used for ACTIVE_ONLY transfers.
514 * pairs to program (but few enough that they all fit in one TCS).
518 * one it'll return -EBUSY.
520 * Only for use for active-only transfers.
522 * Must be called with the drv->lock held since that protects tcs_in_use.
524 * Return: 0 if nothing in flight or -EBUSY if we should try again later.
525 * The caller must re-enable interrupts between tries since that's
529 static int check_for_req_inflight(struct rsc_drv *drv, struct tcs_group *tcs, in check_for_req_inflight() argument
535 int tcs_id = tcs->offset; in check_for_req_inflight()
537 for (i = 0; i < tcs->num_tcs; i++, tcs_id++) { in check_for_req_inflight()
545 for (k = 0; k < msg->num_cmds; k++) { in check_for_req_inflight()
546 if (addr == msg->cmds[k].addr) in check_for_req_inflight()
547 return -EBUSY; in check_for_req_inflight()
556 * find_free_tcs() - Find free tcs in the given tcs_group; only for active.
557 * @tcs: A pointer to the active-only tcs_group (or the wake tcs_group if
558 * we borrowed it because there are zero active-only ones).
560 * Must be called with the drv->lock held since that protects tcs_in_use.
562 * Return: The first tcs that's free.
564 static int find_free_tcs(struct tcs_group *tcs) in find_free_tcs() argument
568 for (i = 0; i < tcs->num_tcs; i++) { in find_free_tcs()
569 if (tcs_is_free(tcs->drv, tcs->offset + i)) in find_free_tcs()
570 return tcs->offset + i; in find_free_tcs()
573 return -EBUSY; in find_free_tcs()
577 * claim_tcs_for_req() - Claim a tcs in the given tcs_group; only for active.
579 * @tcs: The tcs_group used for ACTIVE_ONLY transfers.
582 * Claims a tcs in the given tcs_group while making sure that no existing cmd
585 * Context: Must be called with the drv->lock held since that protects
588 * Return: The id of the claimed tcs or -EBUSY if a matching msg is in flight
591 static int claim_tcs_for_req(struct rsc_drv *drv, struct tcs_group *tcs, in claim_tcs_for_req() argument
598 * when one is already in-flight or being processed. in claim_tcs_for_req()
600 ret = check_for_req_inflight(drv, tcs, msg); in claim_tcs_for_req()
604 return find_free_tcs(tcs); in claim_tcs_for_req()
608 * rpmh_rsc_send_data() - Write / trigger active-only message.
613 * - This is only used for "ACTIVE_ONLY" since the limitations of this
615 * - To do the transfer, we will grab a whole TCS for ourselves--we don't
616 * try to share. If there are none available we'll wait indefinitely
618 * - This function will not wait for the commands to be finished, only for
621 * - This function must be called with interrupts enabled. If the hardware
627 * Return: 0 on success, -EINVAL on error.
631 struct tcs_group *tcs; in rpmh_rsc_send_data() local
635 tcs = get_tcs_for_msg(drv, msg); in rpmh_rsc_send_data()
636 if (IS_ERR(tcs)) in rpmh_rsc_send_data()
637 return PTR_ERR(tcs); in rpmh_rsc_send_data()
639 spin_lock_irqsave(&drv->lock, flags); in rpmh_rsc_send_data()
641 /* Wait forever for a free tcs. It better be there eventually! */ in rpmh_rsc_send_data()
642 wait_event_lock_irq(drv->tcs_wait, in rpmh_rsc_send_data()
643 (tcs_id = claim_tcs_for_req(drv, tcs, msg)) >= 0, in rpmh_rsc_send_data()
644 drv->lock); in rpmh_rsc_send_data()
646 tcs->req[tcs_id - tcs->offset] = msg; in rpmh_rsc_send_data()
647 set_bit(tcs_id, drv->tcs_in_use); in rpmh_rsc_send_data()
648 if (msg->state == RPMH_ACTIVE_ONLY_STATE && tcs->type != ACTIVE_TCS) { in rpmh_rsc_send_data()
651 * repurposed TCS to avoid triggering them. tcs->slots will be in rpmh_rsc_send_data()
658 spin_unlock_irqrestore(&drv->lock, flags); in rpmh_rsc_send_data()
662 * - We marked "tcs_in_use" under lock. in rpmh_rsc_send_data()
663 * - Once "tcs_in_use" has been marked nobody else could be writing in rpmh_rsc_send_data()
665 * - The interrupt can't go off until we trigger w/ the last line in rpmh_rsc_send_data()
675 * find_slots() - Find a place to write the given message.
676 * @tcs: The tcs group to search.
679 * TCS to write to here.
681 * the command array of the returned TCS where the client should
685 * tcs->slots for.
687 * Return: -ENOMEM if there was no room, else 0.
689 static int find_slots(struct tcs_group *tcs, const struct tcs_request *msg, in find_slots() argument
695 /* Do over, until we can fit the full payload in a single TCS */ in find_slots()
697 slot = bitmap_find_next_zero_area(tcs->slots, MAX_TCS_SLOTS, in find_slots()
698 i, msg->num_cmds, 0); in find_slots()
699 if (slot >= tcs->num_tcs * tcs->ncpt) in find_slots()
700 return -ENOMEM; in find_slots()
701 i += tcs->ncpt; in find_slots()
702 } while (slot + msg->num_cmds - 1 >= i); in find_slots()
704 bitmap_set(tcs->slots, slot, msg->num_cmds); in find_slots()
706 offset = slot / tcs->ncpt; in find_slots()
707 *tcs_id = offset + tcs->offset; in find_slots()
708 *cmd_id = slot % tcs->ncpt; in find_slots()
714 * rpmh_rsc_write_ctrl_data() - Write request to controller but don't trigger.
718 * This should only be called for for sleep/wake state, never active-only
724 * Return: 0 if no error; else -error.
728 struct tcs_group *tcs; in rpmh_rsc_write_ctrl_data() local
732 tcs = get_tcs_for_msg(drv, msg); in rpmh_rsc_write_ctrl_data()
733 if (IS_ERR(tcs)) in rpmh_rsc_write_ctrl_data()
734 return PTR_ERR(tcs); in rpmh_rsc_write_ctrl_data()
736 /* find the TCS id and the command in the TCS to write to */ in rpmh_rsc_write_ctrl_data()
737 ret = find_slots(tcs, msg, &tcs_id, &cmd_id); in rpmh_rsc_write_ctrl_data()
745 * rpmh_rsc_ctrlr_is_busy() - Check if any of the AMCs are busy.
753 * Context: Must be called with the drv->lock held.
756 * * False - AMCs are idle
757 * * True - AMCs are busy
762 struct tcs_group *tcs = &drv->tcs[ACTIVE_TCS]; in rpmh_rsc_ctrlr_is_busy() local
766 * dedicated TCS for active state use, then re-purposed wake TCSes in rpmh_rsc_ctrlr_is_busy()
770 if (!tcs->num_tcs) in rpmh_rsc_ctrlr_is_busy()
771 tcs = &drv->tcs[WAKE_TCS]; in rpmh_rsc_ctrlr_is_busy()
773 for (m = tcs->offset; m < tcs->offset + tcs->num_tcs; m++) { in rpmh_rsc_ctrlr_is_busy()
782 * rpmh_rsc_cpu_pm_callback() - Check if any of the AMCs are busy.
807 cpus_in_pm = atomic_inc_return(&drv->cpus_in_pm); in rpmh_rsc_cpu_pm_callback()
814 * AND that CPU was not idle AND that CPU was the last non-idle in rpmh_rsc_cpu_pm_callback()
823 atomic_dec(&drv->cpus_in_pm); in rpmh_rsc_cpu_pm_callback()
830 * It's likely we're on the last CPU. Grab the drv->lock and write in rpmh_rsc_cpu_pm_callback()
841 if (spin_trylock(&drv->lock)) { in rpmh_rsc_cpu_pm_callback()
842 if (rpmh_rsc_ctrlr_is_busy(drv) || rpmh_flush(&drv->client)) in rpmh_rsc_cpu_pm_callback()
844 spin_unlock(&drv->lock); in rpmh_rsc_cpu_pm_callback()
851 /* Double-check if we're here because someone else is up */ in rpmh_rsc_cpu_pm_callback()
856 atomic_dec(&drv->cpus_in_pm); in rpmh_rsc_cpu_pm_callback()
869 struct device_node *dn = pdev->dev.of_node; in rpmh_probe_tcs_config()
872 struct tcs_group *tcs; in rpmh_probe_tcs_config() local
874 ret = of_property_read_u32(dn, "qcom,tcs-offset", &offset); in rpmh_probe_tcs_config()
877 drv->tcs_base = base + offset; in rpmh_probe_tcs_config()
882 max_tcs &= DRV_NUM_TCS_MASK << (DRV_NUM_TCS_SHIFT * drv->id); in rpmh_probe_tcs_config()
883 max_tcs = max_tcs >> (DRV_NUM_TCS_SHIFT * drv->id); in rpmh_probe_tcs_config()
888 n = of_property_count_u32_elems(dn, "qcom,tcs-config"); in rpmh_probe_tcs_config()
890 return -EINVAL; in rpmh_probe_tcs_config()
893 ret = of_property_read_u32_index(dn, "qcom,tcs-config", in rpmh_probe_tcs_config()
898 return -EINVAL; in rpmh_probe_tcs_config()
900 ret = of_property_read_u32_index(dn, "qcom,tcs-config", in rpmh_probe_tcs_config()
905 return -EINVAL; in rpmh_probe_tcs_config()
909 tcs = &drv->tcs[tcs_cfg[i].type]; in rpmh_probe_tcs_config()
910 if (tcs->drv) in rpmh_probe_tcs_config()
911 return -EINVAL; in rpmh_probe_tcs_config()
912 tcs->drv = drv; in rpmh_probe_tcs_config()
913 tcs->type = tcs_cfg[i].type; in rpmh_probe_tcs_config()
914 tcs->num_tcs = tcs_cfg[i].n; in rpmh_probe_tcs_config()
915 tcs->ncpt = ncpt; in rpmh_probe_tcs_config()
917 if (!tcs->num_tcs || tcs->type == CONTROL_TCS) in rpmh_probe_tcs_config()
920 if (st + tcs->num_tcs > max_tcs || in rpmh_probe_tcs_config()
921 st + tcs->num_tcs >= BITS_PER_BYTE * sizeof(tcs->mask)) in rpmh_probe_tcs_config()
922 return -EINVAL; in rpmh_probe_tcs_config()
924 tcs->mask = ((1 << tcs->num_tcs) - 1) << st; in rpmh_probe_tcs_config()
925 tcs->offset = st; in rpmh_probe_tcs_config()
926 st += tcs->num_tcs; in rpmh_probe_tcs_config()
929 drv->num_tcs = st; in rpmh_probe_tcs_config()
936 struct device_node *dn = pdev->dev.of_node; in rpmh_rsc_probe()
945 * Even though RPMh doesn't directly use cmd-db, all of its children in rpmh_rsc_probe()
950 if (ret != -EPROBE_DEFER) in rpmh_rsc_probe()
951 dev_err(&pdev->dev, "Command DB not available (%d)\n", in rpmh_rsc_probe()
956 drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL); in rpmh_rsc_probe()
958 return -ENOMEM; in rpmh_rsc_probe()
960 ret = of_property_read_u32(dn, "qcom,drv-id", &drv->id); in rpmh_rsc_probe()
964 drv->name = of_get_property(dn, "label", NULL); in rpmh_rsc_probe()
965 if (!drv->name) in rpmh_rsc_probe()
966 drv->name = dev_name(&pdev->dev); in rpmh_rsc_probe()
968 snprintf(drv_id, ARRAY_SIZE(drv_id), "drv-%d", drv->id); in rpmh_rsc_probe()
970 base = devm_ioremap_resource(&pdev->dev, res); in rpmh_rsc_probe()
978 spin_lock_init(&drv->lock); in rpmh_rsc_probe()
979 init_waitqueue_head(&drv->tcs_wait); in rpmh_rsc_probe()
980 bitmap_zero(drv->tcs_in_use, MAX_TCS_NR); in rpmh_rsc_probe()
982 irq = platform_get_irq(pdev, drv->id); in rpmh_rsc_probe()
986 ret = devm_request_irq(&pdev->dev, irq, tcs_tx_done, in rpmh_rsc_probe()
988 drv->name, drv); in rpmh_rsc_probe()
1001 drv->rsc_pm.notifier_call = rpmh_rsc_cpu_pm_callback; in rpmh_rsc_probe()
1002 cpu_pm_register_notifier(&drv->rsc_pm); in rpmh_rsc_probe()
1005 /* Enable the active TCS to send requests immediately */ in rpmh_rsc_probe()
1006 writel_relaxed(drv->tcs[ACTIVE_TCS].mask, in rpmh_rsc_probe()
1007 drv->tcs_base + RSC_DRV_IRQ_ENABLE); in rpmh_rsc_probe()
1009 spin_lock_init(&drv->client.cache_lock); in rpmh_rsc_probe()
1010 INIT_LIST_HEAD(&drv->client.cache); in rpmh_rsc_probe()
1011 INIT_LIST_HEAD(&drv->client.batch_cache); in rpmh_rsc_probe()
1013 dev_set_drvdata(&pdev->dev, drv); in rpmh_rsc_probe()
1015 return devm_of_platform_populate(&pdev->dev); in rpmh_rsc_probe()
1019 { .compatible = "qcom,rpmh-rsc", },