49 #define ECHECKER(ret, x)		\  argument
51 		(ret) = (x);		\
52 		if ((ret) < 0)		\
53 			return (ret);	\
56 #define mt9t112_reg_write(ret, client, a, b) \  argument
57 	ECHECKER(ret, __mt9t112_reg_write(client, a, b))
58 #define mt9t112_mcu_write(ret, client, a, b) \  argument
59 	ECHECKER(ret, __mt9t112_mcu_write(client, a, b))
61 #define mt9t112_reg_mask_set(ret, client, a, b, c) \  argument
62 	ECHECKER(ret, __mt9t112_reg_mask_set(client, a, b, c))
63 #define mt9t112_mcu_mask_set(ret, client, a, b, c) \  argument
64 	ECHECKER(ret, __mt9t112_mcu_mask_set(client, a, b, c))
66 #define mt9t112_reg_read(ret, client, a) \  argument
67 	ECHECKER(ret, __mt9t112_reg_read(client, a))
152 	int ret;  in __mt9t112_reg_read()  local
171 	ret = i2c_transfer(client->adapter, msg, 2);  in __mt9t112_reg_read()
172 	if (ret < 0)  in __mt9t112_reg_read()
173 		return ret;  in __mt9t112_reg_read()
175 	memcpy(&ret, buf, 2);  in __mt9t112_reg_read()
176 	return swab16(ret);  in __mt9t112_reg_read()
184 	int ret;  in __mt9t112_reg_write()  local
201 	ret = i2c_transfer(client->adapter, &msg, 1);  in __mt9t112_reg_write()
202 	if (ret >= 0)  in __mt9t112_reg_write()
203 		ret = 0;  in __mt9t112_reg_write()
205 	return ret;  in __mt9t112_reg_write()
226 	int ret;  in __mt9t112_mcu_read()  local
228 	ret = __mt9t112_reg_write(client, 0x098E, command);  in __mt9t112_mcu_read()
229 	if (ret < 0)  in __mt9t112_mcu_read()
230 		return ret;  in __mt9t112_mcu_read()
238 	int ret;  in __mt9t112_mcu_write()  local
240 	ret = __mt9t112_reg_write(client, 0x098E, command);  in __mt9t112_mcu_write()
241 	if (ret < 0)  in __mt9t112_mcu_write()
242 		return ret;  in __mt9t112_mcu_write()
264 	int ret;  in mt9t112_reset()  local
266 	mt9t112_reg_mask_set(ret, client, 0x001a, 0x0001, 0x0001);  in mt9t112_reset()
268 	mt9t112_reg_mask_set(ret, client, 0x001a, 0x0001, 0x0000);  in mt9t112_reset()
270 	return ret;  in mt9t112_reset()
354 	int ret;  in mt9t112_set_a_frame_size()  local
359 	mt9t112_mcu_write(ret, client, VAR(26, 0), width);  in mt9t112_set_a_frame_size()
360 	mt9t112_mcu_write(ret, client, VAR(26, 2), height);  in mt9t112_set_a_frame_size()
363 	mt9t112_mcu_write(ret, client, VAR(18, 43), 8 + width);  in mt9t112_set_a_frame_size()
364 	mt9t112_mcu_write(ret, client, VAR(18, 45), 8 + height);  in mt9t112_set_a_frame_size()
367 	mt9t112_mcu_write(ret, client, VAR(18, 2), 4 + hstart);  in mt9t112_set_a_frame_size()
368 	mt9t112_mcu_write(ret, client, VAR(18, 4), 4 + wstart);  in mt9t112_set_a_frame_size()
371 	mt9t112_mcu_write(ret, client, VAR(18, 6), 11 + height + hstart);  in mt9t112_set_a_frame_size()
372 	mt9t112_mcu_write(ret, client, VAR(18, 8), 11 + width  + wstart);  in mt9t112_set_a_frame_size()
374 	mt9t112_mcu_write(ret, client, VAR8(1, 0), 0x06);  in mt9t112_set_a_frame_size()
376 	return ret;  in mt9t112_set_a_frame_size()
385 	int ret;  in mt9t112_set_pll_dividers()  local
391 	mt9t112_reg_mask_set(ret, client, 0x0010, 0x3fff, val);  in mt9t112_set_pll_dividers()
397 	mt9t112_reg_mask_set(ret, client, 0x0012, 0x0fff, val);  in mt9t112_set_pll_dividers()
404 	mt9t112_reg_mask_set(ret, client, 0x002A, 0x7fff, val);  in mt9t112_set_pll_dividers()
409 	mt9t112_reg_mask_set(ret, client, 0x002C, 0x100f, val);  in mt9t112_set_pll_dividers()
411 	return ret;  in mt9t112_set_pll_dividers()
417 	int data, i, ret;  in mt9t112_init_pll()  local
419 	mt9t112_reg_mask_set(ret, client, 0x0014, 0x003, 0x0001);  in mt9t112_init_pll()
422 	mt9t112_reg_write(ret, client, 0x0014, 0x2145);  in mt9t112_init_pll()
442 	mt9t112_reg_write(ret, client, 0x0014, 0x2525);  in mt9t112_init_pll()
443 	mt9t112_reg_write(ret, client, 0x0014, 0x2527);  in mt9t112_init_pll()
444 	mt9t112_reg_write(ret, client, 0x0014, 0x3427);  in mt9t112_init_pll()
445 	mt9t112_reg_write(ret, client, 0x0014, 0x3027);  in mt9t112_init_pll()
454 	mt9t112_reg_write(ret, client, 0x0014, 0x3046);  in mt9t112_init_pll()
455 	mt9t112_reg_write(ret, client, 0x0016, 0x0400); /* JPEG initialization workaround */  in mt9t112_init_pll()
456 	mt9t112_reg_write(ret, client, 0x0022, 0x0190);  in mt9t112_init_pll()
457 	mt9t112_reg_write(ret, client, 0x3B84, 0x0212);  in mt9t112_init_pll()
460 	mt9t112_reg_write(ret, client, 0x002E, 0x0500);  in mt9t112_init_pll()
462 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0002, 0x0002);  in mt9t112_init_pll()
463 	mt9t112_reg_mask_set(ret, client, 0x3B82, 0x0004, 0x0004);  in mt9t112_init_pll()
466 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0004, 0x0004);  in mt9t112_init_pll()
469 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0001, 0);  in mt9t112_init_pll()
477 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);  in mt9t112_init_pll()
479 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);  in mt9t112_init_pll()
481 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);  in mt9t112_init_pll()
483 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);  in mt9t112_init_pll()
485 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);  in mt9t112_init_pll()
487 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);  in mt9t112_init_pll()
499 	return ret;  in mt9t112_init_pll()
505 	int ret;  in mt9t112_init_setting()  local
508 	mt9t112_mcu_mask_set(ret, client, VAR(26, 160), 0x0040, 0x0000);  in mt9t112_init_setting()
511 	mt9t112_mcu_write(ret, client, VAR(18, 12), 0x0024);  in mt9t112_init_setting()
514 	mt9t112_mcu_write(ret, client, VAR(18, 15), 0x00CC);  in mt9t112_init_setting()
517 	mt9t112_mcu_write(ret, client, VAR(18, 17), 0x01f1);  in mt9t112_init_setting()
520 	mt9t112_mcu_write(ret, client, VAR(18, 19), 0x00fF);  in mt9t112_init_setting()
523 	mt9t112_mcu_write(ret, client, VAR(18, 29), 0x032D);  in mt9t112_init_setting()
526 	mt9t112_mcu_write(ret, client, VAR(18, 31), 0x073a);  in mt9t112_init_setting()
529 	mt9t112_mcu_write(ret, client, VAR(18, 37), 0x07d0);  in mt9t112_init_setting()
532 	mt9t112_mcu_mask_set(ret, client, VAR(27, 160), 0x0040, 0x0000);  in mt9t112_init_setting()
535 	mt9t112_mcu_write(ret, client, VAR(18, 74), 0x004);  in mt9t112_init_setting()
538 	mt9t112_mcu_write(ret, client, VAR(18, 76), 0x004);  in mt9t112_init_setting()
541 	mt9t112_mcu_write(ret, client, VAR(18, 78), 0x60B);  in mt9t112_init_setting()
544 	mt9t112_mcu_write(ret, client, VAR(18, 80), 0x80B);  in mt9t112_init_setting()
547 	mt9t112_mcu_write(ret, client, VAR(18, 87), 0x008C);  in mt9t112_init_setting()
550 	mt9t112_mcu_write(ret, client, VAR(18, 89), 0x01F1);  in mt9t112_init_setting()
553 	mt9t112_mcu_write(ret, client, VAR(18, 91), 0x00FF);  in mt9t112_init_setting()
556 	mt9t112_mcu_write(ret, client, VAR(18, 101), 0x0668);  in mt9t112_init_setting()
559 	mt9t112_mcu_write(ret, client, VAR(18, 103), 0x0AF0);  in mt9t112_init_setting()
562 	mt9t112_mcu_write(ret, client, VAR(18, 109), 0x0AF0);  in mt9t112_init_setting()
573 	mt9t112_mcu_write(ret, client, VAR8(8, 5), 0x01);  in mt9t112_init_setting()
576 	mt9t112_mcu_write(ret, client, VAR(27, 17), 0x0003);  in mt9t112_init_setting()
579 	mt9t112_mcu_write(ret, client, VAR(26, 17), 0x0003);  in mt9t112_init_setting()
586 	mt9t112_mcu_write(ret, client, VAR8(18, 165), 0x25);  in mt9t112_init_setting()
589 	mt9t112_mcu_write(ret, client, VAR8(18, 166), 0x28);  in mt9t112_init_setting()
592 	mt9t112_mcu_write(ret, client, VAR8(18, 167), 0x2C);  in mt9t112_init_setting()
595 	mt9t112_mcu_write(ret, client, VAR8(18, 168), 0x2F);  in mt9t112_init_setting()
598 	mt9t112_mcu_write(ret, client, VAR8(18, 68), 0xBA);  in mt9t112_init_setting()
602 	mt9t112_mcu_write(ret, client, VAR8(18, 303), 0x00);  in mt9t112_init_setting()
605 	mt9t112_mcu_write(ret, client, VAR8(18, 69), 0x9B);  in mt9t112_init_setting()
609 	mt9t112_mcu_write(ret, client, VAR8(18, 301), 0x00);  in mt9t112_init_setting()
612 	mt9t112_mcu_write(ret, client, VAR8(18, 140), 0x82);  in mt9t112_init_setting()
616 	mt9t112_mcu_write(ret, client, VAR8(18, 304), 0x00);  in mt9t112_init_setting()
619 	mt9t112_mcu_write(ret, client, VAR8(18, 141), 0x6D);  in mt9t112_init_setting()
623 	mt9t112_mcu_write(ret, client, VAR8(18, 302), 0x00);  in mt9t112_init_setting()
626 	mt9t112_mcu_write(ret, client, VAR8(8, 2), 0x10);  in mt9t112_init_setting()
629 	mt9t112_mcu_write(ret, client, VAR8(8, 9), 0x02);  in mt9t112_init_setting()
632 	mt9t112_mcu_write(ret, client, VAR8(8, 10), 0x03);  in mt9t112_init_setting()
635 	mt9t112_mcu_write(ret, client, VAR8(8, 12), 0x0A);  in mt9t112_init_setting()
638 	mt9t112_mcu_write(ret, client, VAR(18, 70), 0x0014);  in mt9t112_init_setting()
641 	mt9t112_mcu_write(ret, client, VAR(18, 142), 0x0014);  in mt9t112_init_setting()
647 	mt9t112_mcu_write(ret, client, VAR8(18, 0x0044), 133);  in mt9t112_init_setting()
648 	mt9t112_mcu_write(ret, client, VAR8(18, 0x0045), 110);  in mt9t112_init_setting()
649 	mt9t112_mcu_write(ret, client, VAR8(18, 0x008c), 130);  in mt9t112_init_setting()
650 	mt9t112_mcu_write(ret, client, VAR8(18, 0x008d), 108);  in mt9t112_init_setting()
652 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00A5), 27);  in mt9t112_init_setting()
653 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00a6), 30);  in mt9t112_init_setting()
654 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00a7), 32);  in mt9t112_init_setting()
655 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00a8), 35);  in mt9t112_init_setting()
657 	return ret;  in mt9t112_init_setting()
662 	int ret;  in mt9t112_auto_focus_setting()  local
664 	mt9t112_mcu_write(ret, client, VAR(12, 13),	0x000F);  in mt9t112_auto_focus_setting()
665 	mt9t112_mcu_write(ret, client, VAR(12, 23),	0x0F0F);  in mt9t112_auto_focus_setting()
666 	mt9t112_mcu_write(ret, client, VAR8(1, 0),	0x06);  in mt9t112_auto_focus_setting()
668 	mt9t112_reg_write(ret, client, 0x0614, 0x0000);  in mt9t112_auto_focus_setting()
670 	mt9t112_mcu_write(ret, client, VAR8(1, 0),	0x05);  in mt9t112_auto_focus_setting()
671 	mt9t112_mcu_write(ret, client, VAR8(12, 2),	0x02);  in mt9t112_auto_focus_setting()
672 	mt9t112_mcu_write(ret, client, VAR(12, 3),	0x0002);  in mt9t112_auto_focus_setting()
673 	mt9t112_mcu_write(ret, client, VAR(17, 3),	0x8001);  in mt9t112_auto_focus_setting()
674 	mt9t112_mcu_write(ret, client, VAR(17, 11),	0x0025);  in mt9t112_auto_focus_setting()
675 	mt9t112_mcu_write(ret, client, VAR(17, 13),	0x0193);  in mt9t112_auto_focus_setting()
676 	mt9t112_mcu_write(ret, client, VAR8(17, 33),	0x18);  in mt9t112_auto_focus_setting()
677 	mt9t112_mcu_write(ret, client, VAR8(1, 0),	0x05);  in mt9t112_auto_focus_setting()
679 	return ret;  in mt9t112_auto_focus_setting()
684 	int ret;  in mt9t112_auto_focus_trigger()  local
686 	mt9t112_mcu_write(ret, client, VAR8(12, 25), 0x01);  in mt9t112_auto_focus_trigger()
688 	return ret;  in mt9t112_auto_focus_trigger()
693 	int ret;  in mt9t112_init_camera()  local
695 	ECHECKER(ret, mt9t112_reset(client));  in mt9t112_init_camera()
697 	ECHECKER(ret, mt9t112_init_pll(client));  in mt9t112_init_camera()
699 	ECHECKER(ret, mt9t112_init_setting(client));  in mt9t112_init_camera()
701 	ECHECKER(ret, mt9t112_auto_focus_setting(client));  in mt9t112_init_camera()
703 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0004, 0);  in mt9t112_init_camera()
706 	mt9t112_reg_write(ret, client, 0x3084, 0x2409);  in mt9t112_init_camera()
707 	mt9t112_reg_write(ret, client, 0x3092, 0x0A49);  in mt9t112_init_camera()
708 	mt9t112_reg_write(ret, client, 0x3094, 0x4949);  in mt9t112_init_camera()
709 	mt9t112_reg_write(ret, client, 0x3096, 0x4950);  in mt9t112_init_camera()
716 	mt9t112_mcu_write(ret, client, VAR(26, 160), 0x0A2E);  in mt9t112_init_camera()
717 	mt9t112_mcu_write(ret, client, VAR(27, 160), 0x0A2E);  in mt9t112_init_camera()
721 	mt9t112_mcu_write(ret, client, VAR(27, 144), 0x0CB4);  in mt9t112_init_camera()
725 	mt9t112_mcu_write(ret, client, VAR8(27, 142), 0x01);  in mt9t112_init_camera()
728 	mt9t112_reg_write(ret, client, 0x316C, 0x350F);  in mt9t112_init_camera()
731 	mt9t112_reg_write(ret, client, 0x1E, 0x777);  in mt9t112_init_camera()
733 	return ret;  in mt9t112_init_camera()
745 	int                ret;  in mt9t112_g_register()  local
748 	mt9t112_reg_read(ret, client, reg->reg);  in mt9t112_g_register()
750 	reg->val = (__u64)ret;  in mt9t112_g_register()
759 	int ret;  in mt9t112_s_register()  local
761 	mt9t112_reg_write(ret, client, reg->reg, reg->val);  in mt9t112_s_register()
763 	return ret;  in mt9t112_s_register()
792 	int ret = 0;  in mt9t112_s_stream()  local
805 		return ret;  in mt9t112_s_stream()
811 		ECHECKER(ret, mt9t112_init_camera(client));  in mt9t112_s_stream()
814 		mt9t112_reg_write(ret, client, 0x3C20, param);  in mt9t112_s_stream()
821 	mt9t112_mcu_write(ret, client, VAR(26, 7), priv->format->fmt);  in mt9t112_s_stream()
822 	mt9t112_mcu_write(ret, client, VAR(26, 9), priv->format->order);  in mt9t112_s_stream()
823 	mt9t112_mcu_write(ret, client, VAR8(1, 0), 0x06);  in mt9t112_s_stream()
829 	ECHECKER(ret, mt9t112_auto_focus_trigger(client));  in mt9t112_s_stream()
838 	return ret;  in mt9t112_s_stream()
938 	int ret;  in mt9t112_s_fmt()  local
940 	ret = mt9t112_set_params(priv, &rect, mf->code);  in mt9t112_s_fmt()
942 	if (!ret)  in mt9t112_s_fmt()
945 	return ret;  in mt9t112_s_fmt()
1054 	int		     ret;  in mt9t112_camera_probe()  local
1056 	ret = mt9t112_s_power(&priv->subdev, 1);  in mt9t112_camera_probe()
1057 	if (ret < 0)  in mt9t112_camera_probe()
1058 		return ret;  in mt9t112_camera_probe()
1076 		ret = -ENODEV;  in mt9t112_camera_probe()
1084 	return ret;  in mt9t112_camera_probe()
1098 	int ret;  in mt9t112_probe()  local
1117 	ret = mt9t112_camera_probe(client);  in mt9t112_probe()
1120 	if (!ret)  in mt9t112_probe()
1125 	return ret;  in mt9t112_probe()