1 // SPDX-License-Identifier: MIT
2 /*
3 * clock framework for AMD FCH controller block
4 *
5 * Copyright 2018 Advanced Micro Devices, Inc.
6 */
7
8 #include <linux/clk.h>
9 #include <linux/clkdev.h>
10 #include <linux/clk-provider.h>
11 #include <linux/pci.h>
12 #include <linux/platform_data/clk-fch.h>
13 #include <linux/platform_device.h>
14
15 /* Clock Driving Strength 2 register */
16 #define CLKDRVSTR2 0x28
17 /* Clock Control 1 register */
18 #define MISCCLKCNTL1 0x40
19 /* Auxiliary clock1 enable bit */
20 #define OSCCLKENB 2
21 /* 25Mhz auxiliary output clock freq bit */
22 #define OSCOUT1CLK25MHZ 16
23
24 #define ST_CLK_48M 0
25 #define ST_CLK_25M 1
26 #define ST_CLK_MUX 2
27 #define ST_CLK_GATE 3
28 #define ST_MAX_CLKS 4
29
30 #define CLK_48M_FIXED 0
31 #define CLK_GATE_FIXED 1
32 #define CLK_MAX_FIXED 2
33
34 /* List of supported CPU ids for clk mux with 25Mhz clk support */
35 #define AMD_CPU_ID_ST 0x1576
36
37 static const char * const clk_oscout1_parents[] = { "clk48MHz", "clk25MHz" };
38 static struct clk_hw *hws[ST_MAX_CLKS];
39
40 static const struct pci_device_id fch_pci_ids[] = {
41 { PCI_DEVICE(PCI_VENDOR_ID_AMD, AMD_CPU_ID_ST) },
42 { }
43 };
44
fch_clk_probe(struct platform_device * pdev)45 static int fch_clk_probe(struct platform_device *pdev)
46 {
47 struct fch_clk_data *fch_data;
48 struct pci_dev *rdev;
49
50 fch_data = dev_get_platdata(&pdev->dev);
51 if (!fch_data || !fch_data->base)
52 return -EINVAL;
53
54 rdev = pci_get_domain_bus_and_slot(0, 0, PCI_DEVFN(0, 0));
55 if (!rdev) {
56 dev_err(&pdev->dev, "FCH device not found\n");
57 return -ENODEV;
58 }
59
60 if (pci_match_id(fch_pci_ids, rdev)) {
61 hws[ST_CLK_48M] = clk_hw_register_fixed_rate(NULL, "clk48MHz",
62 NULL, 0, 48000000);
63 hws[ST_CLK_25M] = clk_hw_register_fixed_rate(NULL, "clk25MHz",
64 NULL, 0, 25000000);
65
66 hws[ST_CLK_MUX] = clk_hw_register_mux(NULL, "oscout1_mux",
67 clk_oscout1_parents, ARRAY_SIZE(clk_oscout1_parents),
68 0, fch_data->base + CLKDRVSTR2, OSCOUT1CLK25MHZ, 3, 0,
69 NULL);
70
71 clk_set_parent(hws[ST_CLK_MUX]->clk, hws[ST_CLK_48M]->clk);
72
73 hws[ST_CLK_GATE] = clk_hw_register_gate(NULL, "oscout1",
74 "oscout1_mux", 0, fch_data->base + MISCCLKCNTL1,
75 OSCCLKENB, CLK_GATE_SET_TO_DISABLE, NULL);
76
77 devm_clk_hw_register_clkdev(&pdev->dev, hws[ST_CLK_GATE],
78 fch_data->name, NULL);
79 } else {
80 hws[CLK_48M_FIXED] = clk_hw_register_fixed_rate(NULL, "clk48MHz",
81 NULL, 0, 48000000);
82
83 hws[CLK_GATE_FIXED] = clk_hw_register_gate(NULL, "oscout1",
84 "clk48MHz", 0, fch_data->base + MISCCLKCNTL1,
85 OSCCLKENB, 0, NULL);
86
87 devm_clk_hw_register_clkdev(&pdev->dev, hws[CLK_GATE_FIXED],
88 fch_data->name, NULL);
89 }
90
91 pci_dev_put(rdev);
92 return 0;
93 }
94
fch_clk_remove(struct platform_device * pdev)95 static void fch_clk_remove(struct platform_device *pdev)
96 {
97 int i, clks;
98 struct pci_dev *rdev;
99
100 rdev = pci_get_domain_bus_and_slot(0, 0, PCI_DEVFN(0, 0));
101 if (!rdev)
102 return;
103
104 clks = pci_match_id(fch_pci_ids, rdev) ? CLK_MAX_FIXED : ST_MAX_CLKS;
105
106 for (i = 0; i < clks; i++)
107 clk_hw_unregister(hws[i]);
108
109 pci_dev_put(rdev);
110 }
111
112 static struct platform_driver fch_clk_driver = {
113 .driver = {
114 .name = "clk-fch",
115 .suppress_bind_attrs = true,
116 },
117 .probe = fch_clk_probe,
118 .remove_new = fch_clk_remove,
119 };
120 builtin_platform_driver(fch_clk_driver);
121