sound/soc/qcom/qdsp6/q6prm.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 // Copyright (c) 2021, Linaro Limited
   3
   4 #include <linux/slab.h>
   5 #include <linux/wait.h>
   6 #include <linux/kernel.h>
   7 #include <linux/module.h>
   8 #include <linux/of.h>
   9 #include <linux/delay.h>
  10 #include <linux/of_platform.h>
  11 #include <linux/jiffies.h>
  12 #include <linux/soc/qcom/apr.h>
  13 #include <dt-bindings/soc/qcom,gpr.h>
  14 #include <dt-bindings/sound/qcom,q6dsp-lpass-ports.h>
  15 #include "q6apm.h"
  16 #include "q6prm.h"
  17 #include "audioreach.h"
  18
  19 struct q6prm {
  20         struct device *dev;
  21         gpr_device_t *gdev;
  22         wait_queue_head_t wait;
  23         struct gpr_ibasic_rsp_result_t result;
  24         struct mutex lock;
  25 };
  26
  27 #define PRM_CMD_REQUEST_HW_RSC          0x0100100F
  28 #define PRM_CMD_RSP_REQUEST_HW_RSC      0x02001002
  29 #define PRM_CMD_RELEASE_HW_RSC          0x01001010
  30 #define PRM_CMD_RSP_RELEASE_HW_RSC      0x02001003
  31 #define PARAM_ID_RSC_HW_CORE            0x08001032
  32 #define PARAM_ID_RSC_LPASS_CORE         0x0800102B
  33 #define PARAM_ID_RSC_AUDIO_HW_CLK       0x0800102C
  34
  35 struct prm_cmd_request_hw_core {
  36         struct apm_module_param_data param_data;
  37         uint32_t hw_clk_id;
  38 } __packed;
  39
  40 struct prm_cmd_request_rsc {
  41         struct apm_module_param_data param_data;
  42         uint32_t num_clk_id;
  43         struct audio_hw_clk_cfg clock_id;
  44 } __packed;
  45
  46 struct prm_cmd_release_rsc {
  47         struct apm_module_param_data param_data;
  48         uint32_t num_clk_id;
  49         struct audio_hw_clk_rel_cfg clock_id;
  50 } __packed;
  51
  52 static int q6prm_send_cmd_sync(struct q6prm *prm, struct gpr_pkt *pkt, uint32_t rsp_opcode)
  53 {
  54         return audioreach_send_cmd_sync(prm->dev, prm->gdev, &prm->result, &prm->lock,
  55                                         NULL, &prm->wait, pkt, rsp_opcode);
  56 }
  57
  58 static int q6prm_set_hw_core_req(struct device *dev, uint32_t hw_block_id, bool enable)
  59 {
  60         struct q6prm *prm = dev_get_drvdata(dev->parent);
  61         struct apm_module_param_data *param_data;
  62         struct prm_cmd_request_hw_core *req;
  63         gpr_device_t *gdev = prm->gdev;
  64         uint32_t opcode, rsp_opcode;
  65         struct gpr_pkt *pkt;
  66         int rc;
  67
  68         if (enable) {
  69                 opcode = PRM_CMD_REQUEST_HW_RSC;
  70                 rsp_opcode = PRM_CMD_RSP_REQUEST_HW_RSC;
  71         } else {
  72                 opcode = PRM_CMD_RELEASE_HW_RSC;
  73                 rsp_opcode = PRM_CMD_RSP_RELEASE_HW_RSC;
  74         }
  75
  76         pkt = audioreach_alloc_cmd_pkt(sizeof(*req), opcode, 0, gdev->svc.id, GPR_PRM_MODULE_IID);
  77         if (IS_ERR(pkt))
  78                 return PTR_ERR(pkt);
  79
  80         req = (void *)pkt + GPR_HDR_SIZE + APM_CMD_HDR_SIZE;
  81
  82         param_data = &req->param_data;
  83
  84         param_data->module_instance_id = GPR_PRM_MODULE_IID;
  85         param_data->error_code = 0;
  86         param_data->param_id = PARAM_ID_RSC_HW_CORE;
  87         param_data->param_size = sizeof(*req) - APM_MODULE_PARAM_DATA_SIZE;
  88
  89         req->hw_clk_id = hw_block_id;
  90
  91         rc = q6prm_send_cmd_sync(prm, pkt, rsp_opcode);
  92
  93         kfree(pkt);
  94
  95         return rc;
  96 }
  97
  98 int q6prm_vote_lpass_core_hw(struct device *dev, uint32_t hw_block_id,
  99                              const char *client_name, uint32_t *client_handle)
 100 {
 101         return q6prm_set_hw_core_req(dev, hw_block_id, true);
 102
 103 }
 104 EXPORT_SYMBOL_GPL(q6prm_vote_lpass_core_hw);
 105
 106 int q6prm_unvote_lpass_core_hw(struct device *dev, uint32_t hw_block_id, uint32_t client_handle)
 107 {
 108         return q6prm_set_hw_core_req(dev, hw_block_id, false);
 109 }
 110 EXPORT_SYMBOL_GPL(q6prm_unvote_lpass_core_hw);
 111
 112 static int q6prm_request_lpass_clock(struct device *dev, int clk_id, int clk_attr, int clk_root,
 113                                      unsigned int freq)
 114 {
 115         struct q6prm *prm = dev_get_drvdata(dev->parent);
 116         struct apm_module_param_data *param_data;
 117         struct prm_cmd_request_rsc *req;
 118         gpr_device_t *gdev = prm->gdev;
 119         struct gpr_pkt *pkt;
 120         int rc;
 121
 122         pkt = audioreach_alloc_cmd_pkt(sizeof(*req), PRM_CMD_REQUEST_HW_RSC, 0, gdev->svc.id,
 123                                        GPR_PRM_MODULE_IID);
 124         if (IS_ERR(pkt))
 125                 return PTR_ERR(pkt);
 126
 127         req = (void *)pkt + GPR_HDR_SIZE + APM_CMD_HDR_SIZE;
 128
 129         param_data = &req->param_data;
 130
 131         param_data->module_instance_id = GPR_PRM_MODULE_IID;
 132         param_data->error_code = 0;
 133         param_data->param_id = PARAM_ID_RSC_AUDIO_HW_CLK;
 134         param_data->param_size = sizeof(*req) - APM_MODULE_PARAM_DATA_SIZE;
 135
 136         req->num_clk_id = 1;
 137         req->clock_id.clock_id = clk_id;
 138         req->clock_id.clock_freq = freq;
 139         req->clock_id.clock_attri = clk_attr;
 140         req->clock_id.clock_root = clk_root;
 141
 142         rc = q6prm_send_cmd_sync(prm, pkt, PRM_CMD_RSP_REQUEST_HW_RSC);
 143
 144         kfree(pkt);
 145
 146         return rc;
 147 }
 148
 149 static int q6prm_release_lpass_clock(struct device *dev, int clk_id, int clk_attr, int clk_root,
 150                           unsigned int freq)
 151 {
 152         struct q6prm *prm = dev_get_drvdata(dev->parent);
 153         struct apm_module_param_data *param_data;
 154         struct prm_cmd_release_rsc *rel;
 155         gpr_device_t *gdev = prm->gdev;
 156         struct gpr_pkt *pkt;
 157         int rc;
 158
 159         pkt = audioreach_alloc_cmd_pkt(sizeof(*rel), PRM_CMD_RELEASE_HW_RSC, 0, gdev->svc.id,
 160                                        GPR_PRM_MODULE_IID);
 161         if (IS_ERR(pkt))
 162                 return PTR_ERR(pkt);
 163
 164         rel = (void *)pkt + GPR_HDR_SIZE + APM_CMD_HDR_SIZE;
 165
 166         param_data = &rel->param_data;
 167
 168         param_data->module_instance_id = GPR_PRM_MODULE_IID;
 169         param_data->error_code = 0;
 170         param_data->param_id = PARAM_ID_RSC_AUDIO_HW_CLK;
 171         param_data->param_size = sizeof(*rel) - APM_MODULE_PARAM_DATA_SIZE;
 172
 173         rel->num_clk_id = 1;
 174         rel->clock_id.clock_id = clk_id;
 175
 176         rc = q6prm_send_cmd_sync(prm, pkt, PRM_CMD_RSP_RELEASE_HW_RSC);
 177
 178         kfree(pkt);
 179
 180         return rc;
 181 }
 182
 183 int q6prm_set_lpass_clock(struct device *dev, int clk_id, int clk_attr, int clk_root,
 184                           unsigned int freq)
 185 {
 186         if (freq)
 187                 return q6prm_request_lpass_clock(dev, clk_id, clk_attr, clk_root, freq);
 188
 189         return q6prm_release_lpass_clock(dev, clk_id, clk_attr, clk_root, freq);
 190 }
 191 EXPORT_SYMBOL_GPL(q6prm_set_lpass_clock);
 192
 193 static int prm_callback(struct gpr_resp_pkt *data, void *priv, int op)
 194 {
 195         gpr_device_t *gdev = priv;
 196         struct q6prm *prm = dev_get_drvdata(&gdev->dev);
 197         struct gpr_ibasic_rsp_result_t *result;
 198         struct gpr_hdr *hdr = &data->hdr;
 199
 200         switch (hdr->opcode) {
 201         case PRM_CMD_RSP_REQUEST_HW_RSC:
 202         case PRM_CMD_RSP_RELEASE_HW_RSC:
 203                 result = data->payload;
 204                 prm->result.opcode = hdr->opcode;
 205                 prm->result.status = result->status;
 206                 wake_up(&prm->wait);
 207                 break;
 208         default:
 209                 break;
 210         }
 211
 212         return 0;
 213 }
 214
 215 static int prm_probe(gpr_device_t *gdev)
 216 {
 217         struct device *dev = &gdev->dev;
 218         struct q6prm *cc;
 219
 220         cc = devm_kzalloc(dev, sizeof(*cc), GFP_KERNEL);
 221         if (!cc)
 222                 return -ENOMEM;
 223
 224         cc->dev = dev;
 225         cc->gdev = gdev;
 226         mutex_init(&cc->lock);
 227         init_waitqueue_head(&cc->wait);
 228         dev_set_drvdata(dev, cc);
 229
 230         if (!q6apm_is_adsp_ready())
 231                 return -EPROBE_DEFER;
 232
 233         return devm_of_platform_populate(dev);
 234 }
 235
 236 #ifdef CONFIG_OF
 237 static const struct of_device_id prm_device_id[]  = {
 238         { .compatible = "qcom,q6prm" },
 239         {},
 240 };
 241 MODULE_DEVICE_TABLE(of, prm_device_id);
 242 #endif
 243
 244 static gpr_driver_t prm_driver = {
 245         .probe = prm_probe,
 246         .gpr_callback = prm_callback,
 247         .driver = {
 248                 .name = "qcom-prm",
 249                 .of_match_table = of_match_ptr(prm_device_id),
 250         },
 251 };
 252
 253 module_gpr_driver(prm_driver);
 254 MODULE_DESCRIPTION("Q6 Proxy Resource Manager");
 255 MODULE_LICENSE("GPL");