Martin Sturm / Mbed 2 deprecated Lab3

Dependencies:   mbed

myBMP/myBMP.cpp@0:c546b51ecf0b, 2011-10-11 (annotated)

Committer:
XkLi
Date:
Tue Oct 11 01:24:18 2011 +0000
Revision:
0:c546b51ecf0b
v1.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
XkLi 0:c546b51ecf0b 1 #include "myBMP.h"
XkLi 0:c546b51ecf0b 2
XkLi 0:c546b51ecf0b 3 int BitDepth = 1;
XkLi 0:c546b51ecf0b 4 int Width = 1;
XkLi 0:c546b51ecf0b 5 int Height = 1;
XkLi 0:c546b51ecf0b 6 RGBApixel *Colors;
XkLi 0:c546b51ecf0b 7
XkLi 0:c546b51ecf0b 8 bool SafeFread( char* buffer, int size, int number, FILE* fp )
XkLi 0:c546b51ecf0b 9 {
XkLi 0:c546b51ecf0b 10 using namespace std;
XkLi 0:c546b51ecf0b 11 int ItemsRead;
XkLi 0:c546b51ecf0b 12 if( feof(fp) )
XkLi 0:c546b51ecf0b 13 { return false; }
XkLi 0:c546b51ecf0b 14 ItemsRead = (int) fread( buffer , size , number , fp );
XkLi 0:c546b51ecf0b 15 if( ItemsRead < number )
XkLi 0:c546b51ecf0b 16 { return false; }
XkLi 0:c546b51ecf0b 17 return true;
XkLi 0:c546b51ecf0b 18 }
XkLi 0:c546b51ecf0b 19
XkLi 0:c546b51ecf0b 20 bool Read32bitRow( ebmpBYTE* Buffer, int BufferSize, int Row, NokiaLCD *lcd)
XkLi 0:c546b51ecf0b 21 {
XkLi 0:c546b51ecf0b 22 int i;
XkLi 0:c546b51ecf0b 23 char Colors[4];
XkLi 0:c546b51ecf0b 24 if( Width*4 > BufferSize )
XkLi 0:c546b51ecf0b 25 { return false; }
XkLi 0:c546b51ecf0b 26 for( i=0 ; i < Width ; i++ )
XkLi 0:c546b51ecf0b 27 {
XkLi 0:c546b51ecf0b 28 memcpy( (char*) &(Colors), (char*) Buffer+4*i, 4 );
XkLi 0:c546b51ecf0b 29 //Blue, Green, Red, Alpha
XkLi 0:c546b51ecf0b 30 int color = 0x00000000 | (Colors[2] << 16) | (Colors[1] << 8) | (Colors[0]);
XkLi 0:c546b51ecf0b 31 (*lcd).pixel((130-Width)/2+i,(130-Height)/2+Row,color);
XkLi 0:c546b51ecf0b 32 }
XkLi 0:c546b51ecf0b 33 return true;
XkLi 0:c546b51ecf0b 34 }
XkLi 0:c546b51ecf0b 35
XkLi 0:c546b51ecf0b 36 bool Read24bitRow( ebmpBYTE* Buffer, int BufferSize, int Row, NokiaLCD *lcd)
XkLi 0:c546b51ecf0b 37 {
XkLi 0:c546b51ecf0b 38 int i;
XkLi 0:c546b51ecf0b 39 char Colors[4];
XkLi 0:c546b51ecf0b 40 if( Width*3 > BufferSize )
XkLi 0:c546b51ecf0b 41 { return false; }
XkLi 0:c546b51ecf0b 42 for( i=0 ; i < Width ; i++ )
XkLi 0:c546b51ecf0b 43 {
XkLi 0:c546b51ecf0b 44 memcpy( (char*) &(Colors), (char*) Buffer+3*i, 3 );
XkLi 0:c546b51ecf0b 45 //Blue, Green, Red, Alpha
XkLi 0:c546b51ecf0b 46 int color = 0x00000000 | (Colors[2] << 16) | (Colors[1] << 8) | (Colors[0]);
XkLi 0:c546b51ecf0b 47 (*lcd).pixel((130-Width)/2+i,(130-Height)/2+Row,color);
XkLi 0:c546b51ecf0b 48 }
XkLi 0:c546b51ecf0b 49 return true;
XkLi 0:c546b51ecf0b 50 }
XkLi 0:c546b51ecf0b 51
XkLi 0:c546b51ecf0b 52 RGBApixel GetColor( int ColorNumber)
XkLi 0:c546b51ecf0b 53 {
XkLi 0:c546b51ecf0b 54 RGBApixel Output;
XkLi 0:c546b51ecf0b 55 Output.Red = 255;
XkLi 0:c546b51ecf0b 56 Output.Green = 255;
XkLi 0:c546b51ecf0b 57 Output.Blue = 255;
XkLi 0:c546b51ecf0b 58 Output.Alpha = 0;
XkLi 0:c546b51ecf0b 59
XkLi 0:c546b51ecf0b 60 if( BitDepth != 1 && BitDepth != 4 && BitDepth != 8 )
XkLi 0:c546b51ecf0b 61 {
XkLi 0:c546b51ecf0b 62 return Output;
XkLi 0:c546b51ecf0b 63 }
XkLi 0:c546b51ecf0b 64 if( !Colors )
XkLi 0:c546b51ecf0b 65 {
XkLi 0:c546b51ecf0b 66 return Output;
XkLi 0:c546b51ecf0b 67 }
XkLi 0:c546b51ecf0b 68 Output = Colors[ColorNumber];
XkLi 0:c546b51ecf0b 69 return Output;
XkLi 0:c546b51ecf0b 70 }
XkLi 0:c546b51ecf0b 71
XkLi 0:c546b51ecf0b 72 bool Read8bitRow( ebmpBYTE* Buffer, int BufferSize, int Row, NokiaLCD *lcd)
XkLi 0:c546b51ecf0b 73 {
XkLi 0:c546b51ecf0b 74 int i;
XkLi 0:c546b51ecf0b 75 if( Width > BufferSize )
XkLi 0:c546b51ecf0b 76 { return false; }
XkLi 0:c546b51ecf0b 77 for( i=0 ; i < Width ; i++ )
XkLi 0:c546b51ecf0b 78 {
XkLi 0:c546b51ecf0b 79 int Index = Buffer[i];
XkLi 0:c546b51ecf0b 80 //Blue, Green, Red, Alpha
XkLi 0:c546b51ecf0b 81 RGBApixel colors = GetColor(Index);
XkLi 0:c546b51ecf0b 82 int color = 0x00000000 | (colors.Red<< 16) | (colors.Blue << 8) | (colors.Green);
XkLi 0:c546b51ecf0b 83 (*lcd).pixel((130-Width)/2+i,(130-Height)/2+Row,color);
XkLi 0:c546b51ecf0b 84 }
XkLi 0:c546b51ecf0b 85 return true;
XkLi 0:c546b51ecf0b 86 }
XkLi 0:c546b51ecf0b 87
XkLi 0:c546b51ecf0b 88 bool Read4bitRow( ebmpBYTE* Buffer, int BufferSize, int Row, NokiaLCD *lcd)
XkLi 0:c546b51ecf0b 89 {
XkLi 0:c546b51ecf0b 90 int Shifts[2] = {4 ,0 };
XkLi 0:c546b51ecf0b 91 int Masks[2] = {240,15};
XkLi 0:c546b51ecf0b 92
XkLi 0:c546b51ecf0b 93 int i=0;
XkLi 0:c546b51ecf0b 94 int j;
XkLi 0:c546b51ecf0b 95 int k=0;
XkLi 0:c546b51ecf0b 96 if( Width > 2*BufferSize )
XkLi 0:c546b51ecf0b 97 { return false; }
XkLi 0:c546b51ecf0b 98 while( i < Width )
XkLi 0:c546b51ecf0b 99 {
XkLi 0:c546b51ecf0b 100 j=0;
XkLi 0:c546b51ecf0b 101 while( j < 2 && i < Width )
XkLi 0:c546b51ecf0b 102 {
XkLi 0:c546b51ecf0b 103 int Index = (int) ( (Buffer[k]&Masks[j]) >> Shifts[j]);
XkLi 0:c546b51ecf0b 104 RGBApixel colors = GetColor(Index);
XkLi 0:c546b51ecf0b 105 int color = 0x00000000 | (colors.Red<< 16) | (colors.Blue << 8) | (colors.Green);
XkLi 0:c546b51ecf0b 106 (*lcd).pixel((130-Width)/2+i,(130-Height)/2+Row,color);
XkLi 0:c546b51ecf0b 107 i++; j++;
XkLi 0:c546b51ecf0b 108 }
XkLi 0:c546b51ecf0b 109 k++;
XkLi 0:c546b51ecf0b 110 }
XkLi 0:c546b51ecf0b 111 return true;
XkLi 0:c546b51ecf0b 112 }
XkLi 0:c546b51ecf0b 113 bool Read1bitRow( ebmpBYTE* Buffer, int BufferSize, int Row, NokiaLCD *lcd)
XkLi 0:c546b51ecf0b 114 {
XkLi 0:c546b51ecf0b 115 int Shifts[8] = {7 ,6 ,5 ,4 ,3,2,1,0};
XkLi 0:c546b51ecf0b 116 int Masks[8] = {128,64,32,16,8,4,2,1};
XkLi 0:c546b51ecf0b 117
XkLi 0:c546b51ecf0b 118 int i=0;
XkLi 0:c546b51ecf0b 119 int j;
XkLi 0:c546b51ecf0b 120 int k=0;
XkLi 0:c546b51ecf0b 121
XkLi 0:c546b51ecf0b 122 if( Width > 8*BufferSize )
XkLi 0:c546b51ecf0b 123 { return false; }
XkLi 0:c546b51ecf0b 124 while( i < Width )
XkLi 0:c546b51ecf0b 125 {
XkLi 0:c546b51ecf0b 126 j=0;
XkLi 0:c546b51ecf0b 127 while( j < 8 && i < Width )
XkLi 0:c546b51ecf0b 128 {
XkLi 0:c546b51ecf0b 129 int Index = (int) ( (Buffer[k]&Masks[j]) >> Shifts[j]);
XkLi 0:c546b51ecf0b 130 RGBApixel colors = GetColor(Index);
XkLi 0:c546b51ecf0b 131 int color = 0x00000000 | (colors.Red<< 16) | (colors.Blue << 8) | (colors.Green);
XkLi 0:c546b51ecf0b 132 (*lcd).pixel((130-Width)/2+i,(130-Height)/2+Row,color);
XkLi 0:c546b51ecf0b 133 i++; j++;
XkLi 0:c546b51ecf0b 134 }
XkLi 0:c546b51ecf0b 135 k++;
XkLi 0:c546b51ecf0b 136 }
XkLi 0:c546b51ecf0b 137 return true;
XkLi 0:c546b51ecf0b 138 }
XkLi 0:c546b51ecf0b 139
XkLi 0:c546b51ecf0b 140 int TellNumberOfColors( int BitDepth )
XkLi 0:c546b51ecf0b 141 {
XkLi 0:c546b51ecf0b 142 int output = 1 << BitDepth;
XkLi 0:c546b51ecf0b 143 if( BitDepth == 32 )
XkLi 0:c546b51ecf0b 144 { output = 1 << 24; }
XkLi 0:c546b51ecf0b 145 return output;
XkLi 0:c546b51ecf0b 146 }
XkLi 0:c546b51ecf0b 147
XkLi 0:c546b51ecf0b 148 bool ReadBMPFromFile( const char* FileName, RGBApixel *Colors, NokiaLCD *lcd)
XkLi 0:c546b51ecf0b 149 {
XkLi 0:c546b51ecf0b 150 FILE* fp = fopen( FileName, "rb" );
XkLi 0:c546b51ecf0b 151 if( fp == NULL )
XkLi 0:c546b51ecf0b 152 {
XkLi 0:c546b51ecf0b 153 return false;
XkLi 0:c546b51ecf0b 154 }
XkLi 0:c546b51ecf0b 155
XkLi 0:c546b51ecf0b 156 // read the file header
XkLi 0:c546b51ecf0b 157
XkLi 0:c546b51ecf0b 158 BMFH bmfh;
XkLi 0:c546b51ecf0b 159 bool NotCorrupted = true;
XkLi 0:c546b51ecf0b 160
XkLi 0:c546b51ecf0b 161 NotCorrupted &= SafeFread( (char*) &(bmfh.bfType) , sizeof(ebmpWORD), 1, fp);
XkLi 0:c546b51ecf0b 162
XkLi 0:c546b51ecf0b 163 bool IsBitmap = false;
XkLi 0:c546b51ecf0b 164
XkLi 0:c546b51ecf0b 165 if( bmfh.bfType == 19778 )
XkLi 0:c546b51ecf0b 166 { IsBitmap = true; }
XkLi 0:c546b51ecf0b 167
XkLi 0:c546b51ecf0b 168 if( !IsBitmap )
XkLi 0:c546b51ecf0b 169 {
XkLi 0:c546b51ecf0b 170 fclose( fp );
XkLi 0:c546b51ecf0b 171 return false;
XkLi 0:c546b51ecf0b 172 }
XkLi 0:c546b51ecf0b 173
XkLi 0:c546b51ecf0b 174 NotCorrupted &= SafeFread( (char*) &(bmfh.bfSize) , sizeof(ebmpDWORD) , 1, fp);
XkLi 0:c546b51ecf0b 175 NotCorrupted &= SafeFread( (char*) &(bmfh.bfReserved1) , sizeof(ebmpWORD) , 1, fp);
XkLi 0:c546b51ecf0b 176 NotCorrupted &= SafeFread( (char*) &(bmfh.bfReserved2) , sizeof(ebmpWORD) , 1, fp);
XkLi 0:c546b51ecf0b 177 NotCorrupted &= SafeFread( (char*) &(bmfh.bfOffBits) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 178
XkLi 0:c546b51ecf0b 179 // read the info header
XkLi 0:c546b51ecf0b 180
XkLi 0:c546b51ecf0b 181 BMIH bmih;
XkLi 0:c546b51ecf0b 182
XkLi 0:c546b51ecf0b 183 NotCorrupted &= SafeFread( (char*) &(bmih.biSize) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 184 NotCorrupted &= SafeFread( (char*) &(bmih.biWidth) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 185 NotCorrupted &= SafeFread( (char*) &(bmih.biHeight) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 186 NotCorrupted &= SafeFread( (char*) &(bmih.biPlanes) , sizeof(ebmpWORD) , 1, fp);
XkLi 0:c546b51ecf0b 187 NotCorrupted &= SafeFread( (char*) &(bmih.biBitCount) , sizeof(ebmpWORD) , 1, fp);
XkLi 0:c546b51ecf0b 188
XkLi 0:c546b51ecf0b 189 NotCorrupted &= SafeFread( (char*) &(bmih.biCompression) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 190 NotCorrupted &= SafeFread( (char*) &(bmih.biSizeImage) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 191 NotCorrupted &= SafeFread( (char*) &(bmih.biXPelsPerMeter) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 192 NotCorrupted &= SafeFread( (char*) &(bmih.biYPelsPerMeter) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 193 NotCorrupted &= SafeFread( (char*) &(bmih.biClrUsed) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 194 NotCorrupted &= SafeFread( (char*) &(bmih.biClrImportant) , sizeof(ebmpDWORD) , 1 , fp);
XkLi 0:c546b51ecf0b 195
XkLi 0:c546b51ecf0b 196 // a safety catch: if any of the header information didn't read properly, abort
XkLi 0:c546b51ecf0b 197 // future idea: check to see if at least most is self-consistent
XkLi 0:c546b51ecf0b 198
XkLi 0:c546b51ecf0b 199 if( !NotCorrupted )
XkLi 0:c546b51ecf0b 200 {
XkLi 0:c546b51ecf0b 201 fclose(fp);
XkLi 0:c546b51ecf0b 202 return false;
XkLi 0:c546b51ecf0b 203 }
XkLi 0:c546b51ecf0b 204
XkLi 0:c546b51ecf0b 205 // if bmih.biCompression 1 or 2, then the file is RLE compressed
XkLi 0:c546b51ecf0b 206
XkLi 0:c546b51ecf0b 207 if( bmih.biCompression == 1 || bmih.biCompression == 2 )
XkLi 0:c546b51ecf0b 208 {
XkLi 0:c546b51ecf0b 209 fclose(fp);
XkLi 0:c546b51ecf0b 210 return false;
XkLi 0:c546b51ecf0b 211 }
XkLi 0:c546b51ecf0b 212
XkLi 0:c546b51ecf0b 213 // if bmih.biCompression > 3, then something strange is going on
XkLi 0:c546b51ecf0b 214 // it's probably an OS2 bitmap file.
XkLi 0:c546b51ecf0b 215
XkLi 0:c546b51ecf0b 216 if( bmih.biCompression > 3 )
XkLi 0:c546b51ecf0b 217 {
XkLi 0:c546b51ecf0b 218 fclose(fp);
XkLi 0:c546b51ecf0b 219 return false;
XkLi 0:c546b51ecf0b 220 }
XkLi 0:c546b51ecf0b 221
XkLi 0:c546b51ecf0b 222 if( bmih.biCompression == 3 && bmih.biBitCount != 16 )
XkLi 0:c546b51ecf0b 223 {
XkLi 0:c546b51ecf0b 224 fclose(fp);
XkLi 0:c546b51ecf0b 225 return false;
XkLi 0:c546b51ecf0b 226 }
XkLi 0:c546b51ecf0b 227
XkLi 0:c546b51ecf0b 228 // set the bit depth
XkLi 0:c546b51ecf0b 229
XkLi 0:c546b51ecf0b 230 int TempBitDepth = (int) bmih.biBitCount;
XkLi 0:c546b51ecf0b 231 if( TempBitDepth != 1 && TempBitDepth != 4
XkLi 0:c546b51ecf0b 232 && TempBitDepth != 8 && TempBitDepth != 16
XkLi 0:c546b51ecf0b 233 && TempBitDepth != 24 && TempBitDepth != 32 )
XkLi 0:c546b51ecf0b 234 {
XkLi 0:c546b51ecf0b 235 fclose(fp);
XkLi 0:c546b51ecf0b 236 return false;
XkLi 0:c546b51ecf0b 237 }
XkLi 0:c546b51ecf0b 238 BitDepth = (int)bmih.biBitCount;
XkLi 0:c546b51ecf0b 239 // set the size
XkLi 0:c546b51ecf0b 240
XkLi 0:c546b51ecf0b 241 if( (int) bmih.biWidth <= 0 || (int) bmih.biHeight <= 0 )
XkLi 0:c546b51ecf0b 242 {
XkLi 0:c546b51ecf0b 243 fclose(fp);
XkLi 0:c546b51ecf0b 244 return false;
XkLi 0:c546b51ecf0b 245 }
XkLi 0:c546b51ecf0b 246 Width = (int) bmih.biWidth;
XkLi 0:c546b51ecf0b 247 Height = (int) bmih.biHeight;
XkLi 0:c546b51ecf0b 248 // some preliminaries
XkLi 0:c546b51ecf0b 249
XkLi 0:c546b51ecf0b 250 double dBytesPerPixel = ( (double) BitDepth ) / 8.0;
XkLi 0:c546b51ecf0b 251 double dBytesPerRow = dBytesPerPixel * (Width+0.0);
XkLi 0:c546b51ecf0b 252 dBytesPerRow = ceil(dBytesPerRow);
XkLi 0:c546b51ecf0b 253
XkLi 0:c546b51ecf0b 254 int BytePaddingPerRow = 4 - ( (int) (dBytesPerRow) )% 4;
XkLi 0:c546b51ecf0b 255 if( BytePaddingPerRow == 4 )
XkLi 0:c546b51ecf0b 256 { BytePaddingPerRow = 0; }
XkLi 0:c546b51ecf0b 257
XkLi 0:c546b51ecf0b 258 // if < 16 bits, read the palette
XkLi 0:c546b51ecf0b 259
XkLi 0:c546b51ecf0b 260 if( BitDepth < 16 )
XkLi 0:c546b51ecf0b 261 {
XkLi 0:c546b51ecf0b 262 // determine the number of colors specified in the
XkLi 0:c546b51ecf0b 263 // color table
XkLi 0:c546b51ecf0b 264
XkLi 0:c546b51ecf0b 265 int NumberOfColorsToRead = ((int) bmfh.bfOffBits - 54 )/4;
XkLi 0:c546b51ecf0b 266 if( NumberOfColorsToRead > (1 << BitDepth) )
XkLi 0:c546b51ecf0b 267 { NumberOfColorsToRead = (1 << BitDepth); }
XkLi 0:c546b51ecf0b 268
XkLi 0:c546b51ecf0b 269 int n;
XkLi 0:c546b51ecf0b 270 for( n=0; n < NumberOfColorsToRead ; n++ )
XkLi 0:c546b51ecf0b 271 {
XkLi 0:c546b51ecf0b 272 SafeFread( (char*) &(Colors[n]) , 4 , 1 , fp);
XkLi 0:c546b51ecf0b 273 }
XkLi 0:c546b51ecf0b 274 for( n=NumberOfColorsToRead ; n < TellNumberOfColors(BitDepth) ; n++ )
XkLi 0:c546b51ecf0b 275 {
XkLi 0:c546b51ecf0b 276 RGBApixel WHITE;
XkLi 0:c546b51ecf0b 277 WHITE.Red = 255;
XkLi 0:c546b51ecf0b 278 WHITE.Green = 255;
XkLi 0:c546b51ecf0b 279 WHITE.Blue = 255;
XkLi 0:c546b51ecf0b 280 WHITE.Alpha = 0;
XkLi 0:c546b51ecf0b 281 Colors[n] = WHITE;
XkLi 0:c546b51ecf0b 282 }
XkLi 0:c546b51ecf0b 283 }
XkLi 0:c546b51ecf0b 284
XkLi 0:c546b51ecf0b 285 // skip blank data if bfOffBits so indicates
XkLi 0:c546b51ecf0b 286
XkLi 0:c546b51ecf0b 287 int BytesToSkip = bmfh.bfOffBits - 54;;
XkLi 0:c546b51ecf0b 288 if( BitDepth < 16 )
XkLi 0:c546b51ecf0b 289 { BytesToSkip -= 4*(1 << BitDepth); }
XkLi 0:c546b51ecf0b 290 if( BitDepth == 16 && bmih.biCompression == 3 )
XkLi 0:c546b51ecf0b 291 { BytesToSkip -= 3*4; }
XkLi 0:c546b51ecf0b 292 if( BytesToSkip < 0 )
XkLi 0:c546b51ecf0b 293 { BytesToSkip = 0; }
XkLi 0:c546b51ecf0b 294 if( BytesToSkip > 0 && BitDepth != 16 )
XkLi 0:c546b51ecf0b 295 {
XkLi 0:c546b51ecf0b 296 ebmpBYTE* TempSkipBYTE;
XkLi 0:c546b51ecf0b 297 TempSkipBYTE = new ebmpBYTE [BytesToSkip];
XkLi 0:c546b51ecf0b 298 SafeFread( (char*) TempSkipBYTE , BytesToSkip , 1 , fp);
XkLi 0:c546b51ecf0b 299 delete [] TempSkipBYTE;
XkLi 0:c546b51ecf0b 300 }
XkLi 0:c546b51ecf0b 301
XkLi 0:c546b51ecf0b 302 // This code reads 1, 4, 8, 24, and 32-bpp files
XkLi 0:c546b51ecf0b 303 // with a more-efficient buffered technique.
XkLi 0:c546b51ecf0b 304
XkLi 0:c546b51ecf0b 305 int i,j;
XkLi 0:c546b51ecf0b 306 if( BitDepth != 16 )
XkLi 0:c546b51ecf0b 307 {
XkLi 0:c546b51ecf0b 308 int BufferSize = (int) ( (Width*BitDepth) / 8.0 );
XkLi 0:c546b51ecf0b 309 while( 8*BufferSize < Width*BitDepth )
XkLi 0:c546b51ecf0b 310 { BufferSize++; }
XkLi 0:c546b51ecf0b 311 while( BufferSize % 4 )
XkLi 0:c546b51ecf0b 312 { BufferSize++; }
XkLi 0:c546b51ecf0b 313 ebmpBYTE* Buffer;
XkLi 0:c546b51ecf0b 314 Buffer = new ebmpBYTE [BufferSize];
XkLi 0:c546b51ecf0b 315 j= Height-1;
XkLi 0:c546b51ecf0b 316 while( j > -1 )
XkLi 0:c546b51ecf0b 317 {
XkLi 0:c546b51ecf0b 318 int BytesRead = (int) fread( (char*) Buffer, 1, BufferSize, fp );
XkLi 0:c546b51ecf0b 319 if( BytesRead < BufferSize )
XkLi 0:c546b51ecf0b 320 {
XkLi 0:c546b51ecf0b 321 j = -1;
XkLi 0:c546b51ecf0b 322 }
XkLi 0:c546b51ecf0b 323 else
XkLi 0:c546b51ecf0b 324 {
XkLi 0:c546b51ecf0b 325 bool Success = false;
XkLi 0:c546b51ecf0b 326 if( BitDepth == 1 )
XkLi 0:c546b51ecf0b 327 { Success = Read1bitRow( Buffer, BufferSize, j , lcd); }
XkLi 0:c546b51ecf0b 328 if( BitDepth == 4 )
XkLi 0:c546b51ecf0b 329 { Success = Read4bitRow( Buffer, BufferSize, j , lcd); }
XkLi 0:c546b51ecf0b 330 if( BitDepth == 8 )
XkLi 0:c546b51ecf0b 331 { Success = Read8bitRow( Buffer, BufferSize, j , lcd); }
XkLi 0:c546b51ecf0b 332 if( BitDepth == 24 )
XkLi 0:c546b51ecf0b 333 { Success = Read24bitRow( Buffer, BufferSize, j , lcd); }
XkLi 0:c546b51ecf0b 334 if( BitDepth == 32 )
XkLi 0:c546b51ecf0b 335 { Success = Read32bitRow( Buffer, BufferSize, j , lcd); }
XkLi 0:c546b51ecf0b 336 if( !Success )
XkLi 0:c546b51ecf0b 337 {
XkLi 0:c546b51ecf0b 338 j = -1;
XkLi 0:c546b51ecf0b 339 }
XkLi 0:c546b51ecf0b 340 }
XkLi 0:c546b51ecf0b 341 j--;
XkLi 0:c546b51ecf0b 342 }
XkLi 0:c546b51ecf0b 343 delete [] Buffer;
XkLi 0:c546b51ecf0b 344 }
XkLi 0:c546b51ecf0b 345
XkLi 0:c546b51ecf0b 346 if( BitDepth == 16 )
XkLi 0:c546b51ecf0b 347 {
XkLi 0:c546b51ecf0b 348 int DataBytes = Width*2;
XkLi 0:c546b51ecf0b 349 int PaddingBytes = ( 4 - DataBytes % 4 ) % 4;
XkLi 0:c546b51ecf0b 350
XkLi 0:c546b51ecf0b 351 // set the default mask
XkLi 0:c546b51ecf0b 352
XkLi 0:c546b51ecf0b 353 ebmpWORD BlueMask = 31; // bits 12-16
XkLi 0:c546b51ecf0b 354 ebmpWORD GreenMask = 992; // bits 7-11
XkLi 0:c546b51ecf0b 355 ebmpWORD RedMask = 31744; // bits 2-6
XkLi 0:c546b51ecf0b 356
XkLi 0:c546b51ecf0b 357 // read the bit fields, if necessary, to
XkLi 0:c546b51ecf0b 358 // override the default 5-5-5 mask
XkLi 0:c546b51ecf0b 359
XkLi 0:c546b51ecf0b 360 if( bmih.biCompression != 0 )
XkLi 0:c546b51ecf0b 361 {
XkLi 0:c546b51ecf0b 362 // read the three bit masks
XkLi 0:c546b51ecf0b 363
XkLi 0:c546b51ecf0b 364 ebmpWORD TempMaskWORD;
XkLi 0:c546b51ecf0b 365
XkLi 0:c546b51ecf0b 366 SafeFread( (char*) &RedMask , 2 , 1 , fp );
XkLi 0:c546b51ecf0b 367 SafeFread( (char*) &TempMaskWORD , 2, 1, fp );
XkLi 0:c546b51ecf0b 368
XkLi 0:c546b51ecf0b 369 SafeFread( (char*) &GreenMask , 2 , 1 , fp );
XkLi 0:c546b51ecf0b 370 SafeFread( (char*) &TempMaskWORD , 2, 1, fp );
XkLi 0:c546b51ecf0b 371
XkLi 0:c546b51ecf0b 372 SafeFread( (char*) &BlueMask , 2 , 1 , fp );
XkLi 0:c546b51ecf0b 373 SafeFread( (char*) &TempMaskWORD , 2, 1, fp );
XkLi 0:c546b51ecf0b 374 }
XkLi 0:c546b51ecf0b 375
XkLi 0:c546b51ecf0b 376 // read and skip any meta data
XkLi 0:c546b51ecf0b 377
XkLi 0:c546b51ecf0b 378 if( BytesToSkip > 0 )
XkLi 0:c546b51ecf0b 379 {
XkLi 0:c546b51ecf0b 380 ebmpBYTE* TempSkipBYTE;
XkLi 0:c546b51ecf0b 381 TempSkipBYTE = new ebmpBYTE [BytesToSkip];
XkLi 0:c546b51ecf0b 382 SafeFread( (char*) TempSkipBYTE , BytesToSkip , 1 , fp);
XkLi 0:c546b51ecf0b 383 delete [] TempSkipBYTE;
XkLi 0:c546b51ecf0b 384 }
XkLi 0:c546b51ecf0b 385
XkLi 0:c546b51ecf0b 386 // determine the red, green and blue shifts
XkLi 0:c546b51ecf0b 387
XkLi 0:c546b51ecf0b 388 int GreenShift = 0;
XkLi 0:c546b51ecf0b 389 ebmpWORD TempShiftWORD = GreenMask;
XkLi 0:c546b51ecf0b 390 while( TempShiftWORD > 31 )
XkLi 0:c546b51ecf0b 391 { TempShiftWORD = TempShiftWORD>>1; GreenShift++; }
XkLi 0:c546b51ecf0b 392 int BlueShift = 0;
XkLi 0:c546b51ecf0b 393 TempShiftWORD = BlueMask;
XkLi 0:c546b51ecf0b 394 while( TempShiftWORD > 31 )
XkLi 0:c546b51ecf0b 395 { TempShiftWORD = TempShiftWORD>>1; BlueShift++; }
XkLi 0:c546b51ecf0b 396 int RedShift = 0;
XkLi 0:c546b51ecf0b 397 TempShiftWORD = RedMask;
XkLi 0:c546b51ecf0b 398 while( TempShiftWORD > 31 )
XkLi 0:c546b51ecf0b 399 { TempShiftWORD = TempShiftWORD>>1; RedShift++; }
XkLi 0:c546b51ecf0b 400
XkLi 0:c546b51ecf0b 401 // read the actual pixels
XkLi 0:c546b51ecf0b 402
XkLi 0:c546b51ecf0b 403 for( j=Height-1 ; j >= 0 ; j-- )
XkLi 0:c546b51ecf0b 404 {
XkLi 0:c546b51ecf0b 405 i=0;
XkLi 0:c546b51ecf0b 406 int ReadNumber = 0;
XkLi 0:c546b51ecf0b 407 while( ReadNumber < DataBytes )
XkLi 0:c546b51ecf0b 408 {
XkLi 0:c546b51ecf0b 409 ebmpWORD TempWORD;
XkLi 0:c546b51ecf0b 410 SafeFread( (char*) &TempWORD , 2 , 1 , fp );
XkLi 0:c546b51ecf0b 411 ReadNumber += 2;
XkLi 0:c546b51ecf0b 412
XkLi 0:c546b51ecf0b 413 ebmpWORD Red = RedMask & TempWORD;
XkLi 0:c546b51ecf0b 414 ebmpWORD Green = GreenMask & TempWORD;
XkLi 0:c546b51ecf0b 415 ebmpWORD Blue = BlueMask & TempWORD;
XkLi 0:c546b51ecf0b 416
XkLi 0:c546b51ecf0b 417 ebmpBYTE BlueBYTE = (ebmpBYTE) 8*(Blue>>BlueShift);
XkLi 0:c546b51ecf0b 418 ebmpBYTE GreenBYTE = (ebmpBYTE) 8*(Green>>GreenShift);
XkLi 0:c546b51ecf0b 419 ebmpBYTE RedBYTE = (ebmpBYTE) 8*(Red>>RedShift);
XkLi 0:c546b51ecf0b 420
XkLi 0:c546b51ecf0b 421 int color = 0x00000000 | (RedBYTE << 16) | (GreenBYTE << 8) | (BlueBYTE);
XkLi 0:c546b51ecf0b 422 (*lcd).pixel((130-Width)/2+i,(130-Height)/2+j,color);
XkLi 0:c546b51ecf0b 423 i++;
XkLi 0:c546b51ecf0b 424 }
XkLi 0:c546b51ecf0b 425 ReadNumber = 0;
XkLi 0:c546b51ecf0b 426 while( ReadNumber < PaddingBytes )
XkLi 0:c546b51ecf0b 427 {
XkLi 0:c546b51ecf0b 428 ebmpBYTE TempBYTE;
XkLi 0:c546b51ecf0b 429 SafeFread( (char*) &TempBYTE , 1, 1, fp);
XkLi 0:c546b51ecf0b 430 ReadNumber++;
XkLi 0:c546b51ecf0b 431 }
XkLi 0:c546b51ecf0b 432 }
XkLi 0:c546b51ecf0b 433
XkLi 0:c546b51ecf0b 434 }
XkLi 0:c546b51ecf0b 435
XkLi 0:c546b51ecf0b 436 fclose(fp);
XkLi 0:c546b51ecf0b 437 return true;
XkLi 0:c546b51ecf0b 438 }
XkLi 0:c546b51ecf0b 439
XkLi 0:c546b51ecf0b 440
XkLi 0:c546b51ecf0b 441 BMIH::BMIH()
XkLi 0:c546b51ecf0b 442 {
XkLi 0:c546b51ecf0b 443 biPlanes = 1;
XkLi 0:c546b51ecf0b 444 biCompression = 0;
XkLi 0:c546b51ecf0b 445 biXPelsPerMeter = DefaultXPelsPerMeter;
XkLi 0:c546b51ecf0b 446 biYPelsPerMeter = DefaultYPelsPerMeter;
XkLi 0:c546b51ecf0b 447 biClrUsed = 0;
XkLi 0:c546b51ecf0b 448 biClrImportant = 0;
XkLi 0:c546b51ecf0b 449 }
XkLi 0:c546b51ecf0b 450
XkLi 0:c546b51ecf0b 451 BMFH::BMFH()
XkLi 0:c546b51ecf0b 452 {
XkLi 0:c546b51ecf0b 453 bfType = 19778;
XkLi 0:c546b51ecf0b 454 bfReserved1 = 0;
XkLi 0:c546b51ecf0b 455 bfReserved2 = 0;
XkLi 0:c546b51ecf0b 456 }