typedef struct {
	uint8_t  R;
	uint8_t  G;
	uint8_t  B;
} PIXEL_INFO;

void esc_bitmap(PIXEL_INFO *rgb, uint32_t height, uint32_t width) {

	uint32_t   x, y, ypos, dot_y;
	PIXEL_INFO *imgpt;
	uint32_t    *stack, *pt;  // 24-point double density

	uint8_t nH = width >> 8;
	uint8_t nL = width & 0x00ff;

	stack = (uint32_t *)malloc(width * sizeof(uint32_t));
	for (y = 0; y < height; y += 24) {
		memset(stack,0x00,width*sizeof(uint32_t));
		pt = stack;
		for (x=0; x < width; x++) {
			for (dot_y=0; dot_y < 24; dot_y++) {
				ypos = y + dot_y;
				if (ypos >= height) break;
				imgpt = rgb + (width * ypos) + x;
				(*pt)<<=1;
				if (imgpt->R==0) *pt += 1;
			}
			if (ypos >= height) break;
			pt++;
		}
		esc(0x1B); esc(0x2a); esc(0x21); esc(nL); esc(nH);
/*
		for (pt = stack, x=0; x < width; x++, pt++) {
			esc(((*pt)>>16)&0xff);
			esc(((*pt)>> 8)&0xff);
			esc(((*pt)    )&0xff);
		}
*/
		pt = stack+width-1;
		while (true) {
			esc(((*pt)>>16)&0xff);
			esc(((*pt)>> 8)&0xff);
			esc(((*pt)    )&0xff);
			if (pt==stack) break;
			pt--;
		}
		delay(200);
	}
	esc(0x00);
}