soc/mediatek/mtk-mmsys.c

14 #include <linux/soc/mediatek/mtk-mmsys.h>
16 #include "mtk-mmsys.h"
17 #include "mt8167-mmsys.h"
18 #include "mt8173-mmsys.h"
19 #include "mt8183-mmsys.h"
20 #include "mt8186-mmsys.h"
21 #include "mt8188-mmsys.h"
22 #include "mt8192-mmsys.h"
23 #include "mt8195-mmsys.h"
24 #include "mt8365-mmsys.h"
163 static void mtk_mmsys_update_bits(struct mtk_mmsys *mmsys, u32 offset, u32 mask, u32 val,
169 	if (mmsys->cmdq_base.size && cmdq_pkt) {
170 		ret = cmdq_pkt_write_mask(cmdq_pkt, mmsys->cmdq_base.subsys,
171 					  mmsys->cmdq_base.offset + offset, val,
178 	tmp = readl_relaxed(mmsys->regs + offset);
180 	writel_relaxed(tmp, mmsys->regs + offset);
187 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);
188 	const struct mtk_mmsys_routes *routes = mmsys->data->routes;
191 	for (i = 0; i < mmsys->data->num_routes; i++)
193 			mtk_mmsys_update_bits(mmsys, routes[i].addr, routes[i].mask,
196 	if (mmsys->data->vsync_len)
197 		mtk_mmsys_update_bits(mmsys, MT8188_VDO1_MIXER_VSYNC_LEN, GENMASK(31, 0),
198 				      mmsys->data->vsync_len, NULL);
206 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);
207 	const struct mtk_mmsys_routes *routes = mmsys->data->routes;
210 	for (i = 0; i < mmsys->data->num_routes; i++)
212 			mtk_mmsys_update_bits(mmsys, routes[i].addr, routes[i].mask, 0, NULL);
235 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);
237 	mtk_mmsys_update_bits(mmsys, MT8195_VDO1_MIXER_IN1_ALPHA + (idx - 1) * 4, ~0,
239 	mtk_mmsys_update_bits(mmsys, MT8195_VDO1_HDR_TOP_CFG, BIT(19 + idx),
241 	mtk_mmsys_update_bits(mmsys, MT8195_VDO1_MIXER_IN1_PAD + (idx - 1) * 4,
256 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);
260 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,
264 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,
268 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,
273 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,
327 	struct mtk_mmsys *mmsys = container_of(rcdev, struct mtk_mmsys, rcdev);
332 	if (mmsys->data->rst_tb) {
333 		if (id >= mmsys->data->num_resets) {
335 				id, mmsys->data->num_resets);
338 		id = mmsys->data->rst_tb[id];
343 	reg = mmsys->data->sw0_rst_offset + offset;
345 	spin_lock_irqsave(&mmsys->lock, flags);
348 		mtk_mmsys_update_bits(mmsys, reg, BIT(id), 0, NULL);
350 		mtk_mmsys_update_bits(mmsys, reg, BIT(id), BIT(id), NULL);
352 	spin_unlock_irqrestore(&mmsys->lock, flags);
391 	struct mtk_mmsys *mmsys;
394 	mmsys = devm_kzalloc(dev, sizeof(*mmsys), GFP_KERNEL);
395 	if (!mmsys)
398 	mmsys->regs = devm_platform_ioremap_resource(pdev, 0);
399 	if (IS_ERR(mmsys->regs)) {
400 		ret = PTR_ERR(mmsys->regs);
401 		dev_err(dev, "Failed to ioremap mmsys registers: %d\n", ret);
405 	mmsys->data = of_device_get_match_data(&pdev->dev);
407 	if (mmsys->data->num_resets > 0) {
408 		spin_lock_init(&mmsys->lock);
410 		mmsys->rcdev.owner = THIS_MODULE;
411 		mmsys->rcdev.nr_resets = mmsys->data->num_resets;
412 		mmsys->rcdev.ops = &mtk_mmsys_reset_ops;
413 		mmsys->rcdev.of_node = pdev->dev.of_node;
414 		ret = devm_reset_controller_register(&pdev->dev, &mmsys->rcdev);
416 			dev_err(&pdev->dev, "Couldn't register mmsys reset controller: %d\n", ret);
422 	ret = cmdq_dev_get_client_reg(dev, &mmsys->cmdq_base, 0);
426 	platform_set_drvdata(pdev, mmsys);
428 	clks = platform_device_register_data(&pdev->dev, mmsys->data->clk_driver,
432 	mmsys->clks_pdev = clks;
434 	if (mmsys->data->is_vppsys)
443 	mmsys->drm_pdev = drm;
451 	struct mtk_mmsys *mmsys = platform_get_drvdata(pdev);
453 	platform_device_unregister(mmsys->drm_pdev);
454 	platform_device_unregister(mmsys->clks_pdev);
458 	{ .compatible = "mediatek,mt2701-mmsys", .data = &mt2701_mmsys_driver_data },
459 	{ .compatible = "mediatek,mt2712-mmsys", .data = &mt2712_mmsys_driver_data },
460 	{ .compatible = "mediatek,mt6779-mmsys", .data = &mt6779_mmsys_driver_data },
461 	{ .compatible = "mediatek,mt6795-mmsys", .data = &mt6795_mmsys_driver_data },
462 	{ .compatible = "mediatek,mt6797-mmsys", .data = &mt6797_mmsys_driver_data },
463 	{ .compatible = "mediatek,mt8167-mmsys", .data = &mt8167_mmsys_driver_data },
464 	{ .compatible = "mediatek,mt8173-mmsys", .data = &mt8173_mmsys_driver_data },
465 	{ .compatible = "mediatek,mt8183-mmsys", .data = &mt8183_mmsys_driver_data },
466 	{ .compatible = "mediatek,mt8186-mmsys", .data = &mt8186_mmsys_driver_data },
471 	{ .compatible = "mediatek,mt8192-mmsys", .data = &mt8192_mmsys_driver_data },
472 	/* "mediatek,mt8195-mmsys" compatible is deprecated */
473 	{ .compatible = "mediatek,mt8195-mmsys", .data = &mt8195_vdosys0_driver_data },
478 	{ .compatible = "mediatek,mt8365-mmsys", .data = &mt8365_mmsys_driver_data },
485 		.name = "mtk-mmsys",