| /* |
| * USB IBM C-It Video Camera driver |
| * |
| * Supports Xirlink C-It Video Camera, IBM PC Camera, |
| * IBM NetCamera and Veo Stingray. |
| * |
| * This driver is based on earlier work of: |
| * |
| * (C) Copyright 1999 Johannes Erdfelt |
| * (C) Copyright 1999 Randy Dunlap |
| * |
| * 5/24/00 Removed optional (and unnecessary) locking of the driver while |
| * the device remains plugged in. Corrected race conditions in ibmcam_open |
| * and ibmcam_probe() routines using this as a guideline: |
| * |
| * (2) The big kernel lock is automatically released when a process sleeps |
| * in the kernel and is automatically reacquired on reschedule if the |
| * process had the lock originally. Any code that can be compiled as |
| * a module and is entered with the big kernel lock held *MUST* |
| * increment the use count to activate the indirect module protection |
| * before doing anything that might sleep. |
| * |
| * In practice, this means that all routines that live in modules and |
| * are invoked under the big kernel lock should do MOD_INC_USE_COUNT |
| * as their very first action. And all failure paths from that |
| * routine must do MOD_DEC_USE_COUNT before returning. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/sched.h> |
| #include <linux/wrapper.h> |
| #include <linux/module.h> |
| #include <linux/init.h> |
| |
| #include "usbvideo.h" |
| |
| #define IBMCAM_VENDOR_ID 0x0545 |
| #define IBMCAM_PRODUCT_ID 0x8080 |
| #define NETCAM_PRODUCT_ID 0x8002 /* IBM NetCamera, close to model 2 */ |
| #define VEO_800C_PRODUCT_ID 0x800C /* Veo Stingray, repackaged Model 2 */ |
| #define VEO_800D_PRODUCT_ID 0x800D /* Veo Stingray, repackaged Model 4 */ |
| |
| #define MAX_IBMCAM 4 /* How many devices we allow to connect */ |
| #define USES_IBMCAM_PUTPIXEL 0 /* 0=Fast/oops 1=Slow/secure */ |
| |
| /* Header signatures */ |
| |
| /* Model 1 header: 00 FF 00 xx */ |
| #define HDRSIG_MODEL1_128x96 0x06 /* U Y V Y ... */ |
| #define HDRSIG_MODEL1_176x144 0x0e /* U Y V Y ... */ |
| #define HDRSIG_MODEL1_352x288 0x00 /* V Y U Y ... */ |
| |
| #define IBMCAM_MODEL_1 1 /* XVP-501, 3 interfaces, rev. 0.02 */ |
| #define IBMCAM_MODEL_2 2 /* KSX-X9903, 2 interfaces, rev. 3.0a */ |
| #define IBMCAM_MODEL_3 3 /* KSX-X9902, 2 interfaces, rev. 3.01 */ |
| #define IBMCAM_MODEL_4 4 /* IBM NetCamera, 0545/8002/3.0a */ |
| |
| /* Video sizes supported */ |
| #define VIDEOSIZE_128x96 VIDEOSIZE(128, 96) |
| #define VIDEOSIZE_176x144 VIDEOSIZE(176,144) |
| #define VIDEOSIZE_352x288 VIDEOSIZE(352,288) |
| #define VIDEOSIZE_320x240 VIDEOSIZE(320,240) |
| #define VIDEOSIZE_352x240 VIDEOSIZE(352,240) |
| #define VIDEOSIZE_640x480 VIDEOSIZE(640,480) |
| #define VIDEOSIZE_160x120 VIDEOSIZE(160,120) |
| |
| /* Video sizes supported */ |
| enum { |
| SIZE_128x96 = 0, |
| SIZE_160x120, |
| SIZE_176x144, |
| SIZE_320x240, |
| SIZE_352x240, |
| SIZE_352x288, |
| SIZE_640x480, |
| /* Add/remove/rearrange items before this line */ |
| SIZE_LastItem |
| }; |
| |
| /* |
| * This structure lives in uvd->user field. |
| */ |
| typedef struct { |
| int initialized; /* Had we already sent init sequence? */ |
| int camera_model; /* What type of IBM camera we got? */ |
| int has_hdr; |
| } ibmcam_t; |
| #define IBMCAM_T(uvd) ((ibmcam_t *)((uvd)->user_data)) |
| |
| struct usbvideo *cams = NULL; |
| |
| static int debug = 0; |
| |
| static int flags = 0; /* FLAGS_DISPLAY_HINTS | FLAGS_OVERLAY_STATS; */ |
| |
| static const int min_canvasWidth = 8; |
| static const int min_canvasHeight = 4; |
| |
| static int lighting = 1; /* Medium */ |
| |
| #define SHARPNESS_MIN 0 |
| #define SHARPNESS_MAX 6 |
| static int sharpness = 4; /* Low noise, good details */ |
| |
| #define FRAMERATE_MIN 0 |
| #define FRAMERATE_MAX 6 |
| static int framerate = -1; |
| |
| static int size = SIZE_352x288; |
| |
| /* |
| * Here we define several initialization variables. They may |
| * be used to automatically set color, hue, brightness and |
| * contrast to desired values. This is particularly useful in |
| * case of webcams (which have no controls and no on-screen |
| * output) and also when a client V4L software is used that |
| * does not have some of those controls. In any case it's |
| * good to have startup values as options. |
| * |
| * These values are all in [0..255] range. This simplifies |
| * operation. Note that actual values of V4L variables may |
| * be scaled up (as much as << 8). User can see that only |
| * on overlay output, however, or through a V4L client. |
| */ |
| static int init_brightness = 128; |
| static int init_contrast = 192; |
| static int init_color = 128; |
| static int init_hue = 128; |
| static int hue_correction = 128; |
| |
| /* Settings for camera model 2 */ |
| static int init_model2_rg2 = -1; |
| static int init_model2_sat = -1; |
| static int init_model2_yb = -1; |
| |
| /* 01.01.08 - Added for RCA video in support -LO */ |
| /* Settings for camera model 3 */ |
| static int init_model3_input = 0; |
| |
| MODULE_PARM(debug, "i"); |
| MODULE_PARM_DESC(debug, "Debug level: 0-9 (default=0)"); |
| MODULE_PARM(flags, "i"); |
| MODULE_PARM_DESC(flags, "Bitfield: 0=VIDIOCSYNC, 1=B/W, 2=show hints, 3=show stats, 4=test pattern, 5=separate frames, 6=clean frames"); |
| MODULE_PARM(framerate, "i"); |
| MODULE_PARM_DESC(framerate, "Framerate setting: 0=slowest, 6=fastest (default=2)"); |
| MODULE_PARM(lighting, "i"); |
| MODULE_PARM_DESC(lighting, "Photosensitivity: 0=bright, 1=medium (default), 2=low light"); |
| MODULE_PARM(sharpness, "i"); |
| MODULE_PARM_DESC(sharpness, "Model1 noise reduction: 0=smooth, 6=sharp (default=4)"); |
| MODULE_PARM(size, "i"); |
| MODULE_PARM_DESC(size, "Image size: 0=128x96 1=160x120 2=176x144 3=320x240 4=352x240 5=352x288 6=640x480 (default=5)"); |
| MODULE_PARM(init_brightness, "i"); |
| MODULE_PARM_DESC(init_brightness, "Brightness preconfiguration: 0-255 (default=128)"); |
| MODULE_PARM(init_contrast, "i"); |
| MODULE_PARM_DESC(init_contrast, "Contrast preconfiguration: 0-255 (default=192)"); |
| MODULE_PARM(init_color, "i"); |
| MODULE_PARM_DESC(init_color, "Color preconfiguration: 0-255 (default=128)"); |
| MODULE_PARM(init_hue, "i"); |
| MODULE_PARM_DESC(init_hue, "Hue preconfiguration: 0-255 (default=128)"); |
| MODULE_PARM(hue_correction, "i"); |
| MODULE_PARM_DESC(hue_correction, "YUV colorspace regulation: 0-255 (default=128)"); |
| |
| MODULE_PARM(init_model2_rg2, "i"); |
| MODULE_PARM_DESC(init_model2_rg2, "Model2 preconfiguration: 0-255 (default=47)"); |
| MODULE_PARM(init_model2_sat, "i"); |
| MODULE_PARM_DESC(init_model2_sat, "Model2 preconfiguration: 0-255 (default=52)"); |
| MODULE_PARM(init_model2_yb, "i"); |
| MODULE_PARM_DESC(init_model2_yb, "Model2 preconfiguration: 0-255 (default=160)"); |
| |
| /* 01.01.08 - Added for RCA video in support -LO */ |
| MODULE_PARM(init_model3_input, "i"); |
| MODULE_PARM_DESC(init_model3_input, "Model3 input: 0=CCD 1=RCA"); |
| |
| MODULE_AUTHOR ("Dmitri"); |
| MODULE_DESCRIPTION ("IBM/Xirlink C-it USB Camera Driver for Linux (c) 2000"); |
| MODULE_LICENSE("GPL"); |
| |
| /* Still mysterious i2c commands */ |
| static const unsigned short unknown_88 = 0x0088; |
| static const unsigned short unknown_89 = 0x0089; |
| static const unsigned short bright_3x[3] = { 0x0031, 0x0032, 0x0033 }; |
| static const unsigned short contrast_14 = 0x0014; |
| static const unsigned short light_27 = 0x0027; |
| static const unsigned short sharp_13 = 0x0013; |
| |
| /* i2c commands for Model 2 cameras */ |
| static const unsigned short mod2_brightness = 0x001a; /* $5b .. $ee; default=$5a */ |
| static const unsigned short mod2_set_framerate = 0x001c; /* 0 (fast).. $1F (slow) */ |
| static const unsigned short mod2_color_balance_rg2 = 0x001e; /* 0 (red) .. $7F (green) */ |
| static const unsigned short mod2_saturation = 0x0020; /* 0 (b/w) - $7F (full color) */ |
| static const unsigned short mod2_color_balance_yb = 0x0022; /* 0..$7F, $50 is about right */ |
| static const unsigned short mod2_hue = 0x0024; /* 0..$7F, $70 is about right */ |
| static const unsigned short mod2_sensitivity = 0x0028; /* 0 (min) .. $1F (max) */ |
| |
| struct struct_initData { |
| unsigned char req; |
| unsigned short value; |
| unsigned short index; |
| }; |
| |
| /* |
| * ibmcam_size_to_videosize() |
| * |
| * This procedure converts module option 'size' into the actual |
| * videosize_t that defines the image size in pixels. We need |
| * simplified 'size' because user wants a simple enumerated list |
| * of choices, not an infinite set of possibilities. |
| */ |
| static videosize_t ibmcam_size_to_videosize(int size) |
| { |
| videosize_t vs = VIDEOSIZE_352x288; |
| RESTRICT_TO_RANGE(size, 0, (SIZE_LastItem-1)); |
| switch (size) { |
| case SIZE_128x96: |
| vs = VIDEOSIZE_128x96; |
| break; |
| case SIZE_160x120: |
| vs = VIDEOSIZE_160x120; |
| break; |
| case SIZE_176x144: |
| vs = VIDEOSIZE_176x144; |
| break; |
| case SIZE_320x240: |
| vs = VIDEOSIZE_320x240; |
| break; |
| case SIZE_352x240: |
| vs = VIDEOSIZE_352x240; |
| break; |
| case SIZE_352x288: |
| vs = VIDEOSIZE_352x288; |
| break; |
| case SIZE_640x480: |
| vs = VIDEOSIZE_640x480; |
| break; |
| default: |
| err("size=%d. is not valid", size); |
| break; |
| } |
| return vs; |
| } |
| |
| /* |
| * ibmcam_find_header() |
| * |
| * Locate one of supported header markers in the queue. |
| * Once found, remove all preceding bytes AND the marker (4 bytes) |
| * from the data pump queue. Whatever follows must be video lines. |
| * |
| * History: |
| * 1/21/00 Created. |
| */ |
| static enum ParseState ibmcam_find_header(struct uvd *uvd) /* FIXME: Add frame here */ |
| { |
| struct usbvideo_frame *frame; |
| ibmcam_t *icam; |
| |
| if ((uvd->curframe) < 0 || (uvd->curframe >= USBVIDEO_NUMFRAMES)) { |
| err("ibmcam_find_header: Illegal frame %d.", uvd->curframe); |
| return scan_EndParse; |
| } |
| icam = IBMCAM_T(uvd); |
| assert(icam != NULL); |
| frame = &uvd->frame[uvd->curframe]; |
| icam->has_hdr = 0; |
| switch (icam->camera_model) { |
| case IBMCAM_MODEL_1: |
| { |
| const int marker_len = 4; |
| while (RingQueue_GetLength(&uvd->dp) >= marker_len) { |
| if ((RING_QUEUE_PEEK(&uvd->dp, 0) == 0x00) && |
| (RING_QUEUE_PEEK(&uvd->dp, 1) == 0xFF) && |
| (RING_QUEUE_PEEK(&uvd->dp, 2) == 0x00)) |
| { |
| #if 0 /* This code helps to detect new frame markers */ |
| info("Header sig: 00 FF 00 %02X", RING_QUEUE_PEEK(&uvd->dp, 3)); |
| #endif |
| frame->header = RING_QUEUE_PEEK(&uvd->dp, 3); |
| if ((frame->header == HDRSIG_MODEL1_128x96) || |
| (frame->header == HDRSIG_MODEL1_176x144) || |
| (frame->header == HDRSIG_MODEL1_352x288)) |
| { |
| #if 0 |
| info("Header found."); |
| #endif |
| RING_QUEUE_DEQUEUE_BYTES(&uvd->dp, marker_len); |
| icam->has_hdr = 1; |
| break; |
| } |
| } |
| /* If we are still here then this doesn't look like a header */ |
| RING_QUEUE_DEQUEUE_BYTES(&uvd->dp, 1); |
| } |
| break; |
| } |
| case IBMCAM_MODEL_2: |
| case IBMCAM_MODEL_4: |
| { |
| int marker_len = 0; |
| switch (uvd->videosize) { |
| case VIDEOSIZE_176x144: |
| marker_len = 10; |
| break; |
| default: |
| marker_len = 2; |
| break; |
| } |
| while (RingQueue_GetLength(&uvd->dp) >= marker_len) { |
| if ((RING_QUEUE_PEEK(&uvd->dp, 0) == 0x00) && |
| (RING_QUEUE_PEEK(&uvd->dp, 1) == 0xFF)) |
| { |
| #if 0 |
| info("Header found."); |
| #endif |
| RING_QUEUE_DEQUEUE_BYTES(&uvd->dp, marker_len); |
| icam->has_hdr = 1; |
| frame->header = HDRSIG_MODEL1_176x144; |
| break; |
| } |
| /* If we are still here then this doesn't look like a header */ |
| RING_QUEUE_DEQUEUE_BYTES(&uvd->dp, 1); |
| } |
| break; |
| } |
| case IBMCAM_MODEL_3: |
| { /* |
| * Headers: (one precedes every frame). nc=no compression, |
| * bq=best quality bf=best frame rate. |
| * |
| * 176x144: 00 FF 02 { 0A=nc CA=bq EA=bf } |
| * 320x240: 00 FF 02 { 08=nc 28=bq 68=bf } |
| * 640x480: 00 FF 03 { 08=nc 28=bq 68=bf } |
| * |
| * Bytes '00 FF' seem to indicate header. Other two bytes |
| * encode the frame type. This is a set of bit fields that |
| * encode image size, compression type etc. These fields |
| * do NOT contain frame number because all frames carry |
| * the same header. |
| */ |
| const int marker_len = 4; |
| while (RingQueue_GetLength(&uvd->dp) >= marker_len) { |
| if ((RING_QUEUE_PEEK(&uvd->dp, 0) == 0x00) && |
| (RING_QUEUE_PEEK(&uvd->dp, 1) == 0xFF) && |
| (RING_QUEUE_PEEK(&uvd->dp, 2) != 0xFF)) |
| { |
| /* |
| * Combine 2 bytes of frame type into one |
| * easy to use value |
| */ |
| unsigned long byte3, byte4; |
| |
| byte3 = RING_QUEUE_PEEK(&uvd->dp, 2); |
| byte4 = RING_QUEUE_PEEK(&uvd->dp, 3); |
| frame->header = (byte3 << 8) | byte4; |
| #if 0 |
| info("Header found."); |
| #endif |
| RING_QUEUE_DEQUEUE_BYTES(&uvd->dp, marker_len); |
| icam->has_hdr = 1; |
| break; |
| } |
| /* If we are still here then this doesn't look like a header */ |
| RING_QUEUE_DEQUEUE_BYTES(&uvd->dp, 1); |
| } |
| break; |
| } |
| default: |
| break; |
| } |
| if (!icam->has_hdr) { |
| if (uvd->debug > 2) |
| info("Skipping frame, no header"); |
| return scan_EndParse; |
| } |
| |
| /* Header found */ |
| icam->has_hdr = 1; |
| uvd->stats.header_count++; |
| frame->scanstate = ScanState_Lines; |
| frame->curline = 0; |
| |
| if (flags & FLAGS_FORCE_TESTPATTERN) { |
| usbvideo_TestPattern(uvd, 1, 1); |
| return scan_NextFrame; |
| } |
| return scan_Continue; |
| } |
| |
| /* |
| * ibmcam_parse_lines() |
| * |
| * Parse one line (interlaced) from the buffer, put |
| * decoded RGB value into the current frame buffer |
| * and add the written number of bytes (RGB) to |
| * the *pcopylen. |
| * |
| * History: |
| * 21-Jan-2000 Created. |
| * 12-Oct-2000 Reworked to reflect interlaced nature of the data. |
| */ |
| static enum ParseState ibmcam_parse_lines( |
| struct uvd *uvd, |
| struct usbvideo_frame *frame, |
| long *pcopylen) |
| { |
| unsigned char *f; |
| ibmcam_t *icam; |
| unsigned int len, scanLength, scanHeight, order_uv, order_yc; |
| int v4l_linesize; /* V4L line offset */ |
| const int hue_corr = (uvd->vpic.hue - 0x8000) >> 10; /* -32..+31 */ |
| const int hue2_corr = (hue_correction - 128) / 4; /* -32..+31 */ |
| const int ccm = 128; /* Color correction median - see below */ |
| int y, u, v, i, frame_done=0, color_corr; |
| static unsigned char lineBuffer[640*3]; |
| unsigned const char *chromaLine, *lumaLine; |
| |
| assert(uvd != NULL); |
| assert(frame != NULL); |
| icam = IBMCAM_T(uvd); |
| assert(icam != NULL); |
| color_corr = (uvd->vpic.colour - 0x8000) >> 8; /* -128..+127 = -ccm..+(ccm-1)*/ |
| RESTRICT_TO_RANGE(color_corr, -ccm, ccm+1); |
| |
| v4l_linesize = VIDEOSIZE_X(frame->request) * V4L_BYTES_PER_PIXEL; |
| |
| if (IBMCAM_T(uvd)->camera_model == IBMCAM_MODEL_4) { |
| /* Model 4 frame markers do not carry image size identification */ |
| switch (uvd->videosize) { |
| case VIDEOSIZE_128x96: |
| case VIDEOSIZE_160x120: |
| case VIDEOSIZE_176x144: |
| scanLength = VIDEOSIZE_X(uvd->videosize); |
| scanHeight = VIDEOSIZE_Y(uvd->videosize); |
| break; |
| default: |
| err("ibmcam_parse_lines: Wrong mode."); |
| return scan_Out; |
| } |
| order_yc = 1; /* order_yc: true=Yc false=cY ('c'=either U or V) */ |
| order_uv = 1; /* Always true in this algorithm */ |
| } else { |
| switch (frame->header) { |
| case HDRSIG_MODEL1_128x96: |
| scanLength = 128; |
| scanHeight = 96; |
| order_uv = 1; /* U Y V Y ... */ |
| break; |
| case HDRSIG_MODEL1_176x144: |
| scanLength = 176; |
| scanHeight = 144; |
| order_uv = 1; /* U Y V Y ... */ |
| break; |
| case HDRSIG_MODEL1_352x288: |
| scanLength = 352; |
| scanHeight = 288; |
| order_uv = 0; /* Y V Y V ... */ |
| break; |
| default: |
| err("Unknown header signature 00 FF 00 %02lX", frame->header); |
| return scan_NextFrame; |
| } |
| /* order_yc: true=Yc false=cY ('c'=either U or V) */ |
| order_yc = (IBMCAM_T(uvd)->camera_model == IBMCAM_MODEL_2); |
| } |
| |
| len = scanLength * 3; |
| assert(len <= sizeof(lineBuffer)); |
| |
| /* |
| * Lines are organized this way: |
| * |
| * I420: |
| * ~~~~ |
| * <scanLength-> |
| * ___________________________________ |
| * |-----Y-----|---UVUVUV...UVUV-----| \ |
| * |-----------+---------------------| \ |
| * |<-- 176 -->|<------ 176*2 ------>| Total 72. lines (interlaced) |
| * |... ... | ... | / |
| * |<-- 352 -->|<------ 352*2 ------>| Total 144. lines (interlaced) |
| * |___________|_____________________| / |
| * \ \ |
| * lumaLine chromaLine |
| */ |
| |
| /* Make sure there's enough data for the entire line */ |
| if (RingQueue_GetLength(&uvd->dp) < len) |
| return scan_Out; |
| |
| /* Suck one line out of the ring queue */ |
| RingQueue_Dequeue(&uvd->dp, lineBuffer, len); |
| |
| /* |
| * Make sure that our writing into output buffer |
| * will not exceed the buffer. Mind that we may write |
| * not into current output scanline but in several after |
| * it as well (if we enlarge image vertically.) |
| */ |
| if ((frame->curline + 2) >= VIDEOSIZE_Y(frame->request)) |
| return scan_NextFrame; |
| |
| /* |
| * Now we are sure that entire line (representing all 'scanLength' |
| * pixels from the camera) is available in the buffer. We |
| * start copying the line left-aligned to the V4L buffer. |
| * If the camera line is shorter then we should pad the V4L |
| * buffer with something (black) to complete the line. |
| */ |
| assert(frame->data != NULL); |
| f = frame->data + (v4l_linesize * frame->curline); |
| |
| /* |
| * To obtain chrominance data from the 'chromaLine' use this: |
| * v = chromaLine[0]; // 0-1:[0], 2-3:[4], 4-5:[8]... |
| * u = chromaLine[2]; // 0-1:[2], 2-3:[6], 4-5:[10]... |
| * |
| * Indices must be calculated this way: |
| * v_index = (i >> 1) << 2; |
| * u_index = (i >> 1) << 2 + 2; |
| * |
| * where 'i' is the column number [0..VIDEOSIZE_X(frame->request)-1] |
| */ |
| lumaLine = lineBuffer; |
| chromaLine = lineBuffer + scanLength; |
| for (i = 0; i < VIDEOSIZE_X(frame->request); i++) |
| { |
| unsigned char rv, gv, bv; /* RGB components */ |
| |
| /* Check for various visual debugging hints (colorized pixels) */ |
| if ((flags & FLAGS_DISPLAY_HINTS) && (icam->has_hdr)) { |
| /* |
| * This is bad and should not happen. This means that |
| * we somehow overshoot the line and encountered new |
| * frame! Obviously our camera/V4L frame size is out |
| * of whack. This cyan dot will help you to figure |
| * out where exactly the new frame arrived. |
| */ |
| if (icam->has_hdr == 1) { |
| bv = 0; /* Yellow marker */ |
| gv = 0xFF; |
| rv = 0xFF; |
| } else { |
| bv = 0xFF; /* Cyan marker */ |
| gv = 0xFF; |
| rv = 0; |
| } |
| icam->has_hdr = 0; |
| goto make_pixel; |
| } |
| |
| /* |
| * Check if we are still in range. We may be out of range if our |
| * V4L canvas is wider or taller than the camera "native" image. |
| * Then we quickly fill the remainder of the line with zeros to |
| * make black color and quit the horizontal scanning loop. |
| */ |
| if (((frame->curline + 2) >= scanHeight) || (i >= scanLength)) { |
| const int j = i * V4L_BYTES_PER_PIXEL; |
| #if USES_IBMCAM_PUTPIXEL |
| /* Refresh 'f' because we don't use it much with PUTPIXEL */ |
| f = frame->data + (v4l_linesize * frame->curline) + j; |
| #endif |
| memset(f, 0, v4l_linesize - j); |
| break; |
| } |
| |
| y = lumaLine[i]; |
| if (flags & FLAGS_MONOCHROME) /* Use monochrome for debugging */ |
| rv = gv = bv = y; |
| else { |
| int off_0, off_2; |
| |
| off_0 = (i >> 1) << 2; |
| off_2 = off_0 + 2; |
| |
| if (order_yc) { |
| off_0++; |
| off_2++; |
| } |
| if (!order_uv) { |
| off_0 += 2; |
| off_2 -= 2; |
| } |
| u = chromaLine[off_0] + hue_corr; |
| v = chromaLine[off_2] + hue2_corr; |
| |
| /* Apply color correction */ |
| if (color_corr != 0) { |
| /* Magnify up to 2 times, reduce down to zero saturation */ |
| u = 128 + ((ccm + color_corr) * (u - 128)) / ccm; |
| v = 128 + ((ccm + color_corr) * (v - 128)) / ccm; |
| } |
| YUV_TO_RGB_BY_THE_BOOK(y, u, v, rv, gv, bv); |
| } |
| |
| make_pixel: |
| /* |
| * The purpose of creating the pixel here, in one, |
| * dedicated place is that we may need to make the |
| * pixel wider and taller than it actually is. This |
| * may be used if camera generates small frames for |
| * sake of frame rate (or any other reason.) |
| * |
| * The output data consists of B, G, R bytes |
| * (in this order). |
| */ |
| #if USES_IBMCAM_PUTPIXEL |
| RGB24_PUTPIXEL(frame, i, frame->curline, rv, gv, bv); |
| #else |
| *f++ = bv; |
| *f++ = gv; |
| *f++ = rv; |
| #endif |
| /* |
| * Typically we do not decide within a legitimate frame |
| * that we want to end the frame. However debugging code |
| * may detect marker of new frame within the data. Then |
| * this condition activates. The 'data' pointer is already |
| * pointing at the new marker, so we'd better leave it as is. |
| */ |
| if (frame_done) |
| break; /* End scanning of lines */ |
| } |
| /* |
| * Account for number of bytes that we wrote into output V4L frame. |
| * We do it here, after we are done with the scanline, because we |
| * may fill more than one output scanline if we do vertical |
| * enlargement. |
| */ |
| frame->curline += 2; |
| if (pcopylen != NULL) |
| *pcopylen += 2 * v4l_linesize; |
| frame->deinterlace = Deinterlace_FillOddLines; |
| |
| if (frame_done || (frame->curline >= VIDEOSIZE_Y(frame->request))) |
| return scan_NextFrame; |
| else |
| return scan_Continue; |
| } |
| |
| /* |
| * ibmcam_model2_320x240_parse_lines() |
| * |
| * This procedure deals with a weird RGB format that is produced by IBM |
| * camera model 2 in modes 320x240 and above; 'x' below is 159 or 175, |
| * depending on horizontal size of the picture: |
| * |
| * <--- 160 or 176 pairs of RA,RB bytes -----> |
| * *-----------------------------------------* \ |
| * | RA0 | RB0 | RA1 | RB1 | ... | RAx | RBx | \ This is pair of horizontal lines, |
| * |-----+-----+-----+-----+ ... +-----+-----| *- or one interlaced line, total |
| * | B0 | G0 | B1 | G1 | ... | Bx | Gx | / 120 or 144 such pairs which yield |
| * |=====+=====+=====+=====+ ... +=====+=====| / 240 or 288 lines after deinterlacing. |
| * |
| * Each group of FOUR bytes (RAi, RBi, Bi, Gi) where i=0..frame_width/2-1 |
| * defines ONE pixel. Therefore this format yields 176x144 "decoded" |
| * resolution at best. I do not know why camera sends such format - the |
| * previous model (1) just used interlaced I420 and everyone was happy. |
| * |
| * I do not know what is the difference between RAi and RBi bytes. Both |
| * seemingly represent R component, but slightly vary in value (so that |
| * the picture looks a bit colored if one or another is used). I use |
| * them both as R component in attempt to at least partially recover the |
| * lost resolution. |
| */ |
| static enum ParseState ibmcam_model2_320x240_parse_lines( |
| struct uvd *uvd, |
| struct usbvideo_frame *frame, |
| long *pcopylen) |
| { |
| unsigned char *f, *la, *lb; |
| unsigned int len; |
| int v4l_linesize; /* V4L line offset */ |
| int i, j, frame_done=0, color_corr; |
| int scanLength, scanHeight; |
| static unsigned char lineBuffer[352*2]; |
| |
| switch (uvd->videosize) { |
| case VIDEOSIZE_320x240: |
| case VIDEOSIZE_352x240: |
| case VIDEOSIZE_352x288: |
| scanLength = VIDEOSIZE_X(uvd->videosize); |
| scanHeight = VIDEOSIZE_Y(uvd->videosize); |
| break; |
| default: |
| err("ibmcam_model2_320x240_parse_lines: Wrong mode."); |
| return scan_Out; |
| } |
| |
| color_corr = (uvd->vpic.colour) >> 8; /* 0..+255 */ |
| v4l_linesize = VIDEOSIZE_X(frame->request) * V4L_BYTES_PER_PIXEL; |
| |
| len = scanLength * 2; /* See explanation above */ |
| assert(len <= sizeof(lineBuffer)); |
| |
| /* Make sure there's enough data for the entire line */ |
| if (RingQueue_GetLength(&uvd->dp) < len) |
| return scan_Out; |
| |
| /* Suck one line out of the ring queue */ |
| RingQueue_Dequeue(&uvd->dp, lineBuffer, len); |
| |
| /* |
| * Make sure that our writing into output buffer |
| * will not exceed the buffer. Mind that we may write |
| * not into current output scanline but in several after |
| * it as well (if we enlarge image vertically.) |
| */ |
| if ((frame->curline + 2) >= VIDEOSIZE_Y(frame->request)) |
| return scan_NextFrame; |
| |
| la = lineBuffer; |
| lb = lineBuffer + scanLength; |
| |
| /* |
| * Now we are sure that entire line (representing all |
| * VIDEOSIZE_X(frame->request) |
| * pixels from the camera) is available in the scratch buffer. We |
| * start copying the line left-aligned to the V4L buffer (which |
| * might be larger - not smaller, hopefully). If the camera |
| * line is shorter then we should pad the V4L buffer with something |
| * (black in this case) to complete the line. |
| */ |
| f = frame->data + (v4l_linesize * frame->curline); |
| |
| /* Fill the 2-line strip */ |
| for (i = 0; i < VIDEOSIZE_X(frame->request); i++) { |
| int y, rv, gv, bv; /* RGB components */ |
| |
| j = i & (~1); |
| |
| /* Check for various visual debugging hints (colorized pixels) */ |
| if ((flags & FLAGS_DISPLAY_HINTS) && (IBMCAM_T(uvd)->has_hdr)) { |
| if (IBMCAM_T(uvd)->has_hdr == 1) { |
| bv = 0; /* Yellow marker */ |
| gv = 0xFF; |
| rv = 0xFF; |
| } else { |
| bv = 0xFF; /* Cyan marker */ |
| gv = 0xFF; |
| rv = 0; |
| } |
| IBMCAM_T(uvd)->has_hdr = 0; |
| goto make_pixel; |
| } |
| |
| /* |
| * Check if we are still in range. We may be out of range if our |
| * V4L canvas is wider or taller than the camera "native" image. |
| * Then we quickly fill the remainder of the line with zeros to |
| * make black color and quit the horizontal scanning loop. |
| */ |
| if (((frame->curline + 2) >= scanHeight) || (i >= scanLength)) { |
| const int j = i * V4L_BYTES_PER_PIXEL; |
| #if USES_IBMCAM_PUTPIXEL |
| /* Refresh 'f' because we don't use it much with PUTPIXEL */ |
| f = frame->data + (v4l_linesize * frame->curline) + j; |
| #endif |
| memset(f, 0, v4l_linesize - j); |
| break; |
| } |
| |
| /* |
| * Here I use RA and RB components, one per physical pixel. |
| * This causes fine vertical grid on the picture but may improve |
| * horizontal resolution. If you prefer replicating, use this: |
| * rv = la[j + 0]; ... or ... rv = la[j + 1]; |
| * then the pixel will be replicated. |
| */ |
| rv = la[i]; |
| gv = lb[j + 1]; |
| bv = lb[j + 0]; |
| |
| y = (rv + gv + bv) / 3; /* Brightness (badly calculated) */ |
| |
| if (flags & FLAGS_MONOCHROME) /* Use monochrome for debugging */ |
| rv = gv = bv = y; |
| else if (color_corr != 128) { |
| |
| /* Calculate difference between color and brightness */ |
| rv -= y; |
| gv -= y; |
| bv -= y; |
| |
| /* Scale differences */ |
| rv = (rv * color_corr) / 128; |
| gv = (gv * color_corr) / 128; |
| bv = (bv * color_corr) / 128; |
| |
| /* Reapply brightness */ |
| rv += y; |
| gv += y; |
| bv += y; |
| |
| /* Watch for overflows */ |
| RESTRICT_TO_RANGE(rv, 0, 255); |
| RESTRICT_TO_RANGE(gv, 0, 255); |
| RESTRICT_TO_RANGE(bv, 0, 255); |
| } |
| |
| make_pixel: |
| RGB24_PUTPIXEL(frame, i, frame->curline, rv, gv, bv); |
| } |
| /* |
| * Account for number of bytes that we wrote into output V4L frame. |
| * We do it here, after we are done with the scanline, because we |
| * may fill more than one output scanline if we do vertical |
| * enlargement. |
| */ |
| frame->curline += 2; |
| *pcopylen += v4l_linesize * 2; |
| frame->deinterlace = Deinterlace_FillOddLines; |
| |
| if (frame_done || (frame->curline >= VIDEOSIZE_Y(frame->request))) |
| return scan_NextFrame; |
| else |
| return scan_Continue; |
| } |
| |
| static enum ParseState ibmcam_model3_parse_lines( |
| struct uvd *uvd, |
| struct usbvideo_frame *frame, |
| long *pcopylen) |
| { |
| unsigned char *data; |
| const unsigned char *color; |
| unsigned int len; |
| int v4l_linesize; /* V4L line offset */ |
| const int hue_corr = (uvd->vpic.hue - 0x8000) >> 10; /* -32..+31 */ |
| const int hue2_corr = (hue_correction - 128) / 4; /* -32..+31 */ |
| const int ccm = 128; /* Color correction median - see below */ |
| int i, u, v, rw, data_w=0, data_h=0, color_corr; |
| static unsigned char lineBuffer[640*3]; |
| |
| color_corr = (uvd->vpic.colour - 0x8000) >> 8; /* -128..+127 = -ccm..+(ccm-1)*/ |
| RESTRICT_TO_RANGE(color_corr, -ccm, ccm+1); |
| |
| v4l_linesize = VIDEOSIZE_X(frame->request) * V4L_BYTES_PER_PIXEL; |
| |
| /* The header tells us what sort of data is in this frame */ |
| switch (frame->header) { |
| /* |
| * Uncompressed modes (that are easy to decode). |
| */ |
| case 0x0308: |
| data_w = 640; |
| data_h = 480; |
| break; |
| case 0x0208: |
| data_w = 320; |
| data_h = 240; |
| break; |
| case 0x020A: |
| data_w = 160; |
| data_h = 120; |
| break; |
| /* |
| * Compressed modes (ViCE - that I don't know how to decode). |
| */ |
| case 0x0328: /* 640x480, best quality compression */ |
| case 0x0368: /* 640x480, best frame rate compression */ |
| case 0x0228: /* 320x240, best quality compression */ |
| case 0x0268: /* 320x240, best frame rate compression */ |
| case 0x02CA: /* 160x120, best quality compression */ |
| case 0x02EA: /* 160x120, best frame rate compression */ |
| /* Do nothing with this - not supported */ |
| err("Unsupported mode $%04lx", frame->header); |
| return scan_NextFrame; |
| default: |
| /* Catch unknown headers, may help in learning new headers */ |
| err("Strange frame->header=$%08lx", frame->header); |
| return scan_NextFrame; |
| } |
| |
| /* |
| * Make sure that our writing into output buffer |
| * will not exceed the buffer. Note that we may write |
| * not into current output scanline but in several after |
| * it as well (if we enlarge image vertically.) |
| */ |
| if ((frame->curline + 1) >= data_h) { |
| if (uvd->debug >= 3) |
| info("Reached line %d. (frame is done)", frame->curline); |
| return scan_NextFrame; |
| } |
| |
| /* Make sure there's enough data for the entire line */ |
| len = 3 * data_w; /* <y-data> <uv-data> */ |
| assert(len <= sizeof(lineBuffer)); |
| |
| /* Make sure there's enough data for the entire line */ |
| if (RingQueue_GetLength(&uvd->dp) < len) |
| return scan_Out; |
| |
| /* Suck one line out of the ring queue */ |
| RingQueue_Dequeue(&uvd->dp, lineBuffer, len); |
| |
| data = lineBuffer; |
| color = data + data_w; /* Point to where color planes begin */ |
| |
| /* Bottom-to-top scanning */ |
| rw = (int)VIDEOSIZE_Y(frame->request) - (int)(frame->curline) - 1; |
| RESTRICT_TO_RANGE(rw, 0, VIDEOSIZE_Y(frame->request)-1); |
| |
| for (i = 0; i < VIDEOSIZE_X(frame->request); i++) { |
| int y, rv, gv, bv; /* RGB components */ |
| |
| if (i < data_w) { |
| y = data[i]; /* Luminosity is the first line */ |
| |
| /* Apply static color correction */ |
| u = color[i*2] + hue_corr; |
| v = color[i*2 + 1] + hue2_corr; |
| |
| /* Apply color correction */ |
| if (color_corr != 0) { |
| /* Magnify up to 2 times, reduce down to zero saturation */ |
| u = 128 + ((ccm + color_corr) * (u - 128)) / ccm; |
| v = 128 + ((ccm + color_corr) * (v - 128)) / ccm; |
| } |
| } else |
| y = 0, u = v = 128; |
| |
| YUV_TO_RGB_BY_THE_BOOK(y, u, v, rv, gv, bv); |
| RGB24_PUTPIXEL(frame, i, rw, rv, gv, bv); /* Done by deinterlacing now */ |
| } |
| frame->deinterlace = Deinterlace_FillEvenLines; |
| |
| /* |
| * Account for number of bytes that we wrote into output V4L frame. |
| * We do it here, after we are done with the scanline, because we |
| * may fill more than one output scanline if we do vertical |
| * enlargement. |
| */ |
| frame->curline += 2; |
| *pcopylen += 2 * v4l_linesize; |
| |
| if (frame->curline >= VIDEOSIZE_Y(frame->request)) { |
| if (uvd->debug >= 3) { |
| info("All requested lines (%ld.) done.", |
| VIDEOSIZE_Y(frame->request)); |
| } |
| return scan_NextFrame; |
| } else |
| return scan_Continue; |
| } |
| |
| /* |
| * ibmcam_model4_128x96_parse_lines() |
| * |
| * This decoder is for one strange data format that is produced by Model 4 |
| * camera only in 128x96 mode. This is RGB format and here is its description. |
| * First of all, this is non-interlaced stream, meaning that all scan lines |
| * are present in the datastream. There are 96 consecutive blocks of data |
| * that describe all 96 lines of the image. Each block is 5*128 bytes long |
| * and carries R, G, B components. The format of the block is shown in the |
| * code below. First 128*2 bytes are interleaved R and G components. Then |
| * we have a gap (junk data) 64 bytes long. Then follow B and something |
| * else, also interleaved (this makes another 128*2 bytes). After that |
| * probably another 64 bytes of junk follow. |
| * |
| * History: |
| * 10-Feb-2001 Created. |
| */ |
| static enum ParseState ibmcam_model4_128x96_parse_lines( |
| struct uvd *uvd, |
| struct usbvideo_frame *frame, |
| long *pcopylen) |
| { |
| const unsigned char *data_rv, *data_gv, *data_bv; |
| unsigned int len; |
| int i, v4l_linesize; /* V4L line offset */ |
| const int data_w=128, data_h=96; |
| static unsigned char lineBuffer[128*5]; |
| |
| v4l_linesize = VIDEOSIZE_X(frame->request) * V4L_BYTES_PER_PIXEL; |
| |
| /* |
| * Make sure that our writing into output buffer |
| * will not exceed the buffer. Note that we may write |
| * not into current output scanline but in several after |
| * it as well (if we enlarge image vertically.) |
| */ |
| if ((frame->curline + 1) >= data_h) { |
| if (uvd->debug >= 3) |
| info("Reached line %d. (frame is done)", frame->curline); |
| return scan_NextFrame; |
| } |
| |
| /* |
| * RGRGRG .... RGRG_____________B?B?B? ... B?B?____________ |
| * <---- 128*2 ---><---- 64 ---><--- 128*2 ---><--- 64 ---> |
| */ |
| |
| /* Make sure there's enough data for the entire line */ |
| len = 5 * data_w; |
| assert(len <= sizeof(lineBuffer)); |
| |
| /* Make sure there's enough data for the entire line */ |
| if (RingQueue_GetLength(&uvd->dp) < len) |
| return scan_Out; |
| |
| /* Suck one line out of the ring queue */ |
| RingQueue_Dequeue(&uvd->dp, lineBuffer, len); |
| |
| data_rv = lineBuffer; |
| data_gv = lineBuffer + 1; |
| data_bv = lineBuffer + data_w*2 + data_w/2; |
| for (i = 0; i < VIDEOSIZE_X(frame->request); i++) { |
| int rv, gv, bv; /* RGB components */ |
| if (i < data_w) { |
| const int j = i * 2; |
| gv = data_rv[j]; |
| rv = data_gv[j]; |
| bv = data_bv[j]; |
| if (flags & FLAGS_MONOCHROME) { |
| unsigned long y; |
| y = rv + gv + bv; |
| y /= 3; |
| if (y > 0xFF) |
| y = 0xFF; |
| rv = gv = bv = (unsigned char) y; |
| } |
| } else { |
| rv = gv = bv = 0; |
| } |
| RGB24_PUTPIXEL(frame, i, frame->curline, rv, gv, bv); |
| } |
| frame->deinterlace = Deinterlace_None; |
| frame->curline++; |
| *pcopylen += v4l_linesize; |
| |
| if (frame->curline >= VIDEOSIZE_Y(frame->request)) { |
| if (uvd->debug >= 3) { |
| info("All requested lines (%ld.) done.", |
| VIDEOSIZE_Y(frame->request)); |
| } |
| return scan_NextFrame; |
| } else |
| return scan_Continue; |
| } |
| |
| /* |
| * ibmcam_ProcessIsocData() |
| * |
| * Generic routine to parse the ring queue data. It employs either |
| * ibmcam_find_header() or ibmcam_parse_lines() to do most |
| * of work. |
| * |
| * History: |
| * 1/21/00 Created. |
| */ |
| void ibmcam_ProcessIsocData(struct uvd *uvd, struct usbvideo_frame *frame) |
| { |
| enum ParseState newstate; |
| long copylen = 0; |
| int mod = IBMCAM_T(uvd)->camera_model; |
| |
| while (1) { |
| newstate = scan_Out; |
| if (RingQueue_GetLength(&uvd->dp) > 0) { |
| if (frame->scanstate == ScanState_Scanning) { |
| newstate = ibmcam_find_header(uvd); |
| } else if (frame->scanstate == ScanState_Lines) { |
| if ((mod == IBMCAM_MODEL_2) && |
| ((uvd->videosize == VIDEOSIZE_352x288) || |
| (uvd->videosize == VIDEOSIZE_320x240) || |
| (uvd->videosize == VIDEOSIZE_352x240))) |
| { |
| newstate = ibmcam_model2_320x240_parse_lines( |
| uvd, frame, ©len); |
| } else if (mod == IBMCAM_MODEL_4) { |
| /* |
| * Model 4 cameras (IBM NetCamera) use Model 2 decoder (RGB) |
| * for 320x240 and above; 160x120 and 176x144 uses Model 1 |
| * decoder (YUV), and 128x96 mode uses ??? |
| */ |
| if ((uvd->videosize == VIDEOSIZE_352x288) || |
| (uvd->videosize == VIDEOSIZE_320x240) || |
| (uvd->videosize == VIDEOSIZE_352x240)) |
| { |
| newstate = ibmcam_model2_320x240_parse_lines(uvd, frame, ©len); |
| } else if (uvd->videosize == VIDEOSIZE_128x96) { |
| newstate = ibmcam_model4_128x96_parse_lines(uvd, frame, ©len); |
| } else { |
| newstate = ibmcam_parse_lines(uvd, frame, ©len); |
| } |
| } else if (mod == IBMCAM_MODEL_3) { |
| newstate = ibmcam_model3_parse_lines(uvd, frame, ©len); |
| } else { |
| newstate = ibmcam_parse_lines(uvd, frame, ©len); |
| } |
| } |
| } |
| if (newstate == scan_Continue) |
| continue; |
| else if ((newstate == scan_NextFrame) || (newstate == scan_Out)) |
| break; |
| else |
| return; /* scan_EndParse */ |
| } |
| |
| if (newstate == scan_NextFrame) { |
| frame->frameState = FrameState_Done; |
| uvd->curframe = -1; |
| uvd->stats.frame_num++; |
| if ((mod == IBMCAM_MODEL_2) || (mod == IBMCAM_MODEL_4)) { |
| /* Need software contrast adjustment for those cameras */ |
| frame->flags |= USBVIDEO_FRAME_FLAG_SOFTWARE_CONTRAST; |
| } |
| } |
| |
| /* Update the frame's uncompressed length. */ |
| frame->seqRead_Length += copylen; |
| |
| #if 0 |
| { |
| static unsigned char j=0; |
| memset(frame->data, j++, uvd->max_frame_size); |
| frame->frameState = FrameState_Ready; |
| } |
| #endif |
| } |
| |
| /* |
| * ibmcam_veio() |
| * |
| * History: |
| * 1/27/00 Added check for dev == NULL; this happens if camera is unplugged. |
| */ |
| static int ibmcam_veio( |
| struct uvd *uvd, |
| unsigned char req, |
| unsigned short value, |
| unsigned short index) |
| { |
| static const char proc[] = "ibmcam_veio"; |
| unsigned char cp[8] /* = { 0xde, 0xad, 0xbe, 0xef, 0xde, 0xad, 0xbe, 0xef } */; |
| int i; |
| |
| if (!CAMERA_IS_OPERATIONAL(uvd)) |
| return 0; |
| |
| if (req == 1) { |
| i = usb_control_msg( |
| uvd->dev, |
| usb_rcvctrlpipe(uvd->dev, 0), |
| req, |
| USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT, |
| value, |
| index, |
| cp, |
| sizeof(cp), |
| HZ); |
| #if 0 |
| info("USB => %02x%02x%02x%02x%02x%02x%02x%02x " |
| "(req=$%02x val=$%04x ind=$%04x)", |
| cp[0],cp[1],cp[2],cp[3],cp[4],cp[5],cp[6],cp[7], |
| req, value, index); |
| #endif |
| } else { |
| i = usb_control_msg( |
| uvd->dev, |
| usb_sndctrlpipe(uvd->dev, 0), |
| req, |
| USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT, |
| value, |
| index, |
| NULL, |
| 0, |
| HZ); |
| } |
| if (i < 0) { |
| err("%s: ERROR=%d. Camera stopped; Reconnect or reload driver.", |
| proc, i); |
| uvd->last_error = i; |
| } |
| return i; |
| } |
| |
| /* |
| * ibmcam_calculate_fps() |
| * |
| * This procedure roughly calculates the real frame rate based |
| * on FPS code (framerate=NNN option). Actual FPS differs |
| * slightly depending on lighting conditions, so that actual frame |
| * rate is determined by the camera. Since I don't know how to ask |
| * the camera what FPS is now I have to use the FPS code instead. |
| * |
| * The FPS code is in range [0..6], 0 is slowest, 6 is fastest. |
| * Corresponding real FPS should be in range [3..30] frames per second. |
| * The conversion formula is obvious: |
| * |
| * real_fps = 3 + (fps_code * 4.5) |
| * |
| * History: |
| * 1/18/00 Created. |
| */ |
| static int ibmcam_calculate_fps(struct uvd *uvd) |
| { |
| return 3 + framerate*4 + framerate/2; |
| } |
| |
| /* |
| * ibmcam_send_FF_04_02() |
| * |
| * This procedure sends magic 3-command prefix to the camera. |
| * The purpose of this prefix is not known. |
| * |
| * History: |
| * 1/2/00 Created. |
| */ |
| static void ibmcam_send_FF_04_02(struct uvd *uvd) |
| { |
| ibmcam_veio(uvd, 0, 0x00FF, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0124); |
| } |
| |
| static void ibmcam_send_00_04_06(struct uvd *uvd) |
| { |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0006, 0x0124); |
| } |
| |
| static void ibmcam_send_x_00(struct uvd *uvd, unsigned short x) |
| { |
| ibmcam_veio(uvd, 0, x, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0124); |
| } |
| |
| static void ibmcam_send_x_00_05(struct uvd *uvd, unsigned short x) |
| { |
| ibmcam_send_x_00(uvd, x); |
| ibmcam_veio(uvd, 0, 0x0005, 0x0124); |
| } |
| |
| static void ibmcam_send_x_00_05_02(struct uvd *uvd, unsigned short x) |
| { |
| ibmcam_veio(uvd, 0, x, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0005, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0124); |
| } |
| |
| static void ibmcam_send_x_01_00_05(struct uvd *uvd, unsigned short x) |
| { |
| ibmcam_veio(uvd, 0, x, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0005, 0x0124); |
| } |
| |
| static void ibmcam_send_x_00_05_02_01(struct uvd *uvd, unsigned short x) |
| { |
| ibmcam_veio(uvd, 0, x, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0005, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0124); |
| } |
| |
| static void ibmcam_send_x_00_05_02_08_01(struct uvd *uvd, unsigned short x) |
| { |
| ibmcam_veio(uvd, 0, x, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0005, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0124); |
| } |
| |
| static void ibmcam_Packet_Format1(struct uvd *uvd, unsigned char fkey, unsigned char val) |
| { |
| ibmcam_send_x_01_00_05(uvd, unknown_88); |
| ibmcam_send_x_00_05(uvd, fkey); |
| ibmcam_send_x_00_05_02_08_01(uvd, val); |
| ibmcam_send_x_00_05(uvd, unknown_88); |
| ibmcam_send_x_00_05_02_01(uvd, fkey); |
| ibmcam_send_x_00_05(uvd, unknown_89); |
| ibmcam_send_x_00(uvd, fkey); |
| ibmcam_send_00_04_06(uvd); |
| ibmcam_veio(uvd, 1, 0x0000, 0x0126); |
| ibmcam_send_FF_04_02(uvd); |
| } |
| |
| static void ibmcam_PacketFormat2(struct uvd *uvd, unsigned char fkey, unsigned char val) |
| { |
| ibmcam_send_x_01_00_05 (uvd, unknown_88); |
| ibmcam_send_x_00_05 (uvd, fkey); |
| ibmcam_send_x_00_05_02 (uvd, val); |
| } |
| |
| static void ibmcam_model2_Packet2(struct uvd *uvd) |
| { |
| ibmcam_veio(uvd, 0, 0x00ff, 0x012d); |
| ibmcam_veio(uvd, 0, 0xfea3, 0x0124); |
| } |
| |
| static void ibmcam_model2_Packet1(struct uvd *uvd, unsigned short v1, unsigned short v2) |
| { |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x00ff, 0x012e); |
| ibmcam_veio(uvd, 0, v1, 0x012f); |
| ibmcam_veio(uvd, 0, 0x00ff, 0x0130); |
| ibmcam_veio(uvd, 0, 0xc719, 0x0124); |
| ibmcam_veio(uvd, 0, v2, 0x0127); |
| |
| ibmcam_model2_Packet2(uvd); |
| } |
| |
| /* |
| * ibmcam_model3_Packet1() |
| * |
| * 00_0078_012d |
| * 00_0097_012f |
| * 00_d141_0124 |
| * 00_0096_0127 |
| * 00_fea8_0124 |
| */ |
| static void ibmcam_model3_Packet1(struct uvd *uvd, unsigned short v1, unsigned short v2) |
| { |
| ibmcam_veio(uvd, 0, 0x0078, 0x012d); |
| ibmcam_veio(uvd, 0, v1, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, v2, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| } |
| |
| static void ibmcam_model4_BrightnessPacket(struct uvd *uvd, int i) |
| { |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0026, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, i, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0004, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| } |
| |
| /* |
| * ibmcam_adjust_contrast() |
| * |
| * The contrast value changes from 0 (high contrast) to 15 (low contrast). |
| * This is in reverse to usual order of things (such as TV controls), so |
| * we reverse it again here. |
| * |
| * TODO: we probably don't need to send the setup 5 times... |
| * |
| * History: |
| * 1/2/00 Created. |
| */ |
| static void ibmcam_adjust_contrast(struct uvd *uvd) |
| { |
| unsigned char a_contrast = uvd->vpic.contrast >> 12; |
| unsigned char new_contrast; |
| |
| if (a_contrast >= 16) |
| a_contrast = 15; |
| new_contrast = 15 - a_contrast; |
| if (new_contrast == uvd->vpic_old.contrast) |
| return; |
| uvd->vpic_old.contrast = new_contrast; |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_1: |
| { |
| const int ntries = 5; |
| int i; |
| for (i=0; i < ntries; i++) { |
| ibmcam_Packet_Format1(uvd, contrast_14, new_contrast); |
| ibmcam_send_FF_04_02(uvd); |
| } |
| break; |
| } |
| case IBMCAM_MODEL_2: |
| case IBMCAM_MODEL_4: |
| /* Models 2, 4 do not have this control; implemented in software. */ |
| break; |
| case IBMCAM_MODEL_3: |
| { /* Preset hardware values */ |
| static const struct { |
| unsigned short cv1; |
| unsigned short cv2; |
| unsigned short cv3; |
| } cv[7] = { |
| { 0x05, 0x05, 0x0f }, /* Minimum */ |
| { 0x04, 0x04, 0x16 }, |
| { 0x02, 0x03, 0x16 }, |
| { 0x02, 0x08, 0x16 }, |
| { 0x01, 0x0c, 0x16 }, |
| { 0x01, 0x0e, 0x16 }, |
| { 0x01, 0x10, 0x16 } /* Maximum */ |
| }; |
| int i = a_contrast / 2; |
| RESTRICT_TO_RANGE(i, 0, 6); |
| ibmcam_veio(uvd, 0, 0x0000, 0x010c); /* Stop */ |
| ibmcam_model3_Packet1(uvd, 0x0067, cv[i].cv1); |
| ibmcam_model3_Packet1(uvd, 0x005b, cv[i].cv2); |
| ibmcam_model3_Packet1(uvd, 0x005c, cv[i].cv3); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0114); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); /* Go! */ |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| break; |
| } |
| default: |
| break; |
| } |
| } |
| |
| /* |
| * ibmcam_change_lighting_conditions() |
| * |
| * Camera model 1: |
| * We have 3 levels of lighting conditions: 0=Bright, 1=Medium, 2=Low. |
| * |
| * Camera model 2: |
| * We have 16 levels of lighting, 0 for bright light and up to 15 for |
| * low light. But values above 5 or so are useless because camera is |
| * not really capable to produce anything worth viewing at such light. |
| * This setting may be altered only in certain camera state. |
| * |
| * Low lighting forces slower FPS. Lighting is set as a module parameter. |
| * |
| * History: |
| * 1/5/00 Created. |
| * 2/20/00 Added support for Model 2 cameras. |
| */ |
| static void ibmcam_change_lighting_conditions(struct uvd *uvd) |
| { |
| static const char proc[] = "ibmcam_change_lighting_conditions"; |
| |
| if (debug > 0) |
| info("%s: Set lighting to %hu.", proc, lighting); |
| |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_1: |
| { |
| const int ntries = 5; |
| int i; |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, light_27, (unsigned short) lighting); |
| break; |
| } |
| case IBMCAM_MODEL_2: |
| #if 0 |
| /* |
| * This command apparently requires camera to be stopped. My |
| * experiments showed that it -is- possible to alter the lighting |
| * conditions setting "on the fly", but why bother? This setting does |
| * not work reliably in all cases, so I decided simply to leave the |
| * setting where Xirlink put it - in the camera setup phase. This code |
| * is commented out because it does not work at -any- moment, so its |
| * presence makes no sense. You may use it for experiments. |
| */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x010c); /* Stop camera */ |
| ibmcam_model2_Packet1(uvd, mod2_sensitivity, lighting); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); /* Start camera */ |
| #endif |
| break; |
| case IBMCAM_MODEL_3: |
| case IBMCAM_MODEL_4: |
| default: |
| break; |
| } |
| } |
| |
| /* |
| * ibmcam_set_sharpness() |
| * |
| * Cameras model 1 have internal smoothing feature. It is controlled by value in |
| * range [0..6], where 0 is most smooth and 6 is most sharp (raw image, I guess). |
| * Recommended value is 4. Cameras model 2 do not have this feature at all. |
| */ |
| static void ibmcam_set_sharpness(struct uvd *uvd) |
| { |
| static const char proc[] = "ibmcam_set_sharpness"; |
| |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_1: |
| { |
| static const unsigned short sa[] = { 0x11, 0x13, 0x16, 0x18, 0x1a, 0x8, 0x0a }; |
| unsigned short i, sv; |
| |
| RESTRICT_TO_RANGE(sharpness, SHARPNESS_MIN, SHARPNESS_MAX); |
| if (debug > 0) |
| info("%s: Set sharpness to %hu.", proc, sharpness); |
| |
| sv = sa[sharpness - SHARPNESS_MIN]; |
| for (i=0; i < 2; i++) { |
| ibmcam_send_x_01_00_05 (uvd, unknown_88); |
| ibmcam_send_x_00_05 (uvd, sharp_13); |
| ibmcam_send_x_00_05_02 (uvd, sv); |
| } |
| break; |
| } |
| case IBMCAM_MODEL_2: |
| case IBMCAM_MODEL_4: |
| /* Models 2, 4 do not have this control */ |
| break; |
| case IBMCAM_MODEL_3: |
| { /* |
| * "Use a table of magic numbers. |
| * This setting doesn't really change much. |
| * But that's how Windows does it." |
| */ |
| static const struct { |
| unsigned short sv1; |
| unsigned short sv2; |
| unsigned short sv3; |
| unsigned short sv4; |
| } sv[7] = { |
| { 0x00, 0x00, 0x05, 0x14 }, /* Smoothest */ |
| { 0x01, 0x04, 0x05, 0x14 }, |
| { 0x02, 0x04, 0x05, 0x14 }, |
| { 0x03, 0x04, 0x05, 0x14 }, |
| { 0x03, 0x05, 0x05, 0x14 }, |
| { 0x03, 0x06, 0x05, 0x14 }, |
| { 0x03, 0x07, 0x05, 0x14 } /* Sharpest */ |
| }; |
| RESTRICT_TO_RANGE(sharpness, SHARPNESS_MIN, SHARPNESS_MAX); |
| RESTRICT_TO_RANGE(sharpness, 0, 6); |
| ibmcam_veio(uvd, 0, 0x0000, 0x010c); /* Stop */ |
| ibmcam_model3_Packet1(uvd, 0x0060, sv[sharpness].sv1); |
| ibmcam_model3_Packet1(uvd, 0x0061, sv[sharpness].sv2); |
| ibmcam_model3_Packet1(uvd, 0x0062, sv[sharpness].sv3); |
| ibmcam_model3_Packet1(uvd, 0x0063, sv[sharpness].sv4); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0114); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); /* Go! */ |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0113); |
| break; |
| } |
| default: |
| break; |
| } |
| } |
| |
| /* |
| * ibmcam_set_brightness() |
| * |
| * This procedure changes brightness of the picture. |
| */ |
| static void ibmcam_set_brightness(struct uvd *uvd) |
| { |
| static const char proc[] = "ibmcam_set_brightness"; |
| static const unsigned short n = 1; |
| |
| if (debug > 0) |
| info("%s: Set brightness to %hu.", proc, uvd->vpic.brightness); |
| |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_1: |
| { |
| unsigned short i, j, bv[3]; |
| bv[0] = bv[1] = bv[2] = uvd->vpic.brightness >> 10; |
| if (bv[0] == (uvd->vpic_old.brightness >> 10)) |
| return; |
| uvd->vpic_old.brightness = bv[0]; |
| for (j=0; j < 3; j++) |
| for (i=0; i < n; i++) |
| ibmcam_Packet_Format1(uvd, bright_3x[j], bv[j]); |
| break; |
| } |
| case IBMCAM_MODEL_2: |
| { |
| unsigned short i, j; |
| i = uvd->vpic.brightness >> 12; /* 0 .. 15 */ |
| j = 0x60 + i * ((0xee - 0x60) / 16); /* 0x60 .. 0xee or so */ |
| if (uvd->vpic_old.brightness == j) |
| break; |
| uvd->vpic_old.brightness = j; |
| ibmcam_model2_Packet1(uvd, mod2_brightness, j); |
| break; |
| } |
| case IBMCAM_MODEL_3: |
| { |
| /* Model 3: Brightness range 'i' in [0x0C..0x3F] */ |
| unsigned short i = |
| 0x0C + (uvd->vpic.brightness / (0xFFFF / (0x3F - 0x0C + 1))); |
| RESTRICT_TO_RANGE(i, 0x0C, 0x3F); |
| if (uvd->vpic_old.brightness == i) |
| break; |
| uvd->vpic_old.brightness = i; |
| ibmcam_veio(uvd, 0, 0x0000, 0x010c); /* Stop */ |
| ibmcam_model3_Packet1(uvd, 0x0036, i); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0114); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); /* Go! */ |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0113); |
| break; |
| } |
| case IBMCAM_MODEL_4: |
| { |
| /* Model 4: Brightness range 'i' in [0x04..0xb4] */ |
| unsigned short i = 0x04 + (uvd->vpic.brightness / (0xFFFF / (0xb4 - 0x04 + 1))); |
| RESTRICT_TO_RANGE(i, 0x04, 0xb4); |
| if (uvd->vpic_old.brightness == i) |
| break; |
| uvd->vpic_old.brightness = i; |
| ibmcam_model4_BrightnessPacket(uvd, i); |
| break; |
| } |
| default: |
| break; |
| } |
| } |
| |
| static void ibmcam_set_hue(struct uvd *uvd) |
| { |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_2: |
| { |
| unsigned short hue = uvd->vpic.hue >> 9; /* 0 .. 7F */ |
| if (uvd->vpic_old.hue == hue) |
| return; |
| uvd->vpic_old.hue = hue; |
| ibmcam_model2_Packet1(uvd, mod2_hue, hue); |
| /* ibmcam_model2_Packet1(uvd, mod2_saturation, sat); */ |
| break; |
| } |
| case IBMCAM_MODEL_3: |
| { |
| #if 0 /* This seems not to work. No problem, will fix programmatically */ |
| unsigned short hue = 0x05 + (uvd->vpic.hue / (0xFFFF / (0x37 - 0x05 + 1))); |
| RESTRICT_TO_RANGE(hue, 0x05, 0x37); |
| if (uvd->vpic_old.hue == hue) |
| return; |
| uvd->vpic_old.hue = hue; |
| ibmcam_veio(uvd, 0, 0x0000, 0x010c); /* Stop */ |
| ibmcam_model3_Packet1(uvd, 0x007e, hue); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0114); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); /* Go! */ |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0113); |
| #endif |
| break; |
| } |
| case IBMCAM_MODEL_4: |
| { |
| unsigned short r_gain, g_gain, b_gain, hue; |
| |
| /* |
| * I am not sure r/g/b_gain variables exactly control gain |
| * of those channels. Most likely they subtly change some |
| * very internal image processing settings in the camera. |
| * In any case, here is what they do, and feel free to tweak: |
| * |
| * r_gain: seriously affects red gain |
| * g_gain: seriously affects green gain |
| * b_gain: seriously affects blue gain |
| * hue: changes average color from violet (0) to red (0xFF) |
| * |
| * These settings are preset for a decent white balance in |
| * 320x240, 352x288 modes. Low-res modes exhibit higher contrast |
| * and therefore may need different values here. |
| */ |
| hue = 20 + (uvd->vpic.hue >> 9); |
| switch (uvd->videosize) { |
| case VIDEOSIZE_128x96: |
| r_gain = 90; |
| g_gain = 166; |
| b_gain = 175; |
| break; |
| case VIDEOSIZE_160x120: |
| r_gain = 70; |
| g_gain = 166; |
| b_gain = 185; |
| break; |
| case VIDEOSIZE_176x144: |
| r_gain = 160; |
| g_gain = 175; |
| b_gain = 185; |
| break; |
| default: |
| r_gain = 120; |
| g_gain = 166; |
| b_gain = 175; |
| break; |
| } |
| RESTRICT_TO_RANGE(hue, 1, 0x7f); |
| |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x001e, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, g_gain, 0x0127); /* Green gain */ |
| ibmcam_veio(uvd, 0, r_gain, 0x012e); /* Red gain */ |
| ibmcam_veio(uvd, 0, b_gain, 0x0130); /* Blue gain */ |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, hue, 0x012d); /* Hue */ |
| ibmcam_veio(uvd, 0, 0xf545, 0x0124); |
| break; |
| } |
| default: |
| break; |
| } |
| } |
| |
| /* |
| * ibmcam_adjust_picture() |
| * |
| * This procedure gets called from V4L interface to update picture settings. |
| * Here we change brightness and contrast. |
| */ |
| static void ibmcam_adjust_picture(struct uvd *uvd) |
| { |
| ibmcam_adjust_contrast(uvd); |
| ibmcam_set_brightness(uvd); |
| ibmcam_set_hue(uvd); |
| } |
| |
| static int ibmcam_model1_setup(struct uvd *uvd) |
| { |
| const int ntries = 5; |
| int i; |
| |
| ibmcam_veio(uvd, 1, 0x00, 0x0128); |
| ibmcam_veio(uvd, 1, 0x00, 0x0100); |
| ibmcam_veio(uvd, 0, 0x01, 0x0100); /* LED On */ |
| ibmcam_veio(uvd, 1, 0x00, 0x0100); |
| ibmcam_veio(uvd, 0, 0x81, 0x0100); /* LED Off */ |
| ibmcam_veio(uvd, 1, 0x00, 0x0100); |
| ibmcam_veio(uvd, 0, 0x01, 0x0100); /* LED On */ |
| ibmcam_veio(uvd, 0, 0x01, 0x0108); |
| |
| ibmcam_veio(uvd, 0, 0x03, 0x0112); |
| ibmcam_veio(uvd, 1, 0x00, 0x0115); |
| ibmcam_veio(uvd, 0, 0x06, 0x0115); |
| ibmcam_veio(uvd, 1, 0x00, 0x0116); |
| ibmcam_veio(uvd, 0, 0x44, 0x0116); |
| ibmcam_veio(uvd, 1, 0x00, 0x0116); |
| ibmcam_veio(uvd, 0, 0x40, 0x0116); |
| ibmcam_veio(uvd, 1, 0x00, 0x0115); |
| ibmcam_veio(uvd, 0, 0x0e, 0x0115); |
| ibmcam_veio(uvd, 0, 0x19, 0x012c); |
| |
| ibmcam_Packet_Format1(uvd, 0x00, 0x1e); |
| ibmcam_Packet_Format1(uvd, 0x39, 0x0d); |
| ibmcam_Packet_Format1(uvd, 0x39, 0x09); |
| ibmcam_Packet_Format1(uvd, 0x3b, 0x00); |
| ibmcam_Packet_Format1(uvd, 0x28, 0x22); |
| ibmcam_Packet_Format1(uvd, light_27, 0); |
| ibmcam_Packet_Format1(uvd, 0x2b, 0x1f); |
| ibmcam_Packet_Format1(uvd, 0x39, 0x08); |
| |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x2c, 0x00); |
| |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x30, 0x14); |
| |
| ibmcam_PacketFormat2(uvd, 0x39, 0x02); |
| ibmcam_PacketFormat2(uvd, 0x01, 0xe1); |
| ibmcam_PacketFormat2(uvd, 0x02, 0xcd); |
| ibmcam_PacketFormat2(uvd, 0x03, 0xcd); |
| ibmcam_PacketFormat2(uvd, 0x04, 0xfa); |
| ibmcam_PacketFormat2(uvd, 0x3f, 0xff); |
| ibmcam_PacketFormat2(uvd, 0x39, 0x00); |
| |
| ibmcam_PacketFormat2(uvd, 0x39, 0x02); |
| ibmcam_PacketFormat2(uvd, 0x0a, 0x37); |
| ibmcam_PacketFormat2(uvd, 0x0b, 0xb8); |
| ibmcam_PacketFormat2(uvd, 0x0c, 0xf3); |
| ibmcam_PacketFormat2(uvd, 0x0d, 0xe3); |
| ibmcam_PacketFormat2(uvd, 0x0e, 0x0d); |
| ibmcam_PacketFormat2(uvd, 0x0f, 0xf2); |
| ibmcam_PacketFormat2(uvd, 0x10, 0xd5); |
| ibmcam_PacketFormat2(uvd, 0x11, 0xba); |
| ibmcam_PacketFormat2(uvd, 0x12, 0x53); |
| ibmcam_PacketFormat2(uvd, 0x3f, 0xff); |
| ibmcam_PacketFormat2(uvd, 0x39, 0x00); |
| |
| ibmcam_PacketFormat2(uvd, 0x39, 0x02); |
| ibmcam_PacketFormat2(uvd, 0x16, 0x00); |
| ibmcam_PacketFormat2(uvd, 0x17, 0x28); |
| ibmcam_PacketFormat2(uvd, 0x18, 0x7d); |
| ibmcam_PacketFormat2(uvd, 0x19, 0xbe); |
| ibmcam_PacketFormat2(uvd, 0x3f, 0xff); |
| ibmcam_PacketFormat2(uvd, 0x39, 0x00); |
| |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x00, 0x18); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x13, 0x18); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x14, 0x06); |
| |
| /* This is default brightness */ |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x31, 0x37); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x32, 0x46); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x33, 0x55); |
| |
| ibmcam_Packet_Format1(uvd, 0x2e, 0x04); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x2d, 0x04); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x29, 0x80); |
| ibmcam_Packet_Format1(uvd, 0x2c, 0x01); |
| ibmcam_Packet_Format1(uvd, 0x30, 0x17); |
| ibmcam_Packet_Format1(uvd, 0x39, 0x08); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x34, 0x00); |
| |
| ibmcam_veio(uvd, 0, 0x00, 0x0101); |
| ibmcam_veio(uvd, 0, 0x00, 0x010a); |
| |
| switch (uvd->videosize) { |
| case VIDEOSIZE_128x96: |
| ibmcam_veio(uvd, 0, 0x80, 0x0103); |
| ibmcam_veio(uvd, 0, 0x60, 0x0105); |
| ibmcam_veio(uvd, 0, 0x0c, 0x010b); |
| ibmcam_veio(uvd, 0, 0x04, 0x011b); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x0b, 0x011d); |
| ibmcam_veio(uvd, 0, 0x00, 0x011e); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x00, 0x0129); |
| break; |
| case VIDEOSIZE_176x144: |
| ibmcam_veio(uvd, 0, 0xb0, 0x0103); |
| ibmcam_veio(uvd, 0, 0x8f, 0x0105); |
| ibmcam_veio(uvd, 0, 0x06, 0x010b); |
| ibmcam_veio(uvd, 0, 0x04, 0x011b); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x0d, 0x011d); |
| ibmcam_veio(uvd, 0, 0x00, 0x011e); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x03, 0x0129); |
| break; |
| case VIDEOSIZE_352x288: |
| ibmcam_veio(uvd, 0, 0xb0, 0x0103); |
| ibmcam_veio(uvd, 0, 0x90, 0x0105); |
| ibmcam_veio(uvd, 0, 0x02, 0x010b); |
| ibmcam_veio(uvd, 0, 0x04, 0x011b); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x05, 0x011d); |
| ibmcam_veio(uvd, 0, 0x00, 0x011e); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x00, 0x0129); |
| break; |
| } |
| |
| ibmcam_veio(uvd, 0, 0xff, 0x012b); |
| |
| /* This is another brightness - don't know why */ |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x31, 0xc3); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x32, 0xd2); |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, 0x33, 0xe1); |
| |
| /* Default contrast */ |
| for (i=0; i < ntries; i++) |
| ibmcam_Packet_Format1(uvd, contrast_14, 0x0a); |
| |
| /* Default sharpness */ |
| for (i=0; i < 2; i++) |
| ibmcam_PacketFormat2(uvd, sharp_13, 0x1a); /* Level 4 FIXME */ |
| |
| /* Default lighting conditions */ |
| ibmcam_Packet_Format1(uvd, light_27, lighting); /* 0=Bright 2=Low */ |
| |
| /* Assorted init */ |
| |
| switch (uvd->videosize) { |
| case VIDEOSIZE_128x96: |
| ibmcam_Packet_Format1(uvd, 0x2b, 0x1e); |
| ibmcam_veio(uvd, 0, 0xc9, 0x0119); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x80, 0x0109); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x36, 0x0102); |
| ibmcam_veio(uvd, 0, 0x1a, 0x0104); |
| ibmcam_veio(uvd, 0, 0x04, 0x011a); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x2b, 0x011c); |
| ibmcam_veio(uvd, 0, 0x23, 0x012a); /* Same everywhere */ |
| #if 0 |
| ibmcam_veio(uvd, 0, 0x00, 0x0106); |
| ibmcam_veio(uvd, 0, 0x38, 0x0107); |
| #else |
| ibmcam_veio(uvd, 0, 0x02, 0x0106); |
| ibmcam_veio(uvd, 0, 0x2a, 0x0107); |
| #endif |
| break; |
| case VIDEOSIZE_176x144: |
| ibmcam_Packet_Format1(uvd, 0x2b, 0x1e); |
| ibmcam_veio(uvd, 0, 0xc9, 0x0119); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x80, 0x0109); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x04, 0x0102); |
| ibmcam_veio(uvd, 0, 0x02, 0x0104); |
| ibmcam_veio(uvd, 0, 0x04, 0x011a); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x2b, 0x011c); |
| ibmcam_veio(uvd, 0, 0x23, 0x012a); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x01, 0x0106); |
| ibmcam_veio(uvd, 0, 0xca, 0x0107); |
| break; |
| case VIDEOSIZE_352x288: |
| ibmcam_Packet_Format1(uvd, 0x2b, 0x1f); |
| ibmcam_veio(uvd, 0, 0xc9, 0x0119); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x80, 0x0109); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x08, 0x0102); |
| ibmcam_veio(uvd, 0, 0x01, 0x0104); |
| ibmcam_veio(uvd, 0, 0x04, 0x011a); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x2f, 0x011c); |
| ibmcam_veio(uvd, 0, 0x23, 0x012a); /* Same everywhere */ |
| ibmcam_veio(uvd, 0, 0x03, 0x0106); |
| ibmcam_veio(uvd, 0, 0xf6, 0x0107); |
| break; |
| } |
| return (CAMERA_IS_OPERATIONAL(uvd) ? 0 : -EFAULT); |
| } |
| |
| static int ibmcam_model2_setup(struct uvd *uvd) |
| { |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); /* LED on */ |
| ibmcam_veio(uvd, 1, 0x0000, 0x0116); |
| ibmcam_veio(uvd, 0, 0x0060, 0x0116); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0112); |
| ibmcam_veio(uvd, 0, 0x00bc, 0x012c); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012b); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0108); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0133); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0102); |
| switch (uvd->videosize) { |
| case VIDEOSIZE_176x144: |
| ibmcam_veio(uvd, 0, 0x002c, 0x0103); /* All except 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0024, 0x0105); /* 176x144, 352x288 */ |
| ibmcam_veio(uvd, 0, 0x00b9, 0x010a); /* Unique to this mode */ |
| ibmcam_veio(uvd, 0, 0x0038, 0x0119); /* Unique to this mode */ |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0090, 0x0107); /* Unique to every mode*/ |
| break; |
| case VIDEOSIZE_320x240: |
| ibmcam_veio(uvd, 0, 0x0028, 0x0103); /* Unique to this mode */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); /* Same */ |
| ibmcam_veio(uvd, 0, 0x001e, 0x0105); /* 320x240, 352x240 */ |
| ibmcam_veio(uvd, 0, 0x0039, 0x010a); /* All except 176x144 */ |
| ibmcam_veio(uvd, 0, 0x0070, 0x0119); /* All except 176x144 */ |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0098, 0x0107); /* Unique to every mode*/ |
| break; |
| case VIDEOSIZE_352x240: |
| ibmcam_veio(uvd, 0, 0x002c, 0x0103); /* All except 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); /* Same */ |
| ibmcam_veio(uvd, 0, 0x001e, 0x0105); /* 320x240, 352x240 */ |
| ibmcam_veio(uvd, 0, 0x0039, 0x010a); /* All except 176x144 */ |
| ibmcam_veio(uvd, 0, 0x0070, 0x0119); /* All except 176x144 */ |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); /* Same */ |
| ibmcam_veio(uvd, 0, 0x00da, 0x0107); /* Unique to every mode*/ |
| break; |
| case VIDEOSIZE_352x288: |
| ibmcam_veio(uvd, 0, 0x002c, 0x0103); /* All except 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0024, 0x0105); /* 176x144, 352x288 */ |
| ibmcam_veio(uvd, 0, 0x0039, 0x010a); /* All except 176x144 */ |
| ibmcam_veio(uvd, 0, 0x0070, 0x0119); /* All except 176x144 */ |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); /* Same */ |
| ibmcam_veio(uvd, 0, 0x00fe, 0x0107); /* Unique to every mode*/ |
| break; |
| } |
| return (CAMERA_IS_OPERATIONAL(uvd) ? 0 : -EFAULT); |
| } |
| |
| /* |
| * ibmcam_model1_setup_after_video_if() |
| * |
| * This code adds finishing touches to the video data interface. |
| * Here we configure the frame rate and turn on the LED. |
| */ |
| static void ibmcam_model1_setup_after_video_if(struct uvd *uvd) |
| { |
| unsigned short internal_frame_rate; |
| |
| RESTRICT_TO_RANGE(framerate, FRAMERATE_MIN, FRAMERATE_MAX); |
| internal_frame_rate = FRAMERATE_MAX - framerate; /* 0=Fast 6=Slow */ |
| ibmcam_veio(uvd, 0, 0x01, 0x0100); /* LED On */ |
| ibmcam_veio(uvd, 0, internal_frame_rate, 0x0111); |
| ibmcam_veio(uvd, 0, 0x01, 0x0114); |
| ibmcam_veio(uvd, 0, 0xc0, 0x010c); |
| } |
| |
| static void ibmcam_model2_setup_after_video_if(struct uvd *uvd) |
| { |
| unsigned short setup_model2_rg2, setup_model2_sat, setup_model2_yb; |
| |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); /* LED on */ |
| |
| switch (uvd->videosize) { |
| case VIDEOSIZE_176x144: |
| ibmcam_veio(uvd, 0, 0x0050, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00d0, 0x0111); |
| break; |
| case VIDEOSIZE_320x240: |
| case VIDEOSIZE_352x240: |
| case VIDEOSIZE_352x288: |
| ibmcam_veio(uvd, 0, 0x0040, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x0111); |
| break; |
| } |
| ibmcam_veio(uvd, 0, 0x009b, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00bb, 0x010f); |
| |
| /* |
| * Hardware settings, may affect CMOS sensor; not user controls! |
| * ------------------------------------------------------------- |
| * 0x0004: no effect |
| * 0x0006: hardware effect |
| * 0x0008: no effect |
| * 0x000a: stops video stream, probably important h/w setting |
| * 0x000c: changes color in hardware manner (not user setting) |
| * 0x0012: changes number of colors (does not affect speed) |
| * 0x002a: no effect |
| * 0x002c: hardware setting (related to scan lines) |
| * 0x002e: stops video stream, probably important h/w setting |
| */ |
| ibmcam_model2_Packet1(uvd, 0x000a, 0x005c); |
| ibmcam_model2_Packet1(uvd, 0x0004, 0x0000); |
| ibmcam_model2_Packet1(uvd, 0x0006, 0x00fb); |
| ibmcam_model2_Packet1(uvd, 0x0008, 0x0000); |
| ibmcam_model2_Packet1(uvd, 0x000c, 0x0009); |
| ibmcam_model2_Packet1(uvd, 0x0012, 0x000a); |
| ibmcam_model2_Packet1(uvd, 0x002a, 0x0000); |
| ibmcam_model2_Packet1(uvd, 0x002c, 0x0000); |
| ibmcam_model2_Packet1(uvd, 0x002e, 0x0008); |
| |
| /* |
| * Function 0x0030 pops up all over the place. Apparently |
| * it is a hardware control register, with every bit assigned to |
| * do something. |
| */ |
| ibmcam_model2_Packet1(uvd, 0x0030, 0x0000); |
| |
| /* |
| * Magic control of CMOS sensor. Only lower values like |
| * 0-3 work, and picture shifts left or right. Don't change. |
| */ |
| switch (uvd->videosize) { |
| case VIDEOSIZE_176x144: |
| ibmcam_model2_Packet1(uvd, 0x0014, 0x0002); |
| ibmcam_model2_Packet1(uvd, 0x0016, 0x0002); /* Horizontal shift */ |
| ibmcam_model2_Packet1(uvd, 0x0018, 0x004a); /* Another hardware setting */ |
| break; |
| case VIDEOSIZE_320x240: |
| ibmcam_model2_Packet1(uvd, 0x0014, 0x0009); |
| ibmcam_model2_Packet1(uvd, 0x0016, 0x0005); /* Horizontal shift */ |
| ibmcam_model2_Packet1(uvd, 0x0018, 0x0044); /* Another hardware setting */ |
| break; |
| case VIDEOSIZE_352x240: |
| /* This mode doesn't work as Windows programs it; changed to work */ |
| ibmcam_model2_Packet1(uvd, 0x0014, 0x0009); /* Windows sets this to 8 */ |
| ibmcam_model2_Packet1(uvd, 0x0016, 0x0003); /* Horizontal shift */ |
| ibmcam_model2_Packet1(uvd, 0x0018, 0x0044); /* Windows sets this to 0x0045 */ |
| break; |
| case VIDEOSIZE_352x288: |
| ibmcam_model2_Packet1(uvd, 0x0014, 0x0003); |
| ibmcam_model2_Packet1(uvd, 0x0016, 0x0002); /* Horizontal shift */ |
| ibmcam_model2_Packet1(uvd, 0x0018, 0x004a); /* Another hardware setting */ |
| break; |
| } |
| |
| ibmcam_model2_Packet1(uvd, mod2_brightness, 0x005a); |
| |
| /* |
| * We have our own frame rate setting varying from 0 (slowest) to 6 (fastest). |
| * The camera model 2 allows frame rate in range [0..0x1F] where 0 is also the |
| * slowest setting. However for all practical reasons high settings make no |
| * sense because USB is not fast enough to support high FPS. Be aware that |
| * the picture datastream will be severely disrupted if you ask for |
| * frame rate faster than allowed for the video size - see below: |
| * |
| * Allowable ranges (obtained experimentally on OHCI, K6-3, 450 MHz): |
| * ----------------------------------------------------------------- |
| * 176x144: [6..31] |
| * 320x240: [8..31] |
| * 352x240: [10..31] |
| * 352x288: [16..31] I have to raise lower threshold for stability... |
| * |
| * As usual, slower FPS provides better sensitivity. |
| */ |
| { |
| short hw_fps=31, i_framerate; |
| |
| RESTRICT_TO_RANGE(framerate, FRAMERATE_MIN, FRAMERATE_MAX); |
| i_framerate = FRAMERATE_MAX - framerate + FRAMERATE_MIN; |
| switch (uvd->videosize) { |
| case VIDEOSIZE_176x144: |
| hw_fps = 6 + i_framerate*4; |
| break; |
| case VIDEOSIZE_320x240: |
| hw_fps = 8 + i_framerate*3; |
| break; |
| case VIDEOSIZE_352x240: |
| hw_fps = 10 + i_framerate*2; |
| break; |
| case VIDEOSIZE_352x288: |
| hw_fps = 28 + i_framerate/2; |
| break; |
| } |
| if (uvd->debug > 0) |
| info("Framerate (hardware): %hd.", hw_fps); |
| RESTRICT_TO_RANGE(hw_fps, 0, 31); |
| ibmcam_model2_Packet1(uvd, mod2_set_framerate, hw_fps); |
| } |
| |
| /* |
| * This setting does not visibly affect pictures; left it here |
| * because it was present in Windows USB data stream. This function |
| * does not allow arbitrary values and apparently is a bit mask, to |
| * be activated only at appropriate time. Don't change it randomly! |
| */ |
| switch (uvd->videosize) { |
| case VIDEOSIZE_176x144: |
| ibmcam_model2_Packet1(uvd, 0x0026, 0x00c2); |
| break; |
| case VIDEOSIZE_320x240: |
| ibmcam_model2_Packet1(uvd, 0x0026, 0x0044); |
| break; |
| case VIDEOSIZE_352x240: |
| ibmcam_model2_Packet1(uvd, 0x0026, 0x0046); |
| break; |
| case VIDEOSIZE_352x288: |
| ibmcam_model2_Packet1(uvd, 0x0026, 0x0048); |
| break; |
| } |
| |
| ibmcam_model2_Packet1(uvd, mod2_sensitivity, lighting); |
| |
| if (init_model2_rg2 >= 0) { |
| RESTRICT_TO_RANGE(init_model2_rg2, 0, 255); |
| setup_model2_rg2 = init_model2_rg2; |
| } else |
| setup_model2_rg2 = 0x002f; |
| |
| if (init_model2_sat >= 0) { |
| RESTRICT_TO_RANGE(init_model2_sat, 0, 255); |
| setup_model2_sat = init_model2_sat; |
| } else |
| setup_model2_sat = 0x0034; |
| |
| if (init_model2_yb >= 0) { |
| RESTRICT_TO_RANGE(init_model2_yb, 0, 255); |
| setup_model2_yb = init_model2_yb; |
| } else |
| setup_model2_yb = 0x00a0; |
| |
| ibmcam_model2_Packet1(uvd, mod2_color_balance_rg2, setup_model2_rg2); |
| ibmcam_model2_Packet1(uvd, mod2_saturation, setup_model2_sat); |
| ibmcam_model2_Packet1(uvd, mod2_color_balance_yb, setup_model2_yb); |
| ibmcam_model2_Packet1(uvd, mod2_hue, uvd->vpic.hue >> 9); /* 0 .. 7F */; |
| |
| /* Hardware control command */ |
| ibmcam_model2_Packet1(uvd, 0x0030, 0x0004); |
| |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); /* Go camera, go! */ |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| } |
| |
| static void ibmcam_model4_setup_after_video_if(struct uvd *uvd) |
| { |
| switch (uvd->videosize) { |
| case VIDEOSIZE_128x96: |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00bc, 0x012c); |
| ibmcam_veio(uvd, 0, 0x0080, 0x012b); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0108); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0133); |
| ibmcam_veio(uvd, 0, 0x009b, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00bb, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x000a, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005c, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0004, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00fb, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0009, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0012, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x002a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0000, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0034, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0070, 0x0119); |
| ibmcam_veio(uvd, 0, 0x00d2, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x005e, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x00d0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x0039, 0x010a); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0102); |
| ibmcam_veio(uvd, 0, 0x0028, 0x0103); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); |
| ibmcam_veio(uvd, 0, 0x001e, 0x0105); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0016, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000a, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0014, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012e); |
| ibmcam_veio(uvd, 0, 0x001a, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a0a, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x9545, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0018, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0043, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x001c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00eb, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0032, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0036, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x001e, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0017, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0013, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0031, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0017, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0078, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); |
| break; |
| case VIDEOSIZE_160x120: |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00bc, 0x012c); |
| ibmcam_veio(uvd, 0, 0x0080, 0x012b); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0108); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0133); |
| ibmcam_veio(uvd, 0, 0x009b, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00bb, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x000a, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005c, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0004, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00fb, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0009, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0012, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x002a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0000, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0034, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0038, 0x0119); |
| ibmcam_veio(uvd, 0, 0x00d8, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0106); |
| ibmcam_veio(uvd, 0, 0x00d0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00b9, 0x010a); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0102); |
| ibmcam_veio(uvd, 0, 0x0028, 0x0103); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); |
| ibmcam_veio(uvd, 0, 0x001e, 0x0105); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0016, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000b, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0014, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012e); |
| ibmcam_veio(uvd, 0, 0x001a, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a0a, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x9545, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0018, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0043, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x001c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00c7, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0032, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0025, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0036, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x001e, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0048, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0035, 0x012e); |
| ibmcam_veio(uvd, 0, 0x00d0, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0048, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0090, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); |
| break; |
| case VIDEOSIZE_176x144: |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00bc, 0x012c); |
| ibmcam_veio(uvd, 0, 0x0080, 0x012b); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0108); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0133); |
| ibmcam_veio(uvd, 0, 0x009b, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00bb, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x000a, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005c, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0004, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00fb, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0009, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0012, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x002a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0000, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0034, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0038, 0x0119); |
| ibmcam_veio(uvd, 0, 0x00d6, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x0018, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x00d0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00b9, 0x010a); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0102); |
| ibmcam_veio(uvd, 0, 0x002c, 0x0103); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); |
| ibmcam_veio(uvd, 0, 0x0024, 0x0105); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0016, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0007, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0014, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0001, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012e); |
| ibmcam_veio(uvd, 0, 0x001a, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a0a, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005e, 0x012d); |
| ibmcam_veio(uvd, 0, 0x9545, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0018, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0049, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x001c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00c7, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0032, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0028, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0036, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x001e, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0010, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0013, 0x012e); |
| ibmcam_veio(uvd, 0, 0x002a, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0010, 0x012d); |
| ibmcam_veio(uvd, 0, 0x006d, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); |
| break; |
| case VIDEOSIZE_320x240: |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00bc, 0x012c); |
| ibmcam_veio(uvd, 0, 0x0080, 0x012b); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0108); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0133); |
| ibmcam_veio(uvd, 0, 0x009b, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00bb, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x000a, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005c, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0004, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00fb, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0009, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0012, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x002a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0000, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0034, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0070, 0x0119); |
| ibmcam_veio(uvd, 0, 0x00d2, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x005e, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x00d0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x0039, 0x010a); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0102); |
| ibmcam_veio(uvd, 0, 0x0028, 0x0103); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); |
| ibmcam_veio(uvd, 0, 0x001e, 0x0105); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0016, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000a, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0014, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012e); |
| ibmcam_veio(uvd, 0, 0x001a, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a0a, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x9545, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0018, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0043, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x001c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00eb, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0032, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0036, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x001e, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0017, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0013, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0031, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0017, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0078, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); |
| break; |
| case VIDEOSIZE_352x288: |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00bc, 0x012c); |
| ibmcam_veio(uvd, 0, 0x0080, 0x012b); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0108); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0133); |
| ibmcam_veio(uvd, 0, 0x009b, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00bb, 0x010f); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x000a, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005c, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0004, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00fb, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x000c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0009, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0012, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x002a, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0000, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0034, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0070, 0x0119); |
| ibmcam_veio(uvd, 0, 0x00f2, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x008c, 0x0107); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x0111); |
| ibmcam_veio(uvd, 0, 0x0039, 0x010a); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0102); |
| ibmcam_veio(uvd, 0, 0x002c, 0x0103); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0104); |
| ibmcam_veio(uvd, 0, 0x0024, 0x0105); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0016, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0006, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0014, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0002, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012e); |
| ibmcam_veio(uvd, 0, 0x001a, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a0a, 0x0124); |
| ibmcam_veio(uvd, 0, 0x005e, 0x012d); |
| ibmcam_veio(uvd, 0, 0x9545, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0018, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0049, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd055, 0x0124); |
| ibmcam_veio(uvd, 0, 0x001c, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00cf, 0x012e); |
| ibmcam_veio(uvd, 0, 0xaa28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0032, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x0130); |
| ibmcam_veio(uvd, 0, 0x82a8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0036, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0008, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0xfffa, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x001e, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0010, 0x0127); |
| ibmcam_veio(uvd, 0, 0x0013, 0x012e); |
| ibmcam_veio(uvd, 0, 0x0025, 0x0130); |
| ibmcam_veio(uvd, 0, 0x8a28, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0010, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0048, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd145, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00aa, 0x012d); |
| ibmcam_veio(uvd, 0, 0x0038, 0x012f); |
| ibmcam_veio(uvd, 0, 0xd141, 0x0124); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0127); |
| ibmcam_veio(uvd, 0, 0xfea8, 0x0124); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); |
| break; |
| } |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| } |
| |
| static void ibmcam_model3_setup_after_video_if(struct uvd *uvd) |
| { |
| int i; |
| /* |
| * 01.01.08 - Added for RCA video in support -LO |
| * This struct is used to init the Model3 cam to use the RCA video in port |
| * instead of the CCD sensor. |
| */ |
| static const struct struct_initData initData[] = { |
| {0, 0x0000, 0x010c}, |
| {0, 0x0006, 0x012c}, |
| {0, 0x0078, 0x012d}, |
| {0, 0x0046, 0x012f}, |
| {0, 0xd141, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfea8, 0x0124}, |
| {1, 0x0000, 0x0116}, |
| {0, 0x0064, 0x0116}, |
| {1, 0x0000, 0x0115}, |
| {0, 0x0003, 0x0115}, |
| {0, 0x0008, 0x0123}, |
| {0, 0x0000, 0x0117}, |
| {0, 0x0000, 0x0112}, |
| {0, 0x0080, 0x0100}, |
| {0, 0x0000, 0x0100}, |
| {1, 0x0000, 0x0116}, |
| {0, 0x0060, 0x0116}, |
| {0, 0x0002, 0x0112}, |
| {0, 0x0000, 0x0123}, |
| {0, 0x0001, 0x0117}, |
| {0, 0x0040, 0x0108}, |
| {0, 0x0019, 0x012c}, |
| {0, 0x0040, 0x0116}, |
| {0, 0x000a, 0x0115}, |
| {0, 0x000b, 0x0115}, |
| {0, 0x0078, 0x012d}, |
| {0, 0x0046, 0x012f}, |
| {0, 0xd141, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfea8, 0x0124}, |
| {0, 0x0064, 0x0116}, |
| {0, 0x0000, 0x0115}, |
| {0, 0x0001, 0x0115}, |
| {0, 0xffff, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x00aa, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xffff, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x00f2, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x000f, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xffff, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x00f8, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x00fc, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xffff, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x00f9, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x003c, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xffff, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0027, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0019, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0021, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0006, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0045, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x002a, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x000e, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x002b, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x00f4, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x002c, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0004, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x002d, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0014, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x002e, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0003, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x002f, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0003, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0014, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0040, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0040, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0053, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0x0000, 0x0101}, |
| {0, 0x00a0, 0x0103}, |
| {0, 0x0078, 0x0105}, |
| {0, 0x0000, 0x010a}, |
| {0, 0x0024, 0x010b}, |
| {0, 0x0028, 0x0119}, |
| {0, 0x0088, 0x011b}, |
| {0, 0x0002, 0x011d}, |
| {0, 0x0003, 0x011e}, |
| {0, 0x0000, 0x0129}, |
| {0, 0x00fc, 0x012b}, |
| {0, 0x0008, 0x0102}, |
| {0, 0x0000, 0x0104}, |
| {0, 0x0008, 0x011a}, |
| {0, 0x0028, 0x011c}, |
| {0, 0x0021, 0x012a}, |
| {0, 0x0000, 0x0118}, |
| {0, 0x0000, 0x0132}, |
| {0, 0x0000, 0x0109}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0031, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0040, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0040, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x00dc, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0032, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0020, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0001, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0040, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0040, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0037, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0030, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0xfff9, 0x0124}, |
| {0, 0x0086, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0038, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0008, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0x0000, 0x0127}, |
| {0, 0xfff8, 0x0124}, |
| {0, 0xfffd, 0x0124}, |
| {0, 0xfffa, 0x0124}, |
| {0, 0x0003, 0x0106}, |
| {0, 0x0062, 0x0107}, |
| {0, 0x0003, 0x0111}, |
| }; |
| #define NUM_INIT_DATA |
| |
| unsigned short compression = 0; /* 0=none, 7=best frame rate */ |
| int f_rate; /* 0=Fastest 7=slowest */ |
| |
| if (IBMCAM_T(uvd)->initialized) |
| return; |
| |
| /* Internal frame rate is controlled by f_rate value */ |
| f_rate = 7 - framerate; |
| RESTRICT_TO_RANGE(f_rate, 0, 7); |
| |
| ibmcam_veio(uvd, 0, 0x0000, 0x0100); |
| ibmcam_veio(uvd, 1, 0x0000, 0x0116); |
| ibmcam_veio(uvd, 0, 0x0060, 0x0116); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0112); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0123); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0117); |
| ibmcam_veio(uvd, 0, 0x0040, 0x0108); |
| ibmcam_veio(uvd, 0, 0x0019, 0x012c); |
| ibmcam_veio(uvd, 0, 0x0060, 0x0116); |
| ibmcam_veio(uvd, 0, 0x0002, 0x0115); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0115); |
| ibmcam_veio(uvd, 1, 0x0000, 0x0115); |
| ibmcam_veio(uvd, 0, 0x000b, 0x0115); |
| ibmcam_model3_Packet1(uvd, 0x000a, 0x0040); |
| ibmcam_model3_Packet1(uvd, 0x000b, 0x00f6); |
| ibmcam_model3_Packet1(uvd, 0x000c, 0x0002); |
| ibmcam_model3_Packet1(uvd, 0x000d, 0x0020); |
| ibmcam_model3_Packet1(uvd, 0x000e, 0x0033); |
| ibmcam_model3_Packet1(uvd, 0x000f, 0x0007); |
| ibmcam_model3_Packet1(uvd, 0x0010, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0011, 0x0070); |
| ibmcam_model3_Packet1(uvd, 0x0012, 0x0030); |
| ibmcam_model3_Packet1(uvd, 0x0013, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0014, 0x0001); |
| ibmcam_model3_Packet1(uvd, 0x0015, 0x0001); |
| ibmcam_model3_Packet1(uvd, 0x0016, 0x0001); |
| ibmcam_model3_Packet1(uvd, 0x0017, 0x0001); |
| ibmcam_model3_Packet1(uvd, 0x0018, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x001e, 0x00c3); |
| ibmcam_model3_Packet1(uvd, 0x0020, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0028, 0x0010); |
| ibmcam_model3_Packet1(uvd, 0x0029, 0x0054); |
| ibmcam_model3_Packet1(uvd, 0x002a, 0x0013); |
| ibmcam_model3_Packet1(uvd, 0x002b, 0x0007); |
| ibmcam_model3_Packet1(uvd, 0x002d, 0x0028); |
| ibmcam_model3_Packet1(uvd, 0x002e, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0031, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0032, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0033, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0034, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0035, 0x0038); |
| ibmcam_model3_Packet1(uvd, 0x003a, 0x0001); |
| ibmcam_model3_Packet1(uvd, 0x003c, 0x001e); |
| ibmcam_model3_Packet1(uvd, 0x003f, 0x000a); |
| ibmcam_model3_Packet1(uvd, 0x0041, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0046, 0x003f); |
| ibmcam_model3_Packet1(uvd, 0x0047, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0050, 0x0005); |
| ibmcam_model3_Packet1(uvd, 0x0052, 0x001a); |
| ibmcam_model3_Packet1(uvd, 0x0053, 0x0003); |
| ibmcam_model3_Packet1(uvd, 0x005a, 0x006b); |
| ibmcam_model3_Packet1(uvd, 0x005d, 0x001e); |
| ibmcam_model3_Packet1(uvd, 0x005e, 0x0030); |
| ibmcam_model3_Packet1(uvd, 0x005f, 0x0041); |
| ibmcam_model3_Packet1(uvd, 0x0064, 0x0008); |
| ibmcam_model3_Packet1(uvd, 0x0065, 0x0015); |
| ibmcam_model3_Packet1(uvd, 0x0068, 0x000f); |
| ibmcam_model3_Packet1(uvd, 0x0079, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x007a, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x007c, 0x003f); |
| ibmcam_model3_Packet1(uvd, 0x0082, 0x000f); |
| ibmcam_model3_Packet1(uvd, 0x0085, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x0099, 0x0000); |
| ibmcam_model3_Packet1(uvd, 0x009b, 0x0023); |
| ibmcam_model3_Packet1(uvd, 0x009c, 0x0022); |
| ibmcam_model3_Packet1(uvd, 0x009d, 0x0096); |
| ibmcam_model3_Packet1(uvd, 0x009e, 0x0096); |
| ibmcam_model3_Packet1(uvd, 0x009f, 0x000a); |
| |
| switch (uvd->videosize) { |
| case VIDEOSIZE_160x120: |
| ibmcam_veio(uvd, 0, 0x0000, 0x0101); /* Same on 176x144, 320x240 */ |
| ibmcam_veio(uvd, 0, 0x00a0, 0x0103); /* Same on 176x144, 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0078, 0x0105); /* Same on 176x144, 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x010a); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0024, 0x010b); /* Differs everywhere */ |
| ibmcam_veio(uvd, 0, 0x00a9, 0x0119); |
| ibmcam_veio(uvd, 0, 0x0016, 0x011b); |
| ibmcam_veio(uvd, 0, 0x0002, 0x011d); /* Same on 176x144, 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0003, 0x011e); /* Same on 176x144, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x0129); /* Same */ |
| ibmcam_veio(uvd, 0, 0x00fc, 0x012b); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0018, 0x0102); |
| ibmcam_veio(uvd, 0, 0x0004, 0x0104); |
| ibmcam_veio(uvd, 0, 0x0004, 0x011a); |
| ibmcam_veio(uvd, 0, 0x0028, 0x011c); |
| ibmcam_veio(uvd, 0, 0x0022, 0x012a); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x0118); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0132); |
| ibmcam_model3_Packet1(uvd, 0x0021, 0x0001); /* Same */ |
| ibmcam_veio(uvd, 0, compression, 0x0109); |
| break; |
| case VIDEOSIZE_320x240: |
| ibmcam_veio(uvd, 0, 0x0000, 0x0101); /* Same on 176x144, 320x240 */ |
| ibmcam_veio(uvd, 0, 0x00a0, 0x0103); /* Same on 176x144, 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0078, 0x0105); /* Same on 176x144, 320x240 */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x010a); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0028, 0x010b); /* Differs everywhere */ |
| ibmcam_veio(uvd, 0, 0x0002, 0x011d); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x011e); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0129); /* Same */ |
| ibmcam_veio(uvd, 0, 0x00fc, 0x012b); /* Same */ |
| /* 4 commands from 160x120 skipped */ |
| ibmcam_veio(uvd, 0, 0x0022, 0x012a); /* Same */ |
| ibmcam_model3_Packet1(uvd, 0x0021, 0x0001); /* Same */ |
| ibmcam_veio(uvd, 0, compression, 0x0109); |
| ibmcam_veio(uvd, 0, 0x00d9, 0x0119); |
| ibmcam_veio(uvd, 0, 0x0006, 0x011b); |
| ibmcam_veio(uvd, 0, 0x0021, 0x0102); /* Same on 320x240, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x0010, 0x0104); |
| ibmcam_veio(uvd, 0, 0x0004, 0x011a); |
| ibmcam_veio(uvd, 0, 0x003f, 0x011c); |
| ibmcam_veio(uvd, 0, 0x001c, 0x0118); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0132); |
| break; |
| case VIDEOSIZE_640x480: |
| ibmcam_veio(uvd, 0, 0x00f0, 0x0105); |
| ibmcam_veio(uvd, 0, 0x0000, 0x010a); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0038, 0x010b); /* Differs everywhere */ |
| ibmcam_veio(uvd, 0, 0x00d9, 0x0119); /* Same on 320x240, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x0006, 0x011b); /* Same on 320x240, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x0004, 0x011d); /* NC */ |
| ibmcam_veio(uvd, 0, 0x0003, 0x011e); /* Same on 176x144, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x0000, 0x0129); /* Same */ |
| ibmcam_veio(uvd, 0, 0x00fc, 0x012b); /* Same */ |
| ibmcam_veio(uvd, 0, 0x0021, 0x0102); /* Same on 320x240, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x0016, 0x0104); /* NC */ |
| ibmcam_veio(uvd, 0, 0x0004, 0x011a); /* Same on 320x240, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x003f, 0x011c); /* Same on 320x240, 640x480 */ |
| ibmcam_veio(uvd, 0, 0x0022, 0x012a); /* Same */ |
| ibmcam_veio(uvd, 0, 0x001c, 0x0118); /* Same on 320x240, 640x480 */ |
| ibmcam_model3_Packet1(uvd, 0x0021, 0x0001); /* Same */ |
| ibmcam_veio(uvd, 0, compression, 0x0109); |
| ibmcam_veio(uvd, 0, 0x0040, 0x0101); |
| ibmcam_veio(uvd, 0, 0x0040, 0x0103); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0132); /* Same on 320x240, 640x480 */ |
| break; |
| } |
| ibmcam_model3_Packet1(uvd, 0x007e, 0x000e); /* Hue */ |
| ibmcam_model3_Packet1(uvd, 0x0036, 0x0011); /* Brightness */ |
| ibmcam_model3_Packet1(uvd, 0x0060, 0x0002); /* Sharpness */ |
| ibmcam_model3_Packet1(uvd, 0x0061, 0x0004); /* Sharpness */ |
| ibmcam_model3_Packet1(uvd, 0x0062, 0x0005); /* Sharpness */ |
| ibmcam_model3_Packet1(uvd, 0x0063, 0x0014); /* Sharpness */ |
| ibmcam_model3_Packet1(uvd, 0x0096, 0x00a0); /* Red gain */ |
| ibmcam_model3_Packet1(uvd, 0x0097, 0x0096); /* Blue gain */ |
| ibmcam_model3_Packet1(uvd, 0x0067, 0x0001); /* Contrast */ |
| ibmcam_model3_Packet1(uvd, 0x005b, 0x000c); /* Contrast */ |
| ibmcam_model3_Packet1(uvd, 0x005c, 0x0016); /* Contrast */ |
| ibmcam_model3_Packet1(uvd, 0x0098, 0x000b); |
| ibmcam_model3_Packet1(uvd, 0x002c, 0x0003); /* Was 1, broke 640x480 */ |
| ibmcam_model3_Packet1(uvd, 0x002f, 0x002a); |
| ibmcam_model3_Packet1(uvd, 0x0030, 0x0029); |
| ibmcam_model3_Packet1(uvd, 0x0037, 0x0002); |
| ibmcam_model3_Packet1(uvd, 0x0038, 0x0059); |
| ibmcam_model3_Packet1(uvd, 0x003d, 0x002e); |
| ibmcam_model3_Packet1(uvd, 0x003e, 0x0028); |
| ibmcam_model3_Packet1(uvd, 0x0078, 0x0005); |
| ibmcam_model3_Packet1(uvd, 0x007b, 0x0011); |
| ibmcam_model3_Packet1(uvd, 0x007d, 0x004b); |
| ibmcam_model3_Packet1(uvd, 0x007f, 0x0022); |
| ibmcam_model3_Packet1(uvd, 0x0080, 0x000c); |
| ibmcam_model3_Packet1(uvd, 0x0081, 0x000b); |
| ibmcam_model3_Packet1(uvd, 0x0083, 0x00fd); |
| ibmcam_model3_Packet1(uvd, 0x0086, 0x000b); |
| ibmcam_model3_Packet1(uvd, 0x0087, 0x000b); |
| ibmcam_model3_Packet1(uvd, 0x007e, 0x000e); |
| ibmcam_model3_Packet1(uvd, 0x0096, 0x00a0); /* Red gain */ |
| ibmcam_model3_Packet1(uvd, 0x0097, 0x0096); /* Blue gain */ |
| ibmcam_model3_Packet1(uvd, 0x0098, 0x000b); |
| |
| switch (uvd->videosize) { |
| case VIDEOSIZE_160x120: |
| ibmcam_veio(uvd, 0, 0x0002, 0x0106); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0107); |
| ibmcam_veio(uvd, 0, f_rate, 0x0111); /* Frame rate */ |
| ibmcam_model3_Packet1(uvd, 0x001f, 0x0000); /* Same */ |
| ibmcam_model3_Packet1(uvd, 0x0039, 0x001f); /* Same */ |
| ibmcam_model3_Packet1(uvd, 0x003b, 0x003c); /* Same */ |
| ibmcam_model3_Packet1(uvd, 0x0040, 0x000a); |
| ibmcam_model3_Packet1(uvd, 0x0051, 0x000a); |
| break; |
| case VIDEOSIZE_320x240: |
| ibmcam_veio(uvd, 0, 0x0003, 0x0106); |
| ibmcam_veio(uvd, 0, 0x0062, 0x0107); |
| ibmcam_veio(uvd, 0, f_rate, 0x0111); /* Frame rate */ |
| ibmcam_model3_Packet1(uvd, 0x001f, 0x0000); /* Same */ |
| ibmcam_model3_Packet1(uvd, 0x0039, 0x001f); /* Same */ |
| ibmcam_model3_Packet1(uvd, 0x003b, 0x003c); /* Same */ |
| ibmcam_model3_Packet1(uvd, 0x0040, 0x0008); |
| ibmcam_model3_Packet1(uvd, 0x0051, 0x000b); |
| break; |
| case VIDEOSIZE_640x480: |
| ibmcam_veio(uvd, 0, 0x0002, 0x0106); /* Adjustments */ |
| ibmcam_veio(uvd, 0, 0x00b4, 0x0107); /* Adjustments */ |
| ibmcam_veio(uvd, 0, f_rate, 0x0111); /* Frame rate */ |
| ibmcam_model3_Packet1(uvd, 0x001f, 0x0002); /* !Same */ |
| ibmcam_model3_Packet1(uvd, 0x0039, 0x003e); /* !Same */ |
| ibmcam_model3_Packet1(uvd, 0x0040, 0x0008); |
| ibmcam_model3_Packet1(uvd, 0x0051, 0x000a); |
| break; |
| } |
| |
| /* 01.01.08 - Added for RCA video in support -LO */ |
| if(init_model3_input) { |
| if (debug > 0) |
| info("Setting input to RCA."); |
| for (i=0; i < (sizeof(initData)/sizeof(initData[0])); i++) { |
| ibmcam_veio(uvd, initData[i].req, initData[i].value, initData[i].index); |
| } |
| } |
| |
| ibmcam_veio(uvd, 0, 0x0001, 0x0114); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| } |
| |
| /* |
| * ibmcam_video_stop() |
| * |
| * This code tells camera to stop streaming. The interface remains |
| * configured and bandwidth - claimed. |
| */ |
| static void ibmcam_video_stop(struct uvd *uvd) |
| { |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_1: |
| ibmcam_veio(uvd, 0, 0x00, 0x010c); |
| ibmcam_veio(uvd, 0, 0x00, 0x010c); |
| ibmcam_veio(uvd, 0, 0x01, 0x0114); |
| ibmcam_veio(uvd, 0, 0xc0, 0x010c); |
| ibmcam_veio(uvd, 0, 0x00, 0x010c); |
| ibmcam_send_FF_04_02(uvd); |
| ibmcam_veio(uvd, 1, 0x00, 0x0100); |
| ibmcam_veio(uvd, 0, 0x81, 0x0100); /* LED Off */ |
| break; |
| case IBMCAM_MODEL_2: |
| case IBMCAM_MODEL_4: |
| ibmcam_veio(uvd, 0, 0x0000, 0x010c); /* Stop the camera */ |
| |
| ibmcam_model2_Packet1(uvd, 0x0030, 0x0004); |
| |
| ibmcam_veio(uvd, 0, 0x0080, 0x0100); /* LED Off */ |
| ibmcam_veio(uvd, 0, 0x0020, 0x0111); |
| ibmcam_veio(uvd, 0, 0x00a0, 0x0111); |
| |
| ibmcam_model2_Packet1(uvd, 0x0030, 0x0002); |
| |
| ibmcam_veio(uvd, 0, 0x0020, 0x0111); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0112); |
| break; |
| case IBMCAM_MODEL_3: |
| #if 1 |
| ibmcam_veio(uvd, 0, 0x0000, 0x010c); |
| |
| /* Here we are supposed to select video interface alt. setting 0 */ |
| ibmcam_veio(uvd, 0, 0x0006, 0x012c); |
| |
| ibmcam_model3_Packet1(uvd, 0x0046, 0x0000); |
| |
| ibmcam_veio(uvd, 1, 0x0000, 0x0116); |
| ibmcam_veio(uvd, 0, 0x0064, 0x0116); |
| ibmcam_veio(uvd, 1, 0x0000, 0x0115); |
| ibmcam_veio(uvd, 0, 0x0003, 0x0115); |
| ibmcam_veio(uvd, 0, 0x0008, 0x0123); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0117); |
| ibmcam_veio(uvd, 0, 0x0000, 0x0112); |
| ibmcam_veio(uvd, 0, 0x0080, 0x0100); |
| IBMCAM_T(uvd)->initialized = 0; |
| #endif |
| break; |
| } /* switch */ |
| } |
| |
| /* |
| * ibmcam_reinit_iso() |
| * |
| * This procedure sends couple of commands to the camera and then |
| * resets the video pipe. This sequence was observed to reinit the |
| * camera or, at least, to initiate ISO data stream. |
| * |
| * History: |
| * 1/2/00 Created. |
| */ |
| static void ibmcam_reinit_iso(struct uvd *uvd, int do_stop) |
| { |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_1: |
| if (do_stop) |
| ibmcam_video_stop(uvd); |
| ibmcam_veio(uvd, 0, 0x0001, 0x0114); |
| ibmcam_veio(uvd, 0, 0x00c0, 0x010c); |
| usb_clear_halt(uvd->dev, usb_rcvisocpipe(uvd->dev, uvd->video_endp)); |
| ibmcam_model1_setup_after_video_if(uvd); |
| break; |
| case IBMCAM_MODEL_2: |
| ibmcam_model2_setup_after_video_if(uvd); |
| break; |
| case IBMCAM_MODEL_3: |
| ibmcam_video_stop(uvd); |
| ibmcam_model3_setup_after_video_if(uvd); |
| break; |
| case IBMCAM_MODEL_4: |
| ibmcam_model4_setup_after_video_if(uvd); |
| break; |
| } |
| } |
| |
| static void ibmcam_video_start(struct uvd *uvd) |
| { |
| ibmcam_change_lighting_conditions(uvd); |
| ibmcam_set_sharpness(uvd); |
| ibmcam_reinit_iso(uvd, 0); |
| } |
| |
| /* |
| * Return negative code on failure, 0 on success. |
| */ |
| static int ibmcam_setup_on_open(struct uvd *uvd) |
| { |
| int setup_ok = 0; /* Success by default */ |
| /* Send init sequence only once, it's large! */ |
| if (!IBMCAM_T(uvd)->initialized) { /* FIXME rename */ |
| switch (IBMCAM_T(uvd)->camera_model) { |
| case IBMCAM_MODEL_1: |
| setup_ok = ibmcam_model1_setup(uvd); |
| break; |
| case IBMCAM_MODEL_2: |
| setup_ok = ibmcam_model2_setup(uvd); |
| break; |
| case IBMCAM_MODEL_3: |
| case IBMCAM_MODEL_4: |
| /* We do all setup when Isoc stream is requested */ |
| break; |
| } |
| IBMCAM_T(uvd)->initialized = (setup_ok != 0); |
| } |
| return setup_ok; |
| } |
| |
| static void ibmcam_configure_video(struct uvd *uvd) |
| { |
| if (uvd == NULL) |
| return; |
| |
| RESTRICT_TO_RANGE(init_brightness, 0, 255); |
| RESTRICT_TO_RANGE(init_contrast, 0, 255); |
| RESTRICT_TO_RANGE(init_color, 0, 255); |
| RESTRICT_TO_RANGE(init_hue, 0, 255); |
| RESTRICT_TO_RANGE(hue_correction, 0, 255); |
| |
| memset(&uvd->vpic, 0, sizeof(uvd->vpic)); |
| memset(&uvd->vpic_old, 0x55, sizeof(uvd->vpic_old)); |
| |
| uvd->vpic.colour = init_color << 8; |
| uvd->vpic.hue = init_hue << 8; |
| uvd->vpic.brightness = init_brightness << 8; |
| uvd->vpic.contrast = init_contrast << 8; |
| uvd->vpic.whiteness = 105 << 8; /* This one isn't used */ |
| uvd->vpic.depth = 24; |
| uvd->vpic.palette = VIDEO_PALETTE_RGB24; |
| |
| memset(&uvd->vcap, 0, sizeof(uvd->vcap)); |
| strcpy(uvd->vcap.name, "IBM USB Camera"); |
| uvd->vcap.type = VID_TYPE_CAPTURE; |
| uvd->vcap.channels = 1; |
| uvd->vcap.audios = 0; |
| uvd->vcap.maxwidth = VIDEOSIZE_X(uvd->canvas); |
| uvd->vcap.maxheight = VIDEOSIZE_Y(uvd->canvas); |
| uvd->vcap.minwidth = min_canvasWidth; |
| uvd->vcap.minheight = min_canvasHeight; |
| |
| memset(&uvd->vchan, 0, sizeof(uvd->vchan)); |
| uvd->vchan.flags = 0; |
| uvd->vchan.tuners = 0; |
| uvd->vchan.channel = 0; |
| uvd->vchan.type = VIDEO_TYPE_CAMERA; |
| strcpy(uvd->vchan.name, "Camera"); |
| } |
| |
| /* |
| * ibmcam_probe() |
| * |
| * This procedure queries device descriptor and accepts the interface |
| * if it looks like IBM C-it camera. |
| * |
| * History: |
| * 22-Jan-2000 Moved camera init code to ibmcam_open() |
| * 27=Jan-2000 Changed to use static structures, added locking. |
| * 24-May-2000 Corrected to prevent race condition (MOD_xxx_USE_COUNT). |
| * 03-Jul-2000 Fixed endianness bug. |
| * 12-Nov-2000 Reworked to comply with new probe() signature. |
| * 23-Jan-2001 Added compatibility with 2.2.x kernels. |
| */ |
| static void *ibmcam_probe(struct usb_device *dev, unsigned int ifnum, const struct usb_device_id *devid) |
| { |
| struct uvd *uvd = NULL; |
| int i, nas, model=0, canvasX=0, canvasY=0; |
| int actInterface=-1, inactInterface=-1, maxPS=0; |
| unsigned char video_ep = 0; |
| |
| if (debug >= 1) |
| info("ibmcam_probe(%p,%u.)", dev, ifnum); |
| |
| /* We don't handle multi-config cameras */ |
| if (dev->descriptor.bNumConfigurations != 1) |
| return NULL; |
| |
| /* Is it an IBM camera? */ |
| if (dev->descriptor.idVendor != IBMCAM_VENDOR_ID) |
| return NULL; |
| if ((dev->descriptor.idProduct != IBMCAM_PRODUCT_ID) && |
| (dev->descriptor.idProduct != VEO_800C_PRODUCT_ID) && |
| (dev->descriptor.idProduct != VEO_800D_PRODUCT_ID) && |
| (dev->descriptor.idProduct != NETCAM_PRODUCT_ID)) |
| return NULL; |
| |
| /* Check the version/revision */ |
| switch (dev->descriptor.bcdDevice) { |
| case 0x0002: |
| if (ifnum != 2) |
| return NULL; |
| model = IBMCAM_MODEL_1; |
| break; |
| case 0x030A: |
| if (ifnum != 0) |
| return NULL; |
| if ((dev->descriptor.idProduct == NETCAM_PRODUCT_ID) || |
| (dev->descriptor.idProduct == VEO_800D_PRODUCT_ID)) |
| model = IBMCAM_MODEL_4; |
| else |
| model = IBMCAM_MODEL_2; |
| break; |
| case 0x0301: |
| if (ifnum != 0) |
| return NULL; |
| model = IBMCAM_MODEL_3; |
| break; |
| default: |
| err("IBM camera with revision 0x%04x is not supported.", |
| dev->descriptor.bcdDevice); |
| return NULL; |
| } |
| |
| /* Print detailed info on what we found so far */ |
| do { |
| char *brand = NULL; |
| switch (dev->descriptor.idProduct) { |
| case NETCAM_PRODUCT_ID: |
| brand = "IBM NetCamera"; |
| break; |
| case VEO_800C_PRODUCT_ID: |
| brand = "Veo Stingray [800C]"; |
| break; |
| case VEO_800D_PRODUCT_ID: |
| brand = "Veo Stingray [800D]"; |
| break; |
| case IBMCAM_PRODUCT_ID: |
| default: |
| brand = "IBM PC Camera"; /* a.k.a. Xirlink C-It */ |
| break; |
| } |
| info("%s USB camera found (model %d, rev. 0x%04x)", |
| brand, model, dev->descriptor.bcdDevice); |
| } while (0); |
| |
| /* Validate found interface: must have one ISO endpoint */ |
| nas = dev->actconfig->interface[ifnum].num_altsetting; |
| if (debug > 0) |
| info("Number of alternate settings=%d.", nas); |
| if (nas < 2) { |
| err("Too few alternate settings for this camera!"); |
| return NULL; |
| } |
| /* Validate all alternate settings */ |
| for (i=0; i < nas; i++) { |
| const struct usb_interface_descriptor *interface; |
| const struct usb_endpoint_descriptor *endpoint; |
| |
| interface = &dev->actconfig->interface[ifnum].altsetting[i]; |
| if (interface->bNumEndpoints != 1) { |
| err("Interface %d. has %u. endpoints!", |
| ifnum, (unsigned)(interface->bNumEndpoints)); |
| return NULL; |
| } |
| endpoint = &interface->endpoint[0]; |
| if (video_ep == 0) |
| video_ep = endpoint->bEndpointAddress; |
| else if (video_ep != endpoint->bEndpointAddress) { |
| err("Alternate settings have different endpoint addresses!"); |
| return NULL; |
| } |
| if ((endpoint->bmAttributes & 0x03) != 0x01) { |
| err("Interface %d. has non-ISO endpoint!", ifnum); |
| return NULL; |
| } |
| if ((endpoint->bEndpointAddress & 0x80) == 0) { |
| err("Interface %d. has ISO OUT endpoint!", ifnum); |
| return NULL; |
| } |
| if (endpoint->wMaxPacketSize == 0) { |
| if (inactInterface < 0) |
| inactInterface = i; |
| else { |
| err("More than one inactive alt. setting!"); |
| return NULL; |
| } |
| } else { |
| if (actInterface < 0) { |
| actInterface = i; |
| maxPS = endpoint->wMaxPacketSize; |
| if (debug > 0) |
| info("Active setting=%d. maxPS=%d.", i, maxPS); |
| } else |
| err("More than one active alt. setting! Ignoring #%d.", i); |
| } |
| } |
| if ((maxPS <= 0) || (actInterface < 0) || (inactInterface < 0)) { |
| err("Failed to recognize the camera!"); |
| return NULL; |
| } |
| |
| /* Validate options */ |
| switch (model) { |
| case IBMCAM_MODEL_1: |
| RESTRICT_TO_RANGE(lighting, 0, 2); |
| RESTRICT_TO_RANGE(size, SIZE_128x96, SIZE_352x288); |
| if (framerate < 0) |
| framerate = 2; |
| canvasX = 352; |
| canvasY = 288; |
| break; |
| case IBMCAM_MODEL_2: |
| RESTRICT_TO_RANGE(lighting, 0, 15); |
| RESTRICT_TO_RANGE(size, SIZE_176x144, SIZE_352x240); |
| if (framerate < 0) |
| framerate = 2; |
| canvasX = 352; |
| canvasY = 240; |
| break; |
| case IBMCAM_MODEL_3: |
| RESTRICT_TO_RANGE(lighting, 0, 15); /* FIXME */ |
| switch (size) { |
| case SIZE_160x120: |
| canvasX = 160; |
| canvasY = 120; |
| if (framerate < 0) |
| framerate = 2; |
| RESTRICT_TO_RANGE(framerate, 0, 5); |
| break; |
| default: |
| info("IBM camera: using 320x240"); |
| size = SIZE_320x240; |
| /* No break here */ |
| case SIZE_320x240: |
| canvasX = 320; |
| canvasY = 240; |
| if (framerate < 0) |
| framerate = 3; |
| RESTRICT_TO_RANGE(framerate, 0, 5); |
| break; |
| case SIZE_640x480: |
| canvasX = 640; |
| canvasY = 480; |
| framerate = 0; /* Slowest, and maybe even that is too fast */ |
| break; |
| } |
| break; |
| case IBMCAM_MODEL_4: |
| RESTRICT_TO_RANGE(lighting, 0, 2); |
| switch (size) { |
| case SIZE_128x96: |
| canvasX = 128; |
| canvasY = 96; |
| break; |
| case SIZE_160x120: |
| canvasX = 160; |
| canvasY = 120; |
| break; |
| default: |
| info("IBM NetCamera: using 176x144"); |
| size = SIZE_176x144; |
| /* No break here */ |
| case SIZE_176x144: |
| canvasX = 176; |
| canvasY = 144; |
| break; |
| case SIZE_320x240: |
| canvasX = 320; |
| canvasY = 240; |
| break; |
| case SIZE_352x288: |
| canvasX = 352; |
| canvasY = 288; |
| break; |
| } |
| break; |
| default: |
| err("IBM camera: Model %d. not supported!", model); |
| return NULL; |
| } |
| |
| /* Code below may sleep, need to lock module while we are here */ |
| MOD_INC_USE_COUNT; |
| uvd = usbvideo_AllocateDevice(cams); |
| if (uvd != NULL) { |
| /* Here uvd is a fully allocated uvd object */ |
| uvd->flags = flags; |
| uvd->debug = debug; |
| uvd->dev = dev; |
| uvd->iface = ifnum; |
| uvd->ifaceAltInactive = inactInterface; |
| uvd->ifaceAltActive = actInterface; |
| uvd->video_endp = video_ep; |
| uvd->iso_packet_len = maxPS; |
| uvd->paletteBits = 1L << VIDEO_PALETTE_RGB24; |
| uvd->defaultPalette = VIDEO_PALETTE_RGB24; |
| uvd->canvas = VIDEOSIZE(canvasX, canvasY); |
| uvd->videosize = ibmcam_size_to_videosize(size); |
| |
| /* Initialize ibmcam-specific data */ |
| assert(IBMCAM_T(uvd) != NULL); |
| IBMCAM_T(uvd)->camera_model = model; |
| IBMCAM_T(uvd)->initialized = 0; |
| |
| ibmcam_configure_video(uvd); |
| |
| i = usbvideo_RegisterVideoDevice(uvd); |
| if (i != 0) { |
| err("usbvideo_RegisterVideoDevice() failed."); |
| uvd = NULL; |
| } |
| } |
| MOD_DEC_USE_COUNT; |
| return uvd; |
| } |
| |
| |
| static struct usb_device_id id_table[] = { |
| { USB_DEVICE_VER(IBMCAM_VENDOR_ID, IBMCAM_PRODUCT_ID, 0x0002, 0x0002) }, /* Model 1 */ |
| { USB_DEVICE_VER(IBMCAM_VENDOR_ID, IBMCAM_PRODUCT_ID, 0x030a, 0x030a) }, /* Model 2 */ |
| { USB_DEVICE_VER(IBMCAM_VENDOR_ID, IBMCAM_PRODUCT_ID, 0x0301, 0x0301) }, /* Model 3 */ |
| { USB_DEVICE_VER(IBMCAM_VENDOR_ID, NETCAM_PRODUCT_ID, 0x030a, 0x030a) }, /* Model 4 */ |
| { USB_DEVICE_VER(IBMCAM_VENDOR_ID, VEO_800C_PRODUCT_ID, 0x030a, 0x030a) }, /* Model 2 */ |
| { USB_DEVICE_VER(IBMCAM_VENDOR_ID, VEO_800D_PRODUCT_ID, 0x030a, 0x030a) }, /* Model 4 */ |
| { } /* Terminating entry */ |
| }; |
| |
| /* |
| * ibmcam_init() |
| * |
| * This code is run to initialize the driver. |
| * |
| * History: |
| * 1/27/00 Reworked to use statically allocated ibmcam structures. |
| * 21/10/00 Completely redesigned to use usbvideo services. |
| */ |
| static int __init ibmcam_init(void) |
| { |
| struct usbvideo_cb cbTbl; |
| memset(&cbTbl, 0, sizeof(cbTbl)); |
| cbTbl.probe = ibmcam_probe; |
| cbTbl.setupOnOpen = ibmcam_setup_on_open; |
| cbTbl.videoStart = ibmcam_video_start; |
| cbTbl.videoStop = ibmcam_video_stop; |
| cbTbl.processData = ibmcam_ProcessIsocData; |
| cbTbl.postProcess = usbvideo_DeinterlaceFrame; |
| cbTbl.adjustPicture = ibmcam_adjust_picture; |
| cbTbl.getFPS = ibmcam_calculate_fps; |
| return usbvideo_register( |
| &cams, |
| MAX_IBMCAM, |
| sizeof(ibmcam_t), |
| "ibmcam", |
| &cbTbl, |
| THIS_MODULE, |
| id_table); |
| } |
| |
| static void __exit ibmcam_cleanup(void) |
| { |
| usbvideo_Deregister(&cams); |
| } |
| |
| MODULE_DEVICE_TABLE(usb, id_table); |
| |
| module_init(ibmcam_init); |
| module_exit(ibmcam_cleanup); |
