1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Maxim GMSL2 Serializer Driver
4 *
5 * Copyright (C) 2024 Collabora Ltd.
6 */
7
8 #include <linux/bitfield.h>
9 #include <linux/clk.h>
10 #include <linux/clk-provider.h>
11 #include <linux/delay.h>
12 #include <linux/fwnode.h>
13 #include <linux/gpio/driver.h>
14 #include <linux/i2c-mux.h>
15 #include <linux/i2c.h>
16 #include <linux/regmap.h>
17
18 #include <media/v4l2-cci.h>
19 #include <media/v4l2-ctrls.h>
20 #include <media/v4l2-fwnode.h>
21 #include <media/v4l2-subdev.h>
22
23 #define MAX96717_DEVICE_ID 0xbf
24 #define MAX96717F_DEVICE_ID 0xc8
25 #define MAX96717_PORTS 2
26 #define MAX96717_PAD_SINK 0
27 #define MAX96717_PAD_SOURCE 1
28 #define MAX96717_CSI_NLANES 4
29
30 #define MAX96717_DEFAULT_CLKOUT_RATE 24000000UL
31
32 /* DEV */
33 #define MAX96717_REG3 CCI_REG8(0x3)
34 #define MAX96717_RCLKSEL GENMASK(1, 0)
35 #define RCLKSEL_REF_PLL CCI_REG8(0x3)
36 #define MAX96717_REG6 CCI_REG8(0x6)
37 #define RCLKEN BIT(5)
38 #define MAX96717_DEV_ID CCI_REG8(0xd)
39 #define MAX96717_DEV_REV CCI_REG8(0xe)
40 #define MAX96717_DEV_REV_MASK GENMASK(3, 0)
41
42 /* VID_TX Z */
43 #define MAX96717_VIDEO_TX0 CCI_REG8(0x110)
44 #define MAX96717_VIDEO_AUTO_BPP BIT(3)
45 #define MAX96717_VIDEO_TX2 CCI_REG8(0x112)
46 #define MAX96717_VIDEO_PCLKDET BIT(7)
47
48 /* VTX_Z */
49 #define MAX96717_VTX0 CCI_REG8(0x24e)
50 #define MAX96717_VTX1 CCI_REG8(0x24f)
51 #define MAX96717_PATTERN_CLK_FREQ GENMASK(3, 1)
52 #define MAX96717_VTX_VS_DLY CCI_REG24(0x250)
53 #define MAX96717_VTX_VS_HIGH CCI_REG24(0x253)
54 #define MAX96717_VTX_VS_LOW CCI_REG24(0x256)
55 #define MAX96717_VTX_V2H CCI_REG24(0x259)
56 #define MAX96717_VTX_HS_HIGH CCI_REG16(0x25c)
57 #define MAX96717_VTX_HS_LOW CCI_REG16(0x25e)
58 #define MAX96717_VTX_HS_CNT CCI_REG16(0x260)
59 #define MAX96717_VTX_V2D CCI_REG24(0x262)
60 #define MAX96717_VTX_DE_HIGH CCI_REG16(0x265)
61 #define MAX96717_VTX_DE_LOW CCI_REG16(0x267)
62 #define MAX96717_VTX_DE_CNT CCI_REG16(0x269)
63 #define MAX96717_VTX29 CCI_REG8(0x26b)
64 #define MAX96717_VTX_MODE GENMASK(1, 0)
65 #define MAX96717_VTX_GRAD_INC CCI_REG8(0x26c)
66 #define MAX96717_VTX_CHKB_COLOR_A CCI_REG24(0x26d)
67 #define MAX96717_VTX_CHKB_COLOR_B CCI_REG24(0x270)
68 #define MAX96717_VTX_CHKB_RPT_CNT_A CCI_REG8(0x273)
69 #define MAX96717_VTX_CHKB_RPT_CNT_B CCI_REG8(0x274)
70 #define MAX96717_VTX_CHKB_ALT CCI_REG8(0x275)
71
72 /* GPIO */
73 #define MAX96717_NUM_GPIO 11
74 #define MAX96717_GPIO_REG_A(gpio) CCI_REG8(0x2be + (gpio) * 3)
75 #define MAX96717_GPIO_OUT BIT(4)
76 #define MAX96717_GPIO_IN BIT(3)
77 #define MAX96717_GPIO_RX_EN BIT(2)
78 #define MAX96717_GPIO_TX_EN BIT(1)
79 #define MAX96717_GPIO_OUT_DIS BIT(0)
80
81 /* FRONTTOP */
82 /* MAX96717 only have CSI port 'B' */
83 #define MAX96717_FRONTOP0 CCI_REG8(0x308)
84 #define MAX96717_START_PORT_B BIT(5)
85
86 /* MIPI_RX */
87 #define MAX96717_MIPI_RX1 CCI_REG8(0x331)
88 #define MAX96717_MIPI_LANES_CNT GENMASK(5, 4)
89 #define MAX96717_MIPI_RX2 CCI_REG8(0x332) /* phy1 Lanes map */
90 #define MAX96717_PHY2_LANES_MAP GENMASK(7, 4)
91 #define MAX96717_MIPI_RX3 CCI_REG8(0x333) /* phy2 Lanes map */
92 #define MAX96717_PHY1_LANES_MAP GENMASK(3, 0)
93 #define MAX96717_MIPI_RX4 CCI_REG8(0x334) /* phy1 lane polarities */
94 #define MAX96717_PHY1_LANES_POL GENMASK(6, 4)
95 #define MAX96717_MIPI_RX5 CCI_REG8(0x335) /* phy2 lane polarities */
96 #define MAX96717_PHY2_LANES_POL GENMASK(2, 0)
97
98 /* MIPI_RX_EXT */
99 #define MAX96717_MIPI_RX_EXT11 CCI_REG8(0x383)
100 #define MAX96717_TUN_MODE BIT(7)
101
102 /* REF_VTG */
103 #define REF_VTG0 CCI_REG8(0x3f0)
104 #define REFGEN_PREDEF_EN BIT(6)
105 #define REFGEN_PREDEF_FREQ_MASK GENMASK(5, 4)
106 #define REFGEN_PREDEF_FREQ_ALT BIT(3)
107 #define REFGEN_RST BIT(1)
108 #define REFGEN_EN BIT(0)
109
110 /* MISC */
111 #define PIO_SLEW_1 CCI_REG8(0x570)
112
113 enum max96717_vpg_mode {
114 MAX96717_VPG_DISABLED = 0,
115 MAX96717_VPG_CHECKERBOARD = 1,
116 MAX96717_VPG_GRADIENT = 2,
117 };
118
119 struct max96717_priv {
120 struct i2c_client *client;
121 struct regmap *regmap;
122 struct i2c_mux_core *mux;
123 struct v4l2_mbus_config_mipi_csi2 mipi_csi2;
124 struct v4l2_subdev sd;
125 struct media_pad pads[MAX96717_PORTS];
126 struct v4l2_ctrl_handler ctrl_handler;
127 struct v4l2_async_notifier notifier;
128 struct v4l2_subdev *source_sd;
129 u16 source_sd_pad;
130 u64 enabled_source_streams;
131 u8 pll_predef_index;
132 struct clk_hw clk_hw;
133 struct gpio_chip gpio_chip;
134 enum max96717_vpg_mode pattern;
135 };
136
sd_to_max96717(struct v4l2_subdev * sd)137 static inline struct max96717_priv *sd_to_max96717(struct v4l2_subdev *sd)
138 {
139 return container_of(sd, struct max96717_priv, sd);
140 }
141
clk_hw_to_max96717(struct clk_hw * hw)142 static inline struct max96717_priv *clk_hw_to_max96717(struct clk_hw *hw)
143 {
144 return container_of(hw, struct max96717_priv, clk_hw);
145 }
146
max96717_i2c_mux_select(struct i2c_mux_core * mux,u32 chan)147 static int max96717_i2c_mux_select(struct i2c_mux_core *mux, u32 chan)
148 {
149 return 0;
150 }
151
max96717_i2c_mux_init(struct max96717_priv * priv)152 static int max96717_i2c_mux_init(struct max96717_priv *priv)
153 {
154 priv->mux = i2c_mux_alloc(priv->client->adapter, &priv->client->dev,
155 1, 0, I2C_MUX_LOCKED | I2C_MUX_GATE,
156 max96717_i2c_mux_select, NULL);
157 if (!priv->mux)
158 return -ENOMEM;
159
160 return i2c_mux_add_adapter(priv->mux, 0, 0);
161 }
162
max96717_start_csi(struct max96717_priv * priv,bool start)163 static inline int max96717_start_csi(struct max96717_priv *priv, bool start)
164 {
165 return cci_update_bits(priv->regmap, MAX96717_FRONTOP0,
166 MAX96717_START_PORT_B,
167 start ? MAX96717_START_PORT_B : 0, NULL);
168 }
169
max96717_apply_patgen_timing(struct max96717_priv * priv,struct v4l2_subdev_state * state)170 static int max96717_apply_patgen_timing(struct max96717_priv *priv,
171 struct v4l2_subdev_state *state)
172 {
173 struct v4l2_mbus_framefmt *fmt =
174 v4l2_subdev_state_get_format(state, MAX96717_PAD_SOURCE);
175 const u32 h_active = fmt->width;
176 const u32 h_fp = 88;
177 const u32 h_sw = 44;
178 const u32 h_bp = 148;
179 u32 h_tot;
180 const u32 v_active = fmt->height;
181 const u32 v_fp = 4;
182 const u32 v_sw = 5;
183 const u32 v_bp = 36;
184 u32 v_tot;
185 int ret = 0;
186
187 h_tot = h_active + h_fp + h_sw + h_bp;
188 v_tot = v_active + v_fp + v_sw + v_bp;
189
190 /* 75 Mhz pixel clock */
191 cci_update_bits(priv->regmap, MAX96717_VTX1,
192 MAX96717_PATTERN_CLK_FREQ, 0xa, &ret);
193
194 dev_info(&priv->client->dev, "height: %d width: %d\n", fmt->height,
195 fmt->width);
196
197 cci_write(priv->regmap, MAX96717_VTX_VS_DLY, 0, &ret);
198 cci_write(priv->regmap, MAX96717_VTX_VS_HIGH, v_sw * h_tot, &ret);
199 cci_write(priv->regmap, MAX96717_VTX_VS_LOW,
200 (v_active + v_fp + v_bp) * h_tot, &ret);
201 cci_write(priv->regmap, MAX96717_VTX_HS_HIGH, h_sw, &ret);
202 cci_write(priv->regmap, MAX96717_VTX_HS_LOW, h_active + h_fp + h_bp,
203 &ret);
204 cci_write(priv->regmap, MAX96717_VTX_V2D,
205 h_tot * (v_sw + v_bp) + (h_sw + h_bp), &ret);
206 cci_write(priv->regmap, MAX96717_VTX_HS_CNT, v_tot, &ret);
207 cci_write(priv->regmap, MAX96717_VTX_DE_HIGH, h_active, &ret);
208 cci_write(priv->regmap, MAX96717_VTX_DE_LOW, h_fp + h_sw + h_bp,
209 &ret);
210 cci_write(priv->regmap, MAX96717_VTX_DE_CNT, v_active, &ret);
211 /* B G R */
212 cci_write(priv->regmap, MAX96717_VTX_CHKB_COLOR_A, 0xfecc00, &ret);
213 /* B G R */
214 cci_write(priv->regmap, MAX96717_VTX_CHKB_COLOR_B, 0x006aa7, &ret);
215 cci_write(priv->regmap, MAX96717_VTX_CHKB_RPT_CNT_A, 0x3c, &ret);
216 cci_write(priv->regmap, MAX96717_VTX_CHKB_RPT_CNT_B, 0x3c, &ret);
217 cci_write(priv->regmap, MAX96717_VTX_CHKB_ALT, 0x3c, &ret);
218 cci_write(priv->regmap, MAX96717_VTX_GRAD_INC, 0x10, &ret);
219
220 return ret;
221 }
222
max96717_apply_patgen(struct max96717_priv * priv,struct v4l2_subdev_state * state)223 static int max96717_apply_patgen(struct max96717_priv *priv,
224 struct v4l2_subdev_state *state)
225 {
226 unsigned int val;
227 int ret = 0;
228
229 if (priv->pattern)
230 ret = max96717_apply_patgen_timing(priv, state);
231
232 cci_write(priv->regmap, MAX96717_VTX0, priv->pattern ? 0xfb : 0,
233 &ret);
234
235 val = FIELD_PREP(MAX96717_VTX_MODE, priv->pattern);
236 cci_update_bits(priv->regmap, MAX96717_VTX29, MAX96717_VTX_MODE,
237 val, &ret);
238 return ret;
239 }
240
max96717_s_ctrl(struct v4l2_ctrl * ctrl)241 static int max96717_s_ctrl(struct v4l2_ctrl *ctrl)
242 {
243 struct max96717_priv *priv =
244 container_of(ctrl->handler, struct max96717_priv, ctrl_handler);
245 int ret;
246
247 switch (ctrl->id) {
248 case V4L2_CID_TEST_PATTERN:
249 if (priv->enabled_source_streams)
250 return -EBUSY;
251 priv->pattern = ctrl->val;
252 break;
253 default:
254 return -EINVAL;
255 }
256
257 /* Use bpp from bpp register */
258 ret = cci_update_bits(priv->regmap, MAX96717_VIDEO_TX0,
259 MAX96717_VIDEO_AUTO_BPP,
260 priv->pattern ? 0 : MAX96717_VIDEO_AUTO_BPP,
261 NULL);
262
263 /*
264 * Pattern generator doesn't work with tunnel mode.
265 * Needs RGB color format and deserializer tunnel mode must be disabled.
266 */
267 return cci_update_bits(priv->regmap, MAX96717_MIPI_RX_EXT11,
268 MAX96717_TUN_MODE,
269 priv->pattern ? 0 : MAX96717_TUN_MODE, &ret);
270 }
271
272 static const char * const max96717_test_pattern[] = {
273 "Disabled",
274 "Checkerboard",
275 "Gradient"
276 };
277
278 static const struct v4l2_ctrl_ops max96717_ctrl_ops = {
279 .s_ctrl = max96717_s_ctrl,
280 };
281
max96717_gpiochip_get(struct gpio_chip * gpiochip,unsigned int offset)282 static int max96717_gpiochip_get(struct gpio_chip *gpiochip,
283 unsigned int offset)
284 {
285 struct max96717_priv *priv = gpiochip_get_data(gpiochip);
286 u64 val;
287 int ret;
288
289 ret = cci_read(priv->regmap, MAX96717_GPIO_REG_A(offset),
290 &val, NULL);
291 if (ret)
292 return ret;
293
294 if (val & MAX96717_GPIO_OUT_DIS)
295 return !!(val & MAX96717_GPIO_IN);
296 else
297 return !!(val & MAX96717_GPIO_OUT);
298 }
299
max96717_gpiochip_set(struct gpio_chip * gpiochip,unsigned int offset,int value)300 static void max96717_gpiochip_set(struct gpio_chip *gpiochip,
301 unsigned int offset, int value)
302 {
303 struct max96717_priv *priv = gpiochip_get_data(gpiochip);
304
305 cci_update_bits(priv->regmap, MAX96717_GPIO_REG_A(offset),
306 MAX96717_GPIO_OUT, MAX96717_GPIO_OUT, NULL);
307 }
308
max96717_gpio_get_direction(struct gpio_chip * gpiochip,unsigned int offset)309 static int max96717_gpio_get_direction(struct gpio_chip *gpiochip,
310 unsigned int offset)
311 {
312 struct max96717_priv *priv = gpiochip_get_data(gpiochip);
313 u64 val;
314 int ret;
315
316 ret = cci_read(priv->regmap, MAX96717_GPIO_REG_A(offset), &val, NULL);
317 if (ret < 0)
318 return ret;
319
320 return !!(val & MAX96717_GPIO_OUT_DIS);
321 }
322
max96717_gpio_direction_out(struct gpio_chip * gpiochip,unsigned int offset,int value)323 static int max96717_gpio_direction_out(struct gpio_chip *gpiochip,
324 unsigned int offset, int value)
325 {
326 struct max96717_priv *priv = gpiochip_get_data(gpiochip);
327
328 return cci_update_bits(priv->regmap, MAX96717_GPIO_REG_A(offset),
329 MAX96717_GPIO_OUT_DIS | MAX96717_GPIO_OUT,
330 value ? MAX96717_GPIO_OUT : 0, NULL);
331 }
332
max96717_gpio_direction_in(struct gpio_chip * gpiochip,unsigned int offset)333 static int max96717_gpio_direction_in(struct gpio_chip *gpiochip,
334 unsigned int offset)
335 {
336 struct max96717_priv *priv = gpiochip_get_data(gpiochip);
337
338 return cci_update_bits(priv->regmap, MAX96717_GPIO_REG_A(offset),
339 MAX96717_GPIO_OUT_DIS, MAX96717_GPIO_OUT_DIS,
340 NULL);
341 }
342
max96717_gpiochip_probe(struct max96717_priv * priv)343 static int max96717_gpiochip_probe(struct max96717_priv *priv)
344 {
345 struct device *dev = &priv->client->dev;
346 struct gpio_chip *gc = &priv->gpio_chip;
347 int i, ret = 0;
348
349 gc->label = dev_name(dev);
350 gc->parent = dev;
351 gc->owner = THIS_MODULE;
352 gc->ngpio = MAX96717_NUM_GPIO;
353 gc->base = -1;
354 gc->can_sleep = true;
355 gc->get_direction = max96717_gpio_get_direction;
356 gc->direction_input = max96717_gpio_direction_in;
357 gc->direction_output = max96717_gpio_direction_out;
358 gc->set = max96717_gpiochip_set;
359 gc->get = max96717_gpiochip_get;
360 gc->of_gpio_n_cells = 2;
361
362 /* Disable GPIO forwarding */
363 for (i = 0; i < gc->ngpio; i++)
364 cci_update_bits(priv->regmap, MAX96717_GPIO_REG_A(i),
365 MAX96717_GPIO_RX_EN | MAX96717_GPIO_TX_EN,
366 0, &ret);
367
368 if (ret)
369 return ret;
370
371 ret = devm_gpiochip_add_data(dev, gc, priv);
372 if (ret) {
373 dev_err(dev, "Unable to create gpio_chip\n");
374 return ret;
375 }
376
377 return 0;
378 }
379
_max96717_set_routing(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_krouting * routing)380 static int _max96717_set_routing(struct v4l2_subdev *sd,
381 struct v4l2_subdev_state *state,
382 struct v4l2_subdev_krouting *routing)
383 {
384 static const struct v4l2_mbus_framefmt format = {
385 .width = 1280,
386 .height = 1080,
387 .code = MEDIA_BUS_FMT_Y8_1X8,
388 .field = V4L2_FIELD_NONE,
389 };
390 int ret;
391
392 ret = v4l2_subdev_routing_validate(sd, routing,
393 V4L2_SUBDEV_ROUTING_ONLY_1_TO_1);
394 if (ret)
395 return ret;
396
397 ret = v4l2_subdev_set_routing_with_fmt(sd, state, routing, &format);
398 if (ret)
399 return ret;
400
401 return 0;
402 }
403
max96717_set_routing(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,enum v4l2_subdev_format_whence which,struct v4l2_subdev_krouting * routing)404 static int max96717_set_routing(struct v4l2_subdev *sd,
405 struct v4l2_subdev_state *state,
406 enum v4l2_subdev_format_whence which,
407 struct v4l2_subdev_krouting *routing)
408 {
409 struct max96717_priv *priv = sd_to_max96717(sd);
410
411 if (which == V4L2_SUBDEV_FORMAT_ACTIVE && priv->enabled_source_streams)
412 return -EBUSY;
413
414 return _max96717_set_routing(sd, state, routing);
415 }
416
max96717_set_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_format * format)417 static int max96717_set_fmt(struct v4l2_subdev *sd,
418 struct v4l2_subdev_state *state,
419 struct v4l2_subdev_format *format)
420 {
421 struct max96717_priv *priv = sd_to_max96717(sd);
422 struct v4l2_mbus_framefmt *fmt;
423 u64 stream_source_mask;
424
425 if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE &&
426 priv->enabled_source_streams)
427 return -EBUSY;
428
429 /* No transcoding, source and sink formats must match. */
430 if (format->pad == MAX96717_PAD_SOURCE)
431 return v4l2_subdev_get_fmt(sd, state, format);
432
433 /* Set sink format */
434 fmt = v4l2_subdev_state_get_format(state, format->pad, format->stream);
435 if (!fmt)
436 return -EINVAL;
437
438 *fmt = format->format;
439
440 /* Propagate to source format */
441 fmt = v4l2_subdev_state_get_opposite_stream_format(state, format->pad,
442 format->stream);
443 if (!fmt)
444 return -EINVAL;
445 *fmt = format->format;
446
447 stream_source_mask = BIT(format->stream);
448
449 return v4l2_subdev_state_xlate_streams(state, MAX96717_PAD_SOURCE,
450 MAX96717_PAD_SINK,
451 &stream_source_mask);
452 }
453
max96717_init_state(struct v4l2_subdev * sd,struct v4l2_subdev_state * state)454 static int max96717_init_state(struct v4l2_subdev *sd,
455 struct v4l2_subdev_state *state)
456 {
457 struct v4l2_subdev_route routes[] = {
458 {
459 .sink_pad = MAX96717_PAD_SINK,
460 .sink_stream = 0,
461 .source_pad = MAX96717_PAD_SOURCE,
462 .source_stream = 0,
463 .flags = V4L2_SUBDEV_ROUTE_FL_ACTIVE,
464 },
465 };
466 struct v4l2_subdev_krouting routing = {
467 .num_routes = ARRAY_SIZE(routes),
468 .routes = routes,
469 };
470
471 return _max96717_set_routing(sd, state, &routing);
472 }
473
max96717_pipe_pclkdet(struct max96717_priv * priv)474 static bool max96717_pipe_pclkdet(struct max96717_priv *priv)
475 {
476 u64 val = 0;
477
478 cci_read(priv->regmap, MAX96717_VIDEO_TX2, &val, NULL);
479
480 return val & MAX96717_VIDEO_PCLKDET;
481 }
482
max96717_log_status(struct v4l2_subdev * sd)483 static int max96717_log_status(struct v4l2_subdev *sd)
484 {
485 struct max96717_priv *priv = sd_to_max96717(sd);
486 struct device *dev = &priv->client->dev;
487
488 dev_info(dev, "Serializer: max96717\n");
489 dev_info(dev, "Pipe: pclkdet:%d\n", max96717_pipe_pclkdet(priv));
490
491 return 0;
492 }
493
max96717_enable_streams(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,u32 pad,u64 streams_mask)494 static int max96717_enable_streams(struct v4l2_subdev *sd,
495 struct v4l2_subdev_state *state, u32 pad,
496 u64 streams_mask)
497 {
498 struct max96717_priv *priv = sd_to_max96717(sd);
499 u64 sink_streams;
500 int ret;
501
502 if (!priv->enabled_source_streams)
503 max96717_start_csi(priv, true);
504
505 ret = max96717_apply_patgen(priv, state);
506 if (ret)
507 goto stop_csi;
508
509 if (!priv->pattern) {
510 sink_streams =
511 v4l2_subdev_state_xlate_streams(state,
512 MAX96717_PAD_SOURCE,
513 MAX96717_PAD_SINK,
514 &streams_mask);
515
516 ret = v4l2_subdev_enable_streams(priv->source_sd,
517 priv->source_sd_pad,
518 sink_streams);
519 if (ret)
520 goto stop_csi;
521 }
522
523 priv->enabled_source_streams |= streams_mask;
524
525 return 0;
526
527 stop_csi:
528 if (!priv->enabled_source_streams)
529 max96717_start_csi(priv, false);
530
531 return ret;
532 }
533
max96717_disable_streams(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,u32 pad,u64 streams_mask)534 static int max96717_disable_streams(struct v4l2_subdev *sd,
535 struct v4l2_subdev_state *state, u32 pad,
536 u64 streams_mask)
537 {
538 struct max96717_priv *priv = sd_to_max96717(sd);
539 u64 sink_streams;
540
541 /*
542 * Stop the CSI receiver first then the source,
543 * otherwise the device may become unresponsive
544 * while holding the I2C bus low.
545 */
546 priv->enabled_source_streams &= ~streams_mask;
547 if (!priv->enabled_source_streams)
548 max96717_start_csi(priv, false);
549
550 if (!priv->pattern) {
551 int ret;
552
553 sink_streams =
554 v4l2_subdev_state_xlate_streams(state,
555 MAX96717_PAD_SOURCE,
556 MAX96717_PAD_SINK,
557 &streams_mask);
558
559 ret = v4l2_subdev_disable_streams(priv->source_sd,
560 priv->source_sd_pad,
561 sink_streams);
562 if (ret)
563 return ret;
564 }
565
566 return 0;
567 }
568
569 static const struct v4l2_subdev_pad_ops max96717_pad_ops = {
570 .enable_streams = max96717_enable_streams,
571 .disable_streams = max96717_disable_streams,
572 .set_routing = max96717_set_routing,
573 .get_fmt = v4l2_subdev_get_fmt,
574 .set_fmt = max96717_set_fmt,
575 };
576
577 static const struct v4l2_subdev_core_ops max96717_subdev_core_ops = {
578 .log_status = max96717_log_status,
579 };
580
581 static const struct v4l2_subdev_internal_ops max96717_internal_ops = {
582 .init_state = max96717_init_state,
583 };
584
585 static const struct v4l2_subdev_ops max96717_subdev_ops = {
586 .core = &max96717_subdev_core_ops,
587 .pad = &max96717_pad_ops,
588 };
589
590 static const struct media_entity_operations max96717_entity_ops = {
591 .link_validate = v4l2_subdev_link_validate,
592 };
593
max96717_notify_bound(struct v4l2_async_notifier * notifier,struct v4l2_subdev * source_subdev,struct v4l2_async_connection * asd)594 static int max96717_notify_bound(struct v4l2_async_notifier *notifier,
595 struct v4l2_subdev *source_subdev,
596 struct v4l2_async_connection *asd)
597 {
598 struct max96717_priv *priv = sd_to_max96717(notifier->sd);
599 struct device *dev = &priv->client->dev;
600 int ret;
601
602 ret = media_entity_get_fwnode_pad(&source_subdev->entity,
603 source_subdev->fwnode,
604 MEDIA_PAD_FL_SOURCE);
605 if (ret < 0) {
606 dev_err(dev, "Failed to find pad for %s\n",
607 source_subdev->name);
608 return ret;
609 }
610
611 priv->source_sd = source_subdev;
612 priv->source_sd_pad = ret;
613
614 ret = media_create_pad_link(&source_subdev->entity, priv->source_sd_pad,
615 &priv->sd.entity, 0,
616 MEDIA_LNK_FL_ENABLED |
617 MEDIA_LNK_FL_IMMUTABLE);
618 if (ret) {
619 dev_err(dev, "Unable to link %s:%u -> %s:0\n",
620 source_subdev->name, priv->source_sd_pad,
621 priv->sd.name);
622 return ret;
623 }
624
625 return 0;
626 }
627
628 static const struct v4l2_async_notifier_operations max96717_notify_ops = {
629 .bound = max96717_notify_bound,
630 };
631
max96717_v4l2_notifier_register(struct max96717_priv * priv)632 static int max96717_v4l2_notifier_register(struct max96717_priv *priv)
633 {
634 struct device *dev = &priv->client->dev;
635 struct v4l2_async_connection *asd;
636 struct fwnode_handle *ep_fwnode;
637 int ret;
638
639 ep_fwnode = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev),
640 MAX96717_PAD_SINK, 0, 0);
641 if (!ep_fwnode) {
642 dev_err(dev, "No graph endpoint\n");
643 return -ENODEV;
644 }
645
646 v4l2_async_subdev_nf_init(&priv->notifier, &priv->sd);
647
648 asd = v4l2_async_nf_add_fwnode_remote(&priv->notifier, ep_fwnode,
649 struct v4l2_async_connection);
650
651 fwnode_handle_put(ep_fwnode);
652
653 if (IS_ERR(asd)) {
654 dev_err(dev, "Failed to add subdev: %ld", PTR_ERR(asd));
655 v4l2_async_nf_cleanup(&priv->notifier);
656 return PTR_ERR(asd);
657 }
658
659 priv->notifier.ops = &max96717_notify_ops;
660
661 ret = v4l2_async_nf_register(&priv->notifier);
662 if (ret) {
663 dev_err(dev, "Failed to register subdev_notifier");
664 v4l2_async_nf_cleanup(&priv->notifier);
665 return ret;
666 }
667
668 return 0;
669 }
670
max96717_subdev_init(struct max96717_priv * priv)671 static int max96717_subdev_init(struct max96717_priv *priv)
672 {
673 struct device *dev = &priv->client->dev;
674 int ret;
675
676 v4l2_i2c_subdev_init(&priv->sd, priv->client, &max96717_subdev_ops);
677 priv->sd.internal_ops = &max96717_internal_ops;
678
679 v4l2_ctrl_handler_init(&priv->ctrl_handler, 1);
680 priv->sd.ctrl_handler = &priv->ctrl_handler;
681
682 v4l2_ctrl_new_std_menu_items(&priv->ctrl_handler,
683 &max96717_ctrl_ops,
684 V4L2_CID_TEST_PATTERN,
685 ARRAY_SIZE(max96717_test_pattern) - 1,
686 0, 0, max96717_test_pattern);
687 if (priv->ctrl_handler.error) {
688 ret = priv->ctrl_handler.error;
689 goto err_free_ctrl;
690 }
691
692 priv->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_STREAMS;
693 priv->sd.entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
694 priv->sd.entity.ops = &max96717_entity_ops;
695
696 priv->pads[MAX96717_PAD_SINK].flags = MEDIA_PAD_FL_SINK;
697 priv->pads[MAX96717_PAD_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
698
699 ret = media_entity_pads_init(&priv->sd.entity, 2, priv->pads);
700 if (ret) {
701 dev_err_probe(dev, ret, "Failed to init pads\n");
702 goto err_free_ctrl;
703 }
704
705 ret = v4l2_subdev_init_finalize(&priv->sd);
706 if (ret) {
707 dev_err_probe(dev, ret,
708 "v4l2 subdev init finalized failed\n");
709 goto err_entity_cleanup;
710 }
711 ret = max96717_v4l2_notifier_register(priv);
712 if (ret) {
713 dev_err_probe(dev, ret,
714 "v4l2 subdev notifier register failed\n");
715 goto err_free_state;
716 }
717
718 ret = v4l2_async_register_subdev(&priv->sd);
719 if (ret) {
720 dev_err_probe(dev, ret, "v4l2_async_register_subdev error\n");
721 goto err_unreg_notif;
722 }
723
724 return 0;
725
726 err_unreg_notif:
727 v4l2_async_nf_unregister(&priv->notifier);
728 v4l2_async_nf_cleanup(&priv->notifier);
729 err_free_state:
730 v4l2_subdev_cleanup(&priv->sd);
731 err_entity_cleanup:
732 media_entity_cleanup(&priv->sd.entity);
733 err_free_ctrl:
734 v4l2_ctrl_handler_free(&priv->ctrl_handler);
735
736 return ret;
737 }
738
max96717_subdev_uninit(struct max96717_priv * priv)739 static void max96717_subdev_uninit(struct max96717_priv *priv)
740 {
741 v4l2_async_unregister_subdev(&priv->sd);
742 v4l2_async_nf_unregister(&priv->notifier);
743 v4l2_async_nf_cleanup(&priv->notifier);
744 v4l2_subdev_cleanup(&priv->sd);
745 media_entity_cleanup(&priv->sd.entity);
746 v4l2_ctrl_handler_free(&priv->ctrl_handler);
747 }
748
749 struct max96717_pll_predef_freq {
750 unsigned long freq;
751 bool is_alt;
752 u8 val;
753 };
754
755 static const struct max96717_pll_predef_freq max96717_predef_freqs[] = {
756 { 13500000, true, 0 }, { 19200000, false, 0 },
757 { 24000000, true, 1 }, { 27000000, false, 1 },
758 { 37125000, false, 2 }, { 74250000, false, 3 },
759 };
760
761 static unsigned long
max96717_clk_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)762 max96717_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
763 {
764 struct max96717_priv *priv = clk_hw_to_max96717(hw);
765
766 return max96717_predef_freqs[priv->pll_predef_index].freq;
767 }
768
max96717_clk_find_best_index(struct max96717_priv * priv,unsigned long rate)769 static unsigned int max96717_clk_find_best_index(struct max96717_priv *priv,
770 unsigned long rate)
771 {
772 unsigned int i, idx = 0;
773 unsigned long diff_new, diff_old = U32_MAX;
774
775 for (i = 0; i < ARRAY_SIZE(max96717_predef_freqs); i++) {
776 diff_new = abs(rate - max96717_predef_freqs[i].freq);
777 if (diff_new < diff_old) {
778 diff_old = diff_new;
779 idx = i;
780 }
781 }
782
783 return idx;
784 }
785
max96717_clk_round_rate(struct clk_hw * hw,unsigned long rate,unsigned long * parent_rate)786 static long max96717_clk_round_rate(struct clk_hw *hw, unsigned long rate,
787 unsigned long *parent_rate)
788 {
789 struct max96717_priv *priv = clk_hw_to_max96717(hw);
790 struct device *dev = &priv->client->dev;
791 unsigned int idx;
792
793 idx = max96717_clk_find_best_index(priv, rate);
794
795 if (rate != max96717_predef_freqs[idx].freq) {
796 dev_warn(dev, "Request CLK freq:%lu, found CLK freq:%lu\n",
797 rate, max96717_predef_freqs[idx].freq);
798 }
799
800 return max96717_predef_freqs[idx].freq;
801 }
802
max96717_clk_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)803 static int max96717_clk_set_rate(struct clk_hw *hw, unsigned long rate,
804 unsigned long parent_rate)
805 {
806 struct max96717_priv *priv = clk_hw_to_max96717(hw);
807 unsigned int val, idx;
808 int ret = 0;
809
810 idx = max96717_clk_find_best_index(priv, rate);
811
812 val = FIELD_PREP(REFGEN_PREDEF_FREQ_MASK,
813 max96717_predef_freqs[idx].val);
814
815 if (max96717_predef_freqs[idx].is_alt)
816 val |= REFGEN_PREDEF_FREQ_ALT;
817
818 val |= REFGEN_RST | REFGEN_PREDEF_EN;
819
820 cci_write(priv->regmap, REF_VTG0, val, &ret);
821 cci_update_bits(priv->regmap, REF_VTG0, REFGEN_RST | REFGEN_EN,
822 REFGEN_EN, &ret);
823 if (ret)
824 return ret;
825
826 priv->pll_predef_index = idx;
827
828 return 0;
829 }
830
max96717_clk_prepare(struct clk_hw * hw)831 static int max96717_clk_prepare(struct clk_hw *hw)
832 {
833 struct max96717_priv *priv = clk_hw_to_max96717(hw);
834
835 return cci_update_bits(priv->regmap, MAX96717_REG6, RCLKEN,
836 RCLKEN, NULL);
837 }
838
max96717_clk_unprepare(struct clk_hw * hw)839 static void max96717_clk_unprepare(struct clk_hw *hw)
840 {
841 struct max96717_priv *priv = clk_hw_to_max96717(hw);
842
843 cci_update_bits(priv->regmap, MAX96717_REG6, RCLKEN, 0, NULL);
844 }
845
846 static const struct clk_ops max96717_clk_ops = {
847 .prepare = max96717_clk_prepare,
848 .unprepare = max96717_clk_unprepare,
849 .set_rate = max96717_clk_set_rate,
850 .recalc_rate = max96717_clk_recalc_rate,
851 .round_rate = max96717_clk_round_rate,
852 };
853
max96717_register_clkout(struct max96717_priv * priv)854 static int max96717_register_clkout(struct max96717_priv *priv)
855 {
856 struct device *dev = &priv->client->dev;
857 struct clk_init_data init = { .ops = &max96717_clk_ops };
858 int ret;
859
860 init.name = kasprintf(GFP_KERNEL, "max96717.%s.clk_out", dev_name(dev));
861 if (!init.name)
862 return -ENOMEM;
863
864 /* RCLKSEL Reference PLL output */
865 ret = cci_update_bits(priv->regmap, MAX96717_REG3, MAX96717_RCLKSEL,
866 MAX96717_RCLKSEL, NULL);
867 /* MFP4 fastest slew rate */
868 cci_update_bits(priv->regmap, PIO_SLEW_1, BIT(5) | BIT(4), 0, &ret);
869 if (ret)
870 goto free_init_name;
871
872 priv->clk_hw.init = &init;
873
874 /* Initialize to 24 MHz */
875 ret = max96717_clk_set_rate(&priv->clk_hw,
876 MAX96717_DEFAULT_CLKOUT_RATE, 0);
877 if (ret < 0)
878 goto free_init_name;
879
880 ret = devm_clk_hw_register(dev, &priv->clk_hw);
881 kfree(init.name);
882 if (ret)
883 return dev_err_probe(dev, ret, "Cannot register clock HW\n");
884
885 ret = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
886 &priv->clk_hw);
887 if (ret)
888 return dev_err_probe(dev, ret,
889 "Cannot add OF clock provider\n");
890
891 return 0;
892
893 free_init_name:
894 kfree(init.name);
895 return ret;
896 }
897
max96717_init_csi_lanes(struct max96717_priv * priv)898 static int max96717_init_csi_lanes(struct max96717_priv *priv)
899 {
900 struct v4l2_mbus_config_mipi_csi2 *mipi = &priv->mipi_csi2;
901 unsigned long lanes_used = 0;
902 unsigned int nlanes, lane, val = 0;
903 int ret;
904
905 nlanes = mipi->num_data_lanes;
906
907 ret = cci_update_bits(priv->regmap, MAX96717_MIPI_RX1,
908 MAX96717_MIPI_LANES_CNT,
909 FIELD_PREP(MAX96717_MIPI_LANES_CNT,
910 nlanes - 1), NULL);
911
912 /* lanes polarity */
913 for (lane = 0; lane < nlanes + 1; lane++) {
914 if (!mipi->lane_polarities[lane])
915 continue;
916 /* Clock lane */
917 if (lane == 0)
918 val |= BIT(2);
919 else if (lane < 3)
920 val |= BIT(lane - 1);
921 else
922 val |= BIT(lane);
923 }
924
925 cci_update_bits(priv->regmap, MAX96717_MIPI_RX5,
926 MAX96717_PHY2_LANES_POL,
927 FIELD_PREP(MAX96717_PHY2_LANES_POL, val), &ret);
928
929 cci_update_bits(priv->regmap, MAX96717_MIPI_RX4,
930 MAX96717_PHY1_LANES_POL,
931 FIELD_PREP(MAX96717_PHY1_LANES_POL,
932 val >> 3), &ret);
933 /* lanes mapping */
934 for (lane = 0, val = 0; lane < nlanes; lane++) {
935 val |= (mipi->data_lanes[lane] - 1) << (lane * 2);
936 lanes_used |= BIT(mipi->data_lanes[lane] - 1);
937 }
938
939 /*
940 * Unused lanes need to be mapped as well to not have
941 * the same lanes mapped twice.
942 */
943 for (; lane < MAX96717_CSI_NLANES; lane++) {
944 unsigned int idx = find_first_zero_bit(&lanes_used,
945 MAX96717_CSI_NLANES);
946
947 val |= idx << (lane * 2);
948 lanes_used |= BIT(idx);
949 }
950
951 cci_update_bits(priv->regmap, MAX96717_MIPI_RX3,
952 MAX96717_PHY1_LANES_MAP,
953 FIELD_PREP(MAX96717_PHY1_LANES_MAP, val), &ret);
954
955 return cci_update_bits(priv->regmap, MAX96717_MIPI_RX2,
956 MAX96717_PHY2_LANES_MAP,
957 FIELD_PREP(MAX96717_PHY2_LANES_MAP, val >> 4),
958 &ret);
959 }
960
max96717_hw_init(struct max96717_priv * priv)961 static int max96717_hw_init(struct max96717_priv *priv)
962 {
963 struct device *dev = &priv->client->dev;
964 u64 dev_id, val;
965 int ret;
966
967 ret = cci_read(priv->regmap, MAX96717_DEV_ID, &dev_id, NULL);
968 if (ret)
969 return dev_err_probe(dev, ret,
970 "Fail to read the device id\n");
971
972 if (dev_id != MAX96717_DEVICE_ID && dev_id != MAX96717F_DEVICE_ID)
973 return dev_err_probe(dev, -EOPNOTSUPP,
974 "Unsupported device id got %x\n", (u8)dev_id);
975
976 ret = cci_read(priv->regmap, MAX96717_DEV_REV, &val, NULL);
977 if (ret)
978 return dev_err_probe(dev, ret,
979 "Fail to read device revision");
980
981 dev_dbg(dev, "Found %x (rev %lx)\n", (u8)dev_id,
982 (u8)val & MAX96717_DEV_REV_MASK);
983
984 ret = cci_read(priv->regmap, MAX96717_MIPI_RX_EXT11, &val, NULL);
985 if (ret)
986 return dev_err_probe(dev, ret,
987 "Fail to read mipi rx extension");
988
989 if (!(val & MAX96717_TUN_MODE))
990 return dev_err_probe(dev, -EOPNOTSUPP,
991 "Only supporting tunnel mode");
992
993 return max96717_init_csi_lanes(priv);
994 }
995
max96717_parse_dt(struct max96717_priv * priv)996 static int max96717_parse_dt(struct max96717_priv *priv)
997 {
998 struct device *dev = &priv->client->dev;
999 struct v4l2_fwnode_endpoint vep = { .bus_type = V4L2_MBUS_CSI2_DPHY };
1000 struct fwnode_handle *ep_fwnode;
1001 unsigned char num_data_lanes;
1002 int ret;
1003
1004 ep_fwnode = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev),
1005 MAX96717_PAD_SINK, 0, 0);
1006 if (!ep_fwnode)
1007 return dev_err_probe(dev, -ENOENT, "no endpoint found\n");
1008
1009 ret = v4l2_fwnode_endpoint_parse(ep_fwnode, &vep);
1010
1011 fwnode_handle_put(ep_fwnode);
1012
1013 if (ret < 0)
1014 return dev_err_probe(dev, ret, "Failed to parse sink endpoint");
1015
1016 num_data_lanes = vep.bus.mipi_csi2.num_data_lanes;
1017 if (num_data_lanes < 1 || num_data_lanes > MAX96717_CSI_NLANES)
1018 return dev_err_probe(dev, -EINVAL,
1019 "Invalid data lanes must be 1 to 4\n");
1020
1021 priv->mipi_csi2 = vep.bus.mipi_csi2;
1022
1023 return 0;
1024 }
1025
max96717_probe(struct i2c_client * client)1026 static int max96717_probe(struct i2c_client *client)
1027 {
1028 struct device *dev = &client->dev;
1029 struct max96717_priv *priv;
1030 int ret;
1031
1032 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1033 if (!priv)
1034 return -ENOMEM;
1035
1036 priv->client = client;
1037 priv->regmap = devm_cci_regmap_init_i2c(client, 16);
1038 if (IS_ERR(priv->regmap)) {
1039 ret = PTR_ERR(priv->regmap);
1040 return dev_err_probe(dev, ret, "Failed to init regmap\n");
1041 }
1042
1043 ret = max96717_parse_dt(priv);
1044 if (ret)
1045 return dev_err_probe(dev, ret, "Failed to parse the dt\n");
1046
1047 ret = max96717_hw_init(priv);
1048 if (ret)
1049 return dev_err_probe(dev, ret,
1050 "Failed to initialize the hardware\n");
1051
1052 ret = max96717_gpiochip_probe(priv);
1053 if (ret)
1054 return dev_err_probe(&client->dev, ret,
1055 "Failed to init gpiochip\n");
1056
1057 ret = max96717_register_clkout(priv);
1058 if (ret)
1059 return dev_err_probe(dev, ret, "Failed to register clkout\n");
1060
1061 ret = max96717_subdev_init(priv);
1062 if (ret)
1063 return dev_err_probe(dev, ret,
1064 "Failed to initialize v4l2 subdev\n");
1065
1066 ret = max96717_i2c_mux_init(priv);
1067 if (ret) {
1068 dev_err_probe(dev, ret, "failed to add remote i2c adapter\n");
1069 max96717_subdev_uninit(priv);
1070 }
1071
1072 return ret;
1073 }
1074
max96717_remove(struct i2c_client * client)1075 static void max96717_remove(struct i2c_client *client)
1076 {
1077 struct v4l2_subdev *sd = i2c_get_clientdata(client);
1078 struct max96717_priv *priv = sd_to_max96717(sd);
1079
1080 max96717_subdev_uninit(priv);
1081 i2c_mux_del_adapters(priv->mux);
1082 }
1083
1084 static const struct of_device_id max96717_of_ids[] = {
1085 { .compatible = "maxim,max96717f" },
1086 { }
1087 };
1088 MODULE_DEVICE_TABLE(of, max96717_of_ids);
1089
1090 static struct i2c_driver max96717_i2c_driver = {
1091 .driver = {
1092 .name = "max96717",
1093 .of_match_table = max96717_of_ids,
1094 },
1095 .probe = max96717_probe,
1096 .remove = max96717_remove,
1097 };
1098
1099 module_i2c_driver(max96717_i2c_driver);
1100
1101 MODULE_DESCRIPTION("Maxim GMSL2 MAX96717 Serializer Driver");
1102 MODULE_AUTHOR("Julien Massot <julien.massot@collabora.com>");
1103 MODULE_LICENSE("GPL");
1104