2 * Qualcomm ADSP/SLPI Peripheral Image Loader for MSM8974 and MSM8996
4 * Copyright (C) 2016 Linaro Ltd
5 * Copyright (C) 2014 Sony Mobile Communications AB
6 * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 as published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
18 #include <linux/clk.h>
19 #include <linux/firmware.h>
20 #include <linux/interrupt.h>
21 #include <linux/kernel.h>
22 #include <linux/module.h>
23 #include <linux/of_address.h>
24 #include <linux/of_device.h>
25 #include <linux/platform_device.h>
26 #include <linux/qcom_scm.h>
27 #include <linux/regulator/consumer.h>
28 #include <linux/remoteproc.h>
29 #include <linux/soc/qcom/mdt_loader.h>
30 #include <linux/soc/qcom/smem.h>
31 #include <linux/soc/qcom/smem_state.h>
33 #include "qcom_common.h"
34 #include "remoteproc_internal.h"
37 int crash_reason_smem
;
38 const char *firmware_name
;
53 struct qcom_smem_state
*state
;
57 struct clk
*aggre2_clk
;
59 struct regulator
*cx_supply
;
60 struct regulator
*px_supply
;
63 int crash_reason_smem
;
66 struct completion start_done
;
67 struct completion stop_done
;
70 phys_addr_t mem_reloc
;
74 struct qcom_rproc_subdev smd_subdev
;
77 static int adsp_load(struct rproc
*rproc
, const struct firmware
*fw
)
79 struct qcom_adsp
*adsp
= (struct qcom_adsp
*)rproc
->priv
;
81 return qcom_mdt_load(adsp
->dev
, fw
, rproc
->firmware
, adsp
->pas_id
,
82 adsp
->mem_region
, adsp
->mem_phys
, adsp
->mem_size
);
85 static const struct rproc_fw_ops adsp_fw_ops
= {
86 .find_rsc_table
= qcom_mdt_find_rsc_table
,
90 static int adsp_start(struct rproc
*rproc
)
92 struct qcom_adsp
*adsp
= (struct qcom_adsp
*)rproc
->priv
;
95 ret
= clk_prepare_enable(adsp
->xo
);
99 ret
= clk_prepare_enable(adsp
->aggre2_clk
);
103 ret
= regulator_enable(adsp
->cx_supply
);
105 goto disable_aggre2_clk
;
107 ret
= regulator_enable(adsp
->px_supply
);
109 goto disable_cx_supply
;
111 ret
= qcom_scm_pas_auth_and_reset(adsp
->pas_id
);
114 "failed to authenticate image and release reset\n");
115 goto disable_px_supply
;
118 ret
= wait_for_completion_timeout(&adsp
->start_done
,
119 msecs_to_jiffies(5000));
121 dev_err(adsp
->dev
, "start timed out\n");
122 qcom_scm_pas_shutdown(adsp
->pas_id
);
124 goto disable_px_supply
;
130 regulator_disable(adsp
->px_supply
);
132 regulator_disable(adsp
->cx_supply
);
134 clk_disable_unprepare(adsp
->aggre2_clk
);
136 clk_disable_unprepare(adsp
->xo
);
141 static int adsp_stop(struct rproc
*rproc
)
143 struct qcom_adsp
*adsp
= (struct qcom_adsp
*)rproc
->priv
;
146 qcom_smem_state_update_bits(adsp
->state
,
148 BIT(adsp
->stop_bit
));
150 ret
= wait_for_completion_timeout(&adsp
->stop_done
,
151 msecs_to_jiffies(5000));
153 dev_err(adsp
->dev
, "timed out on wait\n");
155 qcom_smem_state_update_bits(adsp
->state
,
159 ret
= qcom_scm_pas_shutdown(adsp
->pas_id
);
161 dev_err(adsp
->dev
, "failed to shutdown: %d\n", ret
);
166 static void *adsp_da_to_va(struct rproc
*rproc
, u64 da
, int len
)
168 struct qcom_adsp
*adsp
= (struct qcom_adsp
*)rproc
->priv
;
171 offset
= da
- adsp
->mem_reloc
;
172 if (offset
< 0 || offset
+ len
> adsp
->mem_size
)
175 return adsp
->mem_region
+ offset
;
178 static const struct rproc_ops adsp_ops
= {
181 .da_to_va
= adsp_da_to_va
,
184 static irqreturn_t
adsp_wdog_interrupt(int irq
, void *dev
)
186 struct qcom_adsp
*adsp
= dev
;
188 rproc_report_crash(adsp
->rproc
, RPROC_WATCHDOG
);
193 static irqreturn_t
adsp_fatal_interrupt(int irq
, void *dev
)
195 struct qcom_adsp
*adsp
= dev
;
199 msg
= qcom_smem_get(QCOM_SMEM_HOST_ANY
, adsp
->crash_reason_smem
, &len
);
200 if (!IS_ERR(msg
) && len
> 0 && msg
[0])
201 dev_err(adsp
->dev
, "fatal error received: %s\n", msg
);
203 rproc_report_crash(adsp
->rproc
, RPROC_FATAL_ERROR
);
211 static irqreturn_t
adsp_ready_interrupt(int irq
, void *dev
)
216 static irqreturn_t
adsp_handover_interrupt(int irq
, void *dev
)
218 struct qcom_adsp
*adsp
= dev
;
220 complete(&adsp
->start_done
);
225 static irqreturn_t
adsp_stop_ack_interrupt(int irq
, void *dev
)
227 struct qcom_adsp
*adsp
= dev
;
229 complete(&adsp
->stop_done
);
234 static int adsp_init_clock(struct qcom_adsp
*adsp
)
238 adsp
->xo
= devm_clk_get(adsp
->dev
, "xo");
239 if (IS_ERR(adsp
->xo
)) {
240 ret
= PTR_ERR(adsp
->xo
);
241 if (ret
!= -EPROBE_DEFER
)
242 dev_err(adsp
->dev
, "failed to get xo clock");
246 if (adsp
->has_aggre2_clk
) {
247 adsp
->aggre2_clk
= devm_clk_get(adsp
->dev
, "aggre2");
248 if (IS_ERR(adsp
->aggre2_clk
)) {
249 ret
= PTR_ERR(adsp
->aggre2_clk
);
250 if (ret
!= -EPROBE_DEFER
)
252 "failed to get aggre2 clock");
260 static int adsp_init_regulator(struct qcom_adsp
*adsp
)
262 adsp
->cx_supply
= devm_regulator_get(adsp
->dev
, "cx");
263 if (IS_ERR(adsp
->cx_supply
))
264 return PTR_ERR(adsp
->cx_supply
);
266 regulator_set_load(adsp
->cx_supply
, 100000);
268 adsp
->px_supply
= devm_regulator_get(adsp
->dev
, "px");
269 if (IS_ERR(adsp
->px_supply
))
270 return PTR_ERR(adsp
->px_supply
);
275 static int adsp_request_irq(struct qcom_adsp
*adsp
,
276 struct platform_device
*pdev
,
278 irq_handler_t thread_fn
)
282 ret
= platform_get_irq_byname(pdev
, name
);
284 dev_err(&pdev
->dev
, "no %s IRQ defined\n", name
);
288 ret
= devm_request_threaded_irq(&pdev
->dev
, ret
,
293 dev_err(&pdev
->dev
, "request %s IRQ failed\n", name
);
298 static int adsp_alloc_memory_region(struct qcom_adsp
*adsp
)
300 struct device_node
*node
;
304 node
= of_parse_phandle(adsp
->dev
->of_node
, "memory-region", 0);
306 dev_err(adsp
->dev
, "no memory-region specified\n");
310 ret
= of_address_to_resource(node
, 0, &r
);
314 adsp
->mem_phys
= adsp
->mem_reloc
= r
.start
;
315 adsp
->mem_size
= resource_size(&r
);
316 adsp
->mem_region
= devm_ioremap_wc(adsp
->dev
, adsp
->mem_phys
, adsp
->mem_size
);
317 if (!adsp
->mem_region
) {
318 dev_err(adsp
->dev
, "unable to map memory region: %pa+%zx\n",
319 &r
.start
, adsp
->mem_size
);
326 static int adsp_probe(struct platform_device
*pdev
)
328 const struct adsp_data
*desc
;
329 struct qcom_adsp
*adsp
;
333 desc
= of_device_get_match_data(&pdev
->dev
);
337 if (!qcom_scm_is_available())
338 return -EPROBE_DEFER
;
340 rproc
= rproc_alloc(&pdev
->dev
, pdev
->name
, &adsp_ops
,
341 desc
->firmware_name
, sizeof(*adsp
));
343 dev_err(&pdev
->dev
, "unable to allocate remoteproc\n");
347 rproc
->fw_ops
= &adsp_fw_ops
;
349 adsp
= (struct qcom_adsp
*)rproc
->priv
;
350 adsp
->dev
= &pdev
->dev
;
352 adsp
->pas_id
= desc
->pas_id
;
353 adsp
->crash_reason_smem
= desc
->crash_reason_smem
;
354 adsp
->has_aggre2_clk
= desc
->has_aggre2_clk
;
355 platform_set_drvdata(pdev
, adsp
);
357 init_completion(&adsp
->start_done
);
358 init_completion(&adsp
->stop_done
);
360 ret
= adsp_alloc_memory_region(adsp
);
364 ret
= adsp_init_clock(adsp
);
368 ret
= adsp_init_regulator(adsp
);
372 ret
= adsp_request_irq(adsp
, pdev
, "wdog", adsp_wdog_interrupt
);
375 adsp
->wdog_irq
= ret
;
377 ret
= adsp_request_irq(adsp
, pdev
, "fatal", adsp_fatal_interrupt
);
380 adsp
->fatal_irq
= ret
;
382 ret
= adsp_request_irq(adsp
, pdev
, "ready", adsp_ready_interrupt
);
385 adsp
->ready_irq
= ret
;
387 ret
= adsp_request_irq(adsp
, pdev
, "handover", adsp_handover_interrupt
);
390 adsp
->handover_irq
= ret
;
392 ret
= adsp_request_irq(adsp
, pdev
, "stop-ack", adsp_stop_ack_interrupt
);
395 adsp
->stop_ack_irq
= ret
;
397 adsp
->state
= qcom_smem_state_get(&pdev
->dev
, "stop",
399 if (IS_ERR(adsp
->state
)) {
400 ret
= PTR_ERR(adsp
->state
);
404 qcom_add_smd_subdev(rproc
, &adsp
->smd_subdev
);
406 ret
= rproc_add(rproc
);
418 static int adsp_remove(struct platform_device
*pdev
)
420 struct qcom_adsp
*adsp
= platform_get_drvdata(pdev
);
422 qcom_smem_state_put(adsp
->state
);
423 rproc_del(adsp
->rproc
);
425 qcom_remove_smd_subdev(adsp
->rproc
, &adsp
->smd_subdev
);
426 rproc_free(adsp
->rproc
);
431 static const struct adsp_data adsp_resource_init
= {
432 .crash_reason_smem
= 423,
433 .firmware_name
= "adsp.mdt",
435 .has_aggre2_clk
= false,
438 static const struct adsp_data slpi_resource_init
= {
439 .crash_reason_smem
= 424,
440 .firmware_name
= "slpi.mdt",
442 .has_aggre2_clk
= true,
445 static const struct of_device_id adsp_of_match
[] = {
446 { .compatible
= "qcom,msm8974-adsp-pil", .data
= &adsp_resource_init
},
447 { .compatible
= "qcom,msm8996-adsp-pil", .data
= &adsp_resource_init
},
448 { .compatible
= "qcom,msm8996-slpi-pil", .data
= &slpi_resource_init
},
451 MODULE_DEVICE_TABLE(of
, adsp_of_match
);
453 static struct platform_driver adsp_driver
= {
455 .remove
= adsp_remove
,
457 .name
= "qcom_adsp_pil",
458 .of_match_table
= adsp_of_match
,
462 module_platform_driver(adsp_driver
);
463 MODULE_DESCRIPTION("Qualcomm MSM8974/MSM8996 ADSP Peripherial Image Loader");
464 MODULE_LICENSE("GPL v2");