1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/delay.h>
14#include <linux/errno.h>
15#include <linux/i2c.h>
16#include <linux/module.h>
17#include <linux/mutex.h>
18#include <linux/of_graph.h>
19#include <linux/regmap.h>
20#include <linux/slab.h>
21#include <linux/v4l2-dv-timings.h>
22
23#include <media/v4l2-ctrls.h>
24#include <media/v4l2-device.h>
25#include <media/v4l2-dv-timings.h>
26#include <media/v4l2-fwnode.h>
27#include <media/v4l2-ioctl.h>
28
29#include "adv748x.h"
30
31
32
33
34
35#define ADV748X_REGMAP_CONF(n) \
36{ \
37 .name = n, \
38 .reg_bits = 8, \
39 .val_bits = 8, \
40 .max_register = 0xff, \
41 .cache_type = REGCACHE_NONE, \
42}
43
44static const struct regmap_config adv748x_regmap_cnf[] = {
45 ADV748X_REGMAP_CONF("io"),
46 ADV748X_REGMAP_CONF("dpll"),
47 ADV748X_REGMAP_CONF("cp"),
48 ADV748X_REGMAP_CONF("hdmi"),
49 ADV748X_REGMAP_CONF("edid"),
50 ADV748X_REGMAP_CONF("repeater"),
51 ADV748X_REGMAP_CONF("infoframe"),
52 ADV748X_REGMAP_CONF("cbus"),
53 ADV748X_REGMAP_CONF("cec"),
54 ADV748X_REGMAP_CONF("sdp"),
55 ADV748X_REGMAP_CONF("txa"),
56 ADV748X_REGMAP_CONF("txb"),
57};
58
59static int adv748x_configure_regmap(struct adv748x_state *state, int region)
60{
61 int err;
62
63 if (!state->i2c_clients[region])
64 return -ENODEV;
65
66 state->regmap[region] =
67 devm_regmap_init_i2c(state->i2c_clients[region],
68 &adv748x_regmap_cnf[region]);
69
70 if (IS_ERR(state->regmap[region])) {
71 err = PTR_ERR(state->regmap[region]);
72 adv_err(state,
73 "Error initializing regmap %d with error %d\n",
74 region, err);
75 return -EINVAL;
76 }
77
78 return 0;
79}
80struct adv748x_register_map {
81 const char *name;
82 u8 default_addr;
83};
84
85static const struct adv748x_register_map adv748x_default_addresses[] = {
86 [ADV748X_PAGE_IO] = { "main", 0x70 },
87 [ADV748X_PAGE_DPLL] = { "dpll", 0x26 },
88 [ADV748X_PAGE_CP] = { "cp", 0x22 },
89 [ADV748X_PAGE_HDMI] = { "hdmi", 0x34 },
90 [ADV748X_PAGE_EDID] = { "edid", 0x36 },
91 [ADV748X_PAGE_REPEATER] = { "repeater", 0x32 },
92 [ADV748X_PAGE_INFOFRAME] = { "infoframe", 0x31 },
93 [ADV748X_PAGE_CBUS] = { "cbus", 0x30 },
94 [ADV748X_PAGE_CEC] = { "cec", 0x41 },
95 [ADV748X_PAGE_SDP] = { "sdp", 0x79 },
96 [ADV748X_PAGE_TXB] = { "txb", 0x48 },
97 [ADV748X_PAGE_TXA] = { "txa", 0x4a },
98};
99
100static int adv748x_read_check(struct adv748x_state *state,
101 int client_page, u8 reg)
102{
103 struct i2c_client *client = state->i2c_clients[client_page];
104 int err;
105 unsigned int val;
106
107 err = regmap_read(state->regmap[client_page], reg, &val);
108
109 if (err) {
110 adv_err(state, "error reading %02x, %02x\n",
111 client->addr, reg);
112 return err;
113 }
114
115 return val;
116}
117
118int adv748x_read(struct adv748x_state *state, u8 page, u8 reg)
119{
120 return adv748x_read_check(state, page, reg);
121}
122
123int adv748x_write(struct adv748x_state *state, u8 page, u8 reg, u8 value)
124{
125 return regmap_write(state->regmap[page], reg, value);
126}
127
128static int adv748x_write_check(struct adv748x_state *state, u8 page, u8 reg,
129 u8 value, int *error)
130{
131 if (*error)
132 return *error;
133
134 *error = adv748x_write(state, page, reg, value);
135 return *error;
136}
137
138
139
140
141
142
143
144int adv748x_write_block(struct adv748x_state *state, int client_page,
145 unsigned int init_reg, const void *val,
146 size_t val_len)
147{
148 struct regmap *regmap = state->regmap[client_page];
149
150 if (val_len > I2C_SMBUS_BLOCK_MAX)
151 val_len = I2C_SMBUS_BLOCK_MAX;
152
153 return regmap_raw_write(regmap, init_reg, val, val_len);
154}
155
156static int adv748x_set_slave_addresses(struct adv748x_state *state)
157{
158 struct i2c_client *client;
159 unsigned int i;
160 u8 io_reg;
161
162 for (i = ADV748X_PAGE_DPLL; i < ADV748X_PAGE_MAX; ++i) {
163 io_reg = ADV748X_IO_SLAVE_ADDR_BASE + i;
164 client = state->i2c_clients[i];
165
166 io_write(state, io_reg, client->addr << 1);
167 }
168
169 return 0;
170}
171
172static void adv748x_unregister_clients(struct adv748x_state *state)
173{
174 unsigned int i;
175
176 for (i = 1; i < ARRAY_SIZE(state->i2c_clients); ++i)
177 i2c_unregister_device(state->i2c_clients[i]);
178}
179
180static int adv748x_initialise_clients(struct adv748x_state *state)
181{
182 unsigned int i;
183 int ret;
184
185 for (i = ADV748X_PAGE_DPLL; i < ADV748X_PAGE_MAX; ++i) {
186 state->i2c_clients[i] = i2c_new_ancillary_device(
187 state->client,
188 adv748x_default_addresses[i].name,
189 adv748x_default_addresses[i].default_addr);
190
191 if (IS_ERR(state->i2c_clients[i])) {
192 adv_err(state, "failed to create i2c client %u\n", i);
193 return PTR_ERR(state->i2c_clients[i]);
194 }
195
196 ret = adv748x_configure_regmap(state, i);
197 if (ret)
198 return ret;
199 }
200
201 return 0;
202}
203
204
205
206
207
208
209
210struct adv748x_reg_value {
211 u8 page;
212 u8 reg;
213 u8 value;
214};
215
216static int adv748x_write_regs(struct adv748x_state *state,
217 const struct adv748x_reg_value *regs)
218{
219 int ret;
220
221 for (; regs->page != ADV748X_PAGE_EOR; regs++) {
222 ret = adv748x_write(state, regs->page, regs->reg, regs->value);
223 if (ret < 0) {
224 adv_err(state, "Error regs page: 0x%02x reg: 0x%02x\n",
225 regs->page, regs->reg);
226 return ret;
227 }
228 }
229
230 return 0;
231}
232
233
234
235
236
237static int adv748x_power_up_tx(struct adv748x_csi2 *tx)
238{
239 struct adv748x_state *state = tx->state;
240 u8 page = is_txa(tx) ? ADV748X_PAGE_TXA : ADV748X_PAGE_TXB;
241 int ret = 0;
242
243
244 adv748x_write_check(state, page, 0x00, 0x80 | tx->active_lanes, &ret);
245
246
247 adv748x_write_check(state, page, 0x00, 0xa0 | tx->active_lanes, &ret);
248
249
250 if (tx->src == &state->hdmi.sd) {
251 adv748x_write_check(state, page, 0xdb, 0x10, &ret);
252 adv748x_write_check(state, page, 0xd6, 0x07, &ret);
253 } else {
254 adv748x_write_check(state, page, 0xd2, 0x40, &ret);
255 }
256
257 adv748x_write_check(state, page, 0xc4, 0x0a, &ret);
258 adv748x_write_check(state, page, 0x71, 0x33, &ret);
259 adv748x_write_check(state, page, 0x72, 0x11, &ret);
260
261
262 adv748x_write_check(state, page, 0xf0, 0x00, &ret);
263
264
265 adv748x_write_check(state, page, 0x31, 0x82, &ret);
266 adv748x_write_check(state, page, 0x1e, 0x40, &ret);
267
268
269 adv748x_write_check(state, page, 0xda, 0x01, &ret);
270 usleep_range(2000, 2500);
271
272
273 adv748x_write_check(state, page, 0x00, 0x20 | tx->active_lanes, &ret);
274 usleep_range(1000, 1500);
275
276
277 adv748x_write_check(state, page, 0xc1, 0x2b, &ret);
278 usleep_range(1000, 1500);
279 adv748x_write_check(state, page, 0x31, 0x80, &ret);
280
281 return ret;
282}
283
284static int adv748x_power_down_tx(struct adv748x_csi2 *tx)
285{
286 struct adv748x_state *state = tx->state;
287 u8 page = is_txa(tx) ? ADV748X_PAGE_TXA : ADV748X_PAGE_TXB;
288 int ret = 0;
289
290
291 adv748x_write_check(state, page, 0x31, 0x82, &ret);
292 adv748x_write_check(state, page, 0x1e, 0x00, &ret);
293
294
295 adv748x_write_check(state, page, 0x00, 0x80 | tx->active_lanes, &ret);
296
297
298 adv748x_write_check(state, page, 0xda, 0x01, &ret);
299
300
301 adv748x_write_check(state, page, 0xc1, 0x3b, &ret);
302
303 return ret;
304}
305
306int adv748x_tx_power(struct adv748x_csi2 *tx, bool on)
307{
308 int val;
309
310 if (!is_tx_enabled(tx))
311 return 0;
312
313 val = tx_read(tx, ADV748X_CSI_FS_AS_LS);
314 if (val < 0)
315 return val;
316
317
318
319
320
321
322 WARN_ONCE((on && val & ADV748X_CSI_FS_AS_LS_UNKNOWN),
323 "Enabling with unknown bit set");
324
325 return on ? adv748x_power_up_tx(tx) : adv748x_power_down_tx(tx);
326}
327
328
329
330
331static int adv748x_link_setup(struct media_entity *entity,
332 const struct media_pad *local,
333 const struct media_pad *remote, u32 flags)
334{
335 struct v4l2_subdev *rsd = media_entity_to_v4l2_subdev(remote->entity);
336 struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
337 struct adv748x_state *state = v4l2_get_subdevdata(sd);
338 struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
339 bool enable = flags & MEDIA_LNK_FL_ENABLED;
340 u8 io10_mask = ADV748X_IO_10_CSI1_EN |
341 ADV748X_IO_10_CSI4_EN |
342 ADV748X_IO_10_CSI4_IN_SEL_AFE;
343 u8 io10 = 0;
344
345
346 if (enable && tx->src)
347 return -EINVAL;
348
349
350 if (rsd == &state->afe.sd)
351 state->afe.tx = enable ? tx : NULL;
352 else
353 state->hdmi.tx = enable ? tx : NULL;
354
355 tx->src = enable ? rsd : NULL;
356
357 if (state->afe.tx) {
358
359 io10 |= ADV748X_IO_10_CSI4_EN;
360 if (is_txa(tx)) {
361
362
363
364
365
366
367 tx->active_lanes = min(tx->num_lanes, 2U);
368 io10 |= ADV748X_IO_10_CSI4_IN_SEL_AFE;
369 } else {
370
371 io10 |= ADV748X_IO_10_CSI1_EN;
372 }
373 }
374
375 if (state->hdmi.tx) {
376
377
378
379
380 tx->active_lanes = tx->num_lanes;
381 io10 |= ADV748X_IO_10_CSI4_EN;
382 }
383
384 return io_clrset(state, ADV748X_IO_10, io10_mask, io10);
385}
386
387static const struct media_entity_operations adv748x_tx_media_ops = {
388 .link_setup = adv748x_link_setup,
389 .link_validate = v4l2_subdev_link_validate,
390};
391
392static const struct media_entity_operations adv748x_media_ops = {
393 .link_validate = v4l2_subdev_link_validate,
394};
395
396
397
398
399
400
401static const struct adv748x_reg_value adv748x_init_hdmi[] = {
402
403 {ADV748X_PAGE_IO, 0x00, 0x40},
404
405 {ADV748X_PAGE_REPEATER, 0x40, 0x83},
406
407 {ADV748X_PAGE_HDMI, 0x00, 0x08},
408 {ADV748X_PAGE_HDMI, 0x98, 0xff},
409 {ADV748X_PAGE_HDMI, 0x99, 0xa3},
410 {ADV748X_PAGE_HDMI, 0x9a, 0x00},
411 {ADV748X_PAGE_HDMI, 0x9b, 0x0a},
412 {ADV748X_PAGE_HDMI, 0x9d, 0x40},
413 {ADV748X_PAGE_HDMI, 0xcb, 0x09},
414 {ADV748X_PAGE_HDMI, 0x3d, 0x10},
415 {ADV748X_PAGE_HDMI, 0x3e, 0x7b},
416 {ADV748X_PAGE_HDMI, 0x3f, 0x5e},
417 {ADV748X_PAGE_HDMI, 0x4e, 0xfe},
418 {ADV748X_PAGE_HDMI, 0x4f, 0x18},
419 {ADV748X_PAGE_HDMI, 0x57, 0xa3},
420 {ADV748X_PAGE_HDMI, 0x58, 0x04},
421 {ADV748X_PAGE_HDMI, 0x85, 0x10},
422
423 {ADV748X_PAGE_HDMI, 0x83, 0x00},
424 {ADV748X_PAGE_HDMI, 0xa3, 0x01},
425 {ADV748X_PAGE_HDMI, 0xbe, 0x00},
426
427 {ADV748X_PAGE_HDMI, 0x6c, 0x01},
428 {ADV748X_PAGE_HDMI, 0xf8, 0x01},
429 {ADV748X_PAGE_HDMI, 0x0f, 0x00},
430
431
432 {ADV748X_PAGE_IO, 0x04, 0x02},
433 {ADV748X_PAGE_IO, 0x12, 0xf0},
434 {ADV748X_PAGE_IO, 0x17, 0x80},
435 {ADV748X_PAGE_IO, 0x03, 0x86},
436
437 {ADV748X_PAGE_CP, 0x7c, 0x00},
438
439 {ADV748X_PAGE_IO, 0x0c, 0xe0},
440 {ADV748X_PAGE_IO, 0x0e, 0xdd},
441
442 {ADV748X_PAGE_EOR, 0xff, 0xff}
443};
444
445
446static const struct adv748x_reg_value adv748x_init_afe[] = {
447 {ADV748X_PAGE_IO, 0x00, 0x30},
448 {ADV748X_PAGE_IO, 0xf2, 0x01},
449
450 {ADV748X_PAGE_IO, 0x0e, 0xff},
451
452 {ADV748X_PAGE_SDP, 0x0f, 0x00},
453 {ADV748X_PAGE_SDP, 0x52, 0xcd},
454
455 {ADV748X_PAGE_SDP, 0x0e, 0x80},
456 {ADV748X_PAGE_SDP, 0x9c, 0x00},
457 {ADV748X_PAGE_SDP, 0x9c, 0xff},
458 {ADV748X_PAGE_SDP, 0x0e, 0x00},
459
460
461 {ADV748X_PAGE_SDP, 0x80, 0x51},
462 {ADV748X_PAGE_SDP, 0x81, 0x51},
463 {ADV748X_PAGE_SDP, 0x82, 0x68},
464
465 {ADV748X_PAGE_SDP, 0x03, 0x42},
466 {ADV748X_PAGE_SDP, 0x04, 0xb5},
467 {ADV748X_PAGE_SDP, 0x13, 0x00},
468
469 {ADV748X_PAGE_SDP, 0x17, 0x41},
470 {ADV748X_PAGE_SDP, 0x31, 0x12},
471 {ADV748X_PAGE_SDP, 0xe6, 0x4f},
472
473 {ADV748X_PAGE_EOR, 0xff, 0xff}
474};
475
476static int adv748x_sw_reset(struct adv748x_state *state)
477{
478 int ret;
479
480 ret = io_write(state, ADV748X_IO_REG_FF, ADV748X_IO_REG_FF_MAIN_RESET);
481 if (ret)
482 return ret;
483
484 usleep_range(5000, 6000);
485
486
487 ret = io_clrset(state, ADV748X_IO_REG_01, ADV748X_IO_REG_01_PWRDN_MASK,
488 ADV748X_IO_REG_01_PWRDNB);
489 if (ret)
490 return ret;
491
492
493 return io_write(state, ADV748X_IO_REG_F2,
494 ADV748X_IO_REG_F2_READ_AUTO_INC);
495}
496
497static int adv748x_reset(struct adv748x_state *state)
498{
499 int ret;
500 u8 regval = 0;
501
502 ret = adv748x_sw_reset(state);
503 if (ret < 0)
504 return ret;
505
506 ret = adv748x_set_slave_addresses(state);
507 if (ret < 0)
508 return ret;
509
510
511 ret = adv748x_write_regs(state, adv748x_init_hdmi);
512 if (ret)
513 return ret;
514
515 ret = adv748x_write_regs(state, adv748x_init_afe);
516 if (ret)
517 return ret;
518
519 adv748x_afe_s_input(&state->afe, state->afe.input);
520
521 adv_dbg(state, "AFE Default input set to %d\n", state->afe.input);
522
523
524 adv748x_tx_power(&state->txa, 1);
525 adv748x_tx_power(&state->txa, 0);
526 adv748x_tx_power(&state->txb, 1);
527 adv748x_tx_power(&state->txb, 0);
528
529
530 io_write(state, ADV748X_IO_PD, ADV748X_IO_PD_RX_EN);
531
532
533 if (is_tx_enabled(&state->txa)) {
534 regval |= ADV748X_IO_10_CSI4_EN;
535 adv748x_csi2_set_virtual_channel(&state->txa, 0);
536 }
537 if (is_tx_enabled(&state->txb)) {
538 regval |= ADV748X_IO_10_CSI1_EN;
539 adv748x_csi2_set_virtual_channel(&state->txb, 0);
540 }
541 io_write(state, ADV748X_IO_10, regval);
542
543
544 cp_clrset(state, ADV748X_CP_CLMP_POS, ADV748X_CP_CLMP_POS_DIS_AUTO,
545 ADV748X_CP_CLMP_POS_DIS_AUTO);
546
547 return 0;
548}
549
550static int adv748x_identify_chip(struct adv748x_state *state)
551{
552 int msb, lsb;
553
554 lsb = io_read(state, ADV748X_IO_CHIP_REV_ID_1);
555 msb = io_read(state, ADV748X_IO_CHIP_REV_ID_2);
556
557 if (lsb < 0 || msb < 0) {
558 adv_err(state, "Failed to read chip revision\n");
559 return -EIO;
560 }
561
562 adv_info(state, "chip found @ 0x%02x revision %02x%02x\n",
563 state->client->addr << 1, lsb, msb);
564
565 return 0;
566}
567
568
569
570
571
572static int __maybe_unused adv748x_resume_early(struct device *dev)
573{
574 struct i2c_client *client = to_i2c_client(dev);
575 struct adv748x_state *state = i2c_get_clientdata(client);
576
577 return adv748x_reset(state);
578}
579
580
581
582
583
584void adv748x_subdev_init(struct v4l2_subdev *sd, struct adv748x_state *state,
585 const struct v4l2_subdev_ops *ops, u32 function,
586 const char *ident)
587{
588 v4l2_subdev_init(sd, ops);
589 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
590
591
592 sd->owner = state->dev->driver->owner;
593 sd->dev = state->dev;
594
595 v4l2_set_subdevdata(sd, state);
596
597
598 snprintf(sd->name, sizeof(sd->name), "%s %d-%04x %s",
599 state->dev->driver->name,
600 i2c_adapter_id(state->client->adapter),
601 state->client->addr, ident);
602
603 sd->entity.function = function;
604 sd->entity.ops = is_tx(adv748x_sd_to_csi2(sd)) ?
605 &adv748x_tx_media_ops : &adv748x_media_ops;
606}
607
608static int adv748x_parse_csi2_lanes(struct adv748x_state *state,
609 unsigned int port,
610 struct device_node *ep)
611{
612 struct v4l2_fwnode_endpoint vep = { .bus_type = V4L2_MBUS_CSI2_DPHY };
613 unsigned int num_lanes;
614 int ret;
615
616 if (port != ADV748X_PORT_TXA && port != ADV748X_PORT_TXB)
617 return 0;
618
619 ret = v4l2_fwnode_endpoint_parse(of_fwnode_handle(ep), &vep);
620 if (ret)
621 return ret;
622
623 num_lanes = vep.bus.mipi_csi2.num_data_lanes;
624
625 if (vep.base.port == ADV748X_PORT_TXA) {
626 if (num_lanes != 1 && num_lanes != 2 && num_lanes != 4) {
627 adv_err(state, "TXA: Invalid number (%u) of lanes\n",
628 num_lanes);
629 return -EINVAL;
630 }
631
632 state->txa.num_lanes = num_lanes;
633 state->txa.active_lanes = num_lanes;
634 adv_dbg(state, "TXA: using %u lanes\n", state->txa.num_lanes);
635 }
636
637 if (vep.base.port == ADV748X_PORT_TXB) {
638 if (num_lanes != 1) {
639 adv_err(state, "TXB: Invalid number (%u) of lanes\n",
640 num_lanes);
641 return -EINVAL;
642 }
643
644 state->txb.num_lanes = num_lanes;
645 state->txb.active_lanes = num_lanes;
646 adv_dbg(state, "TXB: using %u lanes\n", state->txb.num_lanes);
647 }
648
649 return 0;
650}
651
652static int adv748x_parse_dt(struct adv748x_state *state)
653{
654 struct device_node *ep_np = NULL;
655 struct of_endpoint ep;
656 bool out_found = false;
657 bool in_found = false;
658 int ret;
659
660 for_each_endpoint_of_node(state->dev->of_node, ep_np) {
661 of_graph_parse_endpoint(ep_np, &ep);
662 adv_info(state, "Endpoint %pOF on port %d", ep.local_node,
663 ep.port);
664
665 if (ep.port >= ADV748X_PORT_MAX) {
666 adv_err(state, "Invalid endpoint %pOF on port %d",
667 ep.local_node, ep.port);
668
669 continue;
670 }
671
672 if (state->endpoints[ep.port]) {
673 adv_err(state,
674 "Multiple port endpoints are not supported");
675 continue;
676 }
677
678 of_node_get(ep_np);
679 state->endpoints[ep.port] = ep_np;
680
681
682
683
684
685 if (ep.port < ADV748X_PORT_TXA)
686 in_found = true;
687 else
688 out_found = true;
689
690
691 ret = adv748x_parse_csi2_lanes(state, ep.port, ep_np);
692 if (ret)
693 return ret;
694 }
695
696 return in_found && out_found ? 0 : -ENODEV;
697}
698
699static void adv748x_dt_cleanup(struct adv748x_state *state)
700{
701 unsigned int i;
702
703 for (i = 0; i < ADV748X_PORT_MAX; i++)
704 of_node_put(state->endpoints[i]);
705}
706
707static int adv748x_probe(struct i2c_client *client)
708{
709 struct adv748x_state *state;
710 int ret;
711
712
713 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
714 return -EIO;
715
716 state = devm_kzalloc(&client->dev, sizeof(*state), GFP_KERNEL);
717 if (!state)
718 return -ENOMEM;
719
720 mutex_init(&state->mutex);
721
722 state->dev = &client->dev;
723 state->client = client;
724 state->i2c_clients[ADV748X_PAGE_IO] = client;
725 i2c_set_clientdata(client, state);
726
727
728
729
730
731
732 state->txa.state = state->txb.state = state;
733 state->txa.page = ADV748X_PAGE_TXA;
734 state->txb.page = ADV748X_PAGE_TXB;
735 state->txa.port = ADV748X_PORT_TXA;
736 state->txb.port = ADV748X_PORT_TXB;
737
738
739 ret = adv748x_parse_dt(state);
740 if (ret) {
741 adv_err(state, "Failed to parse device tree");
742 goto err_free_mutex;
743 }
744
745
746 ret = adv748x_configure_regmap(state, ADV748X_PAGE_IO);
747 if (ret) {
748 adv_err(state, "Error configuring IO regmap region");
749 goto err_cleanup_dt;
750 }
751
752 ret = adv748x_identify_chip(state);
753 if (ret) {
754 adv_err(state, "Failed to identify chip");
755 goto err_cleanup_dt;
756 }
757
758
759 ret = adv748x_initialise_clients(state);
760 if (ret) {
761 adv_err(state, "Failed to setup client regmap pages");
762 goto err_cleanup_clients;
763 }
764
765
766 ret = adv748x_reset(state);
767 if (ret) {
768 adv_err(state, "Failed to reset hardware");
769 goto err_cleanup_clients;
770 }
771
772
773 ret = adv748x_hdmi_init(&state->hdmi);
774 if (ret) {
775 adv_err(state, "Failed to probe HDMI");
776 goto err_cleanup_clients;
777 }
778
779
780 ret = adv748x_afe_init(&state->afe);
781 if (ret) {
782 adv_err(state, "Failed to probe AFE");
783 goto err_cleanup_hdmi;
784 }
785
786
787 ret = adv748x_csi2_init(state, &state->txa);
788 if (ret) {
789 adv_err(state, "Failed to probe TXA");
790 goto err_cleanup_afe;
791 }
792
793
794 ret = adv748x_csi2_init(state, &state->txb);
795 if (ret) {
796 adv_err(state, "Failed to probe TXB");
797 goto err_cleanup_txa;
798 }
799
800 return 0;
801
802err_cleanup_txa:
803 adv748x_csi2_cleanup(&state->txa);
804err_cleanup_afe:
805 adv748x_afe_cleanup(&state->afe);
806err_cleanup_hdmi:
807 adv748x_hdmi_cleanup(&state->hdmi);
808err_cleanup_clients:
809 adv748x_unregister_clients(state);
810err_cleanup_dt:
811 adv748x_dt_cleanup(state);
812err_free_mutex:
813 mutex_destroy(&state->mutex);
814
815 return ret;
816}
817
818static int adv748x_remove(struct i2c_client *client)
819{
820 struct adv748x_state *state = i2c_get_clientdata(client);
821
822 adv748x_afe_cleanup(&state->afe);
823 adv748x_hdmi_cleanup(&state->hdmi);
824
825 adv748x_csi2_cleanup(&state->txa);
826 adv748x_csi2_cleanup(&state->txb);
827
828 adv748x_unregister_clients(state);
829 adv748x_dt_cleanup(state);
830 mutex_destroy(&state->mutex);
831
832 return 0;
833}
834
835static const struct of_device_id adv748x_of_table[] = {
836 { .compatible = "adi,adv7481", },
837 { .compatible = "adi,adv7482", },
838 { }
839};
840MODULE_DEVICE_TABLE(of, adv748x_of_table);
841
842static const struct dev_pm_ops adv748x_pm_ops = {
843 SET_LATE_SYSTEM_SLEEP_PM_OPS(NULL, adv748x_resume_early)
844};
845
846static struct i2c_driver adv748x_driver = {
847 .driver = {
848 .name = "adv748x",
849 .of_match_table = adv748x_of_table,
850 .pm = &adv748x_pm_ops,
851 },
852 .probe_new = adv748x_probe,
853 .remove = adv748x_remove,
854};
855
856module_i2c_driver(adv748x_driver);
857
858MODULE_AUTHOR("Kieran Bingham <kieran.bingham@ideasonboard.com>");
859MODULE_DESCRIPTION("ADV748X video decoder");
860MODULE_LICENSE("GPL");
861