1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/bitfield.h>
20#include <linux/clk.h>
21#include <linux/delay.h>
22#include <linux/module.h>
23#include <linux/of_platform.h>
24#include <linux/reset.h>
25
26#include <sound/dmaengine_pcm.h>
27#include <sound/core.h>
28
29#include "stm32_sai.h"
30
31static const struct stm32_sai_conf stm32_sai_conf_f4 = {
32 .version = SAI_STM32F4,
33 .has_spdif = false,
34};
35
36static const struct stm32_sai_conf stm32_sai_conf_h7 = {
37 .version = SAI_STM32H7,
38 .has_spdif = true,
39};
40
41static const struct of_device_id stm32_sai_ids[] = {
42 { .compatible = "st,stm32f4-sai", .data = (void *)&stm32_sai_conf_f4 },
43 { .compatible = "st,stm32h7-sai", .data = (void *)&stm32_sai_conf_h7 },
44 {}
45};
46
47static int stm32_sai_sync_conf_client(struct stm32_sai_data *sai, int synci)
48{
49 int ret;
50
51
52 ret = clk_prepare_enable(sai->pclk);
53 if (ret) {
54 dev_err(&sai->pdev->dev, "failed to enable clock: %d\n", ret);
55 return ret;
56 }
57
58 writel_relaxed(FIELD_PREP(SAI_GCR_SYNCIN_MASK, (synci - 1)), sai->base);
59
60 clk_disable_unprepare(sai->pclk);
61
62 return 0;
63}
64
65static int stm32_sai_sync_conf_provider(struct stm32_sai_data *sai, int synco)
66{
67 u32 prev_synco;
68 int ret;
69
70
71 ret = clk_prepare_enable(sai->pclk);
72 if (ret) {
73 dev_err(&sai->pdev->dev, "failed to enable clock: %d\n", ret);
74 return ret;
75 }
76
77 dev_dbg(&sai->pdev->dev, "Set %s%s as synchro provider\n",
78 sai->pdev->dev.of_node->name,
79 synco == STM_SAI_SYNC_OUT_A ? "A" : "B");
80
81 prev_synco = FIELD_GET(SAI_GCR_SYNCOUT_MASK, readl_relaxed(sai->base));
82 if (prev_synco != STM_SAI_SYNC_OUT_NONE && synco != prev_synco) {
83 dev_err(&sai->pdev->dev, "%s%s already set as sync provider\n",
84 sai->pdev->dev.of_node->name,
85 prev_synco == STM_SAI_SYNC_OUT_A ? "A" : "B");
86 clk_disable_unprepare(sai->pclk);
87 return -EINVAL;
88 }
89
90 writel_relaxed(FIELD_PREP(SAI_GCR_SYNCOUT_MASK, synco), sai->base);
91
92 clk_disable_unprepare(sai->pclk);
93
94 return 0;
95}
96
97static int stm32_sai_set_sync(struct stm32_sai_data *sai_client,
98 struct device_node *np_provider,
99 int synco, int synci)
100{
101 struct platform_device *pdev = of_find_device_by_node(np_provider);
102 struct stm32_sai_data *sai_provider;
103 int ret;
104
105 if (!pdev) {
106 dev_err(&sai_client->pdev->dev,
107 "Device not found for node %s\n", np_provider->name);
108 return -ENODEV;
109 }
110
111 sai_provider = platform_get_drvdata(pdev);
112 if (!sai_provider) {
113 dev_err(&sai_client->pdev->dev,
114 "SAI sync provider data not found\n");
115 return -EINVAL;
116 }
117
118
119 ret = stm32_sai_sync_conf_client(sai_client, synci);
120 if (ret < 0)
121 return ret;
122
123
124 return stm32_sai_sync_conf_provider(sai_provider, synco);
125}
126
127static int stm32_sai_probe(struct platform_device *pdev)
128{
129 struct stm32_sai_data *sai;
130 struct reset_control *rst;
131 struct resource *res;
132 const struct of_device_id *of_id;
133
134 sai = devm_kzalloc(&pdev->dev, sizeof(*sai), GFP_KERNEL);
135 if (!sai)
136 return -ENOMEM;
137
138 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
139 sai->base = devm_ioremap_resource(&pdev->dev, res);
140 if (IS_ERR(sai->base))
141 return PTR_ERR(sai->base);
142
143 of_id = of_match_device(stm32_sai_ids, &pdev->dev);
144 if (of_id)
145 sai->conf = (struct stm32_sai_conf *)of_id->data;
146 else
147 return -EINVAL;
148
149 if (!STM_SAI_IS_F4(sai)) {
150 sai->pclk = devm_clk_get(&pdev->dev, "pclk");
151 if (IS_ERR(sai->pclk)) {
152 dev_err(&pdev->dev, "missing bus clock pclk\n");
153 return PTR_ERR(sai->pclk);
154 }
155 }
156
157 sai->clk_x8k = devm_clk_get(&pdev->dev, "x8k");
158 if (IS_ERR(sai->clk_x8k)) {
159 dev_err(&pdev->dev, "missing x8k parent clock\n");
160 return PTR_ERR(sai->clk_x8k);
161 }
162
163 sai->clk_x11k = devm_clk_get(&pdev->dev, "x11k");
164 if (IS_ERR(sai->clk_x11k)) {
165 dev_err(&pdev->dev, "missing x11k parent clock\n");
166 return PTR_ERR(sai->clk_x11k);
167 }
168
169
170 sai->irq = platform_get_irq(pdev, 0);
171 if (sai->irq < 0) {
172 dev_err(&pdev->dev, "no irq for node %s\n", pdev->name);
173 return sai->irq;
174 }
175
176
177 rst = devm_reset_control_get_exclusive(&pdev->dev, NULL);
178 if (!IS_ERR(rst)) {
179 reset_control_assert(rst);
180 udelay(2);
181 reset_control_deassert(rst);
182 }
183
184 sai->pdev = pdev;
185 sai->set_sync = &stm32_sai_set_sync;
186 platform_set_drvdata(pdev, sai);
187
188 return devm_of_platform_populate(&pdev->dev);
189}
190
191MODULE_DEVICE_TABLE(of, stm32_sai_ids);
192
193static struct platform_driver stm32_sai_driver = {
194 .driver = {
195 .name = "st,stm32-sai",
196 .of_match_table = stm32_sai_ids,
197 },
198 .probe = stm32_sai_probe,
199};
200
201module_platform_driver(stm32_sai_driver);
202
203MODULE_DESCRIPTION("STM32 Soc SAI Interface");
204MODULE_AUTHOR("Olivier Moysan <olivier.moysan@st.com>");
205MODULE_ALIAS("platform:st,stm32-sai");
206MODULE_LICENSE("GPL v2");
207
