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,  in mtk_mmsys_update_bits()  argument
169 	if (mmsys->cmdq_base.size && cmdq_pkt) {  in mtk_mmsys_update_bits()
170 		ret = cmdq_pkt_write_mask(cmdq_pkt, mmsys->cmdq_base.subsys,  in mtk_mmsys_update_bits()
171 					  mmsys->cmdq_base.offset + offset, val,  in mtk_mmsys_update_bits()
178 	tmp = readl_relaxed(mmsys->regs + offset);  in mtk_mmsys_update_bits()
180 	writel_relaxed(tmp, mmsys->regs + offset);  in mtk_mmsys_update_bits()
187 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);  in mtk_mmsys_ddp_connect()  local
188 	const struct mtk_mmsys_routes *routes = mmsys->data->routes;  in mtk_mmsys_ddp_connect()
191 	for (i = 0; i < mmsys->data->num_routes; i++)  in mtk_mmsys_ddp_connect()
193 			mtk_mmsys_update_bits(mmsys, routes[i].addr, routes[i].mask,  in mtk_mmsys_ddp_connect()
196 	if (mmsys->data->vsync_len)  in mtk_mmsys_ddp_connect()
197 		mtk_mmsys_update_bits(mmsys, MT8188_VDO1_MIXER_VSYNC_LEN, GENMASK(31, 0),  in mtk_mmsys_ddp_connect()
198 				      mmsys->data->vsync_len, NULL);  in mtk_mmsys_ddp_connect()
206 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);  in mtk_mmsys_ddp_disconnect()  local
207 	const struct mtk_mmsys_routes *routes = mmsys->data->routes;  in mtk_mmsys_ddp_disconnect()
210 	for (i = 0; i < mmsys->data->num_routes; i++)  in mtk_mmsys_ddp_disconnect()
212 			mtk_mmsys_update_bits(mmsys, routes[i].addr, routes[i].mask, 0, NULL);  in mtk_mmsys_ddp_disconnect()
235 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);  in mtk_mmsys_mixer_in_config()  local
237 	mtk_mmsys_update_bits(mmsys, MT8195_VDO1_MIXER_IN1_ALPHA + (idx - 1) * 4, ~0,  in mtk_mmsys_mixer_in_config()
239 	mtk_mmsys_update_bits(mmsys, MT8195_VDO1_HDR_TOP_CFG, BIT(15 + idx), 0, cmdq_pkt);  in mtk_mmsys_mixer_in_config()
240 	mtk_mmsys_update_bits(mmsys, MT8195_VDO1_HDR_TOP_CFG, BIT(19 + idx),  in mtk_mmsys_mixer_in_config()
242 	mtk_mmsys_update_bits(mmsys, MT8195_VDO1_MIXER_IN1_PAD + (idx - 1) * 4,  in mtk_mmsys_mixer_in_config()
257 	struct mtk_mmsys *mmsys = dev_get_drvdata(dev);  in mtk_mmsys_ddp_dpi_fmt_config()  local
261 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,  in mtk_mmsys_ddp_dpi_fmt_config()
265 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,  in mtk_mmsys_ddp_dpi_fmt_config()
269 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,  in mtk_mmsys_ddp_dpi_fmt_config()
274 		mtk_mmsys_update_bits(mmsys, MT8186_MMSYS_DPI_OUTPUT_FORMAT,  in mtk_mmsys_ddp_dpi_fmt_config()
328 	struct mtk_mmsys *mmsys = container_of(rcdev, struct mtk_mmsys, rcdev);  in mtk_mmsys_reset_update()  local
333 	if (mmsys->data->rst_tb) {  in mtk_mmsys_reset_update()
334 		if (id >= mmsys->data->num_resets) {  in mtk_mmsys_reset_update()
336 				id, mmsys->data->num_resets);  in mtk_mmsys_reset_update()
339 		id = mmsys->data->rst_tb[id];  in mtk_mmsys_reset_update()
344 	reg = mmsys->data->sw0_rst_offset + offset;  in mtk_mmsys_reset_update()
346 	spin_lock_irqsave(&mmsys->lock, flags);  in mtk_mmsys_reset_update()
349 		mtk_mmsys_update_bits(mmsys, reg, BIT(id), 0, NULL);  in mtk_mmsys_reset_update()
351 		mtk_mmsys_update_bits(mmsys, reg, BIT(id), BIT(id), NULL);  in mtk_mmsys_reset_update()
353 	spin_unlock_irqrestore(&mmsys->lock, flags);  in mtk_mmsys_reset_update()
392 	struct mtk_mmsys *mmsys;  in mtk_mmsys_probe()  local
395 	mmsys = devm_kzalloc(dev, sizeof(*mmsys), GFP_KERNEL);  in mtk_mmsys_probe()
396 	if (!mmsys)  in mtk_mmsys_probe()
399 	mmsys->regs = devm_platform_ioremap_resource(pdev, 0);  in mtk_mmsys_probe()
400 	if (IS_ERR(mmsys->regs)) {  in mtk_mmsys_probe()
401 		ret = PTR_ERR(mmsys->regs);  in mtk_mmsys_probe()
402 		dev_err(dev, "Failed to ioremap mmsys registers: %d\n", ret);  in mtk_mmsys_probe()
406 	mmsys->data = of_device_get_match_data(&pdev->dev);  in mtk_mmsys_probe()
408 	if (mmsys->data->num_resets > 0) {  in mtk_mmsys_probe()
409 		spin_lock_init(&mmsys->lock);  in mtk_mmsys_probe()
411 		mmsys->rcdev.owner = THIS_MODULE;  in mtk_mmsys_probe()
412 		mmsys->rcdev.nr_resets = mmsys->data->num_resets;  in mtk_mmsys_probe()
413 		mmsys->rcdev.ops = &mtk_mmsys_reset_ops;  in mtk_mmsys_probe()
414 		mmsys->rcdev.of_node = pdev->dev.of_node;  in mtk_mmsys_probe()
415 		ret = devm_reset_controller_register(&pdev->dev, &mmsys->rcdev);  in mtk_mmsys_probe()
417 			dev_err(&pdev->dev, "Couldn't register mmsys reset controller: %d\n", ret);  in mtk_mmsys_probe()
423 	ret = cmdq_dev_get_client_reg(dev, &mmsys->cmdq_base, 0);  in mtk_mmsys_probe()
427 	platform_set_drvdata(pdev, mmsys);  in mtk_mmsys_probe()
429 	clks = platform_device_register_data(&pdev->dev, mmsys->data->clk_driver,  in mtk_mmsys_probe()
433 	mmsys->clks_pdev = clks;  in mtk_mmsys_probe()
435 	if (mmsys->data->is_vppsys)  in mtk_mmsys_probe()
444 	mmsys->drm_pdev = drm;  in mtk_mmsys_probe()
452 	struct mtk_mmsys *mmsys = platform_get_drvdata(pdev);  in mtk_mmsys_remove()  local
454 	platform_device_unregister(mmsys->drm_pdev);  in mtk_mmsys_remove()
455 	platform_device_unregister(mmsys->clks_pdev);  in mtk_mmsys_remove()
459 	{ .compatible = "mediatek,mt2701-mmsys", .data = &mt2701_mmsys_driver_data },
460 	{ .compatible = "mediatek,mt2712-mmsys", .data = &mt2712_mmsys_driver_data },
461 	{ .compatible = "mediatek,mt6779-mmsys", .data = &mt6779_mmsys_driver_data },
462 	{ .compatible = "mediatek,mt6795-mmsys", .data = &mt6795_mmsys_driver_data },
463 	{ .compatible = "mediatek,mt6797-mmsys", .data = &mt6797_mmsys_driver_data },
464 	{ .compatible = "mediatek,mt8167-mmsys", .data = &mt8167_mmsys_driver_data },
465 	{ .compatible = "mediatek,mt8173-mmsys", .data = &mt8173_mmsys_driver_data },
466 	{ .compatible = "mediatek,mt8183-mmsys", .data = &mt8183_mmsys_driver_data },
467 	{ .compatible = "mediatek,mt8186-mmsys", .data = &mt8186_mmsys_driver_data },
472 	{ .compatible = "mediatek,mt8192-mmsys", .data = &mt8192_mmsys_driver_data },
473 	/* "mediatek,mt8195-mmsys" compatible is deprecated */
474 	{ .compatible = "mediatek,mt8195-mmsys", .data = &mt8195_vdosys0_driver_data },
479 	{ .compatible = "mediatek,mt8365-mmsys", .data = &mt8365_mmsys_driver_data },
486 		.name = "mtk-mmsys",
495 MODULE_DESCRIPTION("MediaTek SoC MMSYS driver");