12fc0a509SSean Wang /* 22fc0a509SSean Wang * Copyright (c) 2017 MediaTek Inc. 32fc0a509SSean Wang * Author: Chen Zhong <chen.zhong@mediatek.com> 42fc0a509SSean Wang * Sean Wang <sean.wang@mediatek.com> 52fc0a509SSean Wang * 62fc0a509SSean Wang * This program is free software; you can redistribute it and/or modify 72fc0a509SSean Wang * it under the terms of the GNU General Public License version 2 as 82fc0a509SSean Wang * published by the Free Software Foundation. 92fc0a509SSean Wang * 102fc0a509SSean Wang * This program is distributed in the hope that it will be useful, 112fc0a509SSean Wang * but WITHOUT ANY WARRANTY; without even the implied warranty of 122fc0a509SSean Wang * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 132fc0a509SSean Wang * GNU General Public License for more details. 142fc0a509SSean Wang */ 152fc0a509SSean Wang 162fc0a509SSean Wang #include <linux/clk-provider.h> 172fc0a509SSean Wang #include <linux/of.h> 182fc0a509SSean Wang #include <linux/of_address.h> 192fc0a509SSean Wang #include <linux/of_device.h> 202fc0a509SSean Wang #include <linux/platform_device.h> 212fc0a509SSean Wang 222fc0a509SSean Wang #include "clk-mtk.h" 232fc0a509SSean Wang #include "clk-gate.h" 242fc0a509SSean Wang 252fc0a509SSean Wang #include <dt-bindings/clock/mt7622-clk.h> 262fc0a509SSean Wang 272fc0a509SSean Wang #define GATE_PCIE(_id, _name, _parent, _shift) { \ 282fc0a509SSean Wang .id = _id, \ 292fc0a509SSean Wang .name = _name, \ 302fc0a509SSean Wang .parent_name = _parent, \ 312fc0a509SSean Wang .regs = &pcie_cg_regs, \ 322fc0a509SSean Wang .shift = _shift, \ 332fc0a509SSean Wang .ops = &mtk_clk_gate_ops_no_setclr_inv, \ 342fc0a509SSean Wang } 352fc0a509SSean Wang 362fc0a509SSean Wang #define GATE_SSUSB(_id, _name, _parent, _shift) { \ 372fc0a509SSean Wang .id = _id, \ 382fc0a509SSean Wang .name = _name, \ 392fc0a509SSean Wang .parent_name = _parent, \ 402fc0a509SSean Wang .regs = &ssusb_cg_regs, \ 412fc0a509SSean Wang .shift = _shift, \ 422fc0a509SSean Wang .ops = &mtk_clk_gate_ops_no_setclr_inv, \ 432fc0a509SSean Wang } 442fc0a509SSean Wang 452fc0a509SSean Wang static const struct mtk_gate_regs pcie_cg_regs = { 462fc0a509SSean Wang .set_ofs = 0x30, 472fc0a509SSean Wang .clr_ofs = 0x30, 482fc0a509SSean Wang .sta_ofs = 0x30, 492fc0a509SSean Wang }; 502fc0a509SSean Wang 512fc0a509SSean Wang static const struct mtk_gate_regs ssusb_cg_regs = { 522fc0a509SSean Wang .set_ofs = 0x30, 532fc0a509SSean Wang .clr_ofs = 0x30, 542fc0a509SSean Wang .sta_ofs = 0x30, 552fc0a509SSean Wang }; 562fc0a509SSean Wang 572fc0a509SSean Wang static const struct mtk_gate ssusb_clks[] = { 582fc0a509SSean Wang GATE_SSUSB(CLK_SSUSB_U2_PHY_1P_EN, "ssusb_u2_phy_1p", 592fc0a509SSean Wang "to_u2_phy_1p", 0), 602fc0a509SSean Wang GATE_SSUSB(CLK_SSUSB_U2_PHY_EN, "ssusb_u2_phy_en", "to_u2_phy", 1), 612fc0a509SSean Wang GATE_SSUSB(CLK_SSUSB_REF_EN, "ssusb_ref_en", "to_usb3_ref", 5), 622fc0a509SSean Wang GATE_SSUSB(CLK_SSUSB_SYS_EN, "ssusb_sys_en", "to_usb3_sys", 6), 632fc0a509SSean Wang GATE_SSUSB(CLK_SSUSB_MCU_EN, "ssusb_mcu_en", "axi_sel", 7), 642fc0a509SSean Wang GATE_SSUSB(CLK_SSUSB_DMA_EN, "ssusb_dma_en", "hif_sel", 8), 652fc0a509SSean Wang }; 662fc0a509SSean Wang 672fc0a509SSean Wang static const struct mtk_gate pcie_clks[] = { 682fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P1_AUX_EN, "pcie_p1_aux_en", "p1_1mhz", 12), 692fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P1_OBFF_EN, "pcie_p1_obff_en", "free_run_4mhz", 13), 702fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P1_AHB_EN, "pcie_p1_ahb_en", "axi_sel", 14), 712fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P1_AXI_EN, "pcie_p1_axi_en", "hif_sel", 15), 722fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P1_MAC_EN, "pcie_p1_mac_en", "pcie1_mac_en", 16), 732fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P1_PIPE_EN, "pcie_p1_pipe_en", "pcie1_pipe_en", 17), 742fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P0_AUX_EN, "pcie_p0_aux_en", "p0_1mhz", 18), 752fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P0_OBFF_EN, "pcie_p0_obff_en", "free_run_4mhz", 19), 762fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P0_AHB_EN, "pcie_p0_ahb_en", "axi_sel", 20), 772fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P0_AXI_EN, "pcie_p0_axi_en", "hif_sel", 21), 782fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P0_MAC_EN, "pcie_p0_mac_en", "pcie0_mac_en", 22), 792fc0a509SSean Wang GATE_PCIE(CLK_PCIE_P0_PIPE_EN, "pcie_p0_pipe_en", "pcie0_pipe_en", 23), 802fc0a509SSean Wang GATE_PCIE(CLK_SATA_AHB_EN, "sata_ahb_en", "axi_sel", 26), 812fc0a509SSean Wang GATE_PCIE(CLK_SATA_AXI_EN, "sata_axi_en", "hif_sel", 27), 822fc0a509SSean Wang GATE_PCIE(CLK_SATA_ASIC_EN, "sata_asic_en", "sata_asic", 28), 832fc0a509SSean Wang GATE_PCIE(CLK_SATA_RBC_EN, "sata_rbc_en", "sata_rbc", 29), 842fc0a509SSean Wang GATE_PCIE(CLK_SATA_PM_EN, "sata_pm_en", "univpll2_d4", 30), 852fc0a509SSean Wang }; 862fc0a509SSean Wang 872fc0a509SSean Wang static int clk_mt7622_ssusbsys_init(struct platform_device *pdev) 882fc0a509SSean Wang { 892fc0a509SSean Wang struct clk_onecell_data *clk_data; 902fc0a509SSean Wang struct device_node *node = pdev->dev.of_node; 912fc0a509SSean Wang int r; 922fc0a509SSean Wang 932fc0a509SSean Wang clk_data = mtk_alloc_clk_data(CLK_SSUSB_NR_CLK); 942fc0a509SSean Wang 952fc0a509SSean Wang mtk_clk_register_gates(node, ssusb_clks, ARRAY_SIZE(ssusb_clks), 962fc0a509SSean Wang clk_data); 972fc0a509SSean Wang 982fc0a509SSean Wang r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data); 992fc0a509SSean Wang if (r) 1002fc0a509SSean Wang dev_err(&pdev->dev, 1012fc0a509SSean Wang "could not register clock provider: %s: %d\n", 1022fc0a509SSean Wang pdev->name, r); 1032fc0a509SSean Wang 1042fc0a509SSean Wang mtk_register_reset_controller(node, 1, 0x34); 1052fc0a509SSean Wang 1062fc0a509SSean Wang return r; 1072fc0a509SSean Wang } 1082fc0a509SSean Wang 1092fc0a509SSean Wang static int clk_mt7622_pciesys_init(struct platform_device *pdev) 1102fc0a509SSean Wang { 1112fc0a509SSean Wang struct clk_onecell_data *clk_data; 1122fc0a509SSean Wang struct device_node *node = pdev->dev.of_node; 1132fc0a509SSean Wang int r; 1142fc0a509SSean Wang 1152fc0a509SSean Wang clk_data = mtk_alloc_clk_data(CLK_PCIE_NR_CLK); 1162fc0a509SSean Wang 1172fc0a509SSean Wang mtk_clk_register_gates(node, pcie_clks, ARRAY_SIZE(pcie_clks), 1182fc0a509SSean Wang clk_data); 1192fc0a509SSean Wang 1202fc0a509SSean Wang r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data); 1212fc0a509SSean Wang if (r) 1222fc0a509SSean Wang dev_err(&pdev->dev, 1232fc0a509SSean Wang "could not register clock provider: %s: %d\n", 1242fc0a509SSean Wang pdev->name, r); 1252fc0a509SSean Wang 1262fc0a509SSean Wang mtk_register_reset_controller(node, 1, 0x34); 1272fc0a509SSean Wang 1282fc0a509SSean Wang return r; 1292fc0a509SSean Wang } 1302fc0a509SSean Wang 1312fc0a509SSean Wang static const struct of_device_id of_match_clk_mt7622_hif[] = { 1322fc0a509SSean Wang { 1332fc0a509SSean Wang .compatible = "mediatek,mt7622-pciesys", 1342fc0a509SSean Wang .data = clk_mt7622_pciesys_init, 1352fc0a509SSean Wang }, { 1362fc0a509SSean Wang .compatible = "mediatek,mt7622-ssusbsys", 1372fc0a509SSean Wang .data = clk_mt7622_ssusbsys_init, 1382fc0a509SSean Wang }, { 1392fc0a509SSean Wang /* sentinel */ 1402fc0a509SSean Wang } 1412fc0a509SSean Wang }; 1422fc0a509SSean Wang 1432fc0a509SSean Wang static int clk_mt7622_hif_probe(struct platform_device *pdev) 1442fc0a509SSean Wang { 1452fc0a509SSean Wang int (*clk_init)(struct platform_device *); 1462fc0a509SSean Wang int r; 1472fc0a509SSean Wang 1482fc0a509SSean Wang clk_init = of_device_get_match_data(&pdev->dev); 1492fc0a509SSean Wang if (!clk_init) 1502fc0a509SSean Wang return -EINVAL; 1512fc0a509SSean Wang 1522fc0a509SSean Wang r = clk_init(pdev); 1532fc0a509SSean Wang if (r) 1542fc0a509SSean Wang dev_err(&pdev->dev, 1552fc0a509SSean Wang "could not register clock provider: %s: %d\n", 1562fc0a509SSean Wang pdev->name, r); 1572fc0a509SSean Wang 1582fc0a509SSean Wang return r; 1592fc0a509SSean Wang } 1602fc0a509SSean Wang 1612fc0a509SSean Wang static struct platform_driver clk_mt7622_hif_drv = { 1622fc0a509SSean Wang .probe = clk_mt7622_hif_probe, 1632fc0a509SSean Wang .driver = { 1642fc0a509SSean Wang .name = "clk-mt7622-hif", 1652fc0a509SSean Wang .of_match_table = of_match_clk_mt7622_hif, 1662fc0a509SSean Wang }, 1672fc0a509SSean Wang }; 1682fc0a509SSean Wang 1692fc0a509SSean Wang builtin_platform_driver(clk_mt7622_hif_drv); 170