Quelle  clk-mt7981-apmixed.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2021 MediaTek Inc.
 * Author: Sam Shih <sam.shih@mediatek.com>
 * Author: Wenzhen Yu <wenzhen.yu@mediatek.com>
 * Author: Jianhui Zhao <zhaojh329@gmail.com>
 * Author: Daniel Golle <daniel@makrotopia.org>
 */

#include <linux/clk-provider.h>
#include <linux/mod_devicetable.h>
#include <linux/platform_device.h>

#include "clk-gate.h"
#include "clk-mtk.h"
#include "clk-mux.h"
#include "clk-pll.h"

#include <dt-bindings/clock/mediatek,mt7981-clk.h>
#include <linux/clk.h>

#define MT7981_PLL_FMAX (2500UL * MHZ)
#define CON0_MT7981_RST_BAR BIT(27)

#define PLL_xtal(_id, _name, _reg, _pwr_reg, _en_mask, _flags, _pcwbits,       \
   _pd_reg, _pd_shift, _tuner_reg, _pcw_reg, _pcw_shift,         \
   _div_table, _parent_name)                                     \
 {                                                                      \
  .id = _id, .name = _name, .reg = _reg, .pwr_reg = _pwr_reg,    \
  .en_mask = _en_mask, .flags = _flags,                          \
  .rst_bar_mask = CON0_MT7981_RST_BAR, .fmax = MT7981_PLL_FMAX,  \
  .pcwbits = _pcwbits, .pd_reg = _pd_reg, .pd_shift = _pd_shift, \
  .tuner_reg = _tuner_reg, .pcw_reg = _pcw_reg,                  \
  .pcw_shift = _pcw_shift, .div_table = _div_table,              \
  .parent_name = _parent_name,                                   \
 }

#define PLL(_id, _name, _reg, _pwr_reg, _en_mask, _flags, _pcwbits, _pd_reg,   \
     _pd_shift, _tuner_reg, _pcw_reg, _pcw_shift)                       \
 PLL_xtal(_id, _name, _reg, _pwr_reg, _en_mask, _flags, _pcwbits,       \
   _pd_reg, _pd_shift, _tuner_reg, _pcw_reg, _pcw_shift, NULL,   \
   "clkxtal")

static const struct mtk_pll_data plls[] = {
 PLL(CLK_APMIXED_ARMPLL, "armpll", 0x0200, 0x020C, 0x00000001, PLL_AO,
     32, 0x0200, 4, 0, 0x0204, 0),
 PLL(CLK_APMIXED_NET2PLL, "net2pll", 0x0210, 0x021C, 0x00000001, 0, 32,
     0x0210, 4, 0, 0x0214, 0),
 PLL(CLK_APMIXED_MMPLL, "mmpll", 0x0220, 0x022C, 0x00000001, 0, 32,
     0x0220, 4, 0, 0x0224, 0),
 PLL(CLK_APMIXED_SGMPLL, "sgmpll", 0x0230, 0x023C, 0x00000001, 0, 32,
     0x0230, 4, 0, 0x0234, 0),
 PLL(CLK_APMIXED_WEDMCUPLL, "wedmcupll", 0x0240, 0x024C, 0x00000001, 0, 32,
     0x0240, 4, 0, 0x0244, 0),
 PLL(CLK_APMIXED_NET1PLL, "net1pll", 0x0250, 0x025C, 0x00000001, 0, 32,
     0x0250, 4, 0, 0x0254, 0),
 PLL(CLK_APMIXED_MPLL, "mpll", 0x0260, 0x0270, 0x00000001, 0, 32,
     0x0260, 4, 0, 0x0264, 0),
 PLL(CLK_APMIXED_APLL2, "apll2", 0x0278, 0x0288, 0x00000001, 0, 32,
     0x0278, 4, 0, 0x027C, 0),
};

static const struct of_device_id of_match_clk_mt7981_apmixed[] = {
 { .compatible = "mediatek,mt7981-apmixedsys", },
 { /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, of_match_clk_mt7981_apmixed);

static int clk_mt7981_apmixed_probe(struct platform_device *pdev)
{
 struct clk_hw_onecell_data *clk_data;
 struct device_node *node = pdev->dev.of_node;
 int r;

 clk_data = mtk_alloc_clk_data(ARRAY_SIZE(plls));
 if (!clk_data)
  return -ENOMEM;

 mtk_clk_register_plls(node, plls, ARRAY_SIZE(plls), clk_data);

 r = of_clk_add_hw_provider(node, of_clk_hw_onecell_get, clk_data);
 if (r) {
  pr_err("%s(): could not register clock provider: %d\n",
         __func__, r);
  goto free_apmixed_data;
 }
 return r;

free_apmixed_data:
 mtk_free_clk_data(clk_data);
 return r;
}

static struct platform_driver clk_mt7981_apmixed_drv = {
 .probe = clk_mt7981_apmixed_probe,
 .driver = {
  .name = "clk-mt7981-apmixed",
  .of_match_table = of_match_clk_mt7981_apmixed,
 },
};
builtin_platform_driver(clk_mt7981_apmixed_drv);

MODULE_DESCRIPTION("MediaTek MT7981 apmixedsys clocks driver");
MODULE_LICENSE("GPL");