Commit | Line | Data |
---|---|---|
d903779b JB |
1 | // SPDX-License-Identifier: (GPL-2.0 OR MIT) |
2 | // Copyright (c) 2018 BayLibre, SAS. | |
3 | // Author: Jerome Brunet <jbrunet@baylibre.com> | |
4 | ||
5 | #include <linux/clk.h> | |
6 | #include <linux/io.h> | |
7 | #include <linux/module.h> | |
bad8a8af RH |
8 | #include <linux/of.h> |
9 | #include <linux/platform_device.h> | |
d903779b JB |
10 | #include <linux/reset-controller.h> |
11 | #include <linux/spinlock.h> | |
12 | ||
13 | #include <dt-bindings/reset/amlogic,meson-axg-audio-arb.h> | |
14 | ||
15 | struct meson_audio_arb_data { | |
16 | struct reset_controller_dev rstc; | |
17 | void __iomem *regs; | |
18 | struct clk *clk; | |
19 | const unsigned int *reset_bits; | |
20 | spinlock_t lock; | |
21 | }; | |
22 | ||
9c41152c JB |
23 | struct meson_audio_arb_match_data { |
24 | const unsigned int *reset_bits; | |
25 | unsigned int reset_num; | |
26 | }; | |
27 | ||
d903779b JB |
28 | #define ARB_GENERAL_BIT 31 |
29 | ||
30 | static const unsigned int axg_audio_arb_reset_bits[] = { | |
31 | [AXG_ARB_TODDR_A] = 0, | |
32 | [AXG_ARB_TODDR_B] = 1, | |
33 | [AXG_ARB_TODDR_C] = 2, | |
34 | [AXG_ARB_FRDDR_A] = 4, | |
35 | [AXG_ARB_FRDDR_B] = 5, | |
36 | [AXG_ARB_FRDDR_C] = 6, | |
37 | }; | |
38 | ||
9c41152c JB |
39 | static const struct meson_audio_arb_match_data axg_audio_arb_match = { |
40 | .reset_bits = axg_audio_arb_reset_bits, | |
41 | .reset_num = ARRAY_SIZE(axg_audio_arb_reset_bits), | |
42 | }; | |
43 | ||
44 | static const unsigned int sm1_audio_arb_reset_bits[] = { | |
45 | [AXG_ARB_TODDR_A] = 0, | |
46 | [AXG_ARB_TODDR_B] = 1, | |
47 | [AXG_ARB_TODDR_C] = 2, | |
48 | [AXG_ARB_FRDDR_A] = 4, | |
49 | [AXG_ARB_FRDDR_B] = 5, | |
50 | [AXG_ARB_FRDDR_C] = 6, | |
51 | [AXG_ARB_TODDR_D] = 3, | |
52 | [AXG_ARB_FRDDR_D] = 7, | |
53 | }; | |
54 | ||
55 | static const struct meson_audio_arb_match_data sm1_audio_arb_match = { | |
56 | .reset_bits = sm1_audio_arb_reset_bits, | |
57 | .reset_num = ARRAY_SIZE(sm1_audio_arb_reset_bits), | |
58 | }; | |
59 | ||
d903779b JB |
60 | static int meson_audio_arb_update(struct reset_controller_dev *rcdev, |
61 | unsigned long id, bool assert) | |
62 | { | |
63 | u32 val; | |
64 | struct meson_audio_arb_data *arb = | |
65 | container_of(rcdev, struct meson_audio_arb_data, rstc); | |
66 | ||
67 | spin_lock(&arb->lock); | |
68 | val = readl(arb->regs); | |
69 | ||
70 | if (assert) | |
71 | val &= ~BIT(arb->reset_bits[id]); | |
72 | else | |
73 | val |= BIT(arb->reset_bits[id]); | |
74 | ||
75 | writel(val, arb->regs); | |
76 | spin_unlock(&arb->lock); | |
77 | ||
78 | return 0; | |
79 | } | |
80 | ||
81 | static int meson_audio_arb_status(struct reset_controller_dev *rcdev, | |
82 | unsigned long id) | |
83 | { | |
84 | u32 val; | |
85 | struct meson_audio_arb_data *arb = | |
86 | container_of(rcdev, struct meson_audio_arb_data, rstc); | |
87 | ||
88 | val = readl(arb->regs); | |
89 | ||
90 | return !(val & BIT(arb->reset_bits[id])); | |
91 | } | |
92 | ||
93 | static int meson_audio_arb_assert(struct reset_controller_dev *rcdev, | |
94 | unsigned long id) | |
95 | { | |
96 | return meson_audio_arb_update(rcdev, id, true); | |
97 | } | |
98 | ||
99 | static int meson_audio_arb_deassert(struct reset_controller_dev *rcdev, | |
100 | unsigned long id) | |
101 | { | |
102 | return meson_audio_arb_update(rcdev, id, false); | |
103 | } | |
104 | ||
105 | static const struct reset_control_ops meson_audio_arb_rstc_ops = { | |
106 | .assert = meson_audio_arb_assert, | |
107 | .deassert = meson_audio_arb_deassert, | |
108 | .status = meson_audio_arb_status, | |
109 | }; | |
110 | ||
111 | static const struct of_device_id meson_audio_arb_of_match[] = { | |
9c41152c JB |
112 | { |
113 | .compatible = "amlogic,meson-axg-audio-arb", | |
114 | .data = &axg_audio_arb_match, | |
115 | }, { | |
116 | .compatible = "amlogic,meson-sm1-audio-arb", | |
117 | .data = &sm1_audio_arb_match, | |
118 | }, | |
d903779b JB |
119 | {} |
120 | }; | |
121 | MODULE_DEVICE_TABLE(of, meson_audio_arb_of_match); | |
122 | ||
b99e9c09 | 123 | static void meson_audio_arb_remove(struct platform_device *pdev) |
d903779b JB |
124 | { |
125 | struct meson_audio_arb_data *arb = platform_get_drvdata(pdev); | |
126 | ||
127 | /* Disable all access */ | |
128 | spin_lock(&arb->lock); | |
129 | writel(0, arb->regs); | |
130 | spin_unlock(&arb->lock); | |
d903779b JB |
131 | } |
132 | ||
133 | static int meson_audio_arb_probe(struct platform_device *pdev) | |
134 | { | |
135 | struct device *dev = &pdev->dev; | |
9c41152c | 136 | const struct meson_audio_arb_match_data *data; |
d903779b | 137 | struct meson_audio_arb_data *arb; |
d903779b JB |
138 | int ret; |
139 | ||
9c41152c JB |
140 | data = of_device_get_match_data(dev); |
141 | if (!data) | |
142 | return -EINVAL; | |
143 | ||
d903779b JB |
144 | arb = devm_kzalloc(dev, sizeof(*arb), GFP_KERNEL); |
145 | if (!arb) | |
146 | return -ENOMEM; | |
147 | platform_set_drvdata(pdev, arb); | |
148 | ||
0e8b3bca | 149 | arb->clk = devm_clk_get_enabled(dev, NULL); |
da46de51 YX |
150 | if (IS_ERR(arb->clk)) |
151 | return dev_err_probe(dev, PTR_ERR(arb->clk), "failed to get clock\n"); | |
d903779b | 152 | |
66a1f392 | 153 | arb->regs = devm_platform_ioremap_resource(pdev, 0); |
d903779b JB |
154 | if (IS_ERR(arb->regs)) |
155 | return PTR_ERR(arb->regs); | |
156 | ||
157 | spin_lock_init(&arb->lock); | |
9c41152c JB |
158 | arb->reset_bits = data->reset_bits; |
159 | arb->rstc.nr_resets = data->reset_num; | |
d903779b JB |
160 | arb->rstc.ops = &meson_audio_arb_rstc_ops; |
161 | arb->rstc.of_node = dev->of_node; | |
13e8a05b | 162 | arb->rstc.owner = THIS_MODULE; |
d903779b JB |
163 | |
164 | /* | |
165 | * Enable general : | |
166 | * In the initial state, all memory interfaces are disabled | |
167 | * and the general bit is on | |
168 | */ | |
d903779b JB |
169 | writel(BIT(ARB_GENERAL_BIT), arb->regs); |
170 | ||
171 | /* Register reset controller */ | |
172 | ret = devm_reset_controller_register(dev, &arb->rstc); | |
173 | if (ret) { | |
174 | dev_err(dev, "failed to register arb reset controller\n"); | |
175 | meson_audio_arb_remove(pdev); | |
176 | } | |
177 | ||
178 | return ret; | |
179 | } | |
180 | ||
181 | static struct platform_driver meson_audio_arb_pdrv = { | |
182 | .probe = meson_audio_arb_probe, | |
b99e9c09 | 183 | .remove_new = meson_audio_arb_remove, |
d903779b JB |
184 | .driver = { |
185 | .name = "meson-audio-arb-reset", | |
186 | .of_match_table = meson_audio_arb_of_match, | |
187 | }, | |
188 | }; | |
189 | module_platform_driver(meson_audio_arb_pdrv); | |
190 | ||
191 | MODULE_DESCRIPTION("Amlogic A113 Audio Memory Arbiter"); | |
192 | MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>"); | |
193 | MODULE_LICENSE("GPL v2"); |