media/i2c/mt9t112.c

53 #define ECHECKER(ret, x)		\
55 		(ret) = (x);		\
56 		if ((ret) < 0)		\
57 			return (ret);	\
60 #define mt9t112_reg_write(ret, client, a, b) \
61 	ECHECKER(ret, __mt9t112_reg_write(client, a, b))
62 #define mt9t112_mcu_write(ret, client, a, b) \
63 	ECHECKER(ret, __mt9t112_mcu_write(client, a, b))
65 #define mt9t112_reg_mask_set(ret, client, a, b, c) \
66 	ECHECKER(ret, __mt9t112_reg_mask_set(client, a, b, c))
67 #define mt9t112_mcu_mask_set(ret, client, a, b, c) \
68 	ECHECKER(ret, __mt9t112_mcu_mask_set(client, a, b, c))
70 #define mt9t112_reg_read(ret, client, a) \
71 	ECHECKER(ret, __mt9t112_reg_read(client, a))
154 	int ret;
172 	ret = i2c_transfer(client->adapter, msg, 2);
173 	if (ret < 0)
174 		return ret;
176 	memcpy(&ret, buf, 2);
178 	return swab16(ret);
186 	int ret;
203 	ret = i2c_transfer(client->adapter, &msg, 1);
205 	return ret >= 0 ? 0 : ret;
225 	int ret;
227 	ret = __mt9t112_reg_write(client, 0x098E, command);
228 	if (ret < 0)
229 		return ret;
237 	int ret;
239 	ret = __mt9t112_reg_write(client, 0x098E, command);
240 	if (ret < 0)
241 		return ret;
262 	int ret;
264 	mt9t112_reg_mask_set(ret, client, 0x001a, 0x0001, 0x0001);
266 	mt9t112_reg_mask_set(ret, client, 0x001a, 0x0001, 0x0000);
268 	return ret;
345 	int ret;
350 	mt9t112_mcu_write(ret, client, VAR(26, 0), width);
351 	mt9t112_mcu_write(ret, client, VAR(26, 2), height);
354 	mt9t112_mcu_write(ret, client, VAR(18, 43), 8 + width);
355 	mt9t112_mcu_write(ret, client, VAR(18, 45), 8 + height);
358 	mt9t112_mcu_write(ret, client, VAR(18, 2), 4 + hstart);
359 	mt9t112_mcu_write(ret, client, VAR(18, 4), 4 + wstart);
362 	mt9t112_mcu_write(ret, client, VAR(18, 6), 11 + height + hstart);
363 	mt9t112_mcu_write(ret, client, VAR(18, 8), 11 + width  + wstart);
365 	mt9t112_mcu_write(ret, client, VAR8(1, 0), 0x06);
367 	return ret;
374 	int ret;
379 	mt9t112_reg_mask_set(ret, client, 0x0010, 0x3fff, val);
383 	mt9t112_reg_mask_set(ret, client, 0x0012, 0x0fff, val);
388 	mt9t112_reg_mask_set(ret, client, 0x002A, 0x7fff, val);
392 	mt9t112_reg_mask_set(ret, client, 0x002C, 0x100f, val);
394 	return ret;
400 	int data, i, ret;
402 	mt9t112_reg_mask_set(ret, client, 0x0014, 0x003, 0x0001);
405 	mt9t112_reg_write(ret, client, 0x0014, 0x2145);
421 	mt9t112_reg_write(ret, client, 0x0014, 0x2525);
422 	mt9t112_reg_write(ret, client, 0x0014, 0x2527);
423 	mt9t112_reg_write(ret, client, 0x0014, 0x3427);
424 	mt9t112_reg_write(ret, client, 0x0014, 0x3027);
433 	mt9t112_reg_write(ret, client, 0x0014, 0x3046);
435 	mt9t112_reg_write(ret, client, 0x0016, 0x0400);
436 	mt9t112_reg_write(ret, client, 0x0022, 0x0190);
437 	mt9t112_reg_write(ret, client, 0x3B84, 0x0212);
440 	mt9t112_reg_write(ret, client, 0x002E, 0x0500);
442 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0002, 0x0002);
443 	mt9t112_reg_mask_set(ret, client, 0x3B82, 0x0004, 0x0004);
446 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0004, 0x0004);
449 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0001, 0);
457 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);
459 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);
461 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);
463 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);
465 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);
467 	mt9t112_reg_write(ret, client, 0x0614, 0x0001);
479 	return ret;
484 	int ret;
487 	mt9t112_mcu_mask_set(ret, client, VAR(26, 160), 0x0040, 0x0000);
490 	mt9t112_mcu_write(ret, client, VAR(18, 12), 0x0024);
493 	mt9t112_mcu_write(ret, client, VAR(18, 15), 0x00CC);
496 	mt9t112_mcu_write(ret, client, VAR(18, 17), 0x01f1);
499 	mt9t112_mcu_write(ret, client, VAR(18, 19), 0x00fF);
502 	mt9t112_mcu_write(ret, client, VAR(18, 29), 0x032D);
505 	mt9t112_mcu_write(ret, client, VAR(18, 31), 0x073a);
508 	mt9t112_mcu_write(ret, client, VAR(18, 37), 0x07d0);
511 	mt9t112_mcu_mask_set(ret, client, VAR(27, 160), 0x0040, 0x0000);
514 	mt9t112_mcu_write(ret, client, VAR(18, 74), 0x004);
517 	mt9t112_mcu_write(ret, client, VAR(18, 76), 0x004);
520 	mt9t112_mcu_write(ret, client, VAR(18, 78), 0x60B);
523 	mt9t112_mcu_write(ret, client, VAR(18, 80), 0x80B);
526 	mt9t112_mcu_write(ret, client, VAR(18, 87), 0x008C);
529 	mt9t112_mcu_write(ret, client, VAR(18, 89), 0x01F1);
532 	mt9t112_mcu_write(ret, client, VAR(18, 91), 0x00FF);
535 	mt9t112_mcu_write(ret, client, VAR(18, 101), 0x0668);
538 	mt9t112_mcu_write(ret, client, VAR(18, 103), 0x0AF0);
541 	mt9t112_mcu_write(ret, client, VAR(18, 109), 0x0AF0);
552 	mt9t112_mcu_write(ret, client, VAR8(8, 5), 0x01);
555 	mt9t112_mcu_write(ret, client, VAR(27, 17), 0x0003);
558 	mt9t112_mcu_write(ret, client, VAR(26, 17), 0x0003);
565 	mt9t112_mcu_write(ret, client, VAR8(18, 165), 0x25);
568 	mt9t112_mcu_write(ret, client, VAR8(18, 166), 0x28);
571 	mt9t112_mcu_write(ret, client, VAR8(18, 167), 0x2C);
574 	mt9t112_mcu_write(ret, client, VAR8(18, 168), 0x2F);
577 	mt9t112_mcu_write(ret, client, VAR8(18, 68), 0xBA);
581 	mt9t112_mcu_write(ret, client, VAR8(18, 303), 0x00);
584 	mt9t112_mcu_write(ret, client, VAR8(18, 69), 0x9B);
588 	mt9t112_mcu_write(ret, client, VAR8(18, 301), 0x00);
591 	mt9t112_mcu_write(ret, client, VAR8(18, 140), 0x82);
595 	mt9t112_mcu_write(ret, client, VAR8(18, 304), 0x00);
598 	mt9t112_mcu_write(ret, client, VAR8(18, 141), 0x6D);
602 	mt9t112_mcu_write(ret, client, VAR8(18, 302), 0x00);
605 	mt9t112_mcu_write(ret, client, VAR8(8, 2), 0x10);
608 	mt9t112_mcu_write(ret, client, VAR8(8, 9), 0x02);
611 	mt9t112_mcu_write(ret, client, VAR8(8, 10), 0x03);
614 	mt9t112_mcu_write(ret, client, VAR8(8, 12), 0x0A);
617 	mt9t112_mcu_write(ret, client, VAR(18, 70), 0x0014);
620 	mt9t112_mcu_write(ret, client, VAR(18, 142), 0x0014);
626 	mt9t112_mcu_write(ret, client, VAR8(18, 0x0044), 133);
627 	mt9t112_mcu_write(ret, client, VAR8(18, 0x0045), 110);
628 	mt9t112_mcu_write(ret, client, VAR8(18, 0x008c), 130);
629 	mt9t112_mcu_write(ret, client, VAR8(18, 0x008d), 108);
631 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00A5), 27);
632 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00a6), 30);
633 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00a7), 32);
634 	mt9t112_mcu_write(ret, client, VAR8(18, 0x00a8), 35);
636 	return ret;
641 	int ret;
643 	mt9t112_mcu_write(ret, client, VAR(12, 13),	0x000F);
644 	mt9t112_mcu_write(ret, client, VAR(12, 23),	0x0F0F);
645 	mt9t112_mcu_write(ret, client, VAR8(1, 0),	0x06);
647 	mt9t112_reg_write(ret, client, 0x0614, 0x0000);
649 	mt9t112_mcu_write(ret, client, VAR8(1, 0),	0x05);
650 	mt9t112_mcu_write(ret, client, VAR8(12, 2),	0x02);
651 	mt9t112_mcu_write(ret, client, VAR(12, 3),	0x0002);
652 	mt9t112_mcu_write(ret, client, VAR(17, 3),	0x8001);
653 	mt9t112_mcu_write(ret, client, VAR(17, 11),	0x0025);
654 	mt9t112_mcu_write(ret, client, VAR(17, 13),	0x0193);
655 	mt9t112_mcu_write(ret, client, VAR8(17, 33),	0x18);
656 	mt9t112_mcu_write(ret, client, VAR8(1, 0),	0x05);
658 	return ret;
663 	int ret;
665 	mt9t112_mcu_write(ret, client, VAR8(12, 25), 0x01);
667 	return ret;
672 	int ret;
674 	ECHECKER(ret, mt9t112_reset(client));
675 	ECHECKER(ret, mt9t112_init_pll(client));
676 	ECHECKER(ret, mt9t112_init_setting(client));
677 	ECHECKER(ret, mt9t112_auto_focus_setting(client));
679 	mt9t112_reg_mask_set(ret, client, 0x0018, 0x0004, 0);
682 	mt9t112_reg_write(ret, client, 0x3084, 0x2409);
683 	mt9t112_reg_write(ret, client, 0x3092, 0x0A49);
684 	mt9t112_reg_write(ret, client, 0x3094, 0x4949);
685 	mt9t112_reg_write(ret, client, 0x3096, 0x4950);
692 	mt9t112_mcu_write(ret, client, VAR(26, 160), 0x0A2E);
693 	mt9t112_mcu_write(ret, client, VAR(27, 160), 0x0A2E);
699 	mt9t112_mcu_write(ret, client, VAR(27, 144), 0x0CB4);
705 	mt9t112_mcu_write(ret, client, VAR8(27, 142), 0x01);
708 	mt9t112_reg_write(ret, client, 0x316C, 0x350F);
711 	mt9t112_reg_write(ret, client, 0x1E, 0x777);
713 	return ret;
725 	int                ret;
728 	mt9t112_reg_read(ret, client, reg->reg);
730 	reg->val = (__u64)ret;
739 	int ret;
741 	mt9t112_reg_write(ret, client, reg->reg, reg->val);
743 	return ret;
749 	int ret;
751 	ret = clk_prepare_enable(priv->clk);
752 	if (ret)
753 		return ret;
798 	int ret = 0;
810 		return ret;
817 		ECHECKER(ret, mt9t112_init_camera(client));
820 		mt9t112_reg_write(ret, client, 0x3C20, param);
827 	mt9t112_mcu_write(ret, client, VAR(26, 7), priv->format->fmt);
828 	mt9t112_mcu_write(ret, client, VAR(26, 9), priv->format->order);
829 	mt9t112_mcu_write(ret, client, VAR8(1, 0), 0x06);
833 	ECHECKER(ret, mt9t112_auto_focus_trigger(client));
842 	return ret;
945 	int ret;
947 	ret = mt9t112_set_params(priv, &rect, mf->code);
949 	if (!ret)
952 	return ret;
1030 	int		     ret;
1032 	ret = mt9t112_s_power(&priv->subdev, 1);
1033 	if (ret < 0)
1034 		return ret;
1050 		ret = -ENODEV;
1059 	return ret;
1065 	int ret;
1096 	ret = mt9t112_camera_probe(client);
1097 	if (ret)
1098 		return ret;