forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
793 lines
30 KiB
793 lines
30 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* Subdriver for the GL860 chip with the MI2020 sensor |
|
* Author Olivier LORIN, from logs by Iceman/Soro2005 + Fret_saw/Hulkie/Tricid |
|
* with the help of Kytrix/BUGabundo/Blazercist. |
|
* Driver achieved thanks to a webcam gift by Kytrix. |
|
*/ |
|
|
|
/* Sensor : MI2020 */ |
|
|
|
#include "gl860.h" |
|
|
|
static u8 dat_wbal1[] = {0x8c, 0xa2, 0x0c}; |
|
|
|
static u8 dat_bright1[] = {0x8c, 0xa2, 0x06}; |
|
static u8 dat_bright3[] = {0x8c, 0xa1, 0x02}; |
|
static u8 dat_bright4[] = {0x90, 0x00, 0x0f}; |
|
static u8 dat_bright5[] = {0x8c, 0xa1, 0x03}; |
|
static u8 dat_bright6[] = {0x90, 0x00, 0x05}; |
|
|
|
static u8 dat_hvflip1[] = {0x8c, 0x27, 0x19}; |
|
static u8 dat_hvflip3[] = {0x8c, 0x27, 0x3b}; |
|
static u8 dat_hvflip5[] = {0x8c, 0xa1, 0x03}; |
|
static u8 dat_hvflip6[] = {0x90, 0x00, 0x06}; |
|
|
|
static struct idxdata tbl_middle_hvflip_low[] = { |
|
{0x33, {0x90, 0x00, 0x06}}, |
|
{6, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x90, 0x00, 0x06}}, |
|
{6, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x90, 0x00, 0x06}}, |
|
{6, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x90, 0x00, 0x06}}, |
|
{6, {0xff, 0xff, 0xff}}, |
|
}; |
|
|
|
static struct idxdata tbl_middle_hvflip_big[] = { |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{102, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x02}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x72}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x01}}, |
|
}; |
|
|
|
static struct idxdata tbl_end_hvflip[] = { |
|
{0x33, {0x8c, 0xa1, 0x02}}, {0x33, {0x90, 0x00, 0x1f}}, |
|
{6, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x02}}, {0x33, {0x90, 0x00, 0x1f}}, |
|
{6, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x02}}, {0x33, {0x90, 0x00, 0x1f}}, |
|
{6, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x02}}, {0x33, {0x90, 0x00, 0x1f}}, |
|
}; |
|
|
|
static u8 dat_freq1[] = { 0x8c, 0xa4, 0x04 }; |
|
|
|
static u8 dat_multi5[] = { 0x8c, 0xa1, 0x03 }; |
|
static u8 dat_multi6[] = { 0x90, 0x00, 0x05 }; |
|
|
|
static struct validx tbl_init_at_startup[] = { |
|
{0x0000, 0x0000}, {0x0010, 0x0010}, {0x0008, 0x00c0}, {0x0001, 0x00c1}, |
|
{0x0001, 0x00c2}, {0x0020, 0x0006}, {0x006a, 0x000d}, |
|
{53, 0xffff}, |
|
{0x0040, 0x0000}, {0x0063, 0x0006}, |
|
}; |
|
|
|
static struct validx tbl_common_0B[] = { |
|
{0x0002, 0x0004}, {0x006a, 0x0007}, {0x00ef, 0x0006}, {0x006a, 0x000d}, |
|
{0x0000, 0x00c0}, {0x0010, 0x0010}, {0x0003, 0x00c1}, {0x0042, 0x00c2}, |
|
{0x0004, 0x00d8}, {0x0000, 0x0058}, {0x0041, 0x0000}, |
|
}; |
|
|
|
static struct idxdata tbl_common_3B[] = { |
|
{0x33, {0x86, 0x25, 0x01}}, {0x33, {0x86, 0x25, 0x00}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x30, {0x1a, 0x0a, 0xcc}}, {0x32, {0x02, 0x00, 0x08}}, |
|
{0x33, {0xf4, 0x03, 0x1d}}, |
|
{6, {0xff, 0xff, 0xff}}, /* 12 */ |
|
{0x34, {0x1e, 0x8f, 0x09}}, {0x34, {0x1c, 0x01, 0x28}}, |
|
{0x34, {0x1e, 0x8f, 0x09}}, |
|
{2, {0xff, 0xff, 0xff}}, /* - */ |
|
{0x34, {0x1e, 0x8f, 0x09}}, {0x32, {0x14, 0x06, 0xe6}}, |
|
{0x33, {0x8c, 0x22, 0x23}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0xa2, 0x0f}}, {0x33, {0x90, 0x00, 0x0d}}, |
|
{0x33, {0x8c, 0xa2, 0x10}}, {0x33, {0x90, 0x00, 0x0b}}, |
|
{0x33, {0x8c, 0xa2, 0x11}}, {0x33, {0x90, 0x00, 0x07}}, |
|
{0x33, {0xf4, 0x03, 0x1d}}, {0x35, {0xa2, 0x00, 0xe2}}, |
|
{0x33, {0x8c, 0xab, 0x05}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{0x32, {0x6e, 0x00, 0x86}}, {0x32, {0x70, 0x0f, 0xaa}}, |
|
{0x32, {0x72, 0x0f, 0xe4}}, {0x33, {0x8c, 0xa3, 0x4a}}, |
|
{0x33, {0x90, 0x00, 0x5a}}, {0x33, {0x8c, 0xa3, 0x4b}}, |
|
{0x33, {0x90, 0x00, 0xa6}}, {0x33, {0x8c, 0xa3, 0x61}}, |
|
{0x33, {0x90, 0x00, 0xc8}}, {0x33, {0x8c, 0xa3, 0x62}}, |
|
{0x33, {0x90, 0x00, 0xe1}}, {0x34, {0xce, 0x01, 0xa8}}, |
|
{0x34, {0xd0, 0x66, 0x33}}, {0x34, {0xd2, 0x31, 0x9a}}, |
|
{0x34, {0xd4, 0x94, 0x63}}, {0x34, {0xd6, 0x4b, 0x25}}, |
|
{0x34, {0xd8, 0x26, 0x70}}, {0x34, {0xda, 0x72, 0x4c}}, |
|
{0x34, {0xdc, 0xff, 0x04}}, {0x34, {0xde, 0x01, 0x5b}}, |
|
{0x34, {0xe6, 0x01, 0x13}}, {0x34, {0xee, 0x0b, 0xf0}}, |
|
{0x34, {0xf6, 0x0b, 0xa4}}, {0x35, {0x00, 0xf6, 0xe7}}, |
|
{0x35, {0x08, 0x0d, 0xfd}}, {0x35, {0x10, 0x25, 0x63}}, |
|
{0x35, {0x18, 0x35, 0x6c}}, {0x35, {0x20, 0x42, 0x7e}}, |
|
{0x35, {0x28, 0x19, 0x44}}, {0x35, {0x30, 0x39, 0xd4}}, |
|
{0x35, {0x38, 0xf5, 0xa8}}, {0x35, {0x4c, 0x07, 0x90}}, |
|
{0x35, {0x44, 0x07, 0xb8}}, {0x35, {0x5c, 0x06, 0x88}}, |
|
{0x35, {0x54, 0x07, 0xff}}, {0x34, {0xe0, 0x01, 0x52}}, |
|
{0x34, {0xe8, 0x00, 0xcc}}, {0x34, {0xf0, 0x0d, 0x83}}, |
|
{0x34, {0xf8, 0x0c, 0xb3}}, {0x35, {0x02, 0xfe, 0xba}}, |
|
{0x35, {0x0a, 0x04, 0xe0}}, {0x35, {0x12, 0x1c, 0x63}}, |
|
{0x35, {0x1a, 0x2b, 0x5a}}, {0x35, {0x22, 0x32, 0x5e}}, |
|
{0x35, {0x2a, 0x0d, 0x28}}, {0x35, {0x32, 0x2c, 0x02}}, |
|
{0x35, {0x3a, 0xf4, 0xfa}}, {0x35, {0x4e, 0x07, 0xef}}, |
|
{0x35, {0x46, 0x07, 0x88}}, {0x35, {0x5e, 0x07, 0xc1}}, |
|
{0x35, {0x56, 0x04, 0x64}}, {0x34, {0xe4, 0x01, 0x15}}, |
|
{0x34, {0xec, 0x00, 0x82}}, {0x34, {0xf4, 0x0c, 0xce}}, |
|
{0x34, {0xfc, 0x0c, 0xba}}, {0x35, {0x06, 0x1f, 0x02}}, |
|
{0x35, {0x0e, 0x02, 0xe3}}, {0x35, {0x16, 0x1a, 0x50}}, |
|
{0x35, {0x1e, 0x24, 0x39}}, {0x35, {0x26, 0x23, 0x4c}}, |
|
{0x35, {0x2e, 0xf9, 0x1b}}, {0x35, {0x36, 0x23, 0x19}}, |
|
{0x35, {0x3e, 0x12, 0x08}}, {0x35, {0x52, 0x07, 0x22}}, |
|
{0x35, {0x4a, 0x03, 0xd3}}, {0x35, {0x62, 0x06, 0x54}}, |
|
{0x35, {0x5a, 0x04, 0x5d}}, {0x34, {0xe2, 0x01, 0x04}}, |
|
{0x34, {0xea, 0x00, 0xa0}}, {0x34, {0xf2, 0x0c, 0xbc}}, |
|
{0x34, {0xfa, 0x0c, 0x5b}}, {0x35, {0x04, 0x17, 0xf2}}, |
|
{0x35, {0x0c, 0x02, 0x08}}, {0x35, {0x14, 0x28, 0x43}}, |
|
{0x35, {0x1c, 0x28, 0x62}}, {0x35, {0x24, 0x2b, 0x60}}, |
|
{0x35, {0x2c, 0x07, 0x33}}, {0x35, {0x34, 0x1f, 0xb0}}, |
|
{0x35, {0x3c, 0xed, 0xcd}}, {0x35, {0x50, 0x00, 0x06}}, |
|
{0x35, {0x48, 0x07, 0xff}}, {0x35, {0x60, 0x05, 0x89}}, |
|
{0x35, {0x58, 0x07, 0xff}}, {0x35, {0x40, 0x00, 0xa0}}, |
|
{0x35, {0x42, 0x00, 0x00}}, {0x32, {0x10, 0x01, 0xfc}}, |
|
{0x33, {0x8c, 0xa1, 0x18}}, {0x33, {0x90, 0x00, 0x3c}}, |
|
{0x33, {0x78, 0x00, 0x00}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x35, {0xb8, 0x1f, 0x20}}, {0x33, {0x8c, 0xa2, 0x06}}, |
|
{0x33, {0x90, 0x00, 0x10}}, {0x33, {0x8c, 0xa2, 0x07}}, |
|
{0x33, {0x90, 0x00, 0x08}}, {0x33, {0x8c, 0xa2, 0x42}}, |
|
{0x33, {0x90, 0x00, 0x0b}}, {0x33, {0x8c, 0xa2, 0x4a}}, |
|
{0x33, {0x90, 0x00, 0x8c}}, {0x35, {0xba, 0xfa, 0x08}}, |
|
{0x33, {0x8c, 0xa2, 0x02}}, {0x33, {0x90, 0x00, 0x22}}, |
|
{0x33, {0x8c, 0xa2, 0x03}}, {0x33, {0x90, 0x00, 0xbb}}, |
|
{0x33, {0x8c, 0xa4, 0x04}}, {0x33, {0x90, 0x00, 0x80}}, |
|
{0x33, {0x8c, 0xa7, 0x9d}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0xa7, 0x9e}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0xa2, 0x0c}}, {0x33, {0x90, 0x00, 0x17}}, |
|
{0x33, {0x8c, 0xa2, 0x15}}, {0x33, {0x90, 0x00, 0x04}}, |
|
{0x33, {0x8c, 0xa2, 0x14}}, {0x33, {0x90, 0x00, 0x20}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x17}}, {0x33, {0x90, 0x21, 0x11}}, |
|
{0x33, {0x8c, 0x27, 0x1b}}, {0x33, {0x90, 0x02, 0x4f}}, |
|
{0x33, {0x8c, 0x27, 0x25}}, {0x33, {0x90, 0x06, 0x0f}}, |
|
{0x33, {0x8c, 0x27, 0x39}}, {0x33, {0x90, 0x21, 0x11}}, |
|
{0x33, {0x8c, 0x27, 0x3d}}, {0x33, {0x90, 0x01, 0x20}}, |
|
{0x33, {0x8c, 0x27, 0x47}}, {0x33, {0x90, 0x09, 0x4c}}, |
|
{0x33, {0x8c, 0x27, 0x03}}, {0x33, {0x90, 0x02, 0x84}}, |
|
{0x33, {0x8c, 0x27, 0x05}}, {0x33, {0x90, 0x01, 0xe2}}, |
|
{0x33, {0x8c, 0x27, 0x07}}, {0x33, {0x90, 0x06, 0x40}}, |
|
{0x33, {0x8c, 0x27, 0x09}}, {0x33, {0x90, 0x04, 0xb0}}, |
|
{0x33, {0x8c, 0x27, 0x0d}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x0f}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x11}}, {0x33, {0x90, 0x04, 0xbd}}, |
|
{0x33, {0x8c, 0x27, 0x13}}, {0x33, {0x90, 0x06, 0x4d}}, |
|
{0x33, {0x8c, 0x27, 0x15}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x17}}, {0x33, {0x90, 0x21, 0x11}}, |
|
{0x33, {0x8c, 0x27, 0x19}}, {0x33, {0x90, 0x04, 0x6c}}, |
|
{0x33, {0x8c, 0x27, 0x1b}}, {0x33, {0x90, 0x02, 0x4f}}, |
|
{0x33, {0x8c, 0x27, 0x1d}}, {0x33, {0x90, 0x01, 0x02}}, |
|
{0x33, {0x8c, 0x27, 0x1f}}, {0x33, {0x90, 0x02, 0x79}}, |
|
{0x33, {0x8c, 0x27, 0x21}}, {0x33, {0x90, 0x01, 0x55}}, |
|
{0x33, {0x8c, 0x27, 0x23}}, {0x33, {0x90, 0x02, 0x85}}, |
|
{0x33, {0x8c, 0x27, 0x25}}, {0x33, {0x90, 0x06, 0x0f}}, |
|
{0x33, {0x8c, 0x27, 0x27}}, {0x33, {0x90, 0x20, 0x20}}, |
|
{0x33, {0x8c, 0x27, 0x29}}, {0x33, {0x90, 0x20, 0x20}}, |
|
{0x33, {0x8c, 0x27, 0x2b}}, {0x33, {0x90, 0x10, 0x20}}, |
|
{0x33, {0x8c, 0x27, 0x2d}}, {0x33, {0x90, 0x20, 0x07}}, |
|
{0x33, {0x8c, 0x27, 0x2f}}, {0x33, {0x90, 0x00, 0x04}}, |
|
{0x33, {0x8c, 0x27, 0x31}}, {0x33, {0x90, 0x00, 0x04}}, |
|
{0x33, {0x8c, 0x27, 0x33}}, {0x33, {0x90, 0x04, 0xbb}}, |
|
{0x33, {0x8c, 0x27, 0x35}}, {0x33, {0x90, 0x06, 0x4b}}, |
|
{0x33, {0x8c, 0x27, 0x37}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x39}}, {0x33, {0x90, 0x21, 0x11}}, |
|
{0x33, {0x8c, 0x27, 0x3b}}, {0x33, {0x90, 0x00, 0x24}}, |
|
{0x33, {0x8c, 0x27, 0x3d}}, {0x33, {0x90, 0x01, 0x20}}, |
|
{0x33, {0x8c, 0x27, 0x41}}, {0x33, {0x90, 0x01, 0x69}}, |
|
{0x33, {0x8c, 0x27, 0x45}}, {0x33, {0x90, 0x04, 0xed}}, |
|
{0x33, {0x8c, 0x27, 0x47}}, {0x33, {0x90, 0x09, 0x4c}}, |
|
{0x33, {0x8c, 0x27, 0x51}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x53}}, {0x33, {0x90, 0x03, 0x20}}, |
|
{0x33, {0x8c, 0x27, 0x55}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x57}}, {0x33, {0x90, 0x02, 0x58}}, |
|
{0x33, {0x8c, 0x27, 0x5f}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x61}}, {0x33, {0x90, 0x06, 0x40}}, |
|
{0x33, {0x8c, 0x27, 0x63}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x65}}, {0x33, {0x90, 0x04, 0xb0}}, |
|
{0x33, {0x8c, 0x22, 0x2e}}, {0x33, {0x90, 0x00, 0xa1}}, |
|
{0x33, {0x8c, 0xa4, 0x08}}, {0x33, {0x90, 0x00, 0x1f}}, |
|
{0x33, {0x8c, 0xa4, 0x09}}, {0x33, {0x90, 0x00, 0x21}}, |
|
{0x33, {0x8c, 0xa4, 0x0a}}, {0x33, {0x90, 0x00, 0x25}}, |
|
{0x33, {0x8c, 0xa4, 0x0b}}, {0x33, {0x90, 0x00, 0x27}}, |
|
{0x33, {0x8c, 0x24, 0x11}}, {0x33, {0x90, 0x00, 0xa1}}, |
|
{0x33, {0x8c, 0x24, 0x13}}, {0x33, {0x90, 0x00, 0xc1}}, |
|
{0x33, {0x8c, 0x24, 0x15}}, {0x33, {0x90, 0x00, 0x6a}}, |
|
{0x33, {0x8c, 0x24, 0x17}}, {0x33, {0x90, 0x00, 0x80}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x05}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x06}}, |
|
{3, {0xff, 0xff, 0xff}}, |
|
}; |
|
|
|
static struct idxdata tbl_init_post_alt_low1[] = { |
|
{0x33, {0x8c, 0x27, 0x15}}, {0x33, {0x90, 0x00, 0x25}}, |
|
{0x33, {0x8c, 0x22, 0x2e}}, {0x33, {0x90, 0x00, 0x81}}, |
|
{0x33, {0x8c, 0xa4, 0x08}}, {0x33, {0x90, 0x00, 0x17}}, |
|
{0x33, {0x8c, 0xa4, 0x09}}, {0x33, {0x90, 0x00, 0x1a}}, |
|
{0x33, {0x8c, 0xa4, 0x0a}}, {0x33, {0x90, 0x00, 0x1d}}, |
|
{0x33, {0x8c, 0xa4, 0x0b}}, {0x33, {0x90, 0x00, 0x20}}, |
|
{0x33, {0x8c, 0x24, 0x11}}, {0x33, {0x90, 0x00, 0x81}}, |
|
{0x33, {0x8c, 0x24, 0x13}}, {0x33, {0x90, 0x00, 0x9b}}, |
|
}; |
|
|
|
static struct idxdata tbl_init_post_alt_low2[] = { |
|
{0x33, {0x8c, 0x27, 0x03}}, {0x33, {0x90, 0x03, 0x24}}, |
|
{0x33, {0x8c, 0x27, 0x05}}, {0x33, {0x90, 0x02, 0x58}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x05}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x06}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
}; |
|
|
|
static struct idxdata tbl_init_post_alt_low3[] = { |
|
{0x34, {0x1e, 0x8f, 0x09}}, {0x34, {0x1c, 0x01, 0x28}}, |
|
{0x34, {0x1e, 0x8f, 0x09}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x34, {0x1e, 0x8f, 0x09}}, {0x32, {0x14, 0x06, 0xe6}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{0x33, {0x2e, 0x01, 0x00}}, {0x34, {0x04, 0x00, 0x2a}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0x27, 0x95}}, {0x33, {0x90, 0x01, 0x00}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x72}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x02}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x05}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x06}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x05}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x06}}, |
|
}; |
|
|
|
static struct idxdata tbl_init_post_alt_big[] = { |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x05}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x06}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x34, {0x1e, 0x8f, 0x09}}, {0x34, {0x1c, 0x01, 0x28}}, |
|
{0x34, {0x1e, 0x8f, 0x09}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x34, {0x1e, 0x8f, 0x09}}, {0x32, {0x14, 0x06, 0xe6}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, |
|
{0x33, {0x90, 0x00, 0x05}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x06}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x05}}, |
|
{2, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x06}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x72}}, |
|
{0x33, {0x8c, 0xa1, 0x30}}, {0x33, {0x90, 0x00, 0x03}}, |
|
{0x33, {0x8c, 0xa1, 0x31}}, {0x33, {0x90, 0x00, 0x02}}, |
|
{0x33, {0x8c, 0xa1, 0x32}}, {0x33, {0x90, 0x00, 0x03}}, |
|
{0x33, {0x8c, 0xa1, 0x34}}, {0x33, {0x90, 0x00, 0x03}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x02}}, |
|
{0x33, {0x2e, 0x01, 0x00}}, {0x34, {0x04, 0x00, 0x2a}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{0x33, {0x8c, 0x27, 0x97}}, {0x33, {0x90, 0x01, 0x00}}, |
|
{51, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x00}}, |
|
{51, {0xff, 0xff, 0xff}}, |
|
{0x33, {0x8c, 0xa1, 0x20}}, {0x33, {0x90, 0x00, 0x72}}, |
|
{0x33, {0x8c, 0xa1, 0x03}}, {0x33, {0x90, 0x00, 0x02}}, |
|
{0x33, {0x8c, 0xa7, 0x02}}, {0x33, {0x90, 0x00, 0x01}}, |
|
{51, {0xff, 0xff, 0xff}}, |
|
}; |
|
|
|
static struct idxdata tbl_init_post_alt_3B[] = { |
|
{0x32, {0x10, 0x01, 0xf8}}, {0x34, {0xce, 0x01, 0xa8}}, |
|
{0x34, {0xd0, 0x66, 0x33}}, {0x34, {0xd2, 0x31, 0x9a}}, |
|
{0x34, {0xd4, 0x94, 0x63}}, {0x34, {0xd6, 0x4b, 0x25}}, |
|
{0x34, {0xd8, 0x26, 0x70}}, {0x34, {0xda, 0x72, 0x4c}}, |
|
{0x34, {0xdc, 0xff, 0x04}}, {0x34, {0xde, 0x01, 0x5b}}, |
|
{0x34, {0xe6, 0x01, 0x13}}, {0x34, {0xee, 0x0b, 0xf0}}, |
|
{0x34, {0xf6, 0x0b, 0xa4}}, {0x35, {0x00, 0xf6, 0xe7}}, |
|
{0x35, {0x08, 0x0d, 0xfd}}, {0x35, {0x10, 0x25, 0x63}}, |
|
{0x35, {0x18, 0x35, 0x6c}}, {0x35, {0x20, 0x42, 0x7e}}, |
|
{0x35, {0x28, 0x19, 0x44}}, {0x35, {0x30, 0x39, 0xd4}}, |
|
{0x35, {0x38, 0xf5, 0xa8}}, {0x35, {0x4c, 0x07, 0x90}}, |
|
{0x35, {0x44, 0x07, 0xb8}}, {0x35, {0x5c, 0x06, 0x88}}, |
|
{0x35, {0x54, 0x07, 0xff}}, {0x34, {0xe0, 0x01, 0x52}}, |
|
{0x34, {0xe8, 0x00, 0xcc}}, {0x34, {0xf0, 0x0d, 0x83}}, |
|
{0x34, {0xf8, 0x0c, 0xb3}}, {0x35, {0x02, 0xfe, 0xba}}, |
|
{0x35, {0x0a, 0x04, 0xe0}}, {0x35, {0x12, 0x1c, 0x63}}, |
|
{0x35, {0x1a, 0x2b, 0x5a}}, {0x35, {0x22, 0x32, 0x5e}}, |
|
{0x35, {0x2a, 0x0d, 0x28}}, {0x35, {0x32, 0x2c, 0x02}}, |
|
{0x35, {0x3a, 0xf4, 0xfa}}, {0x35, {0x4e, 0x07, 0xef}}, |
|
{0x35, {0x46, 0x07, 0x88}}, {0x35, {0x5e, 0x07, 0xc1}}, |
|
{0x35, {0x56, 0x04, 0x64}}, {0x34, {0xe4, 0x01, 0x15}}, |
|
{0x34, {0xec, 0x00, 0x82}}, {0x34, {0xf4, 0x0c, 0xce}}, |
|
{0x34, {0xfc, 0x0c, 0xba}}, {0x35, {0x06, 0x1f, 0x02}}, |
|
{0x35, {0x0e, 0x02, 0xe3}}, {0x35, {0x16, 0x1a, 0x50}}, |
|
{0x35, {0x1e, 0x24, 0x39}}, {0x35, {0x26, 0x23, 0x4c}}, |
|
{0x35, {0x2e, 0xf9, 0x1b}}, {0x35, {0x36, 0x23, 0x19}}, |
|
{0x35, {0x3e, 0x12, 0x08}}, {0x35, {0x52, 0x07, 0x22}}, |
|
{0x35, {0x4a, 0x03, 0xd3}}, {0x35, {0x62, 0x06, 0x54}}, |
|
{0x35, {0x5a, 0x04, 0x5d}}, {0x34, {0xe2, 0x01, 0x04}}, |
|
{0x34, {0xea, 0x00, 0xa0}}, {0x34, {0xf2, 0x0c, 0xbc}}, |
|
{0x34, {0xfa, 0x0c, 0x5b}}, {0x35, {0x04, 0x17, 0xf2}}, |
|
{0x35, {0x0c, 0x02, 0x08}}, {0x35, {0x14, 0x28, 0x43}}, |
|
{0x35, {0x1c, 0x28, 0x62}}, {0x35, {0x24, 0x2b, 0x60}}, |
|
{0x35, {0x2c, 0x07, 0x33}}, {0x35, {0x34, 0x1f, 0xb0}}, |
|
{0x35, {0x3c, 0xed, 0xcd}}, {0x35, {0x50, 0x00, 0x06}}, |
|
{0x35, {0x48, 0x07, 0xff}}, {0x35, {0x60, 0x05, 0x89}}, |
|
{0x35, {0x58, 0x07, 0xff}}, {0x35, {0x40, 0x00, 0xa0}}, |
|
{0x35, {0x42, 0x00, 0x00}}, {0x32, {0x10, 0x01, 0xfc}}, |
|
{0x33, {0x8c, 0xa1, 0x18}}, {0x33, {0x90, 0x00, 0x3c}}, |
|
}; |
|
|
|
static u8 *dat_640 = "\xd0\x02\xd1\x08\xd2\xe1\xd3\x02\xd4\x10\xd5\x81"; |
|
static u8 *dat_800 = "\xd0\x02\xd1\x10\xd2\x57\xd3\x02\xd4\x18\xd5\x21"; |
|
static u8 *dat_1280 = "\xd0\x02\xd1\x20\xd2\x01\xd3\x02\xd4\x28\xd5\x01"; |
|
static u8 *dat_1600 = "\xd0\x02\xd1\x20\xd2\xaf\xd3\x02\xd4\x30\xd5\x41"; |
|
|
|
static int mi2020_init_at_startup(struct gspca_dev *gspca_dev); |
|
static int mi2020_configure_alt(struct gspca_dev *gspca_dev); |
|
static int mi2020_init_pre_alt(struct gspca_dev *gspca_dev); |
|
static int mi2020_init_post_alt(struct gspca_dev *gspca_dev); |
|
static void mi2020_post_unset_alt(struct gspca_dev *gspca_dev); |
|
static int mi2020_camera_settings(struct gspca_dev *gspca_dev); |
|
/*==========================================================================*/ |
|
|
|
void mi2020_init_settings(struct gspca_dev *gspca_dev) |
|
{ |
|
struct sd *sd = (struct sd *) gspca_dev; |
|
|
|
sd->vcur.backlight = 0; |
|
sd->vcur.brightness = 70; |
|
sd->vcur.sharpness = 20; |
|
sd->vcur.contrast = 0; |
|
sd->vcur.gamma = 0; |
|
sd->vcur.hue = 0; |
|
sd->vcur.saturation = 60; |
|
sd->vcur.whitebal = 0; /* 50, not done by hardware */ |
|
sd->vcur.mirror = 0; |
|
sd->vcur.flip = 0; |
|
sd->vcur.AC50Hz = 1; |
|
|
|
sd->vmax.backlight = 64; |
|
sd->vmax.brightness = 128; |
|
sd->vmax.sharpness = 40; |
|
sd->vmax.contrast = 3; |
|
sd->vmax.gamma = 2; |
|
sd->vmax.hue = 0 + 1; /* 200, not done by hardware */ |
|
sd->vmax.saturation = 0; /* 100, not done by hardware */ |
|
sd->vmax.whitebal = 2; /* 100, not done by hardware */ |
|
sd->vmax.mirror = 1; |
|
sd->vmax.flip = 1; |
|
sd->vmax.AC50Hz = 1; |
|
|
|
sd->dev_camera_settings = mi2020_camera_settings; |
|
sd->dev_init_at_startup = mi2020_init_at_startup; |
|
sd->dev_configure_alt = mi2020_configure_alt; |
|
sd->dev_init_pre_alt = mi2020_init_pre_alt; |
|
sd->dev_post_unset_alt = mi2020_post_unset_alt; |
|
} |
|
|
|
/*==========================================================================*/ |
|
|
|
static void common(struct gspca_dev *gspca_dev) |
|
{ |
|
fetch_validx(gspca_dev, tbl_common_0B, ARRAY_SIZE(tbl_common_0B)); |
|
fetch_idxdata(gspca_dev, tbl_common_3B, ARRAY_SIZE(tbl_common_3B)); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0041, 0x0000, 0, NULL); |
|
} |
|
|
|
static int mi2020_init_at_startup(struct gspca_dev *gspca_dev) |
|
{ |
|
u8 c; |
|
|
|
ctrl_in(gspca_dev, 0xc0, 2, 0x0000, 0x0004, 1, &c); |
|
ctrl_in(gspca_dev, 0xc0, 2, 0x0000, 0x0004, 1, &c); |
|
|
|
fetch_validx(gspca_dev, tbl_init_at_startup, |
|
ARRAY_SIZE(tbl_init_at_startup)); |
|
|
|
ctrl_out(gspca_dev, 0x40, 1, 0x7a00, 0x8030, 0, NULL); |
|
ctrl_in(gspca_dev, 0xc0, 2, 0x7a00, 0x8030, 1, &c); |
|
|
|
common(gspca_dev); |
|
|
|
msleep(61); |
|
/* ctrl_out(gspca_dev, 0x40, 11, 0x0000, 0x0000, 0, NULL); */ |
|
/* msleep(36); */ |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0001, 0x0000, 0, NULL); |
|
|
|
return 0; |
|
} |
|
|
|
static int mi2020_init_pre_alt(struct gspca_dev *gspca_dev) |
|
{ |
|
struct sd *sd = (struct sd *) gspca_dev; |
|
|
|
sd->mirrorMask = 0; |
|
sd->vold.hue = -1; |
|
|
|
/* These controls need to be reset */ |
|
sd->vold.brightness = -1; |
|
sd->vold.sharpness = -1; |
|
|
|
/* If not different from default, they do not need to be set */ |
|
sd->vold.contrast = 0; |
|
sd->vold.gamma = 0; |
|
sd->vold.backlight = 0; |
|
|
|
mi2020_init_post_alt(gspca_dev); |
|
|
|
return 0; |
|
} |
|
|
|
static int mi2020_init_post_alt(struct gspca_dev *gspca_dev) |
|
{ |
|
struct sd *sd = (struct sd *) gspca_dev; |
|
s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv; |
|
|
|
s32 mirror = (((sd->vcur.mirror > 0) ^ sd->mirrorMask) > 0); |
|
s32 flip = (((sd->vcur.flip > 0) ^ sd->mirrorMask) > 0); |
|
s32 freq = (sd->vcur.AC50Hz > 0); |
|
s32 wbal = sd->vcur.whitebal; |
|
|
|
u8 dat_freq2[] = {0x90, 0x00, 0x80}; |
|
u8 dat_multi1[] = {0x8c, 0xa7, 0x00}; |
|
u8 dat_multi2[] = {0x90, 0x00, 0x00}; |
|
u8 dat_multi3[] = {0x8c, 0xa7, 0x00}; |
|
u8 dat_multi4[] = {0x90, 0x00, 0x00}; |
|
u8 dat_hvflip2[] = {0x90, 0x04, 0x6c}; |
|
u8 dat_hvflip4[] = {0x90, 0x00, 0x24}; |
|
u8 dat_wbal2[] = {0x90, 0x00, 0x00}; |
|
u8 c; |
|
|
|
sd->nbIm = -1; |
|
|
|
dat_freq2[2] = freq ? 0xc0 : 0x80; |
|
dat_multi1[2] = 0x9d; |
|
dat_multi3[2] = dat_multi1[2] + 1; |
|
if (wbal == 0) { |
|
dat_multi4[2] = dat_multi2[2] = 0; |
|
dat_wbal2[2] = 0x17; |
|
} else if (wbal == 1) { |
|
dat_multi4[2] = dat_multi2[2] = 0; |
|
dat_wbal2[2] = 0x35; |
|
} else if (wbal == 2) { |
|
dat_multi4[2] = dat_multi2[2] = 0x20; |
|
dat_wbal2[2] = 0x17; |
|
} |
|
dat_hvflip2[2] = 0x6c + 2 * (1 - flip) + (1 - mirror); |
|
dat_hvflip4[2] = 0x24 + 2 * (1 - flip) + (1 - mirror); |
|
|
|
msleep(200); |
|
ctrl_out(gspca_dev, 0x40, 5, 0x0001, 0x0000, 0, NULL); |
|
msleep(2); |
|
|
|
common(gspca_dev); |
|
|
|
msleep(142); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0010, 0x0010, 0, NULL); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0003, 0x00c1, 0, NULL); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0042, 0x00c2, 0, NULL); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x006a, 0x000d, 0, NULL); |
|
|
|
switch (reso) { |
|
case IMAGE_640: |
|
case IMAGE_800: |
|
if (reso != IMAGE_800) |
|
ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, |
|
12, dat_640); |
|
else |
|
ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, |
|
12, dat_800); |
|
|
|
fetch_idxdata(gspca_dev, tbl_init_post_alt_low1, |
|
ARRAY_SIZE(tbl_init_post_alt_low1)); |
|
|
|
if (reso == IMAGE_800) |
|
fetch_idxdata(gspca_dev, tbl_init_post_alt_low2, |
|
ARRAY_SIZE(tbl_init_post_alt_low2)); |
|
|
|
fetch_idxdata(gspca_dev, tbl_init_post_alt_low3, |
|
ARRAY_SIZE(tbl_init_post_alt_low3)); |
|
|
|
ctrl_out(gspca_dev, 0x40, 1, 0x0010, 0x0010, 0, NULL); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0000, 0x00c1, 0, NULL); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0041, 0x00c2, 0, NULL); |
|
msleep(120); |
|
break; |
|
|
|
case IMAGE_1280: |
|
case IMAGE_1600: |
|
if (reso == IMAGE_1280) { |
|
ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, |
|
12, dat_1280); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x8c\x27\x07"); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x90\x05\x04"); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x8c\x27\x09"); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x90\x04\x02"); |
|
} else { |
|
ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, |
|
12, dat_1600); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x8c\x27\x07"); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x90\x06\x40"); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x8c\x27\x09"); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, |
|
3, "\x90\x04\xb0"); |
|
} |
|
|
|
fetch_idxdata(gspca_dev, tbl_init_post_alt_big, |
|
ARRAY_SIZE(tbl_init_post_alt_big)); |
|
|
|
ctrl_out(gspca_dev, 0x40, 1, 0x0001, 0x0010, 0, NULL); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0000, 0x00c1, 0, NULL); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0041, 0x00c2, 0, NULL); |
|
msleep(1850); |
|
} |
|
|
|
ctrl_out(gspca_dev, 0x40, 1, 0x0040, 0x0000, 0, NULL); |
|
msleep(40); |
|
|
|
/* AC power frequency */ |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_freq1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_freq2); |
|
msleep(33); |
|
/* light source */ |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi3); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi4); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_wbal1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_wbal2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi5); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi6); |
|
msleep(7); |
|
ctrl_in(gspca_dev, 0xc0, 2, 0x0000, 0x0000, 1, &c); |
|
|
|
fetch_idxdata(gspca_dev, tbl_init_post_alt_3B, |
|
ARRAY_SIZE(tbl_init_post_alt_3B)); |
|
|
|
/* hvflip */ |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip3); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip4); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip5); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip6); |
|
msleep(250); |
|
|
|
if (reso == IMAGE_640 || reso == IMAGE_800) |
|
fetch_idxdata(gspca_dev, tbl_middle_hvflip_low, |
|
ARRAY_SIZE(tbl_middle_hvflip_low)); |
|
else |
|
fetch_idxdata(gspca_dev, tbl_middle_hvflip_big, |
|
ARRAY_SIZE(tbl_middle_hvflip_big)); |
|
|
|
fetch_idxdata(gspca_dev, tbl_end_hvflip, |
|
ARRAY_SIZE(tbl_end_hvflip)); |
|
|
|
sd->nbIm = 0; |
|
|
|
sd->vold.mirror = mirror; |
|
sd->vold.flip = flip; |
|
sd->vold.AC50Hz = freq; |
|
sd->vold.whitebal = wbal; |
|
|
|
mi2020_camera_settings(gspca_dev); |
|
|
|
return 0; |
|
} |
|
|
|
static int mi2020_configure_alt(struct gspca_dev *gspca_dev) |
|
{ |
|
s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv; |
|
|
|
switch (reso) { |
|
case IMAGE_640: |
|
gspca_dev->alt = 3 + 1; |
|
break; |
|
|
|
case IMAGE_800: |
|
case IMAGE_1280: |
|
case IMAGE_1600: |
|
gspca_dev->alt = 1 + 1; |
|
break; |
|
} |
|
return 0; |
|
} |
|
|
|
static int mi2020_camera_settings(struct gspca_dev *gspca_dev) |
|
{ |
|
struct sd *sd = (struct sd *) gspca_dev; |
|
s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv; |
|
|
|
s32 backlight = sd->vcur.backlight; |
|
s32 bright = sd->vcur.brightness; |
|
s32 sharp = sd->vcur.sharpness; |
|
s32 cntr = sd->vcur.contrast; |
|
s32 gam = sd->vcur.gamma; |
|
s32 hue = (sd->vcur.hue > 0); |
|
s32 mirror = (((sd->vcur.mirror > 0) ^ sd->mirrorMask) > 0); |
|
s32 flip = (((sd->vcur.flip > 0) ^ sd->mirrorMask) > 0); |
|
s32 freq = (sd->vcur.AC50Hz > 0); |
|
s32 wbal = sd->vcur.whitebal; |
|
|
|
u8 dat_sharp[] = {0x6c, 0x00, 0x08}; |
|
u8 dat_bright2[] = {0x90, 0x00, 0x00}; |
|
u8 dat_freq2[] = {0x90, 0x00, 0x80}; |
|
u8 dat_multi1[] = {0x8c, 0xa7, 0x00}; |
|
u8 dat_multi2[] = {0x90, 0x00, 0x00}; |
|
u8 dat_multi3[] = {0x8c, 0xa7, 0x00}; |
|
u8 dat_multi4[] = {0x90, 0x00, 0x00}; |
|
u8 dat_hvflip2[] = {0x90, 0x04, 0x6c}; |
|
u8 dat_hvflip4[] = {0x90, 0x00, 0x24}; |
|
u8 dat_wbal2[] = {0x90, 0x00, 0x00}; |
|
|
|
/* Less than 4 images received -> too early to set the settings */ |
|
if (sd->nbIm < 4) { |
|
sd->waitSet = 1; |
|
return 0; |
|
} |
|
sd->waitSet = 0; |
|
|
|
if (freq != sd->vold.AC50Hz) { |
|
sd->vold.AC50Hz = freq; |
|
|
|
dat_freq2[2] = freq ? 0xc0 : 0x80; |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_freq1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_freq2); |
|
msleep(20); |
|
} |
|
|
|
if (wbal != sd->vold.whitebal) { |
|
sd->vold.whitebal = wbal; |
|
if (wbal < 0 || wbal > sd->vmax.whitebal) |
|
wbal = 0; |
|
|
|
dat_multi1[2] = 0x9d; |
|
dat_multi3[2] = dat_multi1[2] + 1; |
|
if (wbal == 0) { |
|
dat_multi4[2] = dat_multi2[2] = 0; |
|
dat_wbal2[2] = 0x17; |
|
} else if (wbal == 1) { |
|
dat_multi4[2] = dat_multi2[2] = 0; |
|
dat_wbal2[2] = 0x35; |
|
} else if (wbal == 2) { |
|
dat_multi4[2] = dat_multi2[2] = 0x20; |
|
dat_wbal2[2] = 0x17; |
|
} |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi3); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi4); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_wbal1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_wbal2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi5); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi6); |
|
} |
|
|
|
if (mirror != sd->vold.mirror || flip != sd->vold.flip) { |
|
sd->vold.mirror = mirror; |
|
sd->vold.flip = flip; |
|
|
|
dat_hvflip2[2] = 0x6c + 2 * (1 - flip) + (1 - mirror); |
|
dat_hvflip4[2] = 0x24 + 2 * (1 - flip) + (1 - mirror); |
|
|
|
fetch_idxdata(gspca_dev, tbl_init_post_alt_3B, |
|
ARRAY_SIZE(tbl_init_post_alt_3B)); |
|
|
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip3); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip4); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip5); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_hvflip6); |
|
msleep(40); |
|
|
|
if (reso == IMAGE_640 || reso == IMAGE_800) |
|
fetch_idxdata(gspca_dev, tbl_middle_hvflip_low, |
|
ARRAY_SIZE(tbl_middle_hvflip_low)); |
|
else |
|
fetch_idxdata(gspca_dev, tbl_middle_hvflip_big, |
|
ARRAY_SIZE(tbl_middle_hvflip_big)); |
|
|
|
fetch_idxdata(gspca_dev, tbl_end_hvflip, |
|
ARRAY_SIZE(tbl_end_hvflip)); |
|
} |
|
|
|
if (bright != sd->vold.brightness) { |
|
sd->vold.brightness = bright; |
|
if (bright < 0 || bright > sd->vmax.brightness) |
|
bright = 0; |
|
|
|
dat_bright2[2] = bright; |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_bright1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_bright2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_bright3); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_bright4); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_bright5); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_bright6); |
|
} |
|
|
|
if (cntr != sd->vold.contrast || gam != sd->vold.gamma) { |
|
sd->vold.contrast = cntr; |
|
if (cntr < 0 || cntr > sd->vmax.contrast) |
|
cntr = 0; |
|
sd->vold.gamma = gam; |
|
if (gam < 0 || gam > sd->vmax.gamma) |
|
gam = 0; |
|
|
|
dat_multi1[2] = 0x6d; |
|
dat_multi3[2] = dat_multi1[2] + 1; |
|
if (cntr == 0) |
|
cntr = 4; |
|
dat_multi4[2] = dat_multi2[2] = cntr * 0x10 + 2 - gam; |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi3); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi4); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi5); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi6); |
|
} |
|
|
|
if (backlight != sd->vold.backlight) { |
|
sd->vold.backlight = backlight; |
|
if (backlight < 0 || backlight > sd->vmax.backlight) |
|
backlight = 0; |
|
|
|
dat_multi1[2] = 0x9d; |
|
dat_multi3[2] = dat_multi1[2] + 1; |
|
dat_multi4[2] = dat_multi2[2] = backlight; |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi1); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi2); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi3); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi4); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi5); |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0033, 3, dat_multi6); |
|
} |
|
|
|
if (sharp != sd->vold.sharpness) { |
|
sd->vold.sharpness = sharp; |
|
if (sharp < 0 || sharp > sd->vmax.sharpness) |
|
sharp = 0; |
|
|
|
dat_sharp[1] = sharp; |
|
ctrl_out(gspca_dev, 0x40, 3, 0x7a00, 0x0032, 3, dat_sharp); |
|
} |
|
|
|
if (hue != sd->vold.hue) { |
|
sd->swapRB = hue; |
|
sd->vold.hue = hue; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static void mi2020_post_unset_alt(struct gspca_dev *gspca_dev) |
|
{ |
|
ctrl_out(gspca_dev, 0x40, 5, 0x0000, 0x0000, 0, NULL); |
|
msleep(40); |
|
ctrl_out(gspca_dev, 0x40, 1, 0x0001, 0x0000, 0, NULL); |
|
}
|
|
|