Lines Matching refs:sd
81 struct v4l2_subdev sd; member
105 static void ad9389b_check_monitor_present_status(struct v4l2_subdev *sd);
106 static bool ad9389b_check_edid_status(struct v4l2_subdev *sd);
107 static void ad9389b_setup(struct v4l2_subdev *sd);
108 static int ad9389b_s_i2s_clock_freq(struct v4l2_subdev *sd, u32 freq);
109 static int ad9389b_s_clock_freq(struct v4l2_subdev *sd, u32 freq);
111 static inline struct ad9389b_state *get_ad9389b_state(struct v4l2_subdev *sd) in get_ad9389b_state() argument
113 return container_of(sd, struct ad9389b_state, sd); in get_ad9389b_state()
118 return &container_of(ctrl->handler, struct ad9389b_state, hdl)->sd; in to_sd()
123 static int ad9389b_rd(struct v4l2_subdev *sd, u8 reg) in ad9389b_rd() argument
125 struct i2c_client *client = v4l2_get_subdevdata(sd); in ad9389b_rd()
130 static int ad9389b_wr(struct v4l2_subdev *sd, u8 reg, u8 val) in ad9389b_wr() argument
132 struct i2c_client *client = v4l2_get_subdevdata(sd); in ad9389b_wr()
141 v4l2_err(sd, "%s: failed reg 0x%x, val 0x%x\n", __func__, reg, val); in ad9389b_wr()
147 static inline void ad9389b_wr_and_or(struct v4l2_subdev *sd, u8 reg, in ad9389b_wr_and_or() argument
150 ad9389b_wr(sd, reg, (ad9389b_rd(sd, reg) & clr_mask) | val_mask); in ad9389b_wr_and_or()
153 static void ad9389b_edid_rd(struct v4l2_subdev *sd, u16 len, u8 *buf) in ad9389b_edid_rd() argument
155 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_edid_rd()
158 v4l2_dbg(1, debug, sd, "%s:\n", __func__); in ad9389b_edid_rd()
164 static inline bool ad9389b_have_hotplug(struct v4l2_subdev *sd) in ad9389b_have_hotplug() argument
166 return ad9389b_rd(sd, 0x42) & MASK_AD9389B_HPD_DETECT; in ad9389b_have_hotplug()
169 static inline bool ad9389b_have_rx_sense(struct v4l2_subdev *sd) in ad9389b_have_rx_sense() argument
171 return ad9389b_rd(sd, 0x42) & MASK_AD9389B_MSEN_DETECT; in ad9389b_have_rx_sense()
174 static void ad9389b_csc_conversion_mode(struct v4l2_subdev *sd, u8 mode) in ad9389b_csc_conversion_mode() argument
176 ad9389b_wr_and_or(sd, 0x17, 0xe7, (mode & 0x3)<<3); in ad9389b_csc_conversion_mode()
177 ad9389b_wr_and_or(sd, 0x18, 0x9f, (mode & 0x3)<<5); in ad9389b_csc_conversion_mode()
180 static void ad9389b_csc_coeff(struct v4l2_subdev *sd, in ad9389b_csc_coeff() argument
186 ad9389b_wr_and_or(sd, 0x18, 0xe0, A1>>8); in ad9389b_csc_coeff()
187 ad9389b_wr(sd, 0x19, A1); in ad9389b_csc_coeff()
188 ad9389b_wr_and_or(sd, 0x1A, 0xe0, A2>>8); in ad9389b_csc_coeff()
189 ad9389b_wr(sd, 0x1B, A2); in ad9389b_csc_coeff()
190 ad9389b_wr_and_or(sd, 0x1c, 0xe0, A3>>8); in ad9389b_csc_coeff()
191 ad9389b_wr(sd, 0x1d, A3); in ad9389b_csc_coeff()
192 ad9389b_wr_and_or(sd, 0x1e, 0xe0, A4>>8); in ad9389b_csc_coeff()
193 ad9389b_wr(sd, 0x1f, A4); in ad9389b_csc_coeff()
196 ad9389b_wr_and_or(sd, 0x20, 0xe0, B1>>8); in ad9389b_csc_coeff()
197 ad9389b_wr(sd, 0x21, B1); in ad9389b_csc_coeff()
198 ad9389b_wr_and_or(sd, 0x22, 0xe0, B2>>8); in ad9389b_csc_coeff()
199 ad9389b_wr(sd, 0x23, B2); in ad9389b_csc_coeff()
200 ad9389b_wr_and_or(sd, 0x24, 0xe0, B3>>8); in ad9389b_csc_coeff()
201 ad9389b_wr(sd, 0x25, B3); in ad9389b_csc_coeff()
202 ad9389b_wr_and_or(sd, 0x26, 0xe0, B4>>8); in ad9389b_csc_coeff()
203 ad9389b_wr(sd, 0x27, B4); in ad9389b_csc_coeff()
206 ad9389b_wr_and_or(sd, 0x28, 0xe0, C1>>8); in ad9389b_csc_coeff()
207 ad9389b_wr(sd, 0x29, C1); in ad9389b_csc_coeff()
208 ad9389b_wr_and_or(sd, 0x2A, 0xe0, C2>>8); in ad9389b_csc_coeff()
209 ad9389b_wr(sd, 0x2B, C2); in ad9389b_csc_coeff()
210 ad9389b_wr_and_or(sd, 0x2C, 0xe0, C3>>8); in ad9389b_csc_coeff()
211 ad9389b_wr(sd, 0x2D, C3); in ad9389b_csc_coeff()
212 ad9389b_wr_and_or(sd, 0x2E, 0xe0, C4>>8); in ad9389b_csc_coeff()
213 ad9389b_wr(sd, 0x2F, C4); in ad9389b_csc_coeff()
216 static void ad9389b_csc_rgb_full2limit(struct v4l2_subdev *sd, bool enable) in ad9389b_csc_rgb_full2limit() argument
221 ad9389b_csc_conversion_mode(sd, csc_mode); in ad9389b_csc_rgb_full2limit()
222 ad9389b_csc_coeff(sd, in ad9389b_csc_rgb_full2limit()
227 ad9389b_wr_and_or(sd, 0x3b, 0xfe, 0x1); in ad9389b_csc_rgb_full2limit()
229 ad9389b_wr_and_or(sd, 0xcd, 0xf9, 0x02); in ad9389b_csc_rgb_full2limit()
232 ad9389b_wr_and_or(sd, 0x3b, 0xfe, 0x0); in ad9389b_csc_rgb_full2limit()
234 ad9389b_wr_and_or(sd, 0xcd, 0xf9, 0x04); in ad9389b_csc_rgb_full2limit()
238 static void ad9389b_set_IT_content_AVI_InfoFrame(struct v4l2_subdev *sd) in ad9389b_set_IT_content_AVI_InfoFrame() argument
240 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_set_IT_content_AVI_InfoFrame()
244 ad9389b_wr_and_or(sd, 0xcd, 0xbf, 0x00); in ad9389b_set_IT_content_AVI_InfoFrame()
247 ad9389b_wr_and_or(sd, 0xcd, 0xbf, 0x40); in ad9389b_set_IT_content_AVI_InfoFrame()
251 static int ad9389b_set_rgb_quantization_mode(struct v4l2_subdev *sd, struct v4l2_ctrl *ctrl) in ad9389b_set_rgb_quantization_mode() argument
253 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_set_rgb_quantization_mode()
260 ad9389b_csc_rgb_full2limit(sd, true); in ad9389b_set_rgb_quantization_mode()
263 ad9389b_csc_rgb_full2limit(sd, false); in ad9389b_set_rgb_quantization_mode()
268 ad9389b_csc_rgb_full2limit(sd, true); in ad9389b_set_rgb_quantization_mode()
272 ad9389b_csc_rgb_full2limit(sd, false); in ad9389b_set_rgb_quantization_mode()
280 static void ad9389b_set_manual_pll_gear(struct v4l2_subdev *sd, u32 pixelclock) in ad9389b_set_manual_pll_gear() argument
308 ad9389b_wr_and_or(sd, 0x98, 0x0f, gear); in ad9389b_set_manual_pll_gear()
315 struct v4l2_subdev *sd = to_sd(ctrl); in ad9389b_s_ctrl() local
316 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_s_ctrl()
318 v4l2_dbg(1, debug, sd, in ad9389b_s_ctrl()
323 ad9389b_wr_and_or(sd, 0xaf, 0xfd, in ad9389b_s_ctrl()
328 return ad9389b_set_rgb_quantization_mode(sd, ctrl); in ad9389b_s_ctrl()
339 static int ad9389b_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg) in ad9389b_g_register() argument
341 reg->val = ad9389b_rd(sd, reg->reg & 0xff); in ad9389b_g_register()
346 static int ad9389b_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg) in ad9389b_s_register() argument
348 ad9389b_wr(sd, reg->reg & 0xff, reg->val & 0xff); in ad9389b_s_register()
353 static int ad9389b_log_status(struct v4l2_subdev *sd) in ad9389b_log_status() argument
355 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_log_status()
382 v4l2_info(sd, "chip revision %d\n", state->chip_revision); in ad9389b_log_status()
383 v4l2_info(sd, "power %s\n", state->power_on ? "on" : "off"); in ad9389b_log_status()
384 v4l2_info(sd, "%s hotplug, %s Rx Sense, %s EDID (%d block(s))\n", in ad9389b_log_status()
385 (ad9389b_rd(sd, 0x42) & MASK_AD9389B_HPD_DETECT) ? in ad9389b_log_status()
387 (ad9389b_rd(sd, 0x42) & MASK_AD9389B_MSEN_DETECT) ? in ad9389b_log_status()
390 v4l2_info(sd, "%s output %s\n", in ad9389b_log_status()
391 (ad9389b_rd(sd, 0xaf) & 0x02) ? in ad9389b_log_status()
393 (ad9389b_rd(sd, 0xa1) & 0x3c) ? in ad9389b_log_status()
395 v4l2_info(sd, "ad9389b: %s\n", (ad9389b_rd(sd, 0xb8) & 0x40) ? in ad9389b_log_status()
397 v4l2_info(sd, "state: %s, error: %s, detect count: %u, msk/irq: %02x/%02x\n", in ad9389b_log_status()
398 states[ad9389b_rd(sd, 0xc8) & 0xf], in ad9389b_log_status()
399 errors[ad9389b_rd(sd, 0xc8) >> 4], in ad9389b_log_status()
401 ad9389b_rd(sd, 0x94), ad9389b_rd(sd, 0x96)); in ad9389b_log_status()
402 manual_gear = ad9389b_rd(sd, 0x98) & 0x80; in ad9389b_log_status()
403 v4l2_info(sd, "ad9389b: RGB quantization: %s range\n", in ad9389b_log_status()
404 ad9389b_rd(sd, 0x3b) & 0x01 ? "limited" : "full"); in ad9389b_log_status()
405 v4l2_info(sd, "ad9389b: %s gear %d\n", in ad9389b_log_status()
407 manual_gear ? ((ad9389b_rd(sd, 0x98) & 0x70) >> 4) : in ad9389b_log_status()
408 ((ad9389b_rd(sd, 0x9e) & 0x0e) >> 1)); in ad9389b_log_status()
409 if (ad9389b_rd(sd, 0xaf) & 0x02) { in ad9389b_log_status()
411 u8 manual_cts = ad9389b_rd(sd, 0x0a) & 0x80; in ad9389b_log_status()
412 u32 N = (ad9389b_rd(sd, 0x01) & 0xf) << 16 | in ad9389b_log_status()
413 ad9389b_rd(sd, 0x02) << 8 | in ad9389b_log_status()
414 ad9389b_rd(sd, 0x03); in ad9389b_log_status()
415 u8 vic_detect = ad9389b_rd(sd, 0x3e) >> 2; in ad9389b_log_status()
416 u8 vic_sent = ad9389b_rd(sd, 0x3d) & 0x3f; in ad9389b_log_status()
420 CTS = (ad9389b_rd(sd, 0x07) & 0xf) << 16 | in ad9389b_log_status()
421 ad9389b_rd(sd, 0x08) << 8 | in ad9389b_log_status()
422 ad9389b_rd(sd, 0x09); in ad9389b_log_status()
424 CTS = (ad9389b_rd(sd, 0x04) & 0xf) << 16 | in ad9389b_log_status()
425 ad9389b_rd(sd, 0x05) << 8 | in ad9389b_log_status()
426 ad9389b_rd(sd, 0x06); in ad9389b_log_status()
427 N = (ad9389b_rd(sd, 0x01) & 0xf) << 16 | in ad9389b_log_status()
428 ad9389b_rd(sd, 0x02) << 8 | in ad9389b_log_status()
429 ad9389b_rd(sd, 0x03); in ad9389b_log_status()
431 v4l2_info(sd, "ad9389b: CTS %s mode: N %d, CTS %d\n", in ad9389b_log_status()
434 v4l2_info(sd, "ad9389b: VIC: detected %d, sent %d\n", in ad9389b_log_status()
438 v4l2_print_dv_timings(sd->name, "timings: ", in ad9389b_log_status()
441 v4l2_info(sd, "no timings set\n"); in ad9389b_log_status()
446 static int ad9389b_s_power(struct v4l2_subdev *sd, int on) in ad9389b_s_power() argument
448 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_s_power()
453 v4l2_dbg(1, debug, sd, "%s: power %s\n", __func__, on ? "on" : "off"); in ad9389b_s_power()
459 ad9389b_wr_and_or(sd, 0x41, 0xbf, 0x40); in ad9389b_s_power()
467 ad9389b_wr_and_or(sd, 0x41, 0xbf, 0x0); in ad9389b_s_power()
468 if ((ad9389b_rd(sd, 0x41) & 0x40) == 0) in ad9389b_s_power()
470 ad9389b_wr_and_or(sd, 0x41, 0xbf, 0x40); in ad9389b_s_power()
474 v4l2_dbg(1, debug, sd, "failed to powerup the ad9389b\n"); in ad9389b_s_power()
475 ad9389b_s_power(sd, 0); in ad9389b_s_power()
479 v4l2_dbg(1, debug, sd, in ad9389b_s_power()
483 ad9389b_wr_and_or(sd, 0xba, 0xef, 0x10); in ad9389b_s_power()
486 ad9389b_wr_and_or(sd, 0x98, 0xf0, 0x07); in ad9389b_s_power()
487 ad9389b_wr(sd, 0x9c, 0x38); in ad9389b_s_power()
488 ad9389b_wr_and_or(sd, 0x9d, 0xfc, 0x01); in ad9389b_s_power()
492 ad9389b_wr(sd, 0xa2, pdata->diff_data_drive_strength); in ad9389b_s_power()
494 ad9389b_wr(sd, 0xa2, 0x87); in ad9389b_s_power()
497 ad9389b_wr(sd, 0xa3, pdata->diff_clk_drive_strength); in ad9389b_s_power()
499 ad9389b_wr(sd, 0xa3, 0x87); in ad9389b_s_power()
501 ad9389b_wr(sd, 0x0a, 0x01); in ad9389b_s_power()
502 ad9389b_wr(sd, 0xbb, 0xff); in ad9389b_s_power()
505 ad9389b_wr(sd, 0xc9, 0xf); in ad9389b_s_power()
510 static void ad9389b_set_isr(struct v4l2_subdev *sd, bool enable) in ad9389b_set_isr() argument
520 else if (ad9389b_have_hotplug(sd)) in ad9389b_set_isr()
532 ad9389b_wr(sd, 0x94, irqs); in ad9389b_set_isr()
533 irqs_rd = ad9389b_rd(sd, 0x94); in ad9389b_set_isr()
537 v4l2_err(sd, "Could not set interrupts: hw failure?\n"); in ad9389b_set_isr()
541 static int ad9389b_isr(struct v4l2_subdev *sd, u32 status, bool *handled) in ad9389b_isr() argument
546 ad9389b_set_isr(sd, false); in ad9389b_isr()
547 irq_status = ad9389b_rd(sd, 0x96); in ad9389b_isr()
549 ad9389b_wr(sd, 0x96, irq_status); in ad9389b_isr()
551 ad9389b_set_isr(sd, true); in ad9389b_isr()
553 v4l2_dbg(1, debug, sd, "%s: irq_status 0x%x\n", __func__, irq_status); in ad9389b_isr()
556 ad9389b_check_monitor_present_status(sd); in ad9389b_isr()
558 ad9389b_check_edid_status(sd); in ad9389b_isr()
577 static int ad9389b_s_stream(struct v4l2_subdev *sd, int enable) in ad9389b_s_stream() argument
579 v4l2_dbg(1, debug, sd, "%s: %sable\n", __func__, (enable ? "en" : "dis")); in ad9389b_s_stream()
581 ad9389b_wr_and_or(sd, 0xa1, ~0x3c, (enable ? 0 : 0x3c)); in ad9389b_s_stream()
583 ad9389b_check_monitor_present_status(sd); in ad9389b_s_stream()
585 ad9389b_s_power(sd, 0); in ad9389b_s_stream()
601 static int ad9389b_s_dv_timings(struct v4l2_subdev *sd, in ad9389b_s_dv_timings() argument
604 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_s_dv_timings()
606 v4l2_dbg(1, debug, sd, "%s:\n", __func__); in ad9389b_s_dv_timings()
622 ad9389b_set_rgb_quantization_mode(sd, state->rgb_quantization_range_ctrl); in ad9389b_s_dv_timings()
626 ad9389b_set_manual_pll_gear(sd, (u32)timings->bt.pixelclock); in ad9389b_s_dv_timings()
629 ad9389b_set_IT_content_AVI_InfoFrame(sd); in ad9389b_s_dv_timings()
634 static int ad9389b_g_dv_timings(struct v4l2_subdev *sd, in ad9389b_g_dv_timings() argument
637 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_g_dv_timings()
639 v4l2_dbg(1, debug, sd, "%s:\n", __func__); in ad9389b_g_dv_timings()
649 static int ad9389b_enum_dv_timings(struct v4l2_subdev *sd, in ad9389b_enum_dv_timings() argument
659 static int ad9389b_dv_timings_cap(struct v4l2_subdev *sd, in ad9389b_dv_timings_cap() argument
677 static int ad9389b_get_edid(struct v4l2_subdev *sd, struct v4l2_edid *edid) in ad9389b_get_edid() argument
679 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_get_edid()
686 v4l2_dbg(1, debug, sd, "EDID segment 0 not found\n"); in ad9389b_get_edid()
706 static int ad9389b_s_audio_stream(struct v4l2_subdev *sd, int enable) in ad9389b_s_audio_stream() argument
708 v4l2_dbg(1, debug, sd, "%s: %sable\n", __func__, (enable ? "en" : "dis")); in ad9389b_s_audio_stream()
711 ad9389b_wr_and_or(sd, 0x45, 0x3f, 0x80); in ad9389b_s_audio_stream()
713 ad9389b_wr_and_or(sd, 0x45, 0x3f, 0x40); in ad9389b_s_audio_stream()
718 static int ad9389b_s_clock_freq(struct v4l2_subdev *sd, u32 freq) in ad9389b_s_clock_freq() argument
735 ad9389b_wr(sd, 0x01, (N >> 16) & 0xf); in ad9389b_s_clock_freq()
736 ad9389b_wr(sd, 0x02, (N >> 8) & 0xff); in ad9389b_s_clock_freq()
737 ad9389b_wr(sd, 0x03, N & 0xff); in ad9389b_s_clock_freq()
742 static int ad9389b_s_i2s_clock_freq(struct v4l2_subdev *sd, u32 freq) in ad9389b_s_i2s_clock_freq() argument
759 ad9389b_wr_and_or(sd, 0x15, 0xf, i2s_sf); in ad9389b_s_i2s_clock_freq()
764 static int ad9389b_s_routing(struct v4l2_subdev *sd, u32 input, u32 output, u32 config) in ad9389b_s_routing() argument
770 ad9389b_wr_and_or(sd, 0x50, 0x1f, 0x20); in ad9389b_s_routing()
772 ad9389b_wr(sd, 0x51, 0x00); in ad9389b_s_routing()
776 ad9389b_wr_and_or(sd, 0x14, 0xf0, 0x02); in ad9389b_s_routing()
798 static void ad9389b_dbg_dump_edid(int lvl, int debug, struct v4l2_subdev *sd, in ad9389b_dbg_dump_edid() argument
806 v4l2_dbg(lvl, debug, sd, "edid segment %d\n", segment); in ad9389b_dbg_dump_edid()
812 v4l2_dbg(lvl, debug, sd, "\n"); in ad9389b_dbg_dump_edid()
818 v4l2_dbg(lvl, debug, sd, "%s\n", b); in ad9389b_dbg_dump_edid()
827 struct v4l2_subdev *sd = &state->sd; in ad9389b_edid_handler() local
830 v4l2_dbg(1, debug, sd, "%s:\n", __func__); in ad9389b_edid_handler()
832 if (ad9389b_check_edid_status(sd)) { in ad9389b_edid_handler()
837 if (ad9389b_have_hotplug(sd)) { in ad9389b_edid_handler()
843 v4l2_dbg(1, debug, sd, "%s: edid read failed\n", __func__); in ad9389b_edid_handler()
844 ad9389b_s_power(sd, false); in ad9389b_edid_handler()
845 ad9389b_s_power(sd, true); in ad9389b_edid_handler()
854 ed.segment = ad9389b_rd(sd, 0xc4); in ad9389b_edid_handler()
855 v4l2_subdev_notify(sd, AD9389B_EDID_DETECT, (void *)&ed); in ad9389b_edid_handler()
856 v4l2_dbg(1, debug, sd, "%s: no edid found\n", __func__); in ad9389b_edid_handler()
859 static void ad9389b_audio_setup(struct v4l2_subdev *sd) in ad9389b_audio_setup() argument
861 v4l2_dbg(1, debug, sd, "%s\n", __func__); in ad9389b_audio_setup()
863 ad9389b_s_i2s_clock_freq(sd, 48000); in ad9389b_audio_setup()
864 ad9389b_s_clock_freq(sd, 48000); in ad9389b_audio_setup()
865 ad9389b_s_routing(sd, 0, 0, 0); in ad9389b_audio_setup()
871 static void ad9389b_setup(struct v4l2_subdev *sd) in ad9389b_setup() argument
873 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_setup()
875 v4l2_dbg(1, debug, sd, "%s\n", __func__); in ad9389b_setup()
878 ad9389b_wr_and_or(sd, 0x15, 0xf1, 0x0); in ad9389b_setup()
880 ad9389b_wr_and_or(sd, 0x16, 0x3f, 0x0); in ad9389b_setup()
883 ad9389b_wr_and_or(sd, 0x17, 0xf9, 0x06); in ad9389b_setup()
885 ad9389b_wr_and_or(sd, 0x45, 0xc7, 0x08); in ad9389b_setup()
887 ad9389b_wr_and_or(sd, 0x46, 0x3f, 0x80); in ad9389b_setup()
889 ad9389b_wr(sd, 0x3c, 0x0); in ad9389b_setup()
891 ad9389b_wr(sd, 0x47, 0x80); in ad9389b_setup()
893 ad9389b_wr_and_or(sd, 0xaf, 0xef, 0x0); in ad9389b_setup()
895 ad9389b_wr_and_or(sd, 0xba, 0x1f, 0x60); in ad9389b_setup()
897 ad9389b_audio_setup(sd); in ad9389b_setup()
901 ad9389b_set_IT_content_AVI_InfoFrame(sd); in ad9389b_setup()
904 static void ad9389b_notify_monitor_detect(struct v4l2_subdev *sd) in ad9389b_notify_monitor_detect() argument
907 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_notify_monitor_detect()
910 v4l2_subdev_notify(sd, AD9389B_MONITOR_DETECT, (void *)&mdt); in ad9389b_notify_monitor_detect()
913 static void ad9389b_update_monitor_present_status(struct v4l2_subdev *sd) in ad9389b_update_monitor_present_status() argument
915 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_update_monitor_present_status()
917 u8 status = ad9389b_rd(sd, 0x42); in ad9389b_update_monitor_present_status()
919 v4l2_dbg(1, debug, sd, "%s: status: 0x%x%s%s\n", in ad9389b_update_monitor_present_status()
926 v4l2_dbg(1, debug, sd, "%s: hotplug detected\n", __func__); in ad9389b_update_monitor_present_status()
928 if (!ad9389b_s_power(sd, true)) { in ad9389b_update_monitor_present_status()
929 v4l2_dbg(1, debug, sd, in ad9389b_update_monitor_present_status()
933 ad9389b_setup(sd); in ad9389b_update_monitor_present_status()
934 ad9389b_notify_monitor_detect(sd); in ad9389b_update_monitor_present_status()
939 v4l2_dbg(1, debug, sd, "%s: hotplug not detected\n", __func__); in ad9389b_update_monitor_present_status()
941 ad9389b_notify_monitor_detect(sd); in ad9389b_update_monitor_present_status()
942 ad9389b_s_power(sd, false); in ad9389b_update_monitor_present_status()
947 v4l2_ctrl_s_ctrl(state->hotplug_ctrl, ad9389b_have_hotplug(sd) ? 0x1 : 0x0); in ad9389b_update_monitor_present_status()
948 v4l2_ctrl_s_ctrl(state->rx_sense_ctrl, ad9389b_have_rx_sense(sd) ? 0x1 : 0x0); in ad9389b_update_monitor_present_status()
956 static void ad9389b_check_monitor_present_status(struct v4l2_subdev *sd) in ad9389b_check_monitor_present_status() argument
958 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_check_monitor_present_status()
961 ad9389b_update_monitor_present_status(sd); in ad9389b_check_monitor_present_status()
967 while (state->power_on && (ad9389b_rd(sd, 0x41) & 0x40)) { in ad9389b_check_monitor_present_status()
969 v4l2_err(sd, "retried %d times, give up\n", retry); in ad9389b_check_monitor_present_status()
972 v4l2_dbg(1, debug, sd, "%s: reset and re-check status (%d)\n", __func__, retry); in ad9389b_check_monitor_present_status()
973 ad9389b_notify_monitor_detect(sd); in ad9389b_check_monitor_present_status()
976 ad9389b_s_power(sd, false); in ad9389b_check_monitor_present_status()
977 ad9389b_update_monitor_present_status(sd); in ad9389b_check_monitor_present_status()
991 static bool edid_verify_crc(struct v4l2_subdev *sd, u32 segment) in edid_verify_crc() argument
993 struct ad9389b_state *state = get_ad9389b_state(sd); in edid_verify_crc()
1005 static bool edid_verify_header(struct v4l2_subdev *sd, u32 segment) in edid_verify_header() argument
1010 struct ad9389b_state *state = get_ad9389b_state(sd); in edid_verify_header()
1024 static bool ad9389b_check_edid_status(struct v4l2_subdev *sd) in ad9389b_check_edid_status() argument
1026 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_check_edid_status()
1029 u8 edidRdy = ad9389b_rd(sd, 0xc5); in ad9389b_check_edid_status()
1031 v4l2_dbg(1, debug, sd, "%s: edid ready (retries: %d)\n", in ad9389b_check_edid_status()
1037 segment = ad9389b_rd(sd, 0xc4); in ad9389b_check_edid_status()
1039 v4l2_err(sd, "edid segment number too big\n"); in ad9389b_check_edid_status()
1042 v4l2_dbg(1, debug, sd, "%s: got segment %d\n", __func__, segment); in ad9389b_check_edid_status()
1043 ad9389b_edid_rd(sd, 256, &state->edid.data[segment * 256]); in ad9389b_check_edid_status()
1044 ad9389b_dbg_dump_edid(2, debug, sd, segment, in ad9389b_check_edid_status()
1048 v4l2_dbg(1, debug, sd, "%s: %d blocks in total\n", in ad9389b_check_edid_status()
1051 if (!edid_verify_crc(sd, segment) || in ad9389b_check_edid_status()
1052 !edid_verify_header(sd, segment)) { in ad9389b_check_edid_status()
1054 v4l2_err(sd, "%s: edid crc or header error\n", __func__); in ad9389b_check_edid_status()
1055 ad9389b_s_power(sd, false); in ad9389b_check_edid_status()
1056 ad9389b_s_power(sd, true); in ad9389b_check_edid_status()
1063 v4l2_dbg(1, debug, sd, "%s: request segment %d\n", in ad9389b_check_edid_status()
1065 ad9389b_wr(sd, 0xc9, 0xf); in ad9389b_check_edid_status()
1066 ad9389b_wr(sd, 0xc4, state->edid.segments); in ad9389b_check_edid_status()
1076 v4l2_subdev_notify(sd, AD9389B_EDID_DETECT, (void *)&ed); in ad9389b_check_edid_status()
1084 static void ad9389b_init_setup(struct v4l2_subdev *sd) in ad9389b_init_setup() argument
1086 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_init_setup()
1089 v4l2_dbg(1, debug, sd, "%s\n", __func__); in ad9389b_init_setup()
1092 ad9389b_wr(sd, 0x96, 0xff); in ad9389b_init_setup()
1096 ad9389b_set_isr(sd, false); in ad9389b_init_setup()
1105 struct v4l2_subdev *sd; in ad9389b_probe() local
1126 sd = &state->sd; in ad9389b_probe()
1127 v4l2_i2c_subdev_init(sd, client, &ad9389b_ops); in ad9389b_probe()
1128 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; in ad9389b_probe()
1148 sd->ctrl_handler = hdl; in ad9389b_probe()
1161 err = media_entity_init(&sd->entity, 1, &state->pad, 0); in ad9389b_probe()
1165 state->chip_revision = ad9389b_rd(sd, 0x0); in ad9389b_probe()
1167 v4l2_err(sd, "chip_revision %d != 2\n", state->chip_revision); in ad9389b_probe()
1171 v4l2_dbg(1, debug, sd, "reg 0x41 0x%x, chip version (reg 0x00) 0x%x\n", in ad9389b_probe()
1172 ad9389b_rd(sd, 0x41), state->chip_revision); in ad9389b_probe()
1176 v4l2_err(sd, "failed to register edid i2c client\n"); in ad9389b_probe()
1181 state->work_queue = create_singlethread_workqueue(sd->name); in ad9389b_probe()
1183 v4l2_err(sd, "could not create workqueue\n"); in ad9389b_probe()
1191 ad9389b_init_setup(sd); in ad9389b_probe()
1192 ad9389b_set_isr(sd, true); in ad9389b_probe()
1194 v4l2_info(sd, "%s found @ 0x%x (%s)\n", client->name, in ad9389b_probe()
1201 media_entity_cleanup(&sd->entity); in ad9389b_probe()
1211 struct v4l2_subdev *sd = i2c_get_clientdata(client); in ad9389b_remove() local
1212 struct ad9389b_state *state = get_ad9389b_state(sd); in ad9389b_remove()
1216 v4l2_dbg(1, debug, sd, "%s removed @ 0x%x (%s)\n", client->name, in ad9389b_remove()
1219 ad9389b_s_stream(sd, false); in ad9389b_remove()
1220 ad9389b_s_audio_stream(sd, false); in ad9389b_remove()
1221 ad9389b_init_setup(sd); in ad9389b_remove()
1225 v4l2_device_unregister_subdev(sd); in ad9389b_remove()
1226 media_entity_cleanup(&sd->entity); in ad9389b_remove()
1227 v4l2_ctrl_handler_free(sd->ctrl_handler); in ad9389b_remove()