123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright (c) 2020, The Linux Foundation. All rights reserved.
- */
- #include <linux/interconnect.h>
- #include <linux/interconnect-provider.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/slab.h>
- #include "bcm-voter.h"
- #include "icc-rpmh.h"
- /**
- * qcom_icc_pre_aggregate - cleans up stale values from prior icc_set
- * @node: icc node to operate on
- */
- void qcom_icc_pre_aggregate(struct icc_node *node)
- {
- size_t i;
- struct qcom_icc_node *qn;
- qn = node->data;
- for (i = 0; i < QCOM_ICC_NUM_BUCKETS; i++) {
- qn->sum_avg[i] = 0;
- qn->max_peak[i] = 0;
- }
- }
- EXPORT_SYMBOL_GPL(qcom_icc_pre_aggregate);
- /**
- * qcom_icc_aggregate - aggregate bw for buckets indicated by tag
- * @node: node to aggregate
- * @tag: tag to indicate which buckets to aggregate
- * @avg_bw: new bw to sum aggregate
- * @peak_bw: new bw to max aggregate
- * @agg_avg: existing aggregate avg bw val
- * @agg_peak: existing aggregate peak bw val
- */
- int qcom_icc_aggregate(struct icc_node *node, u32 tag, u32 avg_bw,
- u32 peak_bw, u32 *agg_avg, u32 *agg_peak)
- {
- size_t i;
- struct qcom_icc_node *qn;
- struct qcom_icc_provider *qp;
- qn = node->data;
- qp = to_qcom_provider(node->provider);
- if (!tag)
- tag = QCOM_ICC_TAG_ALWAYS;
- for (i = 0; i < QCOM_ICC_NUM_BUCKETS; i++) {
- if (tag & BIT(i)) {
- qn->sum_avg[i] += avg_bw;
- qn->max_peak[i] = max_t(u32, qn->max_peak[i], peak_bw);
- }
- if (node->init_avg || node->init_peak) {
- qn->sum_avg[i] = max_t(u64, qn->sum_avg[i], node->init_avg);
- qn->max_peak[i] = max_t(u64, qn->max_peak[i], node->init_peak);
- }
- }
- *agg_avg += avg_bw;
- *agg_peak = max_t(u32, *agg_peak, peak_bw);
- for (i = 0; i < qn->num_bcms; i++)
- qcom_icc_bcm_voter_add(qp->voter, qn->bcms[i]);
- return 0;
- }
- EXPORT_SYMBOL_GPL(qcom_icc_aggregate);
- /**
- * qcom_icc_set - set the constraints based on path
- * @src: source node for the path to set constraints on
- * @dst: destination node for the path to set constraints on
- *
- * Return: 0 on success, or an error code otherwise
- */
- int qcom_icc_set(struct icc_node *src, struct icc_node *dst)
- {
- struct qcom_icc_provider *qp;
- struct icc_node *node;
- if (!src)
- node = dst;
- else
- node = src;
- qp = to_qcom_provider(node->provider);
- qcom_icc_bcm_voter_commit(qp->voter);
- return 0;
- }
- EXPORT_SYMBOL_GPL(qcom_icc_set);
- struct icc_node_data *qcom_icc_xlate_extended(struct of_phandle_args *spec, void *data)
- {
- struct icc_node_data *ndata;
- struct icc_node *node;
- node = of_icc_xlate_onecell(spec, data);
- if (IS_ERR(node))
- return ERR_CAST(node);
- ndata = kzalloc(sizeof(*ndata), GFP_KERNEL);
- if (!ndata)
- return ERR_PTR(-ENOMEM);
- ndata->node = node;
- if (spec->args_count == 2)
- ndata->tag = spec->args[1];
- if (spec->args_count > 2)
- pr_warn("%pOF: Too many arguments, path tag is not parsed\n", spec->np);
- return ndata;
- }
- EXPORT_SYMBOL_GPL(qcom_icc_xlate_extended);
- /**
- * qcom_icc_bcm_init - populates bcm aux data and connect qnodes
- * @bcm: bcm to be initialized
- * @dev: associated provider device
- *
- * Return: 0 on success, or an error code otherwise
- */
- int qcom_icc_bcm_init(struct qcom_icc_bcm *bcm, struct device *dev)
- {
- struct qcom_icc_node *qn;
- const struct bcm_db *data;
- size_t data_count;
- int i;
- /* BCM is already initialised*/
- if (bcm->addr)
- return 0;
- bcm->addr = cmd_db_read_addr(bcm->name);
- if (!bcm->addr) {
- dev_err(dev, "%s could not find RPMh address\n",
- bcm->name);
- return -EINVAL;
- }
- data = cmd_db_read_aux_data(bcm->name, &data_count);
- if (IS_ERR(data)) {
- dev_err(dev, "%s command db read error (%ld)\n",
- bcm->name, PTR_ERR(data));
- return PTR_ERR(data);
- }
- if (!data_count) {
- dev_err(dev, "%s command db missing or partial aux data\n",
- bcm->name);
- return -EINVAL;
- }
- bcm->aux_data.unit = le32_to_cpu(data->unit);
- bcm->aux_data.width = le16_to_cpu(data->width);
- bcm->aux_data.vcd = data->vcd;
- bcm->aux_data.reserved = data->reserved;
- INIT_LIST_HEAD(&bcm->list);
- INIT_LIST_HEAD(&bcm->ws_list);
- if (!bcm->vote_scale)
- bcm->vote_scale = 1000;
- /* Link Qnodes to their respective BCMs */
- for (i = 0; i < bcm->num_nodes; i++) {
- qn = bcm->nodes[i];
- qn->bcms[qn->num_bcms] = bcm;
- qn->num_bcms++;
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(qcom_icc_bcm_init);
- MODULE_LICENSE("GPL v2");
|