10c0d06caSMauro Carvalho Chehab /* Linux driver for Philips webcam 20c0d06caSMauro Carvalho Chehab Decompression for chipset version 2 et 3 30c0d06caSMauro Carvalho Chehab (C) 2004-2006 Luc Saillard (luc@saillard.org) 40c0d06caSMauro Carvalho Chehab 50c0d06caSMauro Carvalho Chehab NOTE: this version of pwc is an unofficial (modified) release of pwc & pcwx 60c0d06caSMauro Carvalho Chehab driver and thus may have bugs that are not present in the original version. 70c0d06caSMauro Carvalho Chehab Please send bug reports and support requests to <luc@saillard.org>. 80c0d06caSMauro Carvalho Chehab The decompression routines have been implemented by reverse-engineering the 90c0d06caSMauro Carvalho Chehab Nemosoft binary pwcx module. Caveat emptor. 100c0d06caSMauro Carvalho Chehab 110c0d06caSMauro Carvalho Chehab This program is free software; you can redistribute it and/or modify 120c0d06caSMauro Carvalho Chehab it under the terms of the GNU General Public License as published by 130c0d06caSMauro Carvalho Chehab the Free Software Foundation; either version 2 of the License, or 140c0d06caSMauro Carvalho Chehab (at your option) any later version. 150c0d06caSMauro Carvalho Chehab 160c0d06caSMauro Carvalho Chehab This program is distributed in the hope that it will be useful, 170c0d06caSMauro Carvalho Chehab but WITHOUT ANY WARRANTY; without even the implied warranty of 180c0d06caSMauro Carvalho Chehab MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 190c0d06caSMauro Carvalho Chehab GNU General Public License for more details. 200c0d06caSMauro Carvalho Chehab 210c0d06caSMauro Carvalho Chehab You should have received a copy of the GNU General Public License 220c0d06caSMauro Carvalho Chehab along with this program; if not, write to the Free Software 230c0d06caSMauro Carvalho Chehab Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 240c0d06caSMauro Carvalho Chehab 250c0d06caSMauro Carvalho Chehab */ 260c0d06caSMauro Carvalho Chehab 270c0d06caSMauro Carvalho Chehab #include "pwc-timon.h" 280c0d06caSMauro Carvalho Chehab #include "pwc-kiara.h" 290c0d06caSMauro Carvalho Chehab #include "pwc-dec23.h" 300c0d06caSMauro Carvalho Chehab 310c0d06caSMauro Carvalho Chehab #include <linux/string.h> 320c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 330c0d06caSMauro Carvalho Chehab 340c0d06caSMauro Carvalho Chehab /* 350c0d06caSMauro Carvalho Chehab * USE_LOOKUP_TABLE_TO_CLAMP 360c0d06caSMauro Carvalho Chehab * 0: use a C version of this tests: { a<0?0:(a>255?255:a) } 370c0d06caSMauro Carvalho Chehab * 1: use a faster lookup table for cpu with a big cache (intel) 380c0d06caSMauro Carvalho Chehab */ 390c0d06caSMauro Carvalho Chehab #define USE_LOOKUP_TABLE_TO_CLAMP 1 400c0d06caSMauro Carvalho Chehab /* 410c0d06caSMauro Carvalho Chehab * UNROLL_LOOP_FOR_COPYING_BLOCK 420c0d06caSMauro Carvalho Chehab * 0: use a loop for a smaller code (but little slower) 430c0d06caSMauro Carvalho Chehab * 1: when unrolling the loop, gcc produces some faster code (perhaps only 443e4d8f48SMauro Carvalho Chehab * valid for intel processor class). Activating this option, automatically 450c0d06caSMauro Carvalho Chehab * activate USE_LOOKUP_TABLE_TO_CLAMP 460c0d06caSMauro Carvalho Chehab */ 470c0d06caSMauro Carvalho Chehab #define UNROLL_LOOP_FOR_COPY 1 480c0d06caSMauro Carvalho Chehab #if UNROLL_LOOP_FOR_COPY 490c0d06caSMauro Carvalho Chehab # undef USE_LOOKUP_TABLE_TO_CLAMP 500c0d06caSMauro Carvalho Chehab # define USE_LOOKUP_TABLE_TO_CLAMP 1 510c0d06caSMauro Carvalho Chehab #endif 520c0d06caSMauro Carvalho Chehab 530c0d06caSMauro Carvalho Chehab static void build_subblock_pattern(struct pwc_dec23_private *pdec) 540c0d06caSMauro Carvalho Chehab { 550c0d06caSMauro Carvalho Chehab static const unsigned int initial_values[12] = { 560c0d06caSMauro Carvalho Chehab -0x526500, -0x221200, 0x221200, 0x526500, 570c0d06caSMauro Carvalho Chehab -0x3de200, 0x3de200, 580c0d06caSMauro Carvalho Chehab -0x6db480, -0x2d5d00, 0x2d5d00, 0x6db480, 590c0d06caSMauro Carvalho Chehab -0x12c200, 0x12c200 600c0d06caSMauro Carvalho Chehab 610c0d06caSMauro Carvalho Chehab }; 620c0d06caSMauro Carvalho Chehab static const unsigned int values_derivated[12] = { 630c0d06caSMauro Carvalho Chehab 0xa4ca, 0x4424, -0x4424, -0xa4ca, 640c0d06caSMauro Carvalho Chehab 0x7bc4, -0x7bc4, 650c0d06caSMauro Carvalho Chehab 0xdb69, 0x5aba, -0x5aba, -0xdb69, 660c0d06caSMauro Carvalho Chehab 0x2584, -0x2584 670c0d06caSMauro Carvalho Chehab }; 680c0d06caSMauro Carvalho Chehab unsigned int temp_values[12]; 690c0d06caSMauro Carvalho Chehab int i, j; 700c0d06caSMauro Carvalho Chehab 710c0d06caSMauro Carvalho Chehab memcpy(temp_values, initial_values, sizeof(initial_values)); 720c0d06caSMauro Carvalho Chehab for (i = 0; i < 256; i++) { 730c0d06caSMauro Carvalho Chehab for (j = 0; j < 12; j++) { 740c0d06caSMauro Carvalho Chehab pdec->table_subblock[i][j] = temp_values[j]; 750c0d06caSMauro Carvalho Chehab temp_values[j] += values_derivated[j]; 760c0d06caSMauro Carvalho Chehab } 770c0d06caSMauro Carvalho Chehab } 780c0d06caSMauro Carvalho Chehab } 790c0d06caSMauro Carvalho Chehab 800c0d06caSMauro Carvalho Chehab static void build_bit_powermask_table(struct pwc_dec23_private *pdec) 810c0d06caSMauro Carvalho Chehab { 820c0d06caSMauro Carvalho Chehab unsigned char *p; 830c0d06caSMauro Carvalho Chehab unsigned int bit, byte, mask, val; 840c0d06caSMauro Carvalho Chehab unsigned int bitpower = 1; 850c0d06caSMauro Carvalho Chehab 860c0d06caSMauro Carvalho Chehab for (bit = 0; bit < 8; bit++) { 870c0d06caSMauro Carvalho Chehab mask = bitpower - 1; 880c0d06caSMauro Carvalho Chehab p = pdec->table_bitpowermask[bit]; 890c0d06caSMauro Carvalho Chehab for (byte = 0; byte < 256; byte++) { 900c0d06caSMauro Carvalho Chehab val = (byte & mask); 910c0d06caSMauro Carvalho Chehab if (byte & bitpower) 920c0d06caSMauro Carvalho Chehab val = -val; 930c0d06caSMauro Carvalho Chehab *p++ = val; 940c0d06caSMauro Carvalho Chehab } 950c0d06caSMauro Carvalho Chehab bitpower<<=1; 960c0d06caSMauro Carvalho Chehab } 970c0d06caSMauro Carvalho Chehab } 980c0d06caSMauro Carvalho Chehab 990c0d06caSMauro Carvalho Chehab 1000c0d06caSMauro Carvalho Chehab static void build_table_color(const unsigned int romtable[16][8], 1010c0d06caSMauro Carvalho Chehab unsigned char p0004[16][1024], 1020c0d06caSMauro Carvalho Chehab unsigned char p8004[16][256]) 1030c0d06caSMauro Carvalho Chehab { 1040c0d06caSMauro Carvalho Chehab int compression_mode, j, k, bit, pw; 1050c0d06caSMauro Carvalho Chehab unsigned char *p0, *p8; 1060c0d06caSMauro Carvalho Chehab const unsigned int *r; 1070c0d06caSMauro Carvalho Chehab 1080c0d06caSMauro Carvalho Chehab /* We have 16 compressions tables */ 1090c0d06caSMauro Carvalho Chehab for (compression_mode = 0; compression_mode < 16; compression_mode++) { 1100c0d06caSMauro Carvalho Chehab p0 = p0004[compression_mode]; 1110c0d06caSMauro Carvalho Chehab p8 = p8004[compression_mode]; 1120c0d06caSMauro Carvalho Chehab r = romtable[compression_mode]; 1130c0d06caSMauro Carvalho Chehab 1140c0d06caSMauro Carvalho Chehab for (j = 0; j < 8; j++, r++, p0 += 128) { 1150c0d06caSMauro Carvalho Chehab 1160c0d06caSMauro Carvalho Chehab for (k = 0; k < 16; k++) { 1170c0d06caSMauro Carvalho Chehab if (k == 0) 1180c0d06caSMauro Carvalho Chehab bit = 1; 1190c0d06caSMauro Carvalho Chehab else if (k >= 1 && k < 3) 1200c0d06caSMauro Carvalho Chehab bit = (r[0] >> 15) & 7; 1210c0d06caSMauro Carvalho Chehab else if (k >= 3 && k < 6) 1220c0d06caSMauro Carvalho Chehab bit = (r[0] >> 12) & 7; 1230c0d06caSMauro Carvalho Chehab else if (k >= 6 && k < 10) 1240c0d06caSMauro Carvalho Chehab bit = (r[0] >> 9) & 7; 1250c0d06caSMauro Carvalho Chehab else if (k >= 10 && k < 13) 1260c0d06caSMauro Carvalho Chehab bit = (r[0] >> 6) & 7; 1270c0d06caSMauro Carvalho Chehab else if (k >= 13 && k < 15) 1280c0d06caSMauro Carvalho Chehab bit = (r[0] >> 3) & 7; 1290c0d06caSMauro Carvalho Chehab else 1300c0d06caSMauro Carvalho Chehab bit = (r[0]) & 7; 1310c0d06caSMauro Carvalho Chehab if (k == 0) 1320c0d06caSMauro Carvalho Chehab *p8++ = 8; 1330c0d06caSMauro Carvalho Chehab else 1340c0d06caSMauro Carvalho Chehab *p8++ = j - bit; 1350c0d06caSMauro Carvalho Chehab *p8++ = bit; 1360c0d06caSMauro Carvalho Chehab 1370c0d06caSMauro Carvalho Chehab pw = 1 << bit; 1380c0d06caSMauro Carvalho Chehab p0[k + 0x00] = (1 * pw) + 0x80; 1390c0d06caSMauro Carvalho Chehab p0[k + 0x10] = (2 * pw) + 0x80; 1400c0d06caSMauro Carvalho Chehab p0[k + 0x20] = (3 * pw) + 0x80; 1410c0d06caSMauro Carvalho Chehab p0[k + 0x30] = (4 * pw) + 0x80; 1420c0d06caSMauro Carvalho Chehab p0[k + 0x40] = (-1 * pw) + 0x80; 1430c0d06caSMauro Carvalho Chehab p0[k + 0x50] = (-2 * pw) + 0x80; 1440c0d06caSMauro Carvalho Chehab p0[k + 0x60] = (-3 * pw) + 0x80; 1450c0d06caSMauro Carvalho Chehab p0[k + 0x70] = (-4 * pw) + 0x80; 1460c0d06caSMauro Carvalho Chehab } /* end of for (k=0; k<16; k++, p8++) */ 1470c0d06caSMauro Carvalho Chehab } /* end of for (j=0; j<8; j++ , table++) */ 1480c0d06caSMauro Carvalho Chehab } /* end of foreach compression_mode */ 1490c0d06caSMauro Carvalho Chehab } 1500c0d06caSMauro Carvalho Chehab 1510c0d06caSMauro Carvalho Chehab /* 1520c0d06caSMauro Carvalho Chehab * 1530c0d06caSMauro Carvalho Chehab */ 1540c0d06caSMauro Carvalho Chehab static void fill_table_dc00_d800(struct pwc_dec23_private *pdec) 1550c0d06caSMauro Carvalho Chehab { 1560c0d06caSMauro Carvalho Chehab #define SCALEBITS 15 1570c0d06caSMauro Carvalho Chehab #define ONE_HALF (1UL << (SCALEBITS - 1)) 1580c0d06caSMauro Carvalho Chehab int i; 1590c0d06caSMauro Carvalho Chehab unsigned int offset1 = ONE_HALF; 1600c0d06caSMauro Carvalho Chehab unsigned int offset2 = 0x0000; 1610c0d06caSMauro Carvalho Chehab 1620c0d06caSMauro Carvalho Chehab for (i=0; i<256; i++) { 1630c0d06caSMauro Carvalho Chehab pdec->table_dc00[i] = offset1 & ~(ONE_HALF); 1640c0d06caSMauro Carvalho Chehab pdec->table_d800[i] = offset2; 1650c0d06caSMauro Carvalho Chehab 1660c0d06caSMauro Carvalho Chehab offset1 += 0x7bc4; 1670c0d06caSMauro Carvalho Chehab offset2 += 0x7bc4; 1680c0d06caSMauro Carvalho Chehab } 1690c0d06caSMauro Carvalho Chehab } 1700c0d06caSMauro Carvalho Chehab 1710c0d06caSMauro Carvalho Chehab /* 1720c0d06caSMauro Carvalho Chehab * To decode the stream: 1730c0d06caSMauro Carvalho Chehab * if look_bits(2) == 0: # op == 2 in the lookup table 1740c0d06caSMauro Carvalho Chehab * skip_bits(2) 1750c0d06caSMauro Carvalho Chehab * end of the stream 1760c0d06caSMauro Carvalho Chehab * elif look_bits(3) == 7: # op == 1 in the lookup table 1770c0d06caSMauro Carvalho Chehab * skip_bits(3) 1780c0d06caSMauro Carvalho Chehab * yyyy = get_bits(4) 1790c0d06caSMauro Carvalho Chehab * xxxx = get_bits(8) 1800c0d06caSMauro Carvalho Chehab * else: # op == 0 in the lookup table 1810c0d06caSMauro Carvalho Chehab * skip_bits(x) 1820c0d06caSMauro Carvalho Chehab * 1830c0d06caSMauro Carvalho Chehab * For speedup processing, we build a lookup table and we takes the first 6 bits. 1840c0d06caSMauro Carvalho Chehab * 1850c0d06caSMauro Carvalho Chehab * struct { 1860c0d06caSMauro Carvalho Chehab * unsigned char op; // operation to execute 1870c0d06caSMauro Carvalho Chehab * unsigned char bits; // bits use to perform operation 1880c0d06caSMauro Carvalho Chehab * unsigned char offset1; // offset to add to access in the table_0004 % 16 1890c0d06caSMauro Carvalho Chehab * unsigned char offset2; // offset to add to access in the table_0004 1900c0d06caSMauro Carvalho Chehab * } 1910c0d06caSMauro Carvalho Chehab * 1920c0d06caSMauro Carvalho Chehab * How to build this table ? 1930c0d06caSMauro Carvalho Chehab * op == 2 when (i%4)==0 1940c0d06caSMauro Carvalho Chehab * op == 1 when (i%8)==7 1950c0d06caSMauro Carvalho Chehab * op == 0 otherwise 1960c0d06caSMauro Carvalho Chehab * 1970c0d06caSMauro Carvalho Chehab */ 1980c0d06caSMauro Carvalho Chehab static const unsigned char hash_table_ops[64*4] = { 1990c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2000c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2010c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x10, 2020c0d06caSMauro Carvalho Chehab 0x00, 0x06, 0x01, 0x30, 2030c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2040c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2050c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x01, 0x20, 2060c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00, 2070c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2080c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2090c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x50, 2100c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x02, 0x00, 2110c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2120c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2130c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x03, 0x00, 2140c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00, 2150c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2160c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2170c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x10, 2180c0d06caSMauro Carvalho Chehab 0x00, 0x06, 0x02, 0x10, 2190c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2200c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2210c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x01, 0x60, 2220c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00, 2230c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2240c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2250c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x50, 2260c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x02, 0x40, 2270c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2280c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2290c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x03, 0x40, 2300c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00, 2310c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2320c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2330c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x10, 2340c0d06caSMauro Carvalho Chehab 0x00, 0x06, 0x01, 0x70, 2350c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2360c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2370c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x01, 0x20, 2380c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00, 2390c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2400c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2410c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x50, 2420c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x02, 0x00, 2430c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2440c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2450c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x03, 0x00, 2460c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00, 2470c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2480c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2490c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x10, 2500c0d06caSMauro Carvalho Chehab 0x00, 0x06, 0x02, 0x50, 2510c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2520c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2530c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x01, 0x60, 2540c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00, 2550c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2560c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x00, 2570c0d06caSMauro Carvalho Chehab 0x00, 0x04, 0x01, 0x50, 2580c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x02, 0x40, 2590c0d06caSMauro Carvalho Chehab 0x02, 0x00, 0x00, 0x00, 2600c0d06caSMauro Carvalho Chehab 0x00, 0x03, 0x01, 0x40, 2610c0d06caSMauro Carvalho Chehab 0x00, 0x05, 0x03, 0x40, 2620c0d06caSMauro Carvalho Chehab 0x01, 0x00, 0x00, 0x00 2630c0d06caSMauro Carvalho Chehab }; 2640c0d06caSMauro Carvalho Chehab 2650c0d06caSMauro Carvalho Chehab /* 2660c0d06caSMauro Carvalho Chehab * 2670c0d06caSMauro Carvalho Chehab */ 2680c0d06caSMauro Carvalho Chehab static const unsigned int MulIdx[16][16] = { 2690c0d06caSMauro Carvalho Chehab {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,}, 2700c0d06caSMauro Carvalho Chehab {0, 1, 2, 3, 0, 1, 2, 3, 0, 1, 2, 3, 0, 1, 2, 3,}, 2710c0d06caSMauro Carvalho Chehab {0, 0, 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3,}, 2720c0d06caSMauro Carvalho Chehab {4, 4, 4, 4, 5, 5, 5, 5, 5, 5, 5, 5, 4, 4, 4, 4,}, 2730c0d06caSMauro Carvalho Chehab {6, 7, 8, 9, 7, 10, 11, 8, 8, 11, 10, 7, 9, 8, 7, 6,}, 2740c0d06caSMauro Carvalho Chehab {4, 5, 5, 4, 4, 5, 5, 4, 4, 5, 5, 4, 4, 5, 5, 4,}, 2750c0d06caSMauro Carvalho Chehab {1, 3, 0, 2, 1, 3, 0, 2, 1, 3, 0, 2, 1, 3, 0, 2,}, 2760c0d06caSMauro Carvalho Chehab {0, 3, 3, 0, 1, 2, 2, 1, 2, 1, 1, 2, 3, 0, 0, 3,}, 2770c0d06caSMauro Carvalho Chehab {0, 1, 2, 3, 3, 2, 1, 0, 3, 2, 1, 0, 0, 1, 2, 3,}, 2780c0d06caSMauro Carvalho Chehab {1, 1, 1, 1, 3, 3, 3, 3, 0, 0, 0, 0, 2, 2, 2, 2,}, 2790c0d06caSMauro Carvalho Chehab {7, 10, 11, 8, 9, 8, 7, 6, 6, 7, 8, 9, 8, 11, 10, 7,}, 2800c0d06caSMauro Carvalho Chehab {4, 5, 5, 4, 5, 4, 4, 5, 5, 4, 4, 5, 4, 5, 5, 4,}, 2810c0d06caSMauro Carvalho Chehab {7, 9, 6, 8, 10, 8, 7, 11, 11, 7, 8, 10, 8, 6, 9, 7,}, 2820c0d06caSMauro Carvalho Chehab {1, 3, 0, 2, 2, 0, 3, 1, 2, 0, 3, 1, 1, 3, 0, 2,}, 2830c0d06caSMauro Carvalho Chehab {1, 2, 2, 1, 3, 0, 0, 3, 0, 3, 3, 0, 2, 1, 1, 2,}, 2840c0d06caSMauro Carvalho Chehab {10, 8, 7, 11, 8, 6, 9, 7, 7, 9, 6, 8, 11, 7, 8, 10} 2850c0d06caSMauro Carvalho Chehab }; 2860c0d06caSMauro Carvalho Chehab 2870c0d06caSMauro Carvalho Chehab #if USE_LOOKUP_TABLE_TO_CLAMP 2880c0d06caSMauro Carvalho Chehab #define MAX_OUTER_CROP_VALUE (512) 2890c0d06caSMauro Carvalho Chehab static unsigned char pwc_crop_table[256 + 2*MAX_OUTER_CROP_VALUE]; 2900c0d06caSMauro Carvalho Chehab #define CLAMP(x) (pwc_crop_table[MAX_OUTER_CROP_VALUE+(x)]) 2910c0d06caSMauro Carvalho Chehab #else 2920c0d06caSMauro Carvalho Chehab #define CLAMP(x) ((x)>255?255:((x)<0?0:x)) 2930c0d06caSMauro Carvalho Chehab #endif 2940c0d06caSMauro Carvalho Chehab 2950c0d06caSMauro Carvalho Chehab 2960c0d06caSMauro Carvalho Chehab /* If the type or the command change, we rebuild the lookup table */ 2970c0d06caSMauro Carvalho Chehab void pwc_dec23_init(struct pwc_device *pdev, const unsigned char *cmd) 2980c0d06caSMauro Carvalho Chehab { 2990c0d06caSMauro Carvalho Chehab int flags, version, shift, i; 3000c0d06caSMauro Carvalho Chehab struct pwc_dec23_private *pdec = &pdev->dec23; 3010c0d06caSMauro Carvalho Chehab 3020c0d06caSMauro Carvalho Chehab mutex_init(&pdec->lock); 3030c0d06caSMauro Carvalho Chehab 3040c0d06caSMauro Carvalho Chehab if (pdec->last_cmd_valid && pdec->last_cmd == cmd[2]) 3050c0d06caSMauro Carvalho Chehab return; 3060c0d06caSMauro Carvalho Chehab 3070c0d06caSMauro Carvalho Chehab if (DEVICE_USE_CODEC3(pdev->type)) { 3080c0d06caSMauro Carvalho Chehab flags = cmd[2] & 0x18; 3090c0d06caSMauro Carvalho Chehab if (flags == 8) 3100c0d06caSMauro Carvalho Chehab pdec->nbits = 7; /* More bits, mean more bits to encode the stream, but better quality */ 3110c0d06caSMauro Carvalho Chehab else if (flags == 0x10) 3120c0d06caSMauro Carvalho Chehab pdec->nbits = 8; 3130c0d06caSMauro Carvalho Chehab else 3140c0d06caSMauro Carvalho Chehab pdec->nbits = 6; 3150c0d06caSMauro Carvalho Chehab 3160c0d06caSMauro Carvalho Chehab version = cmd[2] >> 5; 3170c0d06caSMauro Carvalho Chehab build_table_color(KiaraRomTable[version][0], pdec->table_0004_pass1, pdec->table_8004_pass1); 3180c0d06caSMauro Carvalho Chehab build_table_color(KiaraRomTable[version][1], pdec->table_0004_pass2, pdec->table_8004_pass2); 3190c0d06caSMauro Carvalho Chehab 3200c0d06caSMauro Carvalho Chehab } else { 3210c0d06caSMauro Carvalho Chehab 3220c0d06caSMauro Carvalho Chehab flags = cmd[2] & 6; 3230c0d06caSMauro Carvalho Chehab if (flags == 2) 3240c0d06caSMauro Carvalho Chehab pdec->nbits = 7; 3250c0d06caSMauro Carvalho Chehab else if (flags == 4) 3260c0d06caSMauro Carvalho Chehab pdec->nbits = 8; 3270c0d06caSMauro Carvalho Chehab else 3280c0d06caSMauro Carvalho Chehab pdec->nbits = 6; 3290c0d06caSMauro Carvalho Chehab 3300c0d06caSMauro Carvalho Chehab version = cmd[2] >> 3; 3310c0d06caSMauro Carvalho Chehab build_table_color(TimonRomTable[version][0], pdec->table_0004_pass1, pdec->table_8004_pass1); 3320c0d06caSMauro Carvalho Chehab build_table_color(TimonRomTable[version][1], pdec->table_0004_pass2, pdec->table_8004_pass2); 3330c0d06caSMauro Carvalho Chehab } 3340c0d06caSMauro Carvalho Chehab 3353e4d8f48SMauro Carvalho Chehab /* Information can be coded on a variable number of bits but never less than 8 */ 3360c0d06caSMauro Carvalho Chehab shift = 8 - pdec->nbits; 3370c0d06caSMauro Carvalho Chehab pdec->scalebits = SCALEBITS - shift; 3380c0d06caSMauro Carvalho Chehab pdec->nbitsmask = 0xFF >> shift; 3390c0d06caSMauro Carvalho Chehab 3400c0d06caSMauro Carvalho Chehab fill_table_dc00_d800(pdec); 3410c0d06caSMauro Carvalho Chehab build_subblock_pattern(pdec); 3420c0d06caSMauro Carvalho Chehab build_bit_powermask_table(pdec); 3430c0d06caSMauro Carvalho Chehab 3440c0d06caSMauro Carvalho Chehab #if USE_LOOKUP_TABLE_TO_CLAMP 3450c0d06caSMauro Carvalho Chehab /* Build the static table to clamp value [0-255] */ 3460c0d06caSMauro Carvalho Chehab for (i=0;i<MAX_OUTER_CROP_VALUE;i++) 3470c0d06caSMauro Carvalho Chehab pwc_crop_table[i] = 0; 3480c0d06caSMauro Carvalho Chehab for (i=0; i<256; i++) 3490c0d06caSMauro Carvalho Chehab pwc_crop_table[MAX_OUTER_CROP_VALUE+i] = i; 3500c0d06caSMauro Carvalho Chehab for (i=0; i<MAX_OUTER_CROP_VALUE; i++) 3510c0d06caSMauro Carvalho Chehab pwc_crop_table[MAX_OUTER_CROP_VALUE+256+i] = 255; 3520c0d06caSMauro Carvalho Chehab #endif 3530c0d06caSMauro Carvalho Chehab 3540c0d06caSMauro Carvalho Chehab pdec->last_cmd = cmd[2]; 3550c0d06caSMauro Carvalho Chehab pdec->last_cmd_valid = 1; 3560c0d06caSMauro Carvalho Chehab } 3570c0d06caSMauro Carvalho Chehab 3580c0d06caSMauro Carvalho Chehab /* 3590c0d06caSMauro Carvalho Chehab * Copy the 4x4 image block to Y plane buffer 3600c0d06caSMauro Carvalho Chehab */ 3610c0d06caSMauro Carvalho Chehab static void copy_image_block_Y(const int *src, unsigned char *dst, unsigned int bytes_per_line, unsigned int scalebits) 3620c0d06caSMauro Carvalho Chehab { 3630c0d06caSMauro Carvalho Chehab #if UNROLL_LOOP_FOR_COPY 3640c0d06caSMauro Carvalho Chehab const unsigned char *cm = pwc_crop_table+MAX_OUTER_CROP_VALUE; 3650c0d06caSMauro Carvalho Chehab const int *c = src; 3660c0d06caSMauro Carvalho Chehab unsigned char *d = dst; 3670c0d06caSMauro Carvalho Chehab 3680c0d06caSMauro Carvalho Chehab *d++ = cm[c[0] >> scalebits]; 3690c0d06caSMauro Carvalho Chehab *d++ = cm[c[1] >> scalebits]; 3700c0d06caSMauro Carvalho Chehab *d++ = cm[c[2] >> scalebits]; 3710c0d06caSMauro Carvalho Chehab *d++ = cm[c[3] >> scalebits]; 3720c0d06caSMauro Carvalho Chehab 3730c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line; 3740c0d06caSMauro Carvalho Chehab *d++ = cm[c[4] >> scalebits]; 3750c0d06caSMauro Carvalho Chehab *d++ = cm[c[5] >> scalebits]; 3760c0d06caSMauro Carvalho Chehab *d++ = cm[c[6] >> scalebits]; 3770c0d06caSMauro Carvalho Chehab *d++ = cm[c[7] >> scalebits]; 3780c0d06caSMauro Carvalho Chehab 3790c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line*2; 3800c0d06caSMauro Carvalho Chehab *d++ = cm[c[8] >> scalebits]; 3810c0d06caSMauro Carvalho Chehab *d++ = cm[c[9] >> scalebits]; 3820c0d06caSMauro Carvalho Chehab *d++ = cm[c[10] >> scalebits]; 3830c0d06caSMauro Carvalho Chehab *d++ = cm[c[11] >> scalebits]; 3840c0d06caSMauro Carvalho Chehab 3850c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line*3; 3860c0d06caSMauro Carvalho Chehab *d++ = cm[c[12] >> scalebits]; 3870c0d06caSMauro Carvalho Chehab *d++ = cm[c[13] >> scalebits]; 3880c0d06caSMauro Carvalho Chehab *d++ = cm[c[14] >> scalebits]; 3890c0d06caSMauro Carvalho Chehab *d++ = cm[c[15] >> scalebits]; 3900c0d06caSMauro Carvalho Chehab #else 3910c0d06caSMauro Carvalho Chehab int i; 3920c0d06caSMauro Carvalho Chehab const int *c = src; 3930c0d06caSMauro Carvalho Chehab unsigned char *d = dst; 3940c0d06caSMauro Carvalho Chehab for (i = 0; i < 4; i++, c++) 3950c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c) >> scalebits); 3960c0d06caSMauro Carvalho Chehab 3970c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line; 3980c0d06caSMauro Carvalho Chehab for (i = 0; i < 4; i++, c++) 3990c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c) >> scalebits); 4000c0d06caSMauro Carvalho Chehab 4010c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line*2; 4020c0d06caSMauro Carvalho Chehab for (i = 0; i < 4; i++, c++) 4030c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c) >> scalebits); 4040c0d06caSMauro Carvalho Chehab 4050c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line*3; 4060c0d06caSMauro Carvalho Chehab for (i = 0; i < 4; i++, c++) 4070c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c) >> scalebits); 4080c0d06caSMauro Carvalho Chehab #endif 4090c0d06caSMauro Carvalho Chehab } 4100c0d06caSMauro Carvalho Chehab 4110c0d06caSMauro Carvalho Chehab /* 4120c0d06caSMauro Carvalho Chehab * Copy the 4x4 image block to a CrCb plane buffer 4130c0d06caSMauro Carvalho Chehab * 4140c0d06caSMauro Carvalho Chehab */ 4150c0d06caSMauro Carvalho Chehab static void copy_image_block_CrCb(const int *src, unsigned char *dst, unsigned int bytes_per_line, unsigned int scalebits) 4160c0d06caSMauro Carvalho Chehab { 4170c0d06caSMauro Carvalho Chehab #if UNROLL_LOOP_FOR_COPY 4180c0d06caSMauro Carvalho Chehab /* Unroll all loops */ 4190c0d06caSMauro Carvalho Chehab const unsigned char *cm = pwc_crop_table+MAX_OUTER_CROP_VALUE; 4200c0d06caSMauro Carvalho Chehab const int *c = src; 4210c0d06caSMauro Carvalho Chehab unsigned char *d = dst; 4220c0d06caSMauro Carvalho Chehab 4230c0d06caSMauro Carvalho Chehab *d++ = cm[c[0] >> scalebits]; 4240c0d06caSMauro Carvalho Chehab *d++ = cm[c[4] >> scalebits]; 4250c0d06caSMauro Carvalho Chehab *d++ = cm[c[1] >> scalebits]; 4260c0d06caSMauro Carvalho Chehab *d++ = cm[c[5] >> scalebits]; 4270c0d06caSMauro Carvalho Chehab *d++ = cm[c[2] >> scalebits]; 4280c0d06caSMauro Carvalho Chehab *d++ = cm[c[6] >> scalebits]; 4290c0d06caSMauro Carvalho Chehab *d++ = cm[c[3] >> scalebits]; 4300c0d06caSMauro Carvalho Chehab *d++ = cm[c[7] >> scalebits]; 4310c0d06caSMauro Carvalho Chehab 4320c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line; 4330c0d06caSMauro Carvalho Chehab *d++ = cm[c[12] >> scalebits]; 4340c0d06caSMauro Carvalho Chehab *d++ = cm[c[8] >> scalebits]; 4350c0d06caSMauro Carvalho Chehab *d++ = cm[c[13] >> scalebits]; 4360c0d06caSMauro Carvalho Chehab *d++ = cm[c[9] >> scalebits]; 4370c0d06caSMauro Carvalho Chehab *d++ = cm[c[14] >> scalebits]; 4380c0d06caSMauro Carvalho Chehab *d++ = cm[c[10] >> scalebits]; 4390c0d06caSMauro Carvalho Chehab *d++ = cm[c[15] >> scalebits]; 4400c0d06caSMauro Carvalho Chehab *d++ = cm[c[11] >> scalebits]; 4410c0d06caSMauro Carvalho Chehab #else 4420c0d06caSMauro Carvalho Chehab int i; 4430c0d06caSMauro Carvalho Chehab const int *c1 = src; 4440c0d06caSMauro Carvalho Chehab const int *c2 = src + 4; 4450c0d06caSMauro Carvalho Chehab unsigned char *d = dst; 4460c0d06caSMauro Carvalho Chehab 4470c0d06caSMauro Carvalho Chehab for (i = 0; i < 4; i++, c1++, c2++) { 4480c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c1) >> scalebits); 4490c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c2) >> scalebits); 4500c0d06caSMauro Carvalho Chehab } 4510c0d06caSMauro Carvalho Chehab c1 = src + 12; 4520c0d06caSMauro Carvalho Chehab d = dst + bytes_per_line; 4530c0d06caSMauro Carvalho Chehab for (i = 0; i < 4; i++, c1++, c2++) { 4540c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c1) >> scalebits); 4550c0d06caSMauro Carvalho Chehab *d++ = CLAMP((*c2) >> scalebits); 4560c0d06caSMauro Carvalho Chehab } 4570c0d06caSMauro Carvalho Chehab #endif 4580c0d06caSMauro Carvalho Chehab } 4590c0d06caSMauro Carvalho Chehab 4600c0d06caSMauro Carvalho Chehab /* 4610c0d06caSMauro Carvalho Chehab * To manage the stream, we keep bits in a 32 bits register. 4620c0d06caSMauro Carvalho Chehab * fill_nbits(n): fill the reservoir with at least n bits 4630c0d06caSMauro Carvalho Chehab * skip_bits(n): discard n bits from the reservoir 4640c0d06caSMauro Carvalho Chehab * get_bits(n): fill the reservoir, returns the first n bits and discard the 4650c0d06caSMauro Carvalho Chehab * bits from the reservoir. 4660c0d06caSMauro Carvalho Chehab * __get_nbits(n): faster version of get_bits(n), but asumes that the reservoir 4670c0d06caSMauro Carvalho Chehab * contains at least n bits. bits returned is discarded. 4680c0d06caSMauro Carvalho Chehab */ 4690c0d06caSMauro Carvalho Chehab #define fill_nbits(pdec, nbits_wanted) do { \ 4700c0d06caSMauro Carvalho Chehab while (pdec->nbits_in_reservoir<(nbits_wanted)) \ 4710c0d06caSMauro Carvalho Chehab { \ 4720c0d06caSMauro Carvalho Chehab pdec->reservoir |= (*(pdec->stream)++) << (pdec->nbits_in_reservoir); \ 4730c0d06caSMauro Carvalho Chehab pdec->nbits_in_reservoir += 8; \ 4740c0d06caSMauro Carvalho Chehab } \ 4750c0d06caSMauro Carvalho Chehab } while(0); 4760c0d06caSMauro Carvalho Chehab 4770c0d06caSMauro Carvalho Chehab #define skip_nbits(pdec, nbits_to_skip) do { \ 4780c0d06caSMauro Carvalho Chehab pdec->reservoir >>= (nbits_to_skip); \ 4790c0d06caSMauro Carvalho Chehab pdec->nbits_in_reservoir -= (nbits_to_skip); \ 4800c0d06caSMauro Carvalho Chehab } while(0); 4810c0d06caSMauro Carvalho Chehab 4820c0d06caSMauro Carvalho Chehab #define get_nbits(pdec, nbits_wanted, result) do { \ 4830c0d06caSMauro Carvalho Chehab fill_nbits(pdec, nbits_wanted); \ 4840c0d06caSMauro Carvalho Chehab result = (pdec->reservoir) & ((1U<<(nbits_wanted))-1); \ 4850c0d06caSMauro Carvalho Chehab skip_nbits(pdec, nbits_wanted); \ 4860c0d06caSMauro Carvalho Chehab } while(0); 4870c0d06caSMauro Carvalho Chehab 4880c0d06caSMauro Carvalho Chehab #define __get_nbits(pdec, nbits_wanted, result) do { \ 4890c0d06caSMauro Carvalho Chehab result = (pdec->reservoir) & ((1U<<(nbits_wanted))-1); \ 4900c0d06caSMauro Carvalho Chehab skip_nbits(pdec, nbits_wanted); \ 4910c0d06caSMauro Carvalho Chehab } while(0); 4920c0d06caSMauro Carvalho Chehab 4930c0d06caSMauro Carvalho Chehab #define look_nbits(pdec, nbits_wanted) \ 4940c0d06caSMauro Carvalho Chehab ((pdec->reservoir) & ((1U<<(nbits_wanted))-1)) 4950c0d06caSMauro Carvalho Chehab 4960c0d06caSMauro Carvalho Chehab /* 4970c0d06caSMauro Carvalho Chehab * Decode a 4x4 pixel block 4980c0d06caSMauro Carvalho Chehab */ 4990c0d06caSMauro Carvalho Chehab static void decode_block(struct pwc_dec23_private *pdec, 5000c0d06caSMauro Carvalho Chehab const unsigned char *ptable0004, 5010c0d06caSMauro Carvalho Chehab const unsigned char *ptable8004) 5020c0d06caSMauro Carvalho Chehab { 5030c0d06caSMauro Carvalho Chehab unsigned int primary_color; 5040c0d06caSMauro Carvalho Chehab unsigned int channel_v, offset1, op; 5050c0d06caSMauro Carvalho Chehab int i; 5060c0d06caSMauro Carvalho Chehab 5070c0d06caSMauro Carvalho Chehab fill_nbits(pdec, 16); 5080c0d06caSMauro Carvalho Chehab __get_nbits(pdec, pdec->nbits, primary_color); 5090c0d06caSMauro Carvalho Chehab 5100c0d06caSMauro Carvalho Chehab if (look_nbits(pdec,2) == 0) { 5110c0d06caSMauro Carvalho Chehab skip_nbits(pdec, 2); 5120c0d06caSMauro Carvalho Chehab /* Very simple, the color is the same for all pixels of the square */ 5130c0d06caSMauro Carvalho Chehab for (i = 0; i < 16; i++) 5140c0d06caSMauro Carvalho Chehab pdec->temp_colors[i] = pdec->table_dc00[primary_color]; 5150c0d06caSMauro Carvalho Chehab 5160c0d06caSMauro Carvalho Chehab return; 5170c0d06caSMauro Carvalho Chehab } 5180c0d06caSMauro Carvalho Chehab 5190c0d06caSMauro Carvalho Chehab /* This block is encoded with small pattern */ 5200c0d06caSMauro Carvalho Chehab for (i = 0; i < 16; i++) 5210c0d06caSMauro Carvalho Chehab pdec->temp_colors[i] = pdec->table_d800[primary_color]; 5220c0d06caSMauro Carvalho Chehab 5230c0d06caSMauro Carvalho Chehab __get_nbits(pdec, 3, channel_v); 5240c0d06caSMauro Carvalho Chehab channel_v = ((channel_v & 1) << 2) | (channel_v & 2) | ((channel_v & 4) >> 2); 5250c0d06caSMauro Carvalho Chehab 5260c0d06caSMauro Carvalho Chehab ptable0004 += (channel_v * 128); 5270c0d06caSMauro Carvalho Chehab ptable8004 += (channel_v * 32); 5280c0d06caSMauro Carvalho Chehab 5290c0d06caSMauro Carvalho Chehab offset1 = 0; 5300c0d06caSMauro Carvalho Chehab do 5310c0d06caSMauro Carvalho Chehab { 5320c0d06caSMauro Carvalho Chehab unsigned int htable_idx, rows = 0; 5330c0d06caSMauro Carvalho Chehab const unsigned int *block; 5340c0d06caSMauro Carvalho Chehab 5350c0d06caSMauro Carvalho Chehab /* [ zzzz y x x ] 5360c0d06caSMauro Carvalho Chehab * xx == 00 :=> end of the block def, remove the two bits from the stream 5370c0d06caSMauro Carvalho Chehab * yxx == 111 5380c0d06caSMauro Carvalho Chehab * yxx == any other value 5390c0d06caSMauro Carvalho Chehab * 5400c0d06caSMauro Carvalho Chehab */ 5410c0d06caSMauro Carvalho Chehab fill_nbits(pdec, 16); 5420c0d06caSMauro Carvalho Chehab htable_idx = look_nbits(pdec, 6); 5430c0d06caSMauro Carvalho Chehab op = hash_table_ops[htable_idx * 4]; 5440c0d06caSMauro Carvalho Chehab 5450c0d06caSMauro Carvalho Chehab if (op == 2) { 5460c0d06caSMauro Carvalho Chehab skip_nbits(pdec, 2); 5470c0d06caSMauro Carvalho Chehab 5480c0d06caSMauro Carvalho Chehab } else if (op == 1) { 5490c0d06caSMauro Carvalho Chehab /* 15bits [ xxxx xxxx yyyy 111 ] 5500c0d06caSMauro Carvalho Chehab * yyy => offset in the table8004 5510c0d06caSMauro Carvalho Chehab * xxx => offset in the tabled004 (tree) 5520c0d06caSMauro Carvalho Chehab */ 5530c0d06caSMauro Carvalho Chehab unsigned int mask, shift; 5540c0d06caSMauro Carvalho Chehab unsigned int nbits, col1; 5550c0d06caSMauro Carvalho Chehab unsigned int yyyy; 5560c0d06caSMauro Carvalho Chehab 5570c0d06caSMauro Carvalho Chehab skip_nbits(pdec, 3); 5580c0d06caSMauro Carvalho Chehab /* offset1 += yyyy */ 5590c0d06caSMauro Carvalho Chehab __get_nbits(pdec, 4, yyyy); 5600c0d06caSMauro Carvalho Chehab offset1 += 1 + yyyy; 5610c0d06caSMauro Carvalho Chehab offset1 &= 0x0F; 5620c0d06caSMauro Carvalho Chehab nbits = ptable8004[offset1 * 2]; 5630c0d06caSMauro Carvalho Chehab 5640c0d06caSMauro Carvalho Chehab /* col1 = xxxx xxxx */ 5650c0d06caSMauro Carvalho Chehab __get_nbits(pdec, nbits+1, col1); 5660c0d06caSMauro Carvalho Chehab 5670c0d06caSMauro Carvalho Chehab /* Bit mask table */ 5680c0d06caSMauro Carvalho Chehab mask = pdec->table_bitpowermask[nbits][col1]; 5690c0d06caSMauro Carvalho Chehab shift = ptable8004[offset1 * 2 + 1]; 5700c0d06caSMauro Carvalho Chehab rows = ((mask << shift) + 0x80) & 0xFF; 5710c0d06caSMauro Carvalho Chehab 5720c0d06caSMauro Carvalho Chehab block = pdec->table_subblock[rows]; 5730c0d06caSMauro Carvalho Chehab for (i = 0; i < 16; i++) 5740c0d06caSMauro Carvalho Chehab pdec->temp_colors[i] += block[MulIdx[offset1][i]]; 5750c0d06caSMauro Carvalho Chehab 5760c0d06caSMauro Carvalho Chehab } else { 5770c0d06caSMauro Carvalho Chehab /* op == 0 5780c0d06caSMauro Carvalho Chehab * offset1 is coded on 3 bits 5790c0d06caSMauro Carvalho Chehab */ 5800c0d06caSMauro Carvalho Chehab unsigned int shift; 5810c0d06caSMauro Carvalho Chehab 5820c0d06caSMauro Carvalho Chehab offset1 += hash_table_ops [htable_idx * 4 + 2]; 5830c0d06caSMauro Carvalho Chehab offset1 &= 0x0F; 5840c0d06caSMauro Carvalho Chehab 5850c0d06caSMauro Carvalho Chehab rows = ptable0004[offset1 + hash_table_ops [htable_idx * 4 + 3]]; 5860c0d06caSMauro Carvalho Chehab block = pdec->table_subblock[rows]; 5870c0d06caSMauro Carvalho Chehab for (i = 0; i < 16; i++) 5880c0d06caSMauro Carvalho Chehab pdec->temp_colors[i] += block[MulIdx[offset1][i]]; 5890c0d06caSMauro Carvalho Chehab 5900c0d06caSMauro Carvalho Chehab shift = hash_table_ops[htable_idx * 4 + 1]; 5910c0d06caSMauro Carvalho Chehab skip_nbits(pdec, shift); 5920c0d06caSMauro Carvalho Chehab } 5930c0d06caSMauro Carvalho Chehab 5940c0d06caSMauro Carvalho Chehab } while (op != 2); 5950c0d06caSMauro Carvalho Chehab 5960c0d06caSMauro Carvalho Chehab } 5970c0d06caSMauro Carvalho Chehab 5980c0d06caSMauro Carvalho Chehab static void DecompressBand23(struct pwc_dec23_private *pdec, 5990c0d06caSMauro Carvalho Chehab const unsigned char *rawyuv, 6000c0d06caSMauro Carvalho Chehab unsigned char *planar_y, 6010c0d06caSMauro Carvalho Chehab unsigned char *planar_u, 6020c0d06caSMauro Carvalho Chehab unsigned char *planar_v, 6030c0d06caSMauro Carvalho Chehab unsigned int compressed_image_width, 6040c0d06caSMauro Carvalho Chehab unsigned int real_image_width) 6050c0d06caSMauro Carvalho Chehab { 6060c0d06caSMauro Carvalho Chehab int compression_index, nblocks; 6070c0d06caSMauro Carvalho Chehab const unsigned char *ptable0004; 6080c0d06caSMauro Carvalho Chehab const unsigned char *ptable8004; 6090c0d06caSMauro Carvalho Chehab 6100c0d06caSMauro Carvalho Chehab pdec->reservoir = 0; 6110c0d06caSMauro Carvalho Chehab pdec->nbits_in_reservoir = 0; 6120c0d06caSMauro Carvalho Chehab pdec->stream = rawyuv + 1; /* The first byte of the stream is skipped */ 6130c0d06caSMauro Carvalho Chehab 6140c0d06caSMauro Carvalho Chehab get_nbits(pdec, 4, compression_index); 6150c0d06caSMauro Carvalho Chehab 6160c0d06caSMauro Carvalho Chehab /* pass 1: uncompress Y component */ 6170c0d06caSMauro Carvalho Chehab nblocks = compressed_image_width / 4; 6180c0d06caSMauro Carvalho Chehab 6190c0d06caSMauro Carvalho Chehab ptable0004 = pdec->table_0004_pass1[compression_index]; 6200c0d06caSMauro Carvalho Chehab ptable8004 = pdec->table_8004_pass1[compression_index]; 6210c0d06caSMauro Carvalho Chehab 6220c0d06caSMauro Carvalho Chehab /* Each block decode a square of 4x4 */ 6230c0d06caSMauro Carvalho Chehab while (nblocks) { 6240c0d06caSMauro Carvalho Chehab decode_block(pdec, ptable0004, ptable8004); 6250c0d06caSMauro Carvalho Chehab copy_image_block_Y(pdec->temp_colors, planar_y, real_image_width, pdec->scalebits); 6260c0d06caSMauro Carvalho Chehab planar_y += 4; 6270c0d06caSMauro Carvalho Chehab nblocks--; 6280c0d06caSMauro Carvalho Chehab } 6290c0d06caSMauro Carvalho Chehab 6300c0d06caSMauro Carvalho Chehab /* pass 2: uncompress UV component */ 6310c0d06caSMauro Carvalho Chehab nblocks = compressed_image_width / 8; 6320c0d06caSMauro Carvalho Chehab 6330c0d06caSMauro Carvalho Chehab ptable0004 = pdec->table_0004_pass2[compression_index]; 6340c0d06caSMauro Carvalho Chehab ptable8004 = pdec->table_8004_pass2[compression_index]; 6350c0d06caSMauro Carvalho Chehab 6360c0d06caSMauro Carvalho Chehab /* Each block decode a square of 4x4 */ 6370c0d06caSMauro Carvalho Chehab while (nblocks) { 6380c0d06caSMauro Carvalho Chehab decode_block(pdec, ptable0004, ptable8004); 6390c0d06caSMauro Carvalho Chehab copy_image_block_CrCb(pdec->temp_colors, planar_u, real_image_width/2, pdec->scalebits); 6400c0d06caSMauro Carvalho Chehab 6410c0d06caSMauro Carvalho Chehab decode_block(pdec, ptable0004, ptable8004); 6420c0d06caSMauro Carvalho Chehab copy_image_block_CrCb(pdec->temp_colors, planar_v, real_image_width/2, pdec->scalebits); 6430c0d06caSMauro Carvalho Chehab 6440c0d06caSMauro Carvalho Chehab planar_v += 8; 6450c0d06caSMauro Carvalho Chehab planar_u += 8; 6460c0d06caSMauro Carvalho Chehab nblocks -= 2; 6470c0d06caSMauro Carvalho Chehab } 6480c0d06caSMauro Carvalho Chehab 6490c0d06caSMauro Carvalho Chehab } 6500c0d06caSMauro Carvalho Chehab 6510c0d06caSMauro Carvalho Chehab /** 6520c0d06caSMauro Carvalho Chehab * Uncompress a pwc23 buffer. 653cba862dcSMauro Carvalho Chehab * @pdev: pointer to pwc device's internal struct 654cba862dcSMauro Carvalho Chehab * @src: raw data 655cba862dcSMauro Carvalho Chehab * @dst: image output 6560c0d06caSMauro Carvalho Chehab */ 6570c0d06caSMauro Carvalho Chehab void pwc_dec23_decompress(struct pwc_device *pdev, 6580c0d06caSMauro Carvalho Chehab const void *src, 6590c0d06caSMauro Carvalho Chehab void *dst) 6600c0d06caSMauro Carvalho Chehab { 6610c0d06caSMauro Carvalho Chehab int bandlines_left, bytes_per_block; 6620c0d06caSMauro Carvalho Chehab struct pwc_dec23_private *pdec = &pdev->dec23; 6630c0d06caSMauro Carvalho Chehab 6640c0d06caSMauro Carvalho Chehab /* YUV420P image format */ 6650c0d06caSMauro Carvalho Chehab unsigned char *pout_planar_y; 6660c0d06caSMauro Carvalho Chehab unsigned char *pout_planar_u; 6670c0d06caSMauro Carvalho Chehab unsigned char *pout_planar_v; 6680c0d06caSMauro Carvalho Chehab unsigned int plane_size; 6690c0d06caSMauro Carvalho Chehab 6700c0d06caSMauro Carvalho Chehab mutex_lock(&pdec->lock); 6710c0d06caSMauro Carvalho Chehab 6720c0d06caSMauro Carvalho Chehab bandlines_left = pdev->height / 4; 6730c0d06caSMauro Carvalho Chehab bytes_per_block = pdev->width * 4; 6740c0d06caSMauro Carvalho Chehab plane_size = pdev->height * pdev->width; 6750c0d06caSMauro Carvalho Chehab 6760c0d06caSMauro Carvalho Chehab pout_planar_y = dst; 6770c0d06caSMauro Carvalho Chehab pout_planar_u = dst + plane_size; 6780c0d06caSMauro Carvalho Chehab pout_planar_v = dst + plane_size + plane_size / 4; 6790c0d06caSMauro Carvalho Chehab 6800c0d06caSMauro Carvalho Chehab while (bandlines_left--) { 6810c0d06caSMauro Carvalho Chehab DecompressBand23(pdec, src, 6820c0d06caSMauro Carvalho Chehab pout_planar_y, pout_planar_u, pout_planar_v, 6830c0d06caSMauro Carvalho Chehab pdev->width, pdev->width); 6840c0d06caSMauro Carvalho Chehab src += pdev->vbandlength; 6850c0d06caSMauro Carvalho Chehab pout_planar_y += bytes_per_block; 6860c0d06caSMauro Carvalho Chehab pout_planar_u += pdev->width; 6870c0d06caSMauro Carvalho Chehab pout_planar_v += pdev->width; 6880c0d06caSMauro Carvalho Chehab } 6890c0d06caSMauro Carvalho Chehab mutex_unlock(&pdec->lock); 6900c0d06caSMauro Carvalho Chehab } 691