Permalink
Find file
Fetching contributors…
Cannot retrieve contributors at this time
912 lines (848 sloc) 22.6 KB
/* Spca561decoder (C) 2005 Andrzej Szombierski [qq@kuku.eu.org] */
/*==============================================================*/
/* This program is distributed under the terms of the GNU */
/* General Public License, version 2. You may use, modify, */
/* and redistribute it under the terms of this license. A */
/* copy should be included with this source. */
/*
* Decoder for compressed spca561 images
* It was developed for "Labtec WebCam Elch 2(SPCA561A)" (046d:0929)
* but it might work with other spca561 cameras
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <string.h>
#include "fswebcam.h"
#include "src.h"
#include "log.h"
#include "dec.h"
/*fixme: not reentrant */
static unsigned int bit_bucket;
static const unsigned char *input_ptr;
static inline void refill(int *bitfill)
{
if (*bitfill < 8) {
bit_bucket = (bit_bucket << 8) | *(input_ptr++);
*bitfill += 8;
}
}
static inline int nbits(int *bitfill, int n)
{
bit_bucket = (bit_bucket << 8) | *(input_ptr++);
*bitfill -= n;
return (bit_bucket >> (*bitfill & 0xff)) & ((1 << n) - 1);
}
static inline int _nbits(int *bitfill, int n)
{
*bitfill -= n;
return (bit_bucket >> (*bitfill & 0xff)) & ((1 << n) - 1);
}
static int fun_A(int *bitfill)
{
int ret;
static int tab[] = {
12, 13, 14, 15, 16, 17, 18, 19, -12, -13, -14, -15,
-16, -17, -18, -19, -19
};
ret = tab[nbits(bitfill, 4)];
refill(bitfill);
return ret;
}
static int fun_B(int *bitfill)
{
static int tab1[] =
{ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 31, 31,
31, 31, 31, 31, 31, 31, 31, 31, 31, 31, 31, 31, 31, 31, 31,
16, 17,
18,
19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30
};
static int tab[] =
{ 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, -5,
-6, -7, -8, -9, -10, -11, -12, -13, -14, -15, -16, -17,
-18, -19
};
unsigned int tmp;
tmp = nbits(bitfill, 7) - 68;
refill(bitfill);
if (tmp > 47)
return 0xff;
return tab[tab1[tmp]];
}
static int fun_C(int *bitfill, int gkw)
{
static int tab1[] =
{ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 23, 23, 23, 23, 23, 23,
23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23,
12, 13,
14,
15, 16, 17, 18, 19, 20, 21, 22
};
static int tab[] =
{ 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, -9, -10, -11,
-12, -13, -14, -15, -16, -17, -18, -19
};
unsigned int tmp;
if (gkw == 0xfe) {
if (nbits(bitfill, 1) == 0)
return 7;
else
return -8;
}
if (gkw != 0xff)
return 0xff;
tmp = nbits(bitfill, 7) - 72;
if (tmp > 43)
return 0xff;
refill(bitfill);
return tab[tab1[tmp]];
}
static int fun_D(int *bitfill, int gkw)
{
if (gkw == 0xfd) {
if (nbits(bitfill, 1) == 0)
return 12;
return -13;
}
if (gkw == 0xfc) {
if (nbits(bitfill, 1) == 0)
return 13;
return -14;
}
if (gkw == 0xfe) {
switch (nbits(bitfill, 2)) {
case 0:
return 14;
case 1:
return -15;
case 2:
return 15;
case 3:
return -16;
}
}
if (gkw == 0xff) {
switch (nbits(bitfill, 3)) {
case 4:
return 16;
case 5:
return -17;
case 6:
return 17;
case 7:
return -18;
case 2:
return _nbits(bitfill, 1) ? 0xed : 0x12;
case 3:
(*bitfill)--;
return 18;
}
return 0xff;
}
return gkw;
}
static int fun_E(int cur_byte, int *bitfill)
{
static int tab0[] = { 0, -1, 1, -2, 2, -3, 3, -4 };
static int tab1[] = { 4, -5, 5, -6, 6, -7, 7, -8 };
static int tab2[] = { 8, -9, 9, -10, 10, -11, 11, -12 };
static int tab3[] = { 12, -13, 13, -14, 14, -15, 15, -16 };
static int tab4[] = { 16, -17, 17, -18, 18, -19, 19, -19 };
if ((cur_byte & 0xf0) >= 0x80) {
*bitfill -= 4;
return tab0[(cur_byte >> 4) & 7];
}
if ((cur_byte & 0xc0) == 0x40) {
*bitfill -= 5;
return tab1[(cur_byte >> 3) & 7];
}
if ((cur_byte & 0xe0) == 0x20) {
*bitfill -= 6;
return tab2[(cur_byte >> 2) & 7];
}
if ((cur_byte & 0xf0) == 0x10) {
*bitfill -= 7;
return tab3[(cur_byte >> 1) & 7];
}
if ((cur_byte & 0xf8) == 8) {
*bitfill -= 8;
return tab4[cur_byte & 7];
}
return 0xff;
}
static int fun_F(int cur_byte, int *bitfill)
{
*bitfill -= 5;
switch (cur_byte & 0xf8) {
case 0x80:
return 0;
case 0x88:
return -1;
case 0x90:
return 1;
case 0x98:
return -2;
case 0xa0:
return 2;
case 0xa8:
return -3;
case 0xb0:
return 3;
case 0xb8:
return -4;
case 0xc0:
return 4;
case 0xc8:
return -5;
case 0xd0:
return 5;
case 0xd8:
return -6;
case 0xe0:
return 6;
case 0xe8:
return -7;
case 0xf0:
return 7;
case 0xf8:
return -8;
}
*bitfill -= 1;
switch (cur_byte & 0xfc) {
case 0x40:
return 8;
case 0x44:
return -9;
case 0x48:
return 9;
case 0x4c:
return -10;
case 0x50:
return 10;
case 0x54:
return -11;
case 0x58:
return 11;
case 0x5c:
return -12;
case 0x60:
return 12;
case 0x64:
return -13;
case 0x68:
return 13;
case 0x6c:
return -14;
case 0x70:
return 14;
case 0x74:
return -15;
case 0x78:
return 15;
case 0x7c:
return -16;
}
*bitfill -= 1;
switch (cur_byte & 0xfe) {
case 0x20:
return 16;
case 0x22:
return -17;
case 0x24:
return 17;
case 0x26:
return -18;
case 0x28:
return 18;
case 0x2a:
return -19;
case 0x2c:
return 19;
}
*bitfill += 7;
return 0xff;
}
static int spca561_decode(int width, int height,
const unsigned char *inbuf,
unsigned char *outbuf)
{
/* buffers */
static int accum[8 * 8 * 8];
static int i_hits[8 * 8 * 8];
const int nbits_A[] =
{ 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, 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,
8, 8, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 0, 0, 7, 7,
7, 7,
7, 7, 7, 7, 7,
7, 7, 7, 7, 7, 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, 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, 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_A[] =
{ 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, 11, -11, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9,
10, 10,
255, 254, -4,
-4, -5, -5, -6, -6, -7, -7, -8, -8, -9, -9, -10, -10, -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, 3, 3,
3, 3, 3,
3, 3, 3,
-2, -2, -2, -2, -2, -2, -2, -2, -3, -3, -3, -3, -3, -3, -3,
-3, 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
};
const int nbits_B[] =
{ 0, 8, 7, 7, 6, 6, 6, 6, 5, 5, 5, 5, 5, 5, 5, 5, 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, 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,
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,
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, 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,
};
const int tab_B[] =
{ 0xff, -4, 3, 3, -3, -3, -3, -3, 2, 2, 2, 2, 2, 2, 2, 2, -2,
-2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -2,
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, -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, 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,
};
const int nbits_C[] =
{ 0, 0, 8, 8, 7, 7, 7, 7, 6, 6, 6, 6, 6, 6, 6, 6, 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, 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,
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, 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, 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, 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,
};
const int tab_C[] =
{ 0xff, 0xfe, 6, -7, 5, 5, -6, -6, 4, 4, 4, 4, -5, -5, -5, -5,
3, 3, 3, 3, 3, 3, 3, 3, -4, -4, -4, -4, -4, -4, -4, -4, 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, 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, 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, -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,
};
const int nbits_D[] =
{ 0, 0, 0, 0, 8, 8, 8, 8, 7, 7, 7, 7, 7, 7, 7, 7, 6, 6, 6, 6,
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 spca561_decode not to need the extra border
around its dest buffer */
int fswc_add_image_s561(avgbmp_t *dst, uint8_t *img, uint32_t length, uint32_t width, uint32_t height, int palette)
{
int x, y;
uint8_t *s, *d;
unsigned char tmpimg[650 * 490];
if(spca561_decode(width, height, img, tmpimg) != 0)
{
ERROR("spca561_decode() failed");
return(-1);
}
/* Remove buffer border */
d = tmpimg;
s = tmpimg + 2 * (width + 6) + 3;
for(y = 0; y < height; y++)
{
for(x = 0; x < width; x++) *(d++) = *(s++);
s += 6;
}
fswc_add_image_bayer(dst, tmpimg, width * height, width, height, SRC_PAL_SGBRG8);
return(0);
}