source: soft/giet_vm/applications/rosenfeld/src/bmpNR.c @ 798

Last change on this file since 798 was 798, checked in by meunier, 8 years ago
  • Bug fixes in Rosenfeld
File size: 12.4 KB
Line 
1/* --------------- */
2/* --- bmpNR.c --- */
3/* --------------- */
4
5// Copyright (c) 2013-2014 Lionel Lacassagne, All Rights Reserved
6// Laboratoire de Recherche en Informatique
7// Universite Paris-Sud / CNRS
8
9#include <stdio.h>
10#include <stdlib.h>
11#include <math.h>
12
13/* -- image -- */
14#ifdef CLI
15#include "nrc_os_config.h"
16#include "nrtype.h"
17#include "nrdef.h"
18#include "nrmacro.h"
19#include "nralloc.h"
20#endif
21
22#if TARGET_OS == LINUX
23    #include <sys/types.h>
24    #include <sys/stat.h>
25    #include <fcntl.h>
26    #include <unistd.h>
27#endif
28
29
30#include "palette.h"
31
32/* -- local -- */
33
34#include "bmpNR.h"
35
36#define BM 0x4d42
37#define BI_RGB 0L
38
39PRIVATE void ReadBMProw  (int fd, long width, uint8 * row);
40PRIVATE void WriteBMProw (uint8 * row, long width, int fd);
41//PRIVATE void SetupPalette (RGBQUAD Palette[]);
42
43#if (!defined(WIN32) && !defined(_WINDOWS_) && !defined(_WINGDI_))
44//#pragma message("bmpio.h no WINDOWS echo")
45PRIVATE void Palette_RGBQuad2RGBQUAD(RGBQuad * src, RGBQUAD dst[]);
46#endif
47
48/* ------------------------------------- */
49uint8 *ui8ArrayAppend(uint8 *ptr, uint8 x)
50    /* ------------------------------------- */
51{
52    *ptr++ = x;
53    return ptr;
54}
55/* ---------------------------------------- */
56uint8 *ui16ArrayAppend(uint8 *ptr, uint16 x)
57    /* ---------------------------------------- */
58{
59    uint8 x0, x1;
60
61    x0 = x & 0xFF; x = x >> 8;
62    x1 = x & 0xFF; x = x >> 8;
63
64    *ptr++ = x0;
65    *ptr++ = x1;
66
67    return ptr;
68}
69/* -------------------------------------- */
70uint8 *ui32ArrayAppend(uint8 *ptr, uint32 x)
71    /* -------------------------------------- */
72{
73    uint8 x0, x1, x2, x3;
74
75    x0 = x & 0xFF; x = x >> 8;
76    x1 = x & 0xFF; x = x >> 8;
77    x2 = x & 0xFF; x = x >> 8;
78    x3 = x & 0xFF; x = x >> 8;
79
80    *ptr++ = x0;
81    *ptr++ = x1;
82    *ptr++ = x2;
83    *ptr++ = x3;
84
85    return ptr;
86}
87// Seul moyen de cache dans la librairie ces putains de types windoze
88
89// --------------------------------------------------------
90PRIVATE void ReadBMProw(int fd, long width, uint8 *row)
91    // --------------------------------------------------------
92{
93    // Le fichier est ouvert (en lecture) et ne sera pas ferme a la fin
94    read(fd, row, sizeof(uint8) * width);
95}
96// ---------------------------------------------------------
97PRIVATE void WriteBMProw(uint8 *row, long width, int fd)
98    // ---------------------------------------------------------
99{
100    // Le fichier est deja ouvert et ne sera pas ferme a la fin
101    write(fd, row, sizeof(uint8) * width);
102}
103#if (!defined(WIN32) && !defined(_WINDOWS_) && !defined(_WINGDI_))
104//#pragma message("bmpio.h no WINDOWS echo")
105/* ----------------------------------------------------------- */
106PRIVATE void Palette_RGBQuad2RGBQUAD(RGBQuad *src, RGBQUAD dst[])
107    /* ----------------------------------------------------------- */
108{
109    int i;
110    for (i = 0; i < 256; i++) {
111        dst[i].rgbBlue     = (byte) src[i].blue;
112        dst[i].rgbGreen    = (byte) src[i].green;
113        dst[i].rgbRed      = (byte) src[i].red;
114        dst[i].rgbReserved = (byte) 0;
115    }
116}
117#endif
118
119#if (!defined(WIN32) && !defined(_WINDOWS_) && !defined(_WINGDI_))
120//#pragma message("bmpio.h no WINDOWS echo")
121/* --------------------------------------------------------------------------- */
122IMAGE_EXPORT(int) SaveBMP0_ui8matrix(uint8 **m, int width, int height, RGBQuad *palette_RGBQuad, char *filename)
123    /* --------------------------------------------------------------------------- */
124    /* sauvegarde 'image' au format bmp dans le fichier 'filename' */
125{
126    int rc = 0;
127
128    int v_offset = 0; // no more implemented image->v_offset;
129    int h_offset = 0; // no more implemented image->h_offset;
130    int vmax = height - v_offset;
131    //int hmax = width - h_offset;
132    int height_utile = height - 2*v_offset;
133    int width_utile = width - 2*h_offset;
134    int taille_utile  = height_utile * width_utile;
135
136    //int size;
137    int padding_len;
138
139    BITMAPFILEHEADER Bitmap_File_Header;
140    /*BITMAPINFO;      Bitmap_Info; */
141
142    BITMAPINFOHEADER Bitmap_Info_Header;
143    /*RGBQUAD          RGB_Quad; */
144
145    RGBQUAD palette_RGBQUAD[256]; /* Windows */
146
147    uint8 Padding[3];
148
149    uint8 **data = m;
150    int fd;
151    int  i;
152
153    Padding[0] = 0;
154    Padding[1] = 0;
155    Padding[2] = 0;
156
157    /* --- Header --- */
158    Bitmap_File_Header.bfType      = (WORD) BM;   /* BM                            */
159    Bitmap_File_Header.bfSize      = (DWORD) sizeof(BITMAPFILEHEADER)+sizeof(BITMAPINFOHEADER)+256*sizeof(RGBQuad)+taille_utile;    /* taille avec header et palette */
160    Bitmap_File_Header.bfReserved1 = (WORD) 0; /* 0                             */
161    Bitmap_File_Header.bfReserved2 = (WORD) 0; /* 0                             */
162    Bitmap_File_Header.bfOffBits   = (DWORD) sizeof(BITMAPFILEHEADER) +
163        (DWORD) sizeof(BITMAPINFOHEADER) +
164        (DWORD) sizeof(RGBQUAD)*256;   /* */
165
166
167    Bitmap_Info_Header.biSize          = (DWORD) sizeof(BITMAPINFOHEADER);
168    Bitmap_Info_Header.biWidth         = (LONG)  width_utile;  // width sans padding
169    Bitmap_Info_Header.biHeight        = (LONG)  height_utile; // height sans padding
170    Bitmap_Info_Header.biPlanes        = (WORD)  1;            // 1
171    Bitmap_Info_Header.biBitCount      = (WORD)  8;            // 8 en 256 colors
172    Bitmap_Info_Header.biCompression   = (DWORD) BI_RGB;       // BI_RGB
173    Bitmap_Info_Header.biSizeImage     = (DWORD) 0;            // 0 si BI_RGB
174    Bitmap_Info_Header.biXPelsPerMeter = (LONG)  0;            // ???
175    Bitmap_Info_Header.biYPelsPerMeter = (LONG)  0;            // ???
176    Bitmap_Info_Header.biClrUsed       = (DWORD) 256;          // 256
177    Bitmap_Info_Header.biClrImportant  = (DWORD) 0;            // 0
178
179
180    printf("   SaveBMP %s ", filename);
181    printf("[%dx%d] - [%dx%d] = [%dx%d]\n",height,width, v_offset, h_offset, height_utile, width_utile);
182    fd = open(filename, O_CREAT | O_TRUNC);
183    if (fd < 0) {
184        printf("*** Erreur : Ouverture du fichier impossible dans SaveBMP");
185    }
186
187    /* enregistrement de l'image au format bmp */
188    write(fd, &Bitmap_File_Header, sizeof(BITMAPFILEHEADER));
189    /*if(size != sizeof(BITMAPFILEHEADER)) {
190      printf("Bitmap File Header : octets ecrits %d attendus %d\n", size, sizeof(BITMAPFILEHEADER));
191      Error("Erreur d'ecriture du Bitmap File Header");
192      }*/
193    write(fd, &Bitmap_Info_Header, sizeof(BITMAPINFOHEADER));
194    /*if(size != sizeof(BITMAPINFOHEADER) ){
195      printf("Bitmap Info Header : octets ecrits %d attendus %d\n", size, sizeof(BITMAPINFOHEADER));
196      Error("Erreur d'ecriture du Bitmap Info Header");
197      }*/
198
199    Palette_RGBQuad2RGBQUAD(palette_RGBQuad, palette_RGBQUAD);
200    write(fd, palette_RGBQUAD, sizeof(RGBQUAD) * 256);
201    /*if(size != 256*sizeof(RGBQUAD)) {
202      printf("Palette : octets ecrits %d attendus %d\n", size, 256*sizeof(RGBQUAD));
203      Error("Erreur d'ecriture de la palette");
204      }*/
205
206    //for(i=v_offset; i<vmax; i++)/
207
208    /* en 2x car le compilo est trop con ... */
209    padding_len = width_utile % 4;
210    padding_len = (4 - padding_len) % 4;
211
212    for (i = vmax - 1; i >= v_offset; i--) {
213        WriteBMProw(data[i] + h_offset, width_utile, fd);
214        write(fd, Padding, sizeof(byte) * padding_len);
215    }
216    close(fd);
217    return rc;
218
219}
220#endif
221// ------------------------------------------------------------------------------------------------------------
222IMAGE_EXPORT(int) SaveBMP2_ui8matrix(uint8 **m, int width, int height, RGBQuad *palette_RGBQuad, char *filename)
223    // ------------------------------------------------------------------------------------------------------------
224    // sauvegarde 'image' au format bmp dans le fichier 'filename'
225{
226    int taille_utile  = height * width;
227
228    //int size;
229    int padding_len;
230
231    BitmapFileHeader Bitmap_File_Header;
232
233    BitmapInfoHeader Bitmap_Info_Header;
234
235    //RGBQuad palette_RGBQuad[256]; /* Windows */
236
237    byte Padding[3];
238    uint8 rawBFH[14], *ptrBFH; // raw Bitmap File Header
239    uint8 rawBIH[40], *ptrBIH; // raw Bitmap Info Header
240
241    int fd;
242    int  i;
243
244    //#pragma message("BMP warnin' data structure aligment must be 2")
245    //#pragma message("  sizeof( BitmapFileHeader) must = 14, not 16")
246
247    //DEBUG(printf("BMP0 : %d %d\n", sizeof( BITMAPFILEHEADER), sizeof( BITMAPINFOHEADER)));
248    //DEBUG(printf("BMP0_: %d %d\n", sizeof(_BITMAPFILEHEADER), sizeof(_BITMAPINFOHEADER)));
249    //DEBUG(printf("BMP  : %d %d\n", sizeof( BitmapFileHeader), sizeof( BitmapInfoHeader)));
250    if (sizeof(BitmapFileHeader) != 14) {
251        printf("*** Error SaveMBP: sizeof(BitmapFileHeader) = %d should be 14...\n", (int) sizeof(BitmapFileHeader));
252    }
253
254    Padding[0] = 0;
255    Padding[1] = 0;
256    Padding[2] = 0;
257
258    // --- Header ---
259    Bitmap_File_Header.bfType      = (uint16) BM;   //
260    Bitmap_File_Header.bfSize      = (uint32) sizeof(BitmapFileHeader) + sizeof(BitmapInfoHeader) + 256 * sizeof(RGBQuad) + taille_utile;    /* taille avec header et palette */
261    Bitmap_File_Header.bfReserved1 = (uint16) 0; /* 0                             */
262    Bitmap_File_Header.bfReserved2 = (uint16) 0; /* 0                             */
263    Bitmap_File_Header.bfOffBits   = (uint32) sizeof(BitmapFileHeader) + (uint32) sizeof(BitmapInfoHeader) + (uint32) sizeof(RGBQuad) * 256;   /* */
264
265
266    Bitmap_Info_Header.biSize          = (uint32) sizeof(BitmapInfoHeader);
267    Bitmap_Info_Header.biWidth         = (uint32)  width;  // width sans padding
268    Bitmap_Info_Header.biHeight        = (uint32)  height; // height sans padding
269    Bitmap_Info_Header.biPlanes        = (uint16)  1;      // 1
270    Bitmap_Info_Header.biBitCount      = (uint16)  8;      // 8 en 256 colors
271    Bitmap_Info_Header.biCompression   = (uint32) BI_RGB;  // BI_RGB
272    Bitmap_Info_Header.biSizeImage     = (uint32) 0;       // 0 si BI_RGB
273    Bitmap_Info_Header.biXPelsPerMeter = (uint32)  0;      // ???
274    Bitmap_Info_Header.biYPelsPerMeter = (uint32)  0;      // ???
275    Bitmap_Info_Header.biClrUsed       = (uint32) 256;     // 256
276    Bitmap_Info_Header.biClrImportant  = (uint32) 0;       // 0
277
278    ptrBFH = rawBFH;
279    ptrBFH = ui16ArrayAppend(ptrBFH, Bitmap_File_Header.bfType);
280    ptrBFH = ui32ArrayAppend(ptrBFH, Bitmap_File_Header.bfSize);
281    ptrBFH = ui16ArrayAppend(ptrBFH, Bitmap_File_Header.bfReserved1);
282    ptrBFH = ui16ArrayAppend(ptrBFH, Bitmap_File_Header.bfReserved2);
283    ptrBFH = ui32ArrayAppend(ptrBFH, Bitmap_File_Header.bfOffBits);
284
285    ptrBIH = rawBIH;
286    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biSize);
287    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biWidth);
288    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biHeight);
289    ptrBIH = ui16ArrayAppend(ptrBIH, Bitmap_Info_Header.biPlanes);
290    ptrBIH = ui16ArrayAppend(ptrBIH, Bitmap_Info_Header.biBitCount);
291    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biCompression);
292    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biSizeImage);
293    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biXPelsPerMeter);
294    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biYPelsPerMeter);
295    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biClrUsed);
296    ptrBIH = ui32ArrayAppend(ptrBIH, Bitmap_Info_Header.biClrImportant);
297
298    //printf("   SaveBMP %s %dx%d\n", filename, width, height);
299
300    fd = open(filename, O_CREAT | O_TRUNC);
301    if (fd < 0) {
302        printf("*** Erreur : ouverture du fichier '%s' impossible dans SaveBMP", filename);
303    }
304
305    // enregistrement de l'image au format bmp
306    //size = fwrite(&Bitmap_File_Header, sizeof(BitmapFileHeader), 1, file);
307    write(fd, rawBFH, 14);
308    //if(size != sizeof(BITMAPFILEHEADER)) {
309    //  printf("Bitmap File Header : octets ecrits %d attendus %d\n", size, sizeof(BITMAPFILEHEADER));
310    //  Error("Erreur d'ecriture du Bitmap File Header");
311    //}
312
313    //size = fwrite(&Bitmap_Info_Header, sizeof(BitmapInfoHeader), 1, file);
314    write(fd, rawBIH, 40);
315
316    //if(size != sizeof(BITMAPINFOHEADER) ){
317    //  printf("Bitmap Info Header : octets ecrits %d attendus %d\n", size, sizeof(BITMAPINFOHEADER));
318    //  Error("Erreur d'ecriture du Bitmap Info Header");
319    //}
320
321    write(fd, palette_RGBQuad, sizeof(RGBQuad) * 256);
322    //if(size != 256*sizeof(RGBQUAD)) {
323    //  printf("Palette : octets ecrits %d attendus %d\n", size, 256*sizeof(RGBQUAD));
324    //  Error("Erreur d'ecriture de la palette");
325    //}
326
327
328    // en 2x car le compilo est trop con ...
329    padding_len = width % 4;
330    padding_len = (4 - padding_len) % 4;
331
332    for (i = height - 1; i >= 0; i--) {
333        //WriteBMProw(data[i]+h_offset, width_utile, fichier);
334        WriteBMProw(m[i] + 0, width, fd);
335        write(fd, Padding, sizeof(uint8) * padding_len);
336    }
337    close(fd);
338    return 0;
339}
340
Note: See TracBrowser for help on using the repository browser.