brintos

brintos / linux-shallow public Read only

0
0
Text · 5.7 KiB · 7d91e7c Raw
191 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright (c) 2017, Linaro Ltd4 */5 6#include <linux/kernel.h>7#include <linux/module.h>8#include <linux/io.h>9#include <linux/slab.h>10#include <linux/of.h>11#include <linux/of_platform.h>12#include <linux/platform_device.h>13#include <linux/regmap.h>14#include <linux/mailbox_controller.h>15 16#define QCOM_APCS_IPC_BITS	3217 18struct qcom_apcs_ipc {19	struct mbox_controller mbox;20	struct mbox_chan mbox_chans[QCOM_APCS_IPC_BITS];21 22	struct regmap *regmap;23	unsigned long offset;24	struct platform_device *clk;25};26 27struct qcom_apcs_ipc_data {28	int offset;29	char *clk_name;30};31 32static const struct qcom_apcs_ipc_data ipq6018_apcs_data = {33	.offset = 8, .clk_name = "qcom,apss-ipq6018-clk"34};35 36static const struct qcom_apcs_ipc_data msm8916_apcs_data = {37	.offset = 8, .clk_name = "qcom-apcs-msm8916-clk"38};39 40static const struct qcom_apcs_ipc_data msm8994_apcs_data = {41	.offset = 8, .clk_name = NULL42};43 44static const struct qcom_apcs_ipc_data msm8996_apcs_data = {45	.offset = 16, .clk_name = "qcom-apcs-msm8996-clk"46};47 48static const struct qcom_apcs_ipc_data apps_shared_apcs_data = {49	.offset = 12, .clk_name = NULL50};51 52static const struct qcom_apcs_ipc_data sdx55_apcs_data = {53	.offset = 0x1008, .clk_name = "qcom-sdx55-acps-clk"54};55 56static const struct regmap_config apcs_regmap_config = {57	.reg_bits = 32,58	.reg_stride = 4,59	.val_bits = 32,60	.max_register = 0x1008,61	.fast_io = true,62};63 64static int qcom_apcs_ipc_send_data(struct mbox_chan *chan, void *data)65{66	struct qcom_apcs_ipc *apcs = container_of(chan->mbox,67						  struct qcom_apcs_ipc, mbox);68	unsigned long idx = (unsigned long)chan->con_priv;69 70	return regmap_write(apcs->regmap, apcs->offset, BIT(idx));71}72 73static const struct mbox_chan_ops qcom_apcs_ipc_ops = {74	.send_data = qcom_apcs_ipc_send_data,75};76 77static int qcom_apcs_ipc_probe(struct platform_device *pdev)78{79	struct qcom_apcs_ipc *apcs;80	const struct qcom_apcs_ipc_data *apcs_data;81	struct regmap *regmap;82	void __iomem *base;83	unsigned long i;84	int ret;85 86	apcs = devm_kzalloc(&pdev->dev, sizeof(*apcs), GFP_KERNEL);87	if (!apcs)88		return -ENOMEM;89 90	base = devm_platform_ioremap_resource(pdev, 0);91	if (IS_ERR(base))92		return PTR_ERR(base);93 94	regmap = devm_regmap_init_mmio(&pdev->dev, base, &apcs_regmap_config);95	if (IS_ERR(regmap))96		return PTR_ERR(regmap);97 98	apcs_data = of_device_get_match_data(&pdev->dev);99 100	apcs->regmap = regmap;101	apcs->offset = apcs_data->offset;102 103	/* Initialize channel identifiers */104	for (i = 0; i < ARRAY_SIZE(apcs->mbox_chans); i++)105		apcs->mbox_chans[i].con_priv = (void *)i;106 107	apcs->mbox.dev = &pdev->dev;108	apcs->mbox.ops = &qcom_apcs_ipc_ops;109	apcs->mbox.chans = apcs->mbox_chans;110	apcs->mbox.num_chans = ARRAY_SIZE(apcs->mbox_chans);111 112	ret = devm_mbox_controller_register(&pdev->dev, &apcs->mbox);113	if (ret) {114		dev_err(&pdev->dev, "failed to register APCS IPC controller\n");115		return ret;116	}117 118	if (apcs_data->clk_name) {119		apcs->clk = platform_device_register_data(&pdev->dev,120							  apcs_data->clk_name,121							  PLATFORM_DEVID_AUTO,122							  NULL, 0);123		if (IS_ERR(apcs->clk))124			dev_err(&pdev->dev, "failed to register APCS clk\n");125	}126 127	platform_set_drvdata(pdev, apcs);128 129	return 0;130}131 132static void qcom_apcs_ipc_remove(struct platform_device *pdev)133{134	struct qcom_apcs_ipc *apcs = platform_get_drvdata(pdev);135	struct platform_device *clk = apcs->clk;136 137	platform_device_unregister(clk);138}139 140/* .data is the offset of the ipc register within the global block */141static const struct of_device_id qcom_apcs_ipc_of_match[] = {142	{ .compatible = "qcom,ipq6018-apcs-apps-global", .data = &ipq6018_apcs_data },143	{ .compatible = "qcom,msm8916-apcs-kpss-global", .data = &msm8916_apcs_data },144	{ .compatible = "qcom,msm8939-apcs-kpss-global", .data = &msm8916_apcs_data },145	{ .compatible = "qcom,msm8953-apcs-kpss-global", .data = &msm8994_apcs_data },146	{ .compatible = "qcom,msm8994-apcs-kpss-global", .data = &msm8994_apcs_data },147	{ .compatible = "qcom,msm8996-apcs-hmss-global", .data = &msm8996_apcs_data },148	{ .compatible = "qcom,qcm2290-apcs-hmss-global", .data = &msm8994_apcs_data },149	{ .compatible = "qcom,sdm845-apss-shared", .data = &apps_shared_apcs_data },150	{ .compatible = "qcom,sdx55-apcs-gcc", .data = &sdx55_apcs_data },151	/* Do not add any more entries using existing driver data */152	{ .compatible = "qcom,msm8976-apcs-kpss-global", .data = &msm8994_apcs_data },153	{ .compatible = "qcom,msm8998-apcs-hmss-global", .data = &msm8994_apcs_data },154	{ .compatible = "qcom,qcs404-apcs-apps-global", .data = &msm8916_apcs_data },155	{ .compatible = "qcom,sdm660-apcs-hmss-global", .data = &msm8994_apcs_data },156	{ .compatible = "qcom,sm4250-apcs-hmss-global", .data = &msm8994_apcs_data },157	{ .compatible = "qcom,sm6125-apcs-hmss-global", .data = &msm8994_apcs_data },158	{ .compatible = "qcom,sm6115-apcs-hmss-global", .data = &msm8994_apcs_data },159	{ .compatible = "qcom,ipq5332-apcs-apps-global", .data = &ipq6018_apcs_data },160	{ .compatible = "qcom,ipq8074-apcs-apps-global", .data = &ipq6018_apcs_data },161	{ .compatible = "qcom,sc7180-apss-shared", .data = &apps_shared_apcs_data },162	{ .compatible = "qcom,sc8180x-apss-shared", .data = &apps_shared_apcs_data },163	{ .compatible = "qcom,sm8150-apss-shared", .data = &apps_shared_apcs_data },164	{}165};166MODULE_DEVICE_TABLE(of, qcom_apcs_ipc_of_match);167 168static struct platform_driver qcom_apcs_ipc_driver = {169	.probe = qcom_apcs_ipc_probe,170	.remove_new = qcom_apcs_ipc_remove,171	.driver = {172		.name = "qcom_apcs_ipc",173		.of_match_table = qcom_apcs_ipc_of_match,174	},175};176 177static int __init qcom_apcs_ipc_init(void)178{179	return platform_driver_register(&qcom_apcs_ipc_driver);180}181postcore_initcall(qcom_apcs_ipc_init);182 183static void __exit qcom_apcs_ipc_exit(void)184{185	platform_driver_unregister(&qcom_apcs_ipc_driver);186}187module_exit(qcom_apcs_ipc_exit);188 189MODULE_LICENSE("GPL v2");190MODULE_DESCRIPTION("Qualcomm APCS IPC driver");191