spca561-decompress.c

trident tm5600的linux驱动

		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 5, 5, 5, 5, 5, 5, 5, 5,
		    5, 5,
		5, 5, 5, 5, 5,
		5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 4, 4, 4,
		    4, 4,
		4, 4, 4, 4, 4,
		4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
		    4, 4,
		4, 4, 4, 4, 4,
		4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
		    4, 4,
		4, 4, 4, 4, 4,
		3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
		    3, 3,
		3, 3, 3, 3, 3,
		3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
		    3, 3,
		3, 3, 3, 3, 3,
		3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
		    3, 3,
		3, 3, 3, 3, 3,
		3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
		    3, 3,
		3, 3, 3, 3, 3,
		3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3
	};
	const int tab_D[] =
	    { 0xff, 0xfe, 0xfd, 0xfc, 10, -11, 11, -12, 8, 8, -9, -9, 9, 9,
		-10, -10, 6, 6, 6, 6, -7, -7, -7, -7, 7, 7, 7, 7, -8, -8,
		    -8, -8,
		4, 4, 4, 4,
		4, 4, 4, 4, -5, -5, -5, -5, -5, -5, -5, -5, 5, 5, 5, 5, 5,
		    5, 5, 5,
		-6, -6,
		-6, -6, -6, -6, -6, -6, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
		    2, 2,
		2, 2, -3,
		-3, -3, -3, -3, -3, -3, -3, -3, -3, -3, -3, -3, -3, -3, -3,
		    3, 3,
		3, 3, 3, 3,
		3, 3, 3, 3, 3, 3, 3, 3, 3, 3, -4, -4, -4, -4, -4, -4, -4,
		    -4, -4,
		-4, -4, -4,
		-4, -4, -4, -4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0, 0,
		0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, -1, -1, -1, -1, -1,
		    -1, -1,
		-1, -1, -1,
		-1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
		    -1, -1,
		-1, -1,
		-1, -1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
		    1, 1, 1,
		1, 1, 1,
		1, 1, 1, 1, 1, 1, 1, 1, 1, -2, -2, -2, -2, -2, -2, -2, -2,
		    -2, -2,
		-2, -2, -2,
		-2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2,
		    -2, -2,
		-2, -2
	};

	/* a_curve[19 + i] = ... [-19..19] => [-160..160] */
	const int a_curve[] =
	    { -160, -144, -128, -112, -98, -88, -80, -72, -64, -56, -48,
		-40, -32, -24, -18, -12, -8, -5, -2, 0, 2, 5, 8, 12, 18,
		    24, 32,
		40, 48, 56, 64,
		72, 80, 88, 98, 112, 128, 144, 160
	};
	/* clamp0_255[256 + i] = min(max(i,255),0) */
	const unsigned char clamp0_255[] =
	    { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0,
		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
		    1, 2,
		3, 4, 5, 6, 7, 8, 9, 10,
		11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25,
		    26, 27,
		28, 29, 30, 31, 32, 33,
		34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48,
		    49, 50,
		51, 52, 53, 54, 55, 56,
		57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71,
		    72, 73,
		74, 75, 76, 77, 78, 79,
		80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94,
		    95, 96,
		97, 98, 99, 100, 101,
		102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113,
		    114,
		115, 116, 117, 118, 119,
		120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131,
		    132,
		133, 134, 135, 136, 137,
		138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149,
		    150,
		151, 152, 153, 154, 155,
		156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167,
		    168,
		169, 170, 171, 172, 173,
		174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185,
		    186,
		187, 188, 189, 190, 191,
		192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203,
		    204,
		205, 206, 207, 208, 209,
		210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221,
		    222,
		223, 224, 225, 226, 227,
		228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239,
		    240,
		241, 242, 243, 244, 245,
		246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255, 255, 255, 255, 255,
		255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
		    255,
		255
	};
	/* abs_clamp15[19 + i] = min(abs(i), 15) */
	const int abs_clamp15[] =
	    { 15, 15, 15, 15, 15, 14, 13, 12, 11, 10, 9, 8, 7, 6, 5, 4, 3,
		2, 1, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
		    15, 15,
		15
	};
	/* diff_encoding[256 + i] = ... */
	const int diff_encoding[] =
	    { 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		    7, 7,
		7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		    7, 7,
		7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		    7, 7,
		7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		    7, 7,
		7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		    7, 7,
		7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		    7, 7,
		7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
		    7, 7,
		7, 7, 7, 7, 7, 7, 7,
		7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 5, 5, 5, 5, 5, 5, 5,
		    5, 5,
		5, 5, 5, 5, 5, 3, 3,
		3, 3, 1, 1, 0, 2, 2, 4, 4, 4, 4, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6, 6,
		6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
		    6, 6,
		6, 6, 6, 6, 6, 6
	};

	int block;
	int bitfill = 0;
	int xwidth = width + 6;
	int off_up_right = 2 - 2 * xwidth;
	int off_up_left = -2 - 2 * xwidth;
	int pixel_U = 0, saved_pixel_UR = 0;
	int pixel_x = 0, pixel_y = 2;
	unsigned char *output_ptr = outbuf;

	memset(i_hits, 0, sizeof(i_hits));
	memset(accum, 0, sizeof(accum));

	memcpy(outbuf + xwidth * 2 + 3, inbuf + 0x14, width);
	memcpy(outbuf + xwidth * 3 + 3, inbuf + 0x14 + width, width);

	input_ptr = inbuf + 0x14 + width * 2;
	output_ptr = outbuf + (xwidth) * 4 + 3;

	bit_bucket = 0;

	for (block = 0; block < ((height - 2) * width) / 32; ++block) {
		int b_it, var_7 = 0;
		int cur_byte;

		refill(&bitfill);

		cur_byte = (bit_bucket >> (bitfill & 7)) & 0xff;

		if ((cur_byte & 0x80) == 0) {
			var_7 = 0;
			bitfill--;
		} else if ((cur_byte & 0xC0) == 0x80) {
			var_7 = 1;
			bitfill -= 2;
		} else if ((cur_byte & 0xc0) == 0xc0) {
			var_7 = 2;
			bitfill -= 2;
		}

		for (b_it = 0; b_it < 32; b_it++) {
			int index;
			int pixel_L, pixel_UR, pixel_UL;
			int multiplier;
			int dL, dC, dR;
			int gkw;	/* God knows what */

			refill(&bitfill);
			cur_byte = bit_bucket >> (bitfill & 7) & 0xff;

			pixel_L = output_ptr[-2];
			pixel_UR = output_ptr[off_up_right];
			pixel_UL = output_ptr[off_up_left];

			dL = diff_encoding[0x100 + pixel_UL - pixel_L];
			dC = diff_encoding[0x100 + pixel_U - pixel_UL];
			dR = diff_encoding[0x100 + pixel_UR - pixel_U];

			if (pixel_x < 2) {
				pixel_L = pixel_UL = pixel_U =
				    output_ptr[-xwidth * 2];
				pixel_UR = output_ptr[off_up_right];
				dL = dC = 0;
				dR = diff_encoding[0x100 + pixel_UR -
						   pixel_U];
			} else if (pixel_x > width - 3)
				dR = 0;

			multiplier = 4;
			index = dR + dC * 8 + dL * 64;

			if (pixel_L + pixel_U * 2 <= 144
			    && (pixel_y & 1) == 0
			    && (b_it & 3) == 0 && (dR < 5) && (dC < 5)
			    && (dL < 5)) {
				multiplier = 1;
			} else if (pixel_L <= 48
				   && dL <= 4 && dC <= 4 && dL >= 1
				   && dC >= 1) {
				multiplier = 2;
			} else if (var_7 == 1) {
				multiplier = 2;
			} else if (dC + dL >= 11 || var_7 == 2) {
				multiplier = 8;
			}

			if (i_hits[index] < 7) {
				bitfill -= nbits_A[cur_byte];
				gkw = tab_A[cur_byte];
				if (gkw == 0xfe)
					gkw = fun_A(&bitfill);
			} else if (i_hits[index] >= accum[index]) {
				bitfill -= nbits_B[cur_byte];
				gkw = tab_B[cur_byte];
				if (cur_byte == 0)
					gkw = fun_B(&bitfill);
			} else if (i_hits[index] * 2 >= accum[index]) {
				bitfill -= nbits_C[cur_byte];
				gkw = tab_C[cur_byte];
				if (cur_byte < 2)
					gkw = fun_C(&bitfill, gkw);
			} else if (i_hits[index] * 4 >= accum[index]) {
				bitfill -= nbits_D[cur_byte];
				gkw = tab_D[cur_byte];
				if (cur_byte < 4)
					gkw = fun_D(&bitfill, gkw);
			} else if (i_hits[index] * 8 >= accum[index]) {
				gkw = fun_E(cur_byte, &bitfill);
			} else {
				gkw = fun_F(cur_byte, &bitfill);
			}

			if (gkw == 0xff)
				return -3;

			{
				int tmp1, tmp2;

				tmp1 =
				    (pixel_U + pixel_L) * 3 - pixel_UL * 2;
				tmp1 += (tmp1 < 0) ? 3 : 0;
				tmp2 = a_curve[19 + gkw] * multiplier;
				tmp2 += (tmp2 < 0) ? 1 : 0;

				*(output_ptr++) =
				    clamp0_255[0x100 + (tmp1 >> 2) -
					       (tmp2 >> 1)];
			}
			pixel_U = saved_pixel_UR;
			saved_pixel_UR = pixel_UR;

			if (++pixel_x == width) {
				output_ptr += 6;
				pixel_x = 0;
				pixel_y++;
			}

			accum[index] += abs_clamp15[19 + gkw];

			if (i_hits[index]++ == 15) {
				i_hits[index] = 8;
				accum[index] /= 2;
			}
		}
	}
	return 0;
}

/* FIXME, change internal_spca561_decode not to need the extra border
   around its dest buffer */
void v4lconvert_decode_spca561(const unsigned char *inbuf,
  unsigned char *outbuf, int width, int height)
{
	int i;
	static unsigned char tmpbuf[650 * 490];
	if (internal_spca561_decode(width, height, inbuf, tmpbuf) != 0)
		return;
	for (i = 0; i < height; i++)
		memcpy(outbuf + i * width,
		       tmpbuf + (i + 2) * (width + 6) + 3, width);
}

/*************** License Change Permission Notice ***************

Return-Path: <[e-mail]>
Received: from koko.hhs.nl ([145.52.2.16] verified)
  by hhs.nl (CommuniGate Pro SMTP 4.3.6)
  with ESMTP id 88574071 for [e-mail]; Mon, 16 Jun 2008 16:36:24 +0200
Received: from exim (helo=koko)
	by koko.hhs.nl with local-smtp (Exim 4.62)
	(envelope-from <[e-mail]>)
	id 1K8Fom-0002iJ-3K
	for [e-mail]; Mon, 16 Jun 2008 16:36:24 +0200
Received: from [192.87.102.74] (port=41377 helo=filter6-ams.mf.surf.net)
	by koko.hhs.nl with esmtp (Exim 4.62)
	(envelope-from <[e-mail]>)
	id 1K8Fol-0002iC-Qo
	for [e-mail]; Mon, 16 Jun 2008 16:36:23 +0200
Received: from kuku.eu.org (pa90.wielkopole.sdi.tpnet.pl [217.99.123.90])
	by filter6-ams.mf.surf.net (8.13.8/8.13.8/Debian-3) with ESMTP id m5GEa55r001787
	for <[e-mail]>; Mon, 16 Jun 2008 16:36:06 +0200
Received: (qmail 2243 invoked by uid 500); 16 Jun 2008 14:29:37 -0000
Date: Mon, 16 Jun 2008 16:29:37 +0200 (CEST)
From: Andrzej Szombierski <[e-mail]>
To: Hans de Goede <[e-mail]>
Subject: Re: spca561 decoder license question
In-Reply-To: <[e-mail]>
Message-ID: <[e-mail]>
References: <[e-mail]>
MIME-Version: 1.0
Content-Type: TEXT/PLAIN; charset=iso-8859-2
Content-Transfer-Encoding: QUOTED-PRINTABLE
X-Canit-CHI2: 0.00
X-Bayes-Prob: 0.0001 (Score 0, tokens from: @@RPTN)
X-Spam-Score: 2.00 (**) [Tag at 6.00] RBL(uceprotect-blacklist.surfnet.nl,2.0)
X-CanItPRO-Stream: hhs:[e-mail] (inherits from hhs:default,base:default)
X-Canit-Stats-ID: 85673281 - 37e52c8b07bc
X-Scanned-By: CanIt (www . roaringpenguin . com) on 192.87.102.74
X-Anti-Virus: Kaspersky Anti-Virus for MailServers 5.5.2/RELEASE, bases: 16062008 #776409, status: clean

On Mon, 16 Jun 2008, Hans de Goede wrote:

> Hi,
>=20
> I don't know if you're still subscribed to the spca devel mailing list, s=
o let=20
> me start with a short intro.
>
> I'm a Linux enthusiast / developer currently helping Jean-Fran=E7ois Moin=
e with=20
> porting gspca to video4linux2 and cleaning up the code to get it ready fo=
r=20
> mainline kernel inclusion.
>=20
> As part of this process the decompression code for all supported cams mus=
t be=20
> moved to userspace, as doing in kernel decompression is considered unwant=
ed by=20
> the mainline people (I agree) as it should be done in userspace.
>

Sounds reasonable.
=20
> As such I'm working on a library which does decompression of custom cam f=
ormats=20
> in userspace.
>

Nice. I hope that the library won't be limited to spca-supported webcams,=
=20
and as an application developer I would be able to just request RGB data=20
from any /dev/video*, right?

> I do not want to license this library as GPL (as the current spca code is=
), as=20
> it should be usable by as much software as possible. Instead I want to li=
cense=20
> it under the LGPL version 2.1 or later.

Also sounds reasonable.

>=20
> So my question us my I have your permission to relicense your spca561=20
> decompression code under the LGPL?
>=20

Yes, of course.=20

> Thanks & Regards,
>=20
> Hans
>=20
>

--=20
:: Andrzej Szombierski :: [e-mail] :: http://kuku.eu.org ::
:: [e-mail]  :: radio bez kitu :: http://bezkitu.com ::

*/