C12832_lcd.cpp

00001 /* mbed library for the mbed Lab Board  128*32 pixel LCD
00002  * use C12832 controller
00003  * Copyright (c) 2012 Peter Drescher - DC2PD
00004  * Released under the MIT License: http://mbed.org/license/mit
00005  *
00006  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
00007  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
00008  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
00009  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
00010  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
00011  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
00012  * THE SOFTWARE.
00013  */
00014 
00015 // 13.10.12    initial design
00016 // 25.10.12    add autorefresh of screen
00017 // 25.10.12    add standart font
00018 // 20.12.12    add bitmap graphics
00019 
00020 // optional defines :
00021 // #define debug_lcd  1
00022 
00023 #include "C12832_lcd.h"
00024 #include "mbed.h"
00025 #include "stdio.h"
00026 #include "Small_7.h"
00027 
00028 #define BPP    1       // Bits per pixel
00029 
00030 C12832_LCD::C12832_LCD(const char* name)
00031     : GraphicsDisplay(name),_spi(p5,NC,p7),_reset(p6),_A0(p8),_CS(p11)
00032 {
00033     orientation = 1;
00034     draw_mode = NORMAL;
00035     char_x = 0;
00036     lcd_reset();
00037 }
00038 
00039 int C12832_LCD::width()
00040 {
00041     if (orientation == 0 || orientation == 2) return 32;
00042     else return 128;
00043 }
00044 
00045 int C12832_LCD::height()
00046 {
00047     if (orientation == 0 || orientation == 2) return 128;
00048     else return 32;
00049 }
00050 
00051 
00052 /*void C12832_LCD::set_orientation(unsigned int o)
00053 {
00054     orientation = o;
00055     switch (o) {
00056         case (0):
00057             wr_cmd(0xA0);
00058             wr_cmd(0xC0);
00059             break;
00060         case (1):
00061             wr_cmd(0xA0);
00062             wr_cmd(0xC8);
00063             break;
00064         case (2):
00065             wr_cmd(0xA1);
00066             wr_cmd(0xC8);
00067             break;
00068         case (3):
00069             wr_cmd(0xA1);
00070             wr_cmd(0xC0);
00071             break;
00072     }
00073 }
00074 
00075 */
00076 
00077 void C12832_LCD::invert(unsigned int o)
00078 {
00079     if(o == 0) wr_cmd(0xA6);
00080     else wr_cmd(0xA7);
00081 }
00082 
00083 void C12832_LCD::power_save(unsigned int o)
00084 {
00085     // turn off power save
00086     if(o == 0)
00087     {
00088         // set all points OFF
00089         wr_cmd(0xA4);
00090 
00091         // sleep mode off
00092         wr_cmd(0xAD);
00093         wr_cmd(0x00);
00094     }
00095     else
00096     {
00097         // sleep mode on
00098         wr_cmd(0xAC);
00099         wr_cmd(0x00);
00100         // display OFF
00101         wr_cmd(0xAE);
00102         // set all points ON
00103         wr_cmd(0xA5);
00104     }
00105 
00106 
00107 }
00108 
00109 
00110 void C12832_LCD::set_contrast(unsigned int o)
00111 {
00112     contrast = o;
00113     wr_cmd(0x81);      //  set volume
00114     wr_cmd(o & 0x3F);
00115 }
00116 
00117 unsigned int C12832_LCD::get_contrast(void)
00118 {
00119     return(contrast);
00120 }
00121 
00122 
00123 // write command to lcd controller
00124 
00125 void C12832_LCD::wr_cmd(unsigned char cmd)
00126 {
00127     _A0 = 0;
00128     _CS = 0;
00129 #if defined TARGET_LPC1768     // fast without mbed lib
00130     LPC_SSP1->DR = cmd;
00131     do {
00132     } while ((LPC_SSP1->SR & 0x10) == 0x10); // wait for SPI1 idle
00133 #else
00134     _spi.write(cmd);
00135 #endif
00136     _CS = 1;
00137 }
00138 
00139 // write data to lcd controller
00140 
00141 void C12832_LCD::wr_dat(unsigned char dat)
00142 {
00143     _A0 = 1;
00144     _CS = 0;
00145 #if defined TARGET_LPC1768     // fast without mbed lib
00146     LPC_SSP1->DR = dat;
00147     do {
00148     } while ((LPC_SSP1->SR & 0x10) == 0x10); // wait for SPI1 idle
00149 #else
00150     _spi.write(dat);
00151 #endif
00152     _CS = 1;
00153 }
00154 
00155 // reset and init the lcd controller
00156 
00157 void C12832_LCD::lcd_reset()
00158 {
00159 
00160     _spi.format(8,3);                 // 8 bit spi mode 3
00161     _spi.frequency(20000000);          // 19,2 Mhz SPI clock
00162     DigitalOut _reset(p6);
00163     _A0 = 0;
00164     _CS = 1;
00165     _reset = 0;                        // display reset
00166     wait_us(50);
00167     _reset = 1;                       // end reset
00168     wait_ms(5);
00169 
00170     /* Start Initial Sequence ----------------------------------------------------*/
00171 
00172     wr_cmd(0xAE);   //  display off
00173     wr_cmd(0xA2);   //  bias voltage
00174 
00175     wr_cmd(0xA0);
00176     wr_cmd(0xC8);   //  colum normal
00177 
00178     wr_cmd(0x22);   //  voltage resistor ratio
00179     wr_cmd(0x2F);   //  power on
00180     //wr_cmd(0xA4);   //  LCD display ram
00181     wr_cmd(0x40);   // start line = 0
00182     wr_cmd(0xAF);     // display ON
00183 
00184     wr_cmd(0x81);   //  set contrast
00185     wr_cmd(0x17);   //  set contrast
00186 
00187     wr_cmd(0xA6);     // display normal
00188 
00189 
00190 #if defined TARGET_LPC1768          //setup DMA channel 0       
00191     LPC_SC->PCONP |= (1UL << 29);   // Power up the GPDMA
00192     LPC_GPDMA->DMACConfig = 1;      // enable DMA controller
00193     LPC_GPDMA->DMACIntTCClear = 0x1;
00194     LPC_GPDMA->DMACIntErrClr = 0x1;
00195     LPC_GPDMACH0->DMACCLLI = 0;
00196 #endif
00197     // clear and update LCD
00198     memset(buffer,0x00,512);  // clear display buffer
00199     copy_to_lcd();
00200     auto_up = 1;              // switch on auto update
00201     // dont do this by default. Make the user call
00202     //claim(stdout);           // redirekt printf to lcd
00203     locate(0,0);
00204     set_font((unsigned char*)Small_7);  // standart font
00205 }
00206 
00207 // set one pixel in buffer
00208 
00209 void C12832_LCD::pixel(int x, int y, int color)
00210 {
00211     // first check parameter
00212     if(x > 128 || y > 32 || x < 0 || y < 0) return;
00213 
00214     if(draw_mode == NORMAL) {
00215         if(color == 0)
00216             buffer[x + ((y/8) * 128)] &= ~(1 << (y%8));  // erase pixel
00217         else
00218             buffer[x + ((y/8) * 128)] |= (1 << (y%8));   // set pixel
00219     } else { // XOR mode
00220         if(color == 1)
00221             buffer[x + ((y/8) * 128)] ^= (1 << (y%8));   // xor pixel
00222     }
00223 }
00224 
00225 // update lcd
00226 
00227 void C12832_LCD::copy_to_lcd(void)
00228 {
00229 #ifndef TARGET_LPC1768
00230     int i;
00231 #endif
00232     //page 0
00233     wr_cmd(0x00);      // set column low nibble 0
00234     wr_cmd(0x10);      // set column hi  nibble 0
00235     wr_cmd(0xB0);      // set page address  0
00236     _A0 = 1;
00237 #if defined TARGET_LPC1768
00238     _CS = 0;
00239     // start 128 byte DMA transfer to SPI1
00240     LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_SSP1->DR; // we send to SSP1
00241     LPC_SSP1->DMACR = 0x2;  // Enable SSP1 for DMA.
00242     LPC_GPDMA->DMACIntTCClear = 0x1;
00243     LPC_GPDMA->DMACIntErrClr = 0x1;
00244     LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer);
00245     LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
00246     LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
00247     LPC_GPDMA->DMACSoftSReq = 0x1;
00248     do {
00249     } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
00250     do {
00251     } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
00252     _CS = 1;
00253 #else  // no DMA
00254     for(i=0; i<128; i++) {
00255         wr_dat(buffer[i]);
00256     }
00257 #endif
00258 
00259     // page 1
00260     wr_cmd(0x00);      // set column low nibble 0
00261     wr_cmd(0x10);      // set column hi  nibble 0
00262     wr_cmd(0xB1);      // set page address  1
00263     _A0 = 1;
00264 #if defined TARGET_LPC1768
00265     _CS = 0;
00266     // start 128 byte DMA transfer to SPI1
00267     LPC_GPDMA->DMACIntTCClear = 0x1;
00268     LPC_GPDMA->DMACIntErrClr = 0x1;
00269     LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 128);
00270     LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
00271     LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
00272     LPC_GPDMA->DMACSoftSReq = 0x1;
00273     do {
00274     } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
00275     do {
00276     } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
00277     _CS = 1;
00278 #else // no DMA
00279     for(i=128; i<256; i++) {
00280         wr_dat(buffer[i]);
00281     }
00282 #endif
00283 
00284     //page 2
00285     wr_cmd(0x00);      // set column low nibble 0
00286     wr_cmd(0x10);      // set column hi  nibble 0
00287     wr_cmd(0xB2);      // set page address  2
00288     _A0 = 1;
00289 #if defined TARGET_LPC1768
00290     _CS = 0;
00291     // start 128 byte DMA transfer to SPI1
00292     LPC_GPDMA->DMACIntTCClear = 0x1;
00293     LPC_GPDMA->DMACIntErrClr = 0x1;
00294     LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 256);
00295     LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
00296     LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX ;
00297     LPC_GPDMA->DMACSoftSReq = 0x1;
00298     do {
00299     } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
00300     do {
00301     } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
00302     _CS = 1;
00303 #else // no DMA
00304     for(i=256; i<384; i++) {
00305         wr_dat(buffer[i]);
00306     }
00307 #endif
00308 
00309     //page 3
00310     wr_cmd(0x00);      // set column low nibble 0
00311     wr_cmd(0x10);      // set column hi  nibble 0
00312     wr_cmd(0xB3);      // set page address  3
00313     _A0 = 1;
00314 
00315     _CS = 0;
00316 #if defined TARGET_LPC1768
00317     // start 128 byte DMA transfer to SPI1
00318     LPC_GPDMA->DMACIntTCClear = 0x1;
00319     LPC_GPDMA->DMACIntErrClr = 0x1;
00320     LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 384);
00321     LPC_GPDMACH0->DMACCControl = 128  | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
00322     LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
00323     LPC_GPDMA->DMACSoftSReq = 0x1;
00324     do {
00325     } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
00326     do {
00327     } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
00328     _CS = 1;
00329 #else // no DMA
00330     for(i=384; i<512; i++) {
00331         wr_dat(buffer[i]);
00332     }
00333 #endif
00334 }
00335 
00336 void C12832_LCD::cls(void)
00337 {
00338     memset(buffer,0x00,512);  // clear display buffer
00339     copy_to_lcd();
00340 }
00341 
00342 
00343 void C12832_LCD::line(int x0, int y0, int x1, int y1, int color)
00344 {
00345     int   dx = 0, dy = 0;
00346     int   dx_sym = 0, dy_sym = 0;
00347     int   dx_x2 = 0, dy_x2 = 0;
00348     int   di = 0;
00349 
00350     dx = x1-x0;
00351     dy = y1-y0;
00352 
00353     //  if (dx == 0) {        /* vertical line */
00354     //      if (y1 > y0) vline(x0,y0,y1,color);
00355     //      else vline(x0,y1,y0,color);
00356     //      return;
00357     //  }
00358 
00359     if (dx > 0) {
00360         dx_sym = 1;
00361     } else {
00362         dx_sym = -1;
00363     }
00364     //  if (dy == 0) {        /* horizontal line */
00365     //      if (x1 > x0) hline(x0,x1,y0,color);
00366     //      else  hline(x1,x0,y0,color);
00367     //      return;
00368     //  }
00369 
00370     if (dy > 0) {
00371         dy_sym = 1;
00372     } else {
00373         dy_sym = -1;
00374     }
00375 
00376     dx = dx_sym*dx;
00377     dy = dy_sym*dy;
00378 
00379     dx_x2 = dx*2;
00380     dy_x2 = dy*2;
00381 
00382     if (dx >= dy) {
00383         di = dy_x2 - dx;
00384         while (x0 != x1) {
00385 
00386             pixel(x0, y0, color);
00387             x0 += dx_sym;
00388             if (di<0) {
00389                 di += dy_x2;
00390             } else {
00391                 di += dy_x2 - dx_x2;
00392                 y0 += dy_sym;
00393             }
00394         }
00395         pixel(x0, y0, color);
00396     } else {
00397         di = dx_x2 - dy;
00398         while (y0 != y1) {
00399             pixel(x0, y0, color);
00400             y0 += dy_sym;
00401             if (di < 0) {
00402                 di += dx_x2;
00403             } else {
00404                 di += dx_x2 - dy_x2;
00405                 x0 += dx_sym;
00406             }
00407         }
00408         pixel(x0, y0, color);
00409     }
00410     if(auto_up) copy_to_lcd();
00411 }
00412 
00413 void C12832_LCD::rect(int x0, int y0, int x1, int y1, int color)
00414 {
00415 
00416     if (x1 > x0) line(x0,y0,x1,y0,color);
00417     else  line(x1,y0,x0,y0,color);
00418 
00419     if (y1 > y0) line(x0,y0,x0,y1,color);
00420     else line(x0,y1,x0,y0,color);
00421 
00422     if (x1 > x0) line(x0,y1,x1,y1,color);
00423     else  line(x1,y1,x0,y1,color);
00424 
00425     if (y1 > y0) line(x1,y0,x1,y1,color);
00426     else line(x1,y1,x1,y0,color);
00427 
00428     if(auto_up) copy_to_lcd();
00429 }
00430 
00431 void C12832_LCD::fillrect(int x0, int y0, int x1, int y1, int color)
00432 {
00433     int l,c,i;
00434     if(x0 > x1) {
00435         i = x0;
00436         x0 = x1;
00437         x1 = i;
00438     }
00439 
00440     if(y0 > y1) {
00441         i = y0;
00442         y0 = y1;
00443         y1 = i;
00444     }
00445 
00446     for(l = x0; l<= x1; l ++) {
00447         for(c = y0; c<= y1; c++) {
00448             pixel(l,c,color);
00449         }
00450     }
00451     if(auto_up) copy_to_lcd();
00452 }
00453 
00454 
00455 
00456 void C12832_LCD::circle(int x0, int y0, int r, int color)
00457 {
00458 
00459     int draw_x0, draw_y0;
00460     int draw_x1, draw_y1;
00461     int draw_x2, draw_y2;
00462     int draw_x3, draw_y3;
00463     int draw_x4, draw_y4;
00464     int draw_x5, draw_y5;
00465     int draw_x6, draw_y6;
00466     int draw_x7, draw_y7;
00467     int xx, yy;
00468     int di;
00469     //WindowMax();
00470     if (r == 0) {       /* no radius */
00471         return;
00472     }
00473 
00474     draw_x0 = draw_x1 = x0;
00475     draw_y0 = draw_y1 = y0 + r;
00476     if (draw_y0 < height()) {
00477         pixel(draw_x0, draw_y0, color);     /* 90 degree */
00478     }
00479 
00480     draw_x2 = draw_x3 = x0;
00481     draw_y2 = draw_y3 = y0 - r;
00482     if (draw_y2 >= 0) {
00483         pixel(draw_x2, draw_y2, color);    /* 270 degree */
00484     }
00485 
00486     draw_x4 = draw_x6 = x0 + r;
00487     draw_y4 = draw_y6 = y0;
00488     if (draw_x4 < width()) {
00489         pixel(draw_x4, draw_y4, color);     /* 0 degree */
00490     }
00491 
00492     draw_x5 = draw_x7 = x0 - r;
00493     draw_y5 = draw_y7 = y0;
00494     if (draw_x5>=0) {
00495         pixel(draw_x5, draw_y5, color);     /* 180 degree */
00496     }
00497 
00498     if (r == 1) {
00499         return;
00500     }
00501 
00502     di = 3 - 2*r;
00503     xx = 0;
00504     yy = r;
00505     while (xx < yy) {
00506 
00507         if (di < 0) {
00508             di += 4*xx + 6;
00509         } else {
00510             di += 4*(xx - yy) + 10;
00511             yy--;
00512             draw_y0--;
00513             draw_y1--;
00514             draw_y2++;
00515             draw_y3++;
00516             draw_x4--;
00517             draw_x5++;
00518             draw_x6--;
00519             draw_x7++;
00520         }
00521         xx++;
00522         draw_x0++;
00523         draw_x1--;
00524         draw_x2++;
00525         draw_x3--;
00526         draw_y4++;
00527         draw_y5++;
00528         draw_y6--;
00529         draw_y7--;
00530 
00531         if ( (draw_x0 <= width()) && (draw_y0>=0) ) {
00532             pixel(draw_x0, draw_y0, color);
00533         }
00534 
00535         if ( (draw_x1 >= 0) && (draw_y1 >= 0) ) {
00536             pixel(draw_x1, draw_y1, color);
00537         }
00538 
00539         if ( (draw_x2 <= width()) && (draw_y2 <= height()) ) {
00540             pixel(draw_x2, draw_y2, color);
00541         }
00542 
00543         if ( (draw_x3 >=0 ) && (draw_y3 <= height()) ) {
00544             pixel(draw_x3, draw_y3, color);
00545         }
00546 
00547         if ( (draw_x4 <= width()) && (draw_y4 >= 0) ) {
00548             pixel(draw_x4, draw_y4, color);
00549         }
00550 
00551         if ( (draw_x5 >= 0) && (draw_y5 >= 0) ) {
00552             pixel(draw_x5, draw_y5, color);
00553         }
00554         if ( (draw_x6 <=width()) && (draw_y6 <= height()) ) {
00555             pixel(draw_x6, draw_y6, color);
00556         }
00557         if ( (draw_x7 >= 0) && (draw_y7 <= height()) ) {
00558             pixel(draw_x7, draw_y7, color);
00559         }
00560     }
00561     if(auto_up) copy_to_lcd();
00562 }
00563 
00564 void C12832_LCD::fillcircle(int x, int y, int r, int color)
00565 {
00566     int i,up;
00567     up = auto_up;
00568     auto_up = 0;   // off
00569     for (i = 0; i <= r; i++)
00570         circle(x,y,i,color);
00571     auto_up = up;
00572     if(auto_up) copy_to_lcd();
00573 }
00574 
00575 void C12832_LCD::setmode(int mode)
00576 {
00577     draw_mode = mode;
00578 }
00579 
00580 void C12832_LCD::locate(int x, int y)
00581 {
00582     char_x = x;
00583     char_y = y;
00584 }
00585 
00586 
00587 
00588 int C12832_LCD::columns()
00589 {
00590     return width() / font[1];
00591 }
00592 
00593 
00594 
00595 int C12832_LCD::rows()
00596 {
00597     return height() / font[2];
00598 }
00599 
00600 
00601 
00602 int C12832_LCD::_putc(int value)
00603 {
00604     if (value == '\n') {    // new line
00605         char_x = 0;
00606         char_y = char_y + font[2];
00607         if (char_y >= (unsigned int)height() - font[2]) {
00608             char_y = 0;
00609         }
00610     } else {
00611         character(char_x, char_y, value);
00612         if(auto_up) copy_to_lcd();
00613     }
00614     return value;
00615 }
00616 
00617 void C12832_LCD::character(int x, int y, int c)
00618 {
00619     unsigned int hor,vert,offset,bpl,j,i,b;
00620     unsigned char* zeichen;
00621     unsigned char z,w;
00622 
00623     if ((c < 31) || (c > 127)) return;   // test char range
00624 
00625     // read font parameter from start of array
00626     offset = font[0];                    // bytes / char
00627     hor = font[1];                       // get hor size of font
00628     vert = font[2];                      // get vert size of font
00629     bpl = font[3];                       // bytes per line
00630 
00631     if (char_x + hor > (unsigned int)width()) {
00632         char_x = 0;
00633         char_y = char_y + vert;
00634         if (char_y >= (unsigned int)height() - font[2]) {
00635             char_y = 0;
00636         }
00637     }
00638 
00639     zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
00640     w = zeichen[0];                          // width of actual char
00641     // construct the char into the buffer
00642     for (j=0; j<vert; j++) {  //  vert line
00643         for (i=0; i<hor; i++) {   //  horz line
00644             z =  zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
00645             b = 1 << (j & 0x07);
00646             if (( z & b ) == 0x00) {
00647                 pixel(x+i,y+j,0);
00648             } else {
00649                 pixel(x+i,y+j,1);
00650             }
00651 
00652         }
00653     }
00654 
00655     char_x += w;
00656 }
00657 
00658 
00659 void C12832_LCD::set_font(unsigned char* f)
00660 {
00661     font = f;
00662 }
00663 
00664 void C12832_LCD::set_auto_up(unsigned int up)
00665 {
00666     if(up ) auto_up = 1;
00667     else auto_up = 0;
00668 }
00669 
00670 unsigned int C12832_LCD::get_auto_up(void)
00671 {
00672     return (auto_up);
00673 }
00674 
00675 void C12832_LCD::print_bm(Bitmap bm, int x, int y)
00676 {
00677     int h,v,b;
00678     char d;
00679 
00680     for(v=0; v < bm.ySize; v++) {   // lines
00681         for(h=0; h < bm.xSize; h++) { // pixel
00682             if(h + x > 127) break;
00683             if(v + y > 31) break;
00684             d = bm.data[bm.Byte_in_Line * v + ((h & 0xF8) >> 3)];
00685             b = 0x80 >> (h & 0x07);
00686             if((d & b) == 0) {
00687                 pixel(x+h,y+v,0);
00688             } else {
00689                 pixel(x+h,y+v,1);
00690             }
00691         }
00692     }
00693 
00694 }
00695 
00696