374 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/* Subdriver for the GL860 chip with the OV9655 sensor3 * Author Olivier LORIN, from logs done by Simon (Sur3) and Almighurt4 * on dsd's weblog5 */6 7/* Sensor : OV9655 */8 9#include "gl860.h"10 11static struct validx tbl_init_at_startup[] = {12 {0x0000, 0x0000}, {0x0010, 0x0010}, {0x0008, 0x00c0}, {0x0001, 0x00c1},13 {0x0001, 0x00c2}, {0x0020, 0x0006}, {0x006a, 0x000d},14 15 {0x0040, 0x0000},16};17 18static struct validx tbl_commmon[] = {19 {0x0041, 0x0000}, {0x006a, 0x0007}, {0x0063, 0x0006}, {0x006a, 0x000d},20 {0x0000, 0x00c0}, {0x0010, 0x0010}, {0x0001, 0x00c1}, {0x0041, 0x00c2},21 {0x0004, 0x00d8}, {0x0012, 0x0004}, {0x0000, 0x0058}, {0x0040, 0x0000},22 {0x00f3, 0x0006}, {0x0058, 0x0000}, {0x0048, 0x0000}, {0x0061, 0x0000},23};24 25static s32 tbl_length[] = {12, 56, 52, 54, 56, 42, 32, 12};26 27static u8 *tbl_640[] = {28 (u8[]){29 0x00, 0x40, 0x07, 0x6a, 0x06, 0xf3, 0x0d, 0x6a,30 0x10, 0x10, 0xc1, 0x0131 }, (u8[]){32 0x12, 0x80, 0x00, 0x00, 0x01, 0x98, 0x02, 0x80,33 0x03, 0x12, 0x04, 0x03, 0x0b, 0x57, 0x0e, 0x61,34 0x0f, 0x42, 0x11, 0x01, 0x12, 0x60, 0x13, 0x00,35 0x14, 0x3a, 0x16, 0x24, 0x17, 0x14, 0x18, 0x00,36 0x19, 0x01, 0x1a, 0x3d, 0x1e, 0x04, 0x24, 0x3c,37 0x25, 0x36, 0x26, 0x72, 0x27, 0x08, 0x28, 0x08,38 0x29, 0x15, 0x2a, 0x00, 0x2b, 0x00, 0x2c, 0x0839 }, (u8[]){40 0x32, 0xff, 0x33, 0x00, 0x34, 0x3d, 0x35, 0x00,41 0x36, 0xfa, 0x38, 0x72, 0x39, 0x57, 0x3a, 0x00,42 0x3b, 0x0c, 0x3d, 0x99, 0x3e, 0x0c, 0x3f, 0xc1,43 0x40, 0xc0, 0x41, 0x00, 0x42, 0xc0, 0x43, 0x0a,44 0x44, 0xf0, 0x45, 0x46, 0x46, 0x62, 0x47, 0x2a,45 0x48, 0x3c, 0x4a, 0xee, 0x4b, 0xe7, 0x4c, 0xe7,46 0x4d, 0xe7, 0x4e, 0xe747 }, (u8[]){48 0x4f, 0x98, 0x50, 0x98, 0x51, 0x00, 0x52, 0x28,49 0x53, 0x70, 0x54, 0x98, 0x58, 0x1a, 0x59, 0x85,50 0x5a, 0xa9, 0x5b, 0x64, 0x5c, 0x84, 0x5d, 0x53,51 0x5e, 0x0e, 0x5f, 0xf0, 0x60, 0xf0, 0x61, 0xf0,52 0x62, 0x00, 0x63, 0x00, 0x64, 0x02, 0x65, 0x20,53 0x66, 0x00, 0x69, 0x0a, 0x6b, 0x5a, 0x6c, 0x04,54 0x6d, 0x55, 0x6e, 0x00, 0x6f, 0x9d55 }, (u8[]){56 0x70, 0x15, 0x71, 0x78, 0x72, 0x00, 0x73, 0x00,57 0x74, 0x3a, 0x75, 0x35, 0x76, 0x01, 0x77, 0x02,58 0x7a, 0x24, 0x7b, 0x04, 0x7c, 0x07, 0x7d, 0x10,59 0x7e, 0x28, 0x7f, 0x36, 0x80, 0x44, 0x81, 0x52,60 0x82, 0x60, 0x83, 0x6c, 0x84, 0x78, 0x85, 0x8c,61 0x86, 0x9e, 0x87, 0xbb, 0x88, 0xd2, 0x89, 0xe5,62 0x8a, 0x23, 0x8c, 0x8d, 0x90, 0x7c, 0x91, 0x7b63 }, (u8[]){64 0x9d, 0x02, 0x9e, 0x02, 0x9f, 0x74, 0xa0, 0x73,65 0xa1, 0x40, 0xa4, 0x50, 0xa5, 0x68, 0xa6, 0x70,66 0xa8, 0xc1, 0xa9, 0xef, 0xaa, 0x92, 0xab, 0x04,67 0xac, 0x80, 0xad, 0x80, 0xae, 0x80, 0xaf, 0x80,68 0xb2, 0xf2, 0xb3, 0x20, 0xb4, 0x20, 0xb5, 0x00,69 0xb6, 0xaf70 }, (u8[]){71 0xbb, 0xae, 0xbc, 0x4f, 0xbd, 0x4e, 0xbe, 0x6a,72 0xbf, 0x68, 0xc0, 0xaa, 0xc1, 0xc0, 0xc2, 0x01,73 0xc3, 0x4e, 0xc6, 0x85, 0xc7, 0x81, 0xc9, 0xe0,74 0xca, 0xe8, 0xcb, 0xf0, 0xcc, 0xd8, 0xcd, 0x9375 }, (u8[]){76 0xd0, 0x01, 0xd1, 0x08, 0xd2, 0xe0, 0xd3, 0x01,77 0xd4, 0x10, 0xd5, 0x8078 }79};80 81static u8 *tbl_1280[] = {82 (u8[]){83 0x00, 0x40, 0x07, 0x6a, 0x06, 0xf3, 0x0d, 0x6a,84 0x10, 0x10, 0xc1, 0x0185 },86 (u8[]){87 0x12, 0x80, 0x00, 0x00, 0x01, 0x98, 0x02, 0x80,88 0x03, 0x12, 0x04, 0x01, 0x0b, 0x57, 0x0e, 0x61,89 0x0f, 0x42, 0x11, 0x00, 0x12, 0x00, 0x13, 0x00,90 0x14, 0x3a, 0x16, 0x24, 0x17, 0x1b, 0x18, 0xbb,91 0x19, 0x01, 0x1a, 0x81, 0x1e, 0x04, 0x24, 0x3c,92 0x25, 0x36, 0x26, 0x72, 0x27, 0x08, 0x28, 0x08,93 0x29, 0x15, 0x2a, 0x00, 0x2b, 0x00, 0x2c, 0x0894 },95 (u8[]){96 0x32, 0xa4, 0x33, 0x00, 0x34, 0x3d, 0x35, 0x00,97 0x36, 0xf8, 0x38, 0x72, 0x39, 0x57, 0x3a, 0x00,98 0x3b, 0x0c, 0x3d, 0x99, 0x3e, 0x0c, 0x3f, 0xc2,99 0x40, 0xc0, 0x41, 0x00, 0x42, 0xc0, 0x43, 0x0a,100 0x44, 0xf0, 0x45, 0x46, 0x46, 0x62, 0x47, 0x2a,101 0x48, 0x3c, 0x4a, 0xec, 0x4b, 0xe8, 0x4c, 0xe8,102 0x4d, 0xe8, 0x4e, 0xe8103 },104 (u8[]){105 0x4f, 0x98, 0x50, 0x98, 0x51, 0x00, 0x52, 0x28,106 0x53, 0x70, 0x54, 0x98, 0x58, 0x1a, 0x59, 0x85,107 0x5a, 0xa9, 0x5b, 0x64, 0x5c, 0x84, 0x5d, 0x53,108 0x5e, 0x0e, 0x5f, 0xf0, 0x60, 0xf0, 0x61, 0xf0,109 0x62, 0x00, 0x63, 0x00, 0x64, 0x02, 0x65, 0x20,110 0x66, 0x00, 0x69, 0x02, 0x6b, 0x5a, 0x6c, 0x04,111 0x6d, 0x55, 0x6e, 0x00, 0x6f, 0x9d112 },113 (u8[]){114 0x70, 0x08, 0x71, 0x78, 0x72, 0x00, 0x73, 0x01,115 0x74, 0x3a, 0x75, 0x35, 0x76, 0x01, 0x77, 0x02,116 0x7a, 0x24, 0x7b, 0x04, 0x7c, 0x07, 0x7d, 0x10,117 0x7e, 0x28, 0x7f, 0x36, 0x80, 0x44, 0x81, 0x52,118 0x82, 0x60, 0x83, 0x6c, 0x84, 0x78, 0x85, 0x8c,119 0x86, 0x9e, 0x87, 0xbb, 0x88, 0xd2, 0x89, 0xe5,120 0x8a, 0x23, 0x8c, 0x0d, 0x90, 0x90, 0x91, 0x90121 },122 (u8[]){123 0x9d, 0x02, 0x9e, 0x02, 0x9f, 0x94, 0xa0, 0x94,124 0xa1, 0x01, 0xa4, 0x50, 0xa5, 0x68, 0xa6, 0x70,125 0xa8, 0xc1, 0xa9, 0xef, 0xaa, 0x92, 0xab, 0x04,126 0xac, 0x80, 0xad, 0x80, 0xae, 0x80, 0xaf, 0x80,127 0xb2, 0xf2, 0xb3, 0x20, 0xb4, 0x20, 0xb5, 0x00,128 0xb6, 0xaf129 },130 (u8[]){131 0xbb, 0xae, 0xbc, 0x38, 0xbd, 0x39, 0xbe, 0x01,132 0xbf, 0x01, 0xc0, 0xe2, 0xc1, 0xc0, 0xc2, 0x01,133 0xc3, 0x4e, 0xc6, 0x85, 0xc7, 0x81, 0xc9, 0xe0,134 0xca, 0xe8, 0xcb, 0xf0, 0xcc, 0xd8, 0xcd, 0x93135 },136 (u8[]){137 0xd0, 0x21, 0xd1, 0x18, 0xd2, 0xe0, 0xd3, 0x01,138 0xd4, 0x28, 0xd5, 0x00139 }140};141 142static u8 c04[] = {0x04};143static u8 dat_post1[] = "\x04\x00\x10\x20\xa1\x00\x00\x02";144static u8 dat_post2[] = "\x10\x10\xc1\x02";145static u8 dat_post3[] = "\x04\x00\x10\x7c\xa1\x00\x00\x04";146static u8 dat_post4[] = "\x10\x02\xc1\x06";147static u8 dat_post5[] = "\x04\x00\x10\x7b\xa1\x00\x00\x08";148static u8 dat_post6[] = "\x10\x10\xc1\x05";149static u8 dat_post7[] = "\x04\x00\x10\x7c\xa1\x00\x00\x08";150static u8 dat_post8[] = "\x04\x00\x10\x7c\xa1\x00\x00\x09";151 152static struct validx tbl_init_post_alt[] = {153 {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x603c, 0x00ff},154 {0x6003, 0x00ff}, {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x6001, 0x00ff},155 {0x6000, 0x801e},156 {0xffff, 0xffff},157 {0x6004, 0x001e}, {0x6000, 0x801e},158 {0xffff, 0xffff},159 {0x6004, 0x001e}, {0x6012, 0x0003}, {0x6000, 0x801e},160 {0xffff, 0xffff},161 {0x6004, 0x001e}, {0x6000, 0x801e},162 {0xffff, 0xffff},163 {0x6004, 0x001e}, {0x6012, 0x0003},164 {0xffff, 0xffff},165 {0x6000, 0x801e},166 {0xffff, 0xffff},167 {0x6004, 0x001e}, {0x6000, 0x801e},168 {0xffff, 0xffff},169 {0x6004, 0x001e}, {0x6012, 0x0003}, {0x6000, 0x801e},170 {0xffff, 0xffff},171 {0x6004, 0x001e}, {0x6000, 0x801e},172 {0xffff, 0xffff},173 {0x6004, 0x001e}, {0x6012, 0x0003},174 {0xffff, 0xffff},175 {0x6000, 0x801e},176 {0xffff, 0xffff},177 {0x6004, 0x001e}, {0x6000, 0x801e},178 {0xffff, 0xffff},179 {0x6004, 0x001e}, {0x6012, 0x0003},180};181 182static int ov9655_init_at_startup(struct gspca_dev *gspca_dev);183static int ov9655_configure_alt(struct gspca_dev *gspca_dev);184static int ov9655_init_pre_alt(struct gspca_dev *gspca_dev);185static int ov9655_init_post_alt(struct gspca_dev *gspca_dev);186static void ov9655_post_unset_alt(struct gspca_dev *gspca_dev);187static int ov9655_camera_settings(struct gspca_dev *gspca_dev);188/*==========================================================================*/189 190void ov9655_init_settings(struct gspca_dev *gspca_dev)191{192 struct sd *sd = (struct sd *) gspca_dev;193 194 sd->vcur.backlight = 0;195 sd->vcur.brightness = 128;196 sd->vcur.sharpness = 0;197 sd->vcur.contrast = 0;198 sd->vcur.gamma = 0;199 sd->vcur.hue = 0;200 sd->vcur.saturation = 0;201 sd->vcur.whitebal = 0;202 203 sd->vmax.backlight = 0;204 sd->vmax.brightness = 255;205 sd->vmax.sharpness = 0;206 sd->vmax.contrast = 0;207 sd->vmax.gamma = 0;208 sd->vmax.hue = 0 + 1;209 sd->vmax.saturation = 0;210 sd->vmax.whitebal = 0;211 sd->vmax.mirror = 0;212 sd->vmax.flip = 0;213 sd->vmax.AC50Hz = 0;214 215 sd->dev_camera_settings = ov9655_camera_settings;216 sd->dev_init_at_startup = ov9655_init_at_startup;217 sd->dev_configure_alt = ov9655_configure_alt;218 sd->dev_init_pre_alt = ov9655_init_pre_alt;219 sd->dev_post_unset_alt = ov9655_post_unset_alt;220}221 222/*==========================================================================*/223 224static int ov9655_init_at_startup(struct gspca_dev *gspca_dev)225{226 fetch_validx(gspca_dev, tbl_init_at_startup,227 ARRAY_SIZE(tbl_init_at_startup));228 fetch_validx(gspca_dev, tbl_commmon, ARRAY_SIZE(tbl_commmon));229/* ctrl_out(gspca_dev, 0x40, 11, 0x0000, 0x0000, 0, NULL);*/230 231 return 0;232}233 234static int ov9655_init_pre_alt(struct gspca_dev *gspca_dev)235{236 struct sd *sd = (struct sd *) gspca_dev;237 238 sd->vold.brightness = -1;239 sd->vold.hue = -1;240 241 fetch_validx(gspca_dev, tbl_commmon, ARRAY_SIZE(tbl_commmon));242 243 ov9655_init_post_alt(gspca_dev);244 245 return 0;246}247 248static int ov9655_init_post_alt(struct gspca_dev *gspca_dev)249{250 s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv;251 s32 n; /* reserved for FETCH functions */252 s32 i;253 u8 **tbl;254 255 ctrl_out(gspca_dev, 0x40, 5, 0x0001, 0x0000, 0, NULL);256 257 tbl = (reso == IMAGE_640) ? tbl_640 : tbl_1280;258 259 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200,260 tbl_length[0], tbl[0]);261 for (i = 1; i < 7; i++)262 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200,263 tbl_length[i], tbl[i]);264 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200,265 tbl_length[7], tbl[7]);266 267 n = fetch_validx(gspca_dev, tbl_init_post_alt,268 ARRAY_SIZE(tbl_init_post_alt));269 270 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);271 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,272 ARRAY_SIZE(tbl_init_post_alt), n);273 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);274 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,275 ARRAY_SIZE(tbl_init_post_alt), n);276 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);277 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,278 ARRAY_SIZE(tbl_init_post_alt), n);279 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);280 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,281 ARRAY_SIZE(tbl_init_post_alt), n);282 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post1);283 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,284 ARRAY_SIZE(tbl_init_post_alt), n);285 286 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);287 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,288 ARRAY_SIZE(tbl_init_post_alt), n);289 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);290 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,291 ARRAY_SIZE(tbl_init_post_alt), n);292 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);293 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,294 ARRAY_SIZE(tbl_init_post_alt), n);295 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);296 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,297 ARRAY_SIZE(tbl_init_post_alt), n);298 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post1);299 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,300 ARRAY_SIZE(tbl_init_post_alt), n);301 302 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);303 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,304 ARRAY_SIZE(tbl_init_post_alt), n);305 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);306 keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,307 ARRAY_SIZE(tbl_init_post_alt), n);308 309 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post1);310 311 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post2);312 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post3);313 314 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post4);315 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post5);316 317 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post6);318 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post7);319 320 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post8);321 322 ov9655_camera_settings(gspca_dev);323 324 return 0;325}326 327static int ov9655_configure_alt(struct gspca_dev *gspca_dev)328{329 s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv;330 331 switch (reso) {332 case IMAGE_640:333 gspca_dev->alt = 1 + 1;334 break;335 336 default:337 gspca_dev->alt = 1 + 1;338 break;339 }340 return 0;341}342 343static int ov9655_camera_settings(struct gspca_dev *gspca_dev)344{345 struct sd *sd = (struct sd *) gspca_dev;346 347 u8 dat_bright[] = "\x04\x00\x10\x7c\xa1\x00\x00\x70";348 349 s32 bright = sd->vcur.brightness;350 s32 hue = sd->vcur.hue;351 352 if (bright != sd->vold.brightness) {353 sd->vold.brightness = bright;354 if (bright < 0 || bright > sd->vmax.brightness)355 bright = 0;356 357 dat_bright[3] = bright;358 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_bright);359 }360 361 if (hue != sd->vold.hue) {362 sd->vold.hue = hue;363 sd->swapRB = (hue != 0);364 }365 366 return 0;367}368 369static void ov9655_post_unset_alt(struct gspca_dev *gspca_dev)370{371 ctrl_out(gspca_dev, 0x40, 5, 0x0000, 0x0000, 0, NULL);372 ctrl_out(gspca_dev, 0x40, 1, 0x0061, 0x0000, 0, NULL);373}374