#include #include #include
static unsigned char sg_BHeader[] = { 0x42, 0x4D, 0x36, 0x58, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x00, 0x00, 0x00, 0x28, 0x00, 0x00, 0x00, 0x40, 0x01, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x00, 0x01, 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; #define RGB565TO1555(rgb) ((unsigned short)((unsigned short)(rgb & 0x001f) | ((unsigned short)(rgb & 0xffe0) >> 1)))
void SaveBMPFile(unsigned char *raw, char *filename) { unsigned short *p = (unsigned short *)raw; typedef unsigned int UINT; typedef unsigned char UCHAR; UINT m_Width = 640, m_Height = 480; UINT i, j; int bmp = open(filename, O_WRONLY | O_CREAT); if(bmp < 0) return; sg_BHeader[0x02] = (UCHAR)(m_Width * m_Height * 2 + 0x36) & 0xff; sg_BHeader[0x03] = (UCHAR)((m_Width * m_Height * 2 + 0x36) >> 8) & 0xff; sg_BHeader[0x04] = (UCHAR)((m_Width * m_Height * 2 + 0x36) >> 16) & 0xff; sg_BHeader[0x05] = (UCHAR)((m_Width * m_Height * 2 + 0x36) >> 24) & 0xff; sg_BHeader[0x12] = (UCHAR)m_Width & 0xff; sg_BHeader[0x13] = (UCHAR)(m_Width >> 8) & 0xff; sg_BHeader[0x14] = (UCHAR)(m_Width >> 16) & 0xff; sg_BHeader[0x15] = (UCHAR)(m_Width >> 24) & 0xff; sg_BHeader[0x16] = (UCHAR)m_Height & 0xff; sg_BHeader[0x17] = (UCHAR)(m_Height >> 8) & 0xff; sg_BHeader[0x18] = (UCHAR)(m_Height >> 16) & 0xff; sg_BHeader[0x19] = (UCHAR)(m_Height >> 24) & 0xff; write(bmp, sg_BHeader, sizeof(sg_BHeader)); for(i = 0; i < m_Height; i++) { unsigned short *c = p + (m_Height - 1 - i) * m_Width; unsigned short cc; for(j = 0; j < m_Width; j++) { cc = RGB565TO1555(*(c + j)); // cc = *(c + j); write(bmp, &cc, 2); } } close(bmp); }
int main(int argc, char *argv[]) { unsigned char buf[640*480*2]; char *filename = "/mnt/yaffs/screenshot.bmp"; int fb; fb = open("/dev/fb/0", O_RDONLY); if(fb < 0) exit(1); if(argc == 2) filename = argv[1]; printf("reading screen...\n"); read(fb, buf, 640*480*2); close(fb); printf("saving screen...\n"); SaveBMPFile(buf, filename); printf("file %s created successfully\n", filename); exit(0); } |