cregit-Linux how code gets into the kernel

Release 4.11 drivers/remoteproc/qcom_adsp_pil.c

/*
 * Qualcomm ADSP/SLPI Peripheral Image Loader for MSM8974 and MSM8996
 *
 * Copyright (C) 2016 Linaro Ltd
 * Copyright (C) 2014 Sony Mobile Communications AB
 * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <linux/clk.h>
#include <linux/firmware.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/of_address.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/qcom_scm.h>
#include <linux/regulator/consumer.h>
#include <linux/remoteproc.h>
#include <linux/soc/qcom/mdt_loader.h>
#include <linux/soc/qcom/smem.h>
#include <linux/soc/qcom/smem_state.h>

#include "qcom_common.h"
#include "remoteproc_internal.h"


struct adsp_data {
	
int crash_reason_smem;
	
const char *firmware_name;
	
int pas_id;
	
bool has_aggre2_clk;
};


struct qcom_adsp {
	
struct device *dev;
	
struct rproc *rproc;

	
int wdog_irq;
	
int fatal_irq;
	
int ready_irq;
	
int handover_irq;
	
int stop_ack_irq;

	
struct qcom_smem_state *state;
	
unsigned stop_bit;

	
struct clk *xo;
	
struct clk *aggre2_clk;

	
struct regulator *cx_supply;
	
struct regulator *px_supply;

	
int pas_id;
	
int crash_reason_smem;
	
bool has_aggre2_clk;

	
struct completion start_done;
	
struct completion stop_done;

	
phys_addr_t mem_phys;
	
phys_addr_t mem_reloc;
	
void *mem_region;
	
size_t mem_size;

	
struct qcom_rproc_subdev smd_subdev;
};


static int adsp_load(struct rproc *rproc, const struct firmware *fw) { struct qcom_adsp *adsp = (struct qcom_adsp *)rproc->priv; return qcom_mdt_load(adsp->dev, fw, rproc->firmware, adsp->pas_id, adsp->mem_region, adsp->mem_phys, adsp->mem_size); }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson5691.80%266.67%
Avaneesh Kumar Dwivedi58.20%133.33%
Total61100.00%3100.00%

static const struct rproc_fw_ops adsp_fw_ops = { .find_rsc_table = qcom_mdt_find_rsc_table, .load = adsp_load, };
static int adsp_start(struct rproc *rproc) { struct qcom_adsp *adsp = (struct qcom_adsp *)rproc->priv; int ret; ret = clk_prepare_enable(adsp->xo); if (ret) return ret; ret = clk_prepare_enable(adsp->aggre2_clk); if (ret) goto disable_xo_clk; ret = regulator_enable(adsp->cx_supply); if (ret) goto disable_aggre2_clk; ret = regulator_enable(adsp->px_supply); if (ret) goto disable_cx_supply; ret = qcom_scm_pas_auth_and_reset(adsp->pas_id); if (ret) { dev_err(adsp->dev, "failed to authenticate image and release reset\n"); goto disable_px_supply; } ret = wait_for_completion_timeout(&adsp->start_done, msecs_to_jiffies(5000)); if (!ret) { dev_err(adsp->dev, "start timed out\n"); qcom_scm_pas_shutdown(adsp->pas_id); ret = -ETIMEDOUT; goto disable_px_supply; } ret = 0; disable_px_supply: regulator_disable(adsp->px_supply); disable_cx_supply: regulator_disable(adsp->cx_supply); disable_aggre2_clk: clk_disable_unprepare(adsp->aggre2_clk); disable_xo_clk: clk_disable_unprepare(adsp->xo); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson12258.65%125.00%
Avaneesh Kumar Dwivedi6129.33%250.00%
Sarangdhar Joshi2512.02%125.00%
Total208100.00%4100.00%


static int adsp_stop(struct rproc *rproc) { struct qcom_adsp *adsp = (struct qcom_adsp *)rproc->priv; int ret; qcom_smem_state_update_bits(adsp->state, BIT(adsp->stop_bit), BIT(adsp->stop_bit)); ret = wait_for_completion_timeout(&adsp->stop_done, msecs_to_jiffies(5000)); if (ret == 0) dev_err(adsp->dev, "timed out on wait\n"); qcom_smem_state_update_bits(adsp->state, BIT(adsp->stop_bit), 0); ret = qcom_scm_pas_shutdown(adsp->pas_id); if (ret) dev_err(adsp->dev, "failed to shutdown: %d\n", ret); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson11997.54%150.00%
Avaneesh Kumar Dwivedi32.46%150.00%
Total122100.00%2100.00%


static void *adsp_da_to_va(struct rproc *rproc, u64 da, int len) { struct qcom_adsp *adsp = (struct qcom_adsp *)rproc->priv; int offset; offset = da - adsp->mem_reloc; if (offset < 0 || offset + len > adsp->mem_size) return NULL; return adsp->mem_region + offset; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson67100.00%1100.00%
Total67100.00%1100.00%

static const struct rproc_ops adsp_ops = { .start = adsp_start, .stop = adsp_stop, .da_to_va = adsp_da_to_va, };
static irqreturn_t adsp_wdog_interrupt(int irq, void *dev) { struct qcom_adsp *adsp = dev; rproc_report_crash(adsp->rproc, RPROC_WATCHDOG); return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson32100.00%1100.00%
Total32100.00%1100.00%


static irqreturn_t adsp_fatal_interrupt(int irq, void *dev) { struct qcom_adsp *adsp = dev; size_t len; char *msg; msg = qcom_smem_get(QCOM_SMEM_HOST_ANY, adsp->crash_reason_smem, &len); if (!IS_ERR(msg) && len > 0 && msg[0]) dev_err(adsp->dev, "fatal error received: %s\n", msg); rproc_report_crash(adsp->rproc, RPROC_FATAL_ERROR); if (!IS_ERR(msg)) msg[0] = '\0'; return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson9396.88%150.00%
Avaneesh Kumar Dwivedi33.12%150.00%
Total96100.00%2100.00%


static irqreturn_t adsp_ready_interrupt(int irq, void *dev) { return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson16100.00%1100.00%
Total16100.00%1100.00%


static irqreturn_t adsp_handover_interrupt(int irq, void *dev) { struct qcom_adsp *adsp = dev; complete(&adsp->start_done); return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson31100.00%1100.00%
Total31100.00%1100.00%


static irqreturn_t adsp_stop_ack_interrupt(int irq, void *dev) { struct qcom_adsp *adsp = dev; complete(&adsp->stop_done); return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson31100.00%1100.00%
Total31100.00%1100.00%


static int adsp_init_clock(struct qcom_adsp *adsp) { int ret; adsp->xo = devm_clk_get(adsp->dev, "xo"); if (IS_ERR(adsp->xo)) { ret = PTR_ERR(adsp->xo); if (ret != -EPROBE_DEFER) dev_err(adsp->dev, "failed to get xo clock"); return ret; } if (adsp->has_aggre2_clk) { adsp->aggre2_clk = devm_clk_get(adsp->dev, "aggre2"); if (IS_ERR(adsp->aggre2_clk)) { ret = PTR_ERR(adsp->aggre2_clk); if (ret != -EPROBE_DEFER) dev_err(adsp->dev, "failed to get aggre2 clock"); return ret; } } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sarangdhar Joshi6953.49%150.00%
Avaneesh Kumar Dwivedi6046.51%150.00%
Total129100.00%2100.00%


static int adsp_init_regulator(struct qcom_adsp *adsp) { adsp->cx_supply = devm_regulator_get(adsp->dev, "cx"); if (IS_ERR(adsp->cx_supply)) return PTR_ERR(adsp->cx_supply); regulator_set_load(adsp->cx_supply, 100000); adsp->px_supply = devm_regulator_get(adsp->dev, "px"); if (IS_ERR(adsp->px_supply)) return PTR_ERR(adsp->px_supply); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson5363.86%150.00%
Avaneesh Kumar Dwivedi3036.14%150.00%
Total83100.00%2100.00%


static int adsp_request_irq(struct qcom_adsp *adsp, struct platform_device *pdev, const char *name, irq_handler_t thread_fn) { int ret; ret = platform_get_irq_byname(pdev, name); if (ret < 0) { dev_err(&pdev->dev, "no %s IRQ defined\n", name); return ret; } ret = devm_request_threaded_irq(&pdev->dev, ret, NULL, thread_fn, IRQF_ONESHOT, "adsp", adsp); if (ret) dev_err(&pdev->dev, "request %s IRQ failed\n", name); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson100100.00%1100.00%
Total100100.00%1100.00%


static int adsp_alloc_memory_region(struct qcom_adsp *adsp) { struct device_node *node; struct resource r; int ret; node = of_parse_phandle(adsp->dev->of_node, "memory-region", 0); if (!node) { dev_err(adsp->dev, "no memory-region specified\n"); return -EINVAL; } ret = of_address_to_resource(node, 0, &r); if (ret) return ret; adsp->mem_phys = adsp->mem_reloc = r.start; adsp->mem_size = resource_size(&r); adsp->mem_region = devm_ioremap_wc(adsp->dev, adsp->mem_phys, adsp->mem_size); if (!adsp->mem_region) { dev_err(adsp->dev, "unable to map memory region: %pa+%zx\n", &r.start, adsp->mem_size); return -EBUSY; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson152100.00%1100.00%
Total152100.00%1100.00%


static int adsp_probe(struct platform_device *pdev) { const struct adsp_data *desc; struct qcom_adsp *adsp; struct rproc *rproc; int ret; desc = of_device_get_match_data(&pdev->dev); if (!desc) return -EINVAL; if (!qcom_scm_is_available()) return -EPROBE_DEFER; rproc = rproc_alloc(&pdev->dev, pdev->name, &adsp_ops, desc->firmware_name, sizeof(*adsp)); if (!rproc) { dev_err(&pdev->dev, "unable to allocate remoteproc\n"); return -ENOMEM; } rproc->fw_ops = &adsp_fw_ops; adsp = (struct qcom_adsp *)rproc->priv; adsp->dev = &pdev->dev; adsp->rproc = rproc; adsp->pas_id = desc->pas_id; adsp->crash_reason_smem = desc->crash_reason_smem; adsp->has_aggre2_clk = desc->has_aggre2_clk; platform_set_drvdata(pdev, adsp); init_completion(&adsp->start_done); init_completion(&adsp->stop_done); ret = adsp_alloc_memory_region(adsp); if (ret) goto free_rproc; ret = adsp_init_clock(adsp); if (ret) goto free_rproc; ret = adsp_init_regulator(adsp); if (ret) goto free_rproc; ret = adsp_request_irq(adsp, pdev, "wdog", adsp_wdog_interrupt); if (ret < 0) goto free_rproc; adsp->wdog_irq = ret; ret = adsp_request_irq(adsp, pdev, "fatal", adsp_fatal_interrupt); if (ret < 0) goto free_rproc; adsp->fatal_irq = ret; ret = adsp_request_irq(adsp, pdev, "ready", adsp_ready_interrupt); if (ret < 0) goto free_rproc; adsp->ready_irq = ret; ret = adsp_request_irq(adsp, pdev, "handover", adsp_handover_interrupt); if (ret < 0) goto free_rproc; adsp->handover_irq = ret; ret = adsp_request_irq(adsp, pdev, "stop-ack", adsp_stop_ack_interrupt); if (ret < 0) goto free_rproc; adsp->stop_ack_irq = ret; adsp->state = qcom_smem_state_get(&pdev->dev, "stop", &adsp->stop_bit); if (IS_ERR(adsp->state)) { ret = PTR_ERR(adsp->state); goto free_rproc; } qcom_add_smd_subdev(rproc, &adsp->smd_subdev); ret = rproc_add(rproc); if (ret) goto free_rproc; return 0; free_rproc: rproc_free(rproc); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson38285.27%350.00%
Avaneesh Kumar Dwivedi5211.61%233.33%
Sarangdhar Joshi143.12%116.67%
Total448100.00%6100.00%


static int adsp_remove(struct platform_device *pdev) { struct qcom_adsp *adsp = platform_get_drvdata(pdev); qcom_smem_state_put(adsp->state); rproc_del(adsp->rproc); qcom_remove_smd_subdev(adsp->rproc, &adsp->smd_subdev); rproc_free(adsp->rproc); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson57100.00%3100.00%
Total57100.00%3100.00%

static const struct adsp_data adsp_resource_init = { .crash_reason_smem = 423, .firmware_name = "adsp.mdt", .pas_id = 1, .has_aggre2_clk = false, }; static const struct adsp_data slpi_resource_init = { .crash_reason_smem = 424, .firmware_name = "slpi.mdt", .pas_id = 12, .has_aggre2_clk = true, }; static const struct of_device_id adsp_of_match[] = { { .compatible = "qcom,msm8974-adsp-pil", .data = &adsp_resource_init}, { .compatible = "qcom,msm8996-adsp-pil", .data = &adsp_resource_init}, { .compatible = "qcom,msm8996-slpi-pil", .data = &slpi_resource_init}, { }, }; MODULE_DEVICE_TABLE(of, adsp_of_match); static struct platform_driver adsp_driver = { .probe = adsp_probe, .remove = adsp_remove, .driver = { .name = "qcom_adsp_pil", .of_match_table = adsp_of_match, }, }; module_platform_driver(adsp_driver); MODULE_DESCRIPTION("Qualcomm MSM8974/MSM8996 ADSP Peripherial Image Loader"); MODULE_LICENSE("GPL v2");

Overall Contributors

PersonTokensPropCommitsCommitProp
Björn Andersson154477.43%763.64%
Avaneesh Kumar Dwivedi33416.75%327.27%
Sarangdhar Joshi1165.82%19.09%
Total1994100.00%11100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.