1 // SPDX-License-Identifier: GPL-2.0
3 * Driver for Silicon Labs Si544 Programmable Oscillator
4 * Copyright (C) 2018 Topic Embedded Products
5 * Author: Mike Looijmans <mike.looijmans@topic.nl>
8 #include <linux/clk-provider.h>
9 #include <linux/delay.h>
10 #include <linux/module.h>
11 #include <linux/i2c.h>
12 #include <linux/regmap.h>
13 #include <linux/slab.h>
15 /* I2C registers (decimal as in datasheet) */
16 #define SI544_REG_CONTROL 7
17 #define SI544_REG_OE_STATE 17
18 #define SI544_REG_HS_DIV 23
19 #define SI544_REG_LS_HS_DIV 24
20 #define SI544_REG_FBDIV0 26
21 #define SI544_REG_FBDIV8 27
22 #define SI544_REG_FBDIV16 28
23 #define SI544_REG_FBDIV24 29
24 #define SI544_REG_FBDIV32 30
25 #define SI544_REG_FBDIV40 31
26 #define SI544_REG_FCAL_OVR 69
27 #define SI544_REG_ADPLL_DELTA_M0 231
28 #define SI544_REG_ADPLL_DELTA_M8 232
29 #define SI544_REG_ADPLL_DELTA_M16 233
30 #define SI544_REG_PAGE_SELECT 255
33 #define SI544_CONTROL_RESET BIT(7)
34 #define SI544_CONTROL_MS_ICAL2 BIT(3)
36 #define SI544_OE_STATE_ODC_OE BIT(0)
38 /* Max freq depends on speed grade */
39 #define SI544_MIN_FREQ 200000U
41 /* Si544 Internal oscilator runs at 55.05 MHz */
44 /* VCO range is 10.8 .. 12.1 GHz, max depends on speed grade */
45 #define FVCO_MIN 10800000000ULL
47 #define HS_DIV_MAX 2046
48 #define HS_DIV_MAX_ODD 33
50 /* Lowest frequency synthesizeable using only the HS divider */
51 #define MIN_HSDIV_FREQ (FVCO_MIN / HS_DIV_MAX)
53 enum si544_speed_grade {
61 struct regmap *regmap;
62 struct i2c_client *i2c_client;
63 enum si544_speed_grade speed_grade;
65 #define to_clk_si544(_hw) container_of(_hw, struct clk_si544, hw)
68 * struct clk_si544_muldiv - Multiplier/divider settings
69 * @fb_div_frac: integer part of feedback divider (32 bits)
70 * @fb_div_int: fractional part of feedback divider (11 bits)
71 * @hs_div: 1st divider, 5..2046, must be even when >33
72 * @ls_div_bits: 2nd divider, as 2^x, range 0..5
73 * If ls_div_bits is non-zero, hs_div must be even
75 struct clk_si544_muldiv {
82 /* Enables or disables the output driver */
83 static int si544_enable_output(struct clk_si544 *data, bool enable)
85 return regmap_update_bits(data->regmap, SI544_REG_OE_STATE,
86 SI544_OE_STATE_ODC_OE, enable ? SI544_OE_STATE_ODC_OE : 0);
89 static int si544_prepare(struct clk_hw *hw)
91 struct clk_si544 *data = to_clk_si544(hw);
93 return si544_enable_output(data, true);
96 static void si544_unprepare(struct clk_hw *hw)
98 struct clk_si544 *data = to_clk_si544(hw);
100 si544_enable_output(data, false);
103 static int si544_is_prepared(struct clk_hw *hw)
105 struct clk_si544 *data = to_clk_si544(hw);
109 err = regmap_read(data->regmap, SI544_REG_OE_STATE, &val);
113 return !!(val & SI544_OE_STATE_ODC_OE);
116 /* Retrieve clock multiplier and dividers from hardware */
117 static int si544_get_muldiv(struct clk_si544 *data,
118 struct clk_si544_muldiv *settings)
123 err = regmap_bulk_read(data->regmap, SI544_REG_HS_DIV, reg, 2);
127 settings->ls_div_bits = (reg[1] >> 4) & 0x07;
128 settings->hs_div = (reg[1] & 0x07) << 8 | reg[0];
130 err = regmap_bulk_read(data->regmap, SI544_REG_FBDIV0, reg, 6);
134 settings->fb_div_int = reg[4] | (reg[5] & 0x07) << 8;
135 settings->fb_div_frac = reg[0] | reg[1] << 8 | reg[2] << 16 |
140 static int si544_set_muldiv(struct clk_si544 *data,
141 struct clk_si544_muldiv *settings)
146 reg[0] = settings->hs_div;
147 reg[1] = settings->hs_div >> 8 | settings->ls_div_bits << 4;
149 err = regmap_bulk_write(data->regmap, SI544_REG_HS_DIV, reg, 2);
153 reg[0] = settings->fb_div_frac;
154 reg[1] = settings->fb_div_frac >> 8;
155 reg[2] = settings->fb_div_frac >> 16;
156 reg[3] = settings->fb_div_frac >> 24;
157 reg[4] = settings->fb_div_int;
158 reg[5] = settings->fb_div_int >> 8;
161 * Writing to SI544_REG_FBDIV40 triggers the clock change, so that
162 * must be written last
164 return regmap_bulk_write(data->regmap, SI544_REG_FBDIV0, reg, 6);
167 static bool is_valid_frequency(const struct clk_si544 *data,
168 unsigned long frequency)
170 unsigned long max_freq = 0;
172 if (frequency < SI544_MIN_FREQ)
175 switch (data->speed_grade) {
177 max_freq = 1500000000;
180 max_freq = 800000000;
183 max_freq = 350000000;
187 return frequency <= max_freq;
190 /* Calculate divider settings for a given frequency */
191 static int si544_calc_muldiv(struct clk_si544_muldiv *settings,
192 unsigned long frequency)
199 /* Determine the minimum value of LS_DIV and resulting target freq. */
201 settings->ls_div_bits = 0;
203 if (frequency >= MIN_HSDIV_FREQ) {
204 settings->ls_div_bits = 0;
207 tmp = 2 * HS_DIV_MAX;
208 while (tmp <= (HS_DIV_MAX * 32)) {
209 if (((u64)frequency * tmp) >= FVCO_MIN)
214 settings->ls_div_bits = res;
215 ls_freq = frequency << res;
218 /* Determine minimum HS_DIV by rounding up */
219 vco = FVCO_MIN + ls_freq - 1;
220 do_div(vco, ls_freq);
221 settings->hs_div = vco;
223 /* round up to even number when required */
224 if ((settings->hs_div & 1) &&
225 (settings->hs_div > HS_DIV_MAX_ODD || settings->ls_div_bits))
228 /* Calculate VCO frequency (in 10..12GHz range) */
229 vco = (u64)ls_freq * settings->hs_div;
231 /* Calculate the integer part of the feedback divider */
232 tmp = do_div(vco, FXO);
233 settings->fb_div_int = vco;
235 /* And the fractional bits using the remainder */
236 vco = (u64)tmp << 32;
237 vco += FXO / 2; /* Round to nearest multiple */
239 settings->fb_div_frac = vco;
244 /* Calculate resulting frequency given the register settings */
245 static unsigned long si544_calc_rate(struct clk_si544_muldiv *settings)
247 u32 d = settings->hs_div * BIT(settings->ls_div_bits);
250 /* Calculate VCO from the fractional part */
251 vco = (u64)settings->fb_div_frac * FXO;
255 /* Add the integer part of the VCO frequency */
256 vco += (u64)settings->fb_div_int * FXO;
258 /* Apply divider to obtain the generated frequency */
264 static unsigned long si544_recalc_rate(struct clk_hw *hw,
265 unsigned long parent_rate)
267 struct clk_si544 *data = to_clk_si544(hw);
268 struct clk_si544_muldiv settings;
271 err = si544_get_muldiv(data, &settings);
275 return si544_calc_rate(&settings);
278 static long si544_round_rate(struct clk_hw *hw, unsigned long rate,
279 unsigned long *parent_rate)
281 struct clk_si544 *data = to_clk_si544(hw);
282 struct clk_si544_muldiv settings;
285 if (!is_valid_frequency(data, rate))
288 err = si544_calc_muldiv(&settings, rate);
292 return si544_calc_rate(&settings);
296 * Update output frequency for "big" frequency changes
298 static int si544_set_rate(struct clk_hw *hw, unsigned long rate,
299 unsigned long parent_rate)
301 struct clk_si544 *data = to_clk_si544(hw);
302 struct clk_si544_muldiv settings;
303 unsigned int old_oe_state;
306 if (!is_valid_frequency(data, rate))
309 err = si544_calc_muldiv(&settings, rate);
313 err = regmap_read(data->regmap, SI544_REG_OE_STATE, &old_oe_state);
317 si544_enable_output(data, false);
319 /* Allow FCAL for this frequency update */
320 err = regmap_write(data->regmap, SI544_REG_FCAL_OVR, 0);
325 err = si544_set_muldiv(data, &settings);
327 return err; /* Undefined state now, best to leave disabled */
329 /* Trigger calibration */
330 err = regmap_write(data->regmap, SI544_REG_CONTROL,
331 SI544_CONTROL_MS_ICAL2);
335 /* Applying a new frequency can take up to 10ms */
336 usleep_range(10000, 12000);
338 if (old_oe_state & SI544_OE_STATE_ODC_OE)
339 si544_enable_output(data, true);
344 static const struct clk_ops si544_clk_ops = {
345 .prepare = si544_prepare,
346 .unprepare = si544_unprepare,
347 .is_prepared = si544_is_prepared,
348 .recalc_rate = si544_recalc_rate,
349 .round_rate = si544_round_rate,
350 .set_rate = si544_set_rate,
353 static bool si544_regmap_is_volatile(struct device *dev, unsigned int reg)
356 case SI544_REG_CONTROL:
357 case SI544_REG_FCAL_OVR:
364 static const struct regmap_config si544_regmap_config = {
367 .cache_type = REGCACHE_RBTREE,
368 .max_register = SI544_REG_PAGE_SELECT,
369 .volatile_reg = si544_regmap_is_volatile,
372 static int si544_probe(struct i2c_client *client,
373 const struct i2c_device_id *id)
375 struct clk_si544 *data;
376 struct clk_init_data init;
379 data = devm_kzalloc(&client->dev, sizeof(*data), GFP_KERNEL);
383 init.ops = &si544_clk_ops;
385 init.num_parents = 0;
386 data->hw.init = &init;
387 data->i2c_client = client;
388 data->speed_grade = id->driver_data;
390 if (of_property_read_string(client->dev.of_node, "clock-output-names",
392 init.name = client->dev.of_node->name;
394 data->regmap = devm_regmap_init_i2c(client, &si544_regmap_config);
395 if (IS_ERR(data->regmap))
396 return PTR_ERR(data->regmap);
398 i2c_set_clientdata(client, data);
400 /* Select page 0, just to be sure, there appear to be no more */
401 err = regmap_write(data->regmap, SI544_REG_PAGE_SELECT, 0);
405 err = devm_clk_hw_register(&client->dev, &data->hw);
407 dev_err(&client->dev, "clock registration failed\n");
410 err = devm_of_clk_add_hw_provider(&client->dev, of_clk_hw_simple_get,
413 dev_err(&client->dev, "unable to add clk provider\n");
420 static const struct i2c_device_id si544_id[] = {
421 { "si544a", si544a },
422 { "si544b", si544b },
423 { "si544c", si544c },
426 MODULE_DEVICE_TABLE(i2c, si544_id);
428 static const struct of_device_id clk_si544_of_match[] = {
429 { .compatible = "silabs,si544a" },
430 { .compatible = "silabs,si544b" },
431 { .compatible = "silabs,si544c" },
434 MODULE_DEVICE_TABLE(of, clk_si544_of_match);
436 static struct i2c_driver si544_driver = {
439 .of_match_table = clk_si544_of_match,
441 .probe = si544_probe,
442 .id_table = si544_id,
444 module_i2c_driver(si544_driver);
446 MODULE_AUTHOR("Mike Looijmans <mike.looijmans@topic.nl>");
447 MODULE_DESCRIPTION("Si544 driver");
448 MODULE_LICENSE("GPL");