2021-09-14 05:16:26 +03:00
// SPDX-License-Identifier: GPL-2.0-only
//
// Copyright (c) 2021 MediaTek Inc.
// Author: Chun-Jie Chen <chun-jie.chen@mediatek.com>
# include "clk-gate.h"
# include "clk-mtk.h"
# include <dt-bindings/clock/mt8195-clk.h>
# include <linux/clk-provider.h>
# include <linux/platform_device.h>
static const struct mtk_gate_regs vdo0_0_cg_regs = {
. set_ofs = 0x104 ,
. clr_ofs = 0x108 ,
. sta_ofs = 0x100 ,
} ;
static const struct mtk_gate_regs vdo0_1_cg_regs = {
. set_ofs = 0x114 ,
. clr_ofs = 0x118 ,
. sta_ofs = 0x110 ,
} ;
static const struct mtk_gate_regs vdo0_2_cg_regs = {
. set_ofs = 0x124 ,
. clr_ofs = 0x128 ,
. sta_ofs = 0x120 ,
} ;
# define GATE_VDO0_0(_id, _name, _parent, _shift) \
GATE_MTK ( _id , _name , _parent , & vdo0_0_cg_regs , _shift , & mtk_clk_gate_ops_setclr )
# define GATE_VDO0_1(_id, _name, _parent, _shift) \
GATE_MTK ( _id , _name , _parent , & vdo0_1_cg_regs , _shift , & mtk_clk_gate_ops_setclr )
# define GATE_VDO0_2(_id, _name, _parent, _shift) \
GATE_MTK ( _id , _name , _parent , & vdo0_2_cg_regs , _shift , & mtk_clk_gate_ops_setclr )
static const struct mtk_gate vdo0_clks [ ] = {
/* VDO0_0 */
GATE_VDO0_0 ( CLK_VDO0_DISP_OVL0 , " vdo0_disp_ovl0 " , " top_vpp " , 0 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_COLOR0 , " vdo0_disp_color0 " , " top_vpp " , 2 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_COLOR1 , " vdo0_disp_color1 " , " top_vpp " , 3 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_CCORR0 , " vdo0_disp_ccorr0 " , " top_vpp " , 4 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_CCORR1 , " vdo0_disp_ccorr1 " , " top_vpp " , 5 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_AAL0 , " vdo0_disp_aal0 " , " top_vpp " , 6 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_AAL1 , " vdo0_disp_aal1 " , " top_vpp " , 7 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_GAMMA0 , " vdo0_disp_gamma0 " , " top_vpp " , 8 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_GAMMA1 , " vdo0_disp_gamma1 " , " top_vpp " , 9 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_DITHER0 , " vdo0_disp_dither0 " , " top_vpp " , 10 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_DITHER1 , " vdo0_disp_dither1 " , " top_vpp " , 11 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_OVL1 , " vdo0_disp_ovl1 " , " top_vpp " , 16 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_WDMA0 , " vdo0_disp_wdma0 " , " top_vpp " , 17 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_WDMA1 , " vdo0_disp_wdma1 " , " top_vpp " , 18 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_RDMA0 , " vdo0_disp_rdma0 " , " top_vpp " , 19 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_RDMA1 , " vdo0_disp_rdma1 " , " top_vpp " , 20 ) ,
GATE_VDO0_0 ( CLK_VDO0_DSI0 , " vdo0_dsi0 " , " top_vpp " , 21 ) ,
GATE_VDO0_0 ( CLK_VDO0_DSI1 , " vdo0_dsi1 " , " top_vpp " , 22 ) ,
GATE_VDO0_0 ( CLK_VDO0_DSC_WRAP0 , " vdo0_dsc_wrap0 " , " top_vpp " , 23 ) ,
GATE_VDO0_0 ( CLK_VDO0_VPP_MERGE0 , " vdo0_vpp_merge0 " , " top_vpp " , 24 ) ,
GATE_VDO0_0 ( CLK_VDO0_DP_INTF0 , " vdo0_dp_intf0 " , " top_vpp " , 25 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_MUTEX0 , " vdo0_disp_mutex0 " , " top_vpp " , 26 ) ,
GATE_VDO0_0 ( CLK_VDO0_DISP_IL_ROT0 , " vdo0_disp_il_rot0 " , " top_vpp " , 27 ) ,
GATE_VDO0_0 ( CLK_VDO0_APB_BUS , " vdo0_apb_bus " , " top_vpp " , 28 ) ,
GATE_VDO0_0 ( CLK_VDO0_FAKE_ENG0 , " vdo0_fake_eng0 " , " top_vpp " , 29 ) ,
GATE_VDO0_0 ( CLK_VDO0_FAKE_ENG1 , " vdo0_fake_eng1 " , " top_vpp " , 30 ) ,
/* VDO0_1 */
GATE_VDO0_1 ( CLK_VDO0_DL_ASYNC0 , " vdo0_dl_async0 " , " top_vpp " , 0 ) ,
GATE_VDO0_1 ( CLK_VDO0_DL_ASYNC1 , " vdo0_dl_async1 " , " top_vpp " , 1 ) ,
GATE_VDO0_1 ( CLK_VDO0_DL_ASYNC2 , " vdo0_dl_async2 " , " top_vpp " , 2 ) ,
GATE_VDO0_1 ( CLK_VDO0_DL_ASYNC3 , " vdo0_dl_async3 " , " top_vpp " , 3 ) ,
GATE_VDO0_1 ( CLK_VDO0_DL_ASYNC4 , " vdo0_dl_async4 " , " top_vpp " , 4 ) ,
GATE_VDO0_1 ( CLK_VDO0_DISP_MONITOR0 , " vdo0_disp_monitor0 " , " top_vpp " , 5 ) ,
GATE_VDO0_1 ( CLK_VDO0_DISP_MONITOR1 , " vdo0_disp_monitor1 " , " top_vpp " , 6 ) ,
GATE_VDO0_1 ( CLK_VDO0_DISP_MONITOR2 , " vdo0_disp_monitor2 " , " top_vpp " , 7 ) ,
GATE_VDO0_1 ( CLK_VDO0_DISP_MONITOR3 , " vdo0_disp_monitor3 " , " top_vpp " , 8 ) ,
GATE_VDO0_1 ( CLK_VDO0_DISP_MONITOR4 , " vdo0_disp_monitor4 " , " top_vpp " , 9 ) ,
GATE_VDO0_1 ( CLK_VDO0_SMI_GALS , " vdo0_smi_gals " , " top_vpp " , 10 ) ,
GATE_VDO0_1 ( CLK_VDO0_SMI_COMMON , " vdo0_smi_common " , " top_vpp " , 11 ) ,
GATE_VDO0_1 ( CLK_VDO0_SMI_EMI , " vdo0_smi_emi " , " top_vpp " , 12 ) ,
GATE_VDO0_1 ( CLK_VDO0_SMI_IOMMU , " vdo0_smi_iommu " , " top_vpp " , 13 ) ,
GATE_VDO0_1 ( CLK_VDO0_SMI_LARB , " vdo0_smi_larb " , " top_vpp " , 14 ) ,
GATE_VDO0_1 ( CLK_VDO0_SMI_RSI , " vdo0_smi_rsi " , " top_vpp " , 15 ) ,
/* VDO0_2 */
GATE_VDO0_2 ( CLK_VDO0_DSI0_DSI , " vdo0_dsi0_dsi " , " top_dsi_occ " , 0 ) ,
GATE_VDO0_2 ( CLK_VDO0_DSI1_DSI , " vdo0_dsi1_dsi " , " top_dsi_occ " , 8 ) ,
GATE_VDO0_2 ( CLK_VDO0_DP_INTF0_DP_INTF , " vdo0_dp_intf0_dp_intf " , " top_edp " , 16 ) ,
} ;
static int clk_mt8195_vdo0_probe ( struct platform_device * pdev )
{
struct device * dev = & pdev - > dev ;
struct device_node * node = dev - > parent - > of_node ;
struct clk_onecell_data * clk_data ;
int r ;
clk_data = mtk_alloc_clk_data ( CLK_VDO0_NR_CLK ) ;
if ( ! clk_data )
return - ENOMEM ;
r = mtk_clk_register_gates ( node , vdo0_clks , ARRAY_SIZE ( vdo0_clks ) , clk_data ) ;
if ( r )
goto free_vdo0_data ;
r = of_clk_add_provider ( node , of_clk_src_onecell_get , clk_data ) ;
if ( r )
2022-02-08 15:40:32 +03:00
goto unregister_gates ;
2021-09-14 05:16:26 +03:00
2022-02-08 15:40:33 +03:00
platform_set_drvdata ( pdev , clk_data ) ;
2021-09-14 05:16:26 +03:00
return r ;
2022-02-08 15:40:32 +03:00
unregister_gates :
mtk_clk_unregister_gates ( vdo0_clks , ARRAY_SIZE ( vdo0_clks ) , clk_data ) ;
2021-09-14 05:16:26 +03:00
free_vdo0_data :
mtk_free_clk_data ( clk_data ) ;
return r ;
}
2022-02-08 15:40:33 +03:00
static int clk_mt8195_vdo0_remove ( struct platform_device * pdev )
{
struct device * dev = & pdev - > dev ;
struct device_node * node = dev - > parent - > of_node ;
struct clk_onecell_data * clk_data = platform_get_drvdata ( pdev ) ;
of_clk_del_provider ( node ) ;
mtk_clk_unregister_gates ( vdo0_clks , ARRAY_SIZE ( vdo0_clks ) , clk_data ) ;
mtk_free_clk_data ( clk_data ) ;
return 0 ;
}
2021-09-14 05:16:26 +03:00
static struct platform_driver clk_mt8195_vdo0_drv = {
. probe = clk_mt8195_vdo0_probe ,
2022-02-08 15:40:33 +03:00
. remove = clk_mt8195_vdo0_remove ,
2021-09-14 05:16:26 +03:00
. driver = {
. name = " clk-mt8195-vdo0 " ,
} ,
} ;
builtin_platform_driver ( clk_mt8195_vdo0_drv ) ;