void from_565_rle(void)
{
unsigned short times, count;
unsigned short in [2];
unsigned short color, outR, outG, outB;
unsigned total = 0;
while(read(0, in, 4)) {
count = in[0];
color = in[1];
total += count;
outR = from565_r(color);
outG = from565_g(color);
outB = from565_b(color);
for (times=0;times<count;times++) {
write(1, &outR, 1);
write(1, &outG, 1);
write(1, &outB, 1);
}
}
fprintf(stderr,"%d pixels\n",total);
}
void to_565_raw_dither(int width)
{
unsigned char in[3];
unsigned short out;
int i = 0;
int e;
int* error = (int *) malloc((width+2) * 3 * sizeof(int));
int* next_error = (int *) malloc((width+2) * 3 * sizeof(int));
memset(error, 0, (width+2) * 3 * sizeof(int));
memset(next_error, 0, (width+2) * 3 * sizeof(int));
error += 3; // array goes from [-3..((width+1)*3+2)]
next_error += 3;
while(read(0, in, 3) == 3) {
int r = in[0] + error[i*3+0];
int rb = (r < 0) ? 0 : ((r > 255) ? 255 : r);
int g = in[1] + error[i*3+1];
int gb = (g < 0) ? 0 : ((g > 255) ? 255 : g);
int b = in[2] + error[i*3+2];
int bb = (b < 0) ? 0 : ((b > 255) ? 255 : b);
out = to565(rb, gb, bb);
write(1, &out, 2);
#define apply_error(ch) { \
next_error[(i-1)*3+ch] += e * 3 / 16; \
next_error[(i)*3+ch] += e * 5 / 16; \
next_error[(i+1)*3+ch] += e * 1 / 16; \
error[(i+1)*3+ch] += e - ((e*1/16) + (e*3/16) + (e*5/16)); \
}
e = r - from565_r(out);
apply_error(0);
e = g - from565_g(out);
apply_error(1);
e = b - from565_b(out);
apply_error(2);
#undef apply_error
++i;
if (i == width) {
// error <- next_error; next_error <- 0
int* temp = error; error = next_error; next_error = temp;
memset(next_error, 0, (width+1) * 3 * sizeof(int));
i = 0;
}
}
free(error-3);
free(next_error-3);
return;
}
void from_565_raw(void)
{
unsigned short out;
unsigned short in;
while(read(0, &in, 2) == 2) {
out = from565_r(in);
write(1, &out, 1);
out = from565_g(in);
write(1, &out, 1);
out = from565_b(in);
write(1, &out, 1);
}
return;
}
