hc
2024-08-12 233ab1bd4c5697f5cdec94e60206e8c6ac609b4c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
// SPDX-License-Identifier:     GPL-2.0+
/*
 * (C) Copyright 2021, Rockchip Electronics Co., Ltd
 *
 * Rockchip SARADC driver for U-Boot
 */
 
#include <common.h>
#include <adc.h>
#include <clk.h>
#include <dm.h>
#include <errno.h>
#include <asm/io.h>
#include <reset.h>
 
#define SARADC2_EN_END_INT        BIT(0)
#define SARADC2_START            BIT(4)
#define SARADC2_SINGLE_MODE        BIT(5)
 
#define SARADC_TIMEOUT            (100 * 1000)
 
struct rockchip_saradc_regs {
   u32 conv_con;
   u32 t_pd_soc;
   u32 t_as_soc;
   u32 t_das_soc;
   u32 t_sel_soc;
   u32 high_comp0;
   u32 high_comp1;
   u32 high_comp2;
   u32 high_comp3;
   u32 high_comp4;
   u32 high_comp5;
   u32 reserved0044;
   u32 high_comp7;
   u32 high_comp8;
   u32 high_comp9;
   u32 high_comp10;
   u32 high_comp11;
   u32 high_comp12;
   u32 high_comp13;
   u32 high_comp14;
   u32 high_comp15;
   u32 low_comp0;
   u32 low_comp1;
   u32 low_comp2;
   u32 low_comp3;
   u32 low_comp4;
   u32 low_comp5;
   u32 low_comp6;
   u32 low_comp7;
   u32 low_comp8;
   u32 low_comp9;
   u32 low_comp10;
   u32 low_comp11;
   u32 low_comp12;
   u32 low_comp13;
   u32 low_comp14;
   u32 low_comp15;
   u32 debounce;
   u32 ht_int_en;
   u32 lt_int_en;
   u32 reserved0160[24];
   u32 mt_int_en;
   u32 end_int_en;
   u32 st_con;
   u32 status;
   u32 end_int_st;
   u32 ht_int_st;
   u32 lt_int_st;
   u32 mt_int_st;
   u32 data0;
   u32 data1;
   u32 data2;
   u32 data3;
   u32 data4;
   u32 data5;
   u32 data6;
   u32 data7;
   u32 data8;
   u32 data9;
   u32 data10;
   u32 data11;
   u32 data12;
   u32 data13;
   u32 data14;
   u32 data15;
   u32 auto_ch_en;
};
 
struct rockchip_saradc_data {
   int                num_bits;
   int                num_channels;
   unsigned long            clk_rate;
};
 
struct rockchip_saradc_priv {
   struct rockchip_saradc_regs        *regs;
   int                    active_channel;
   const struct rockchip_saradc_data    *data;
   struct reset_ctl            rst;
};
 
static int rockchip_saradc_channel_data(struct udevice *dev, int channel,
                   unsigned int *data)
{
   struct rockchip_saradc_priv *priv = dev_get_priv(dev);
   struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
 
   if (channel != priv->active_channel) {
       pr_err("Requested channel is not active!");
       return -EINVAL;
   }
 
   /* Clear irq */
   writel(0x1, &priv->regs->end_int_st);
 
   *data = readl(&priv->regs->data0 + priv->active_channel);
   *data &= uc_pdata->data_mask;
 
   return 0;
}
 
static int rockchip_saradc_start_channel(struct udevice *dev, int channel)
{
   struct rockchip_saradc_priv *priv = dev_get_priv(dev);
   int val;
 
   if (channel < 0 || channel >= priv->data->num_channels) {
       pr_err("Requested channel is invalid!");
       return -EINVAL;
   }
 
#if CONFIG_IS_ENABLED(DM_RESET)
   reset_assert(&priv->rst);
   udelay(10);
   reset_deassert(&priv->rst);
#endif
   writel(0x20, &priv->regs->t_pd_soc);
   writel(0xc, &priv->regs->t_das_soc);
   val = SARADC2_EN_END_INT << 16 | SARADC2_EN_END_INT;
   writel(val, &priv->regs->end_int_en);
   val = SARADC2_START | SARADC2_SINGLE_MODE | channel;
   writel(val << 16 | val, &priv->regs->conv_con);
 
   udelay(100);
 
   priv->active_channel = channel;
 
   return 0;
}
 
static int rockchip_saradc_stop(struct udevice *dev)
{
   struct rockchip_saradc_priv *priv = dev_get_priv(dev);
 
   priv->active_channel = -1;
 
   return 0;
}
 
static int rockchip_saradc_probe(struct udevice *dev)
{
   struct rockchip_saradc_priv *priv = dev_get_priv(dev);
   struct clk clk;
   int ret;
 
#if CONFIG_IS_ENABLED(DM_RESET)
   ret = reset_get_by_name(dev, "saradc-apb", &priv->rst);
   if (ret) {
       debug("reset_get_by_name() failed: %d\n", ret);
       return ret;
   }
#endif
 
   ret = clk_get_by_index(dev, 0, &clk);
   if (ret)
       return ret;
 
   ret = clk_set_rate(&clk, priv->data->clk_rate);
   if (IS_ERR_VALUE(ret))
       return ret;
 
   /* Wait until pll stable */
   mdelay(5);
 
   priv->active_channel = -1;
 
   return 0;
}
 
static int rockchip_saradc_ofdata_to_platdata(struct udevice *dev)
{
   struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
   struct rockchip_saradc_priv *priv = dev_get_priv(dev);
   struct rockchip_saradc_data *data;
 
   data = (struct rockchip_saradc_data *)dev_get_driver_data(dev);
   priv->regs = (struct rockchip_saradc_regs *)dev_read_addr(dev);
   if (priv->regs == (struct rockchip_saradc_regs *)FDT_ADDR_T_NONE) {
       pr_err("Dev: %s - can't get address!", dev->name);
       return -ENODATA;
   }
 
   priv->data = data;
   uc_pdata->data_mask = (1 << priv->data->num_bits) - 1;
   uc_pdata->data_format = ADC_DATA_FORMAT_BIN;
   uc_pdata->data_timeout_us = SARADC_TIMEOUT / 5;
   uc_pdata->channel_mask = (1 << priv->data->num_channels) - 1;
 
   return 0;
}
 
static const struct adc_ops rockchip_saradc_ops = {
   .start_channel = rockchip_saradc_start_channel,
   .channel_data = rockchip_saradc_channel_data,
   .stop = rockchip_saradc_stop,
};
 
static const struct rockchip_saradc_data rk3588_saradc_data = {
   .num_bits = 12,
   .num_channels = 8,
   .clk_rate = 1000000,
};
 
static const struct rockchip_saradc_data rk3562_saradc_data = {
   .num_bits = 10,
   .num_channels = 8,
   .clk_rate = 1000000,
};
 
static const struct rockchip_saradc_data rk1106_saradc_data = {
   .num_bits = 10,
   .num_channels = 2,
   .clk_rate = 1000000,
};
 
static const struct udevice_id rockchip_saradc_ids[] = {
   {
       .compatible = "rockchip,rk3588-saradc",
       .data = (ulong)&rk3588_saradc_data
   },
   {
       .compatible = "rockchip,rk3528-saradc",
       .data = (ulong)&rk3588_saradc_data
   },
   {
       .compatible = "rockchip,rk3562-saradc",
       .data = (ulong)&rk3562_saradc_data
   },
   {
       .compatible = "rockchip,rv1106-saradc",
       .data = (ulong)&rk1106_saradc_data
   },
   { }
};
 
U_BOOT_DRIVER(rockchip_saradc_v2) = {
   .name        = "rockchip_saradc_v2",
   .id        = UCLASS_ADC,
   .of_match    = rockchip_saradc_ids,
   .ops        = &rockchip_saradc_ops,
   .probe        = rockchip_saradc_probe,
   .ofdata_to_platdata = rockchip_saradc_ofdata_to_platdata,
   .priv_auto_alloc_size = sizeof(struct rockchip_saradc_priv),
};