Lib for the LCD display on mbed lab Board

Dependents:   HTTPServerCustom

Fork of C12832_lcd by Peter Drescher

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers C12832_lcd.cpp Source File

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     : _spi(p5,NC,p7),_reset(p6),_A0(p8),_CS(p11),GraphicsDisplay(name)
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 
00084 void C12832_LCD::set_contrast(unsigned int o)
00085 {
00086     contrast = o;
00087     wr_cmd(0x81);      //  set volume
00088     wr_cmd(o & 0x3F);
00089 }
00090 
00091 unsigned int C12832_LCD::get_contrast(void)
00092 {
00093     return(contrast);
00094 }
00095 
00096 
00097 // write command to lcd controller
00098 
00099 void C12832_LCD::wr_cmd(unsigned char cmd)
00100 {
00101     _A0 = 0;
00102     _CS = 0;
00103 #if defined TARGET_LPC1768     // fast without mbed lib
00104     LPC_SSP1->DR = cmd;
00105     do {
00106     } while ((LPC_SSP1->SR & 0x10) == 0x10); // wait for SPI1 idle
00107 #else
00108     _spi.write(cmd);
00109 #endif
00110     _CS = 1;
00111 }
00112 
00113 // write data to lcd controller
00114 
00115 void C12832_LCD::wr_dat(unsigned char dat)
00116 {
00117     _A0 = 1;
00118     _CS = 0;
00119 #if defined TARGET_LPC1768     // fast without mbed lib
00120     LPC_SSP1->DR = dat;
00121     do {
00122     } while ((LPC_SSP1->SR & 0x10) == 0x10); // wait for SPI1 idle
00123 #else
00124     _spi.write(dat);
00125 #endif
00126     _CS = 1;
00127 }
00128 
00129 // reset and init the lcd controller
00130 
00131 void C12832_LCD::lcd_reset()
00132 {
00133 
00134     _spi.format(8,3);                 // 8 bit spi mode 3
00135     _spi.frequency(20000000);          // 19,2 Mhz SPI clock
00136     DigitalOut _reset(p6);
00137     _A0 = 0;
00138     _CS = 1;
00139     _reset = 0;                        // display reset
00140     wait_us(50);
00141     _reset = 1;                       // end reset
00142     wait_ms(5);
00143 
00144     /* Start Initial Sequence ----------------------------------------------------*/
00145 
00146     wr_cmd(0xAE);   //  display off
00147     wr_cmd(0xA2);   //  bias voltage
00148 
00149     wr_cmd(0xA0);
00150     wr_cmd(0xC8);   //  colum normal
00151 
00152     wr_cmd(0x22);   //  voltage resistor ratio
00153     wr_cmd(0x2F);   //  power on
00154     //wr_cmd(0xA4);   //  LCD display ram
00155     wr_cmd(0x40);   // start line = 0
00156     wr_cmd(0xAF);     // display ON
00157 
00158     wr_cmd(0x81);   //  set contrast
00159     wr_cmd(0x17);   //  set contrast
00160 
00161     wr_cmd(0xA6);     // display normal
00162 
00163 
00164 #if defined TARGET_LPC1768          //setup DMA channel 0       
00165     LPC_SC->PCONP |= (1UL << 29);   // Power up the GPDMA
00166     LPC_GPDMA->DMACConfig = 1;      // enable DMA controller
00167     LPC_GPDMA->DMACIntTCClear = 0x1;
00168     LPC_GPDMA->DMACIntErrClr = 0x1;
00169     LPC_GPDMACH0->DMACCLLI = 0;
00170 #endif
00171     // clear and update LCD
00172     memset(buffer,0x00,512);  // clear display buffer
00173     copy_to_lcd();
00174     auto_up = 1;              // switch on auto update
00175     // dont do this by default. Make the user call
00176     //claim(stdout);           // redirekt printf to lcd
00177     locate(0,0);
00178     set_font((unsigned char*)Small_7);  // standart font
00179 }
00180 
00181 // set one pixel in buffer
00182 
00183 void C12832_LCD::pixel(int x, int y, int color)
00184 {
00185     // first check parameter
00186     if(x > 128 || y > 32 || x < 0 || y < 0) return;
00187 
00188     if(draw_mode == NORMAL) {
00189         if(color == 0)
00190             buffer[x + ((y/8) * 128)] &= ~(1 << (y%8));  // erase pixel
00191         else
00192             buffer[x + ((y/8) * 128)] |= (1 << (y%8));   // set pixel
00193     } else { // XOR mode
00194         if(color == 1)
00195             buffer[x + ((y/8) * 128)] ^= (1 << (y%8));   // xor pixel
00196     }
00197 }
00198 
00199 // update lcd
00200 
00201 void C12832_LCD::copy_to_lcd(void)
00202 {
00203 #ifndef TARGET_LPC1768
00204     int i;
00205 #endif
00206     //page 0
00207     wr_cmd(0x00);      // set column low nibble 0
00208     wr_cmd(0x10);      // set column hi  nibble 0
00209     wr_cmd(0xB0);      // set page address  0
00210     _A0 = 1;
00211 #if defined TARGET_LPC1768
00212     _CS = 0;
00213     // start 128 byte DMA transfer to SPI1
00214     LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_SSP1->DR; // we send to SSP1
00215     LPC_SSP1->DMACR = 0x2;  // Enable SSP1 for DMA.
00216     LPC_GPDMA->DMACIntTCClear = 0x1;
00217     LPC_GPDMA->DMACIntErrClr = 0x1;
00218     LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer);
00219     LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
00220     LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
00221     LPC_GPDMA->DMACSoftSReq = 0x1;
00222     do {
00223     } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
00224     do {
00225     } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
00226     _CS = 1;
00227 #else  // no DMA
00228     for(i=0; i<128; i++) {
00229         wr_dat(buffer[i]);
00230     }
00231 #endif
00232 
00233     // page 1
00234     wr_cmd(0x00);      // set column low nibble 0
00235     wr_cmd(0x10);      // set column hi  nibble 0
00236     wr_cmd(0xB1);      // set page address  1
00237     _A0 = 1;
00238 #if defined TARGET_LPC1768
00239     _CS = 0;
00240     // start 128 byte DMA transfer to SPI1
00241     LPC_GPDMA->DMACIntTCClear = 0x1;
00242     LPC_GPDMA->DMACIntErrClr = 0x1;
00243     LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 128);
00244     LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
00245     LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
00246     LPC_GPDMA->DMACSoftSReq = 0x1;
00247     do {
00248     } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
00249     do {
00250     } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
00251     _CS = 1;
00252 #else // no DMA
00253     for(i=128; i<256; i++) {
00254         wr_dat(buffer[i]);
00255     }
00256 #endif
00257 
00258     //page 2
00259     wr_cmd(0x00);      // set column low nibble 0
00260     wr_cmd(0x10);      // set column hi  nibble 0
00261     wr_cmd(0xB2);      // set page address  2
00262     _A0 = 1;
00263 #if defined TARGET_LPC1768
00264     _CS = 0;
00265     // start 128 byte DMA transfer to SPI1
00266     LPC_GPDMA->DMACIntTCClear = 0x1;
00267     LPC_GPDMA->DMACIntErrClr = 0x1;
00268     LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 256);
00269     LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
00270     LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX ;
00271     LPC_GPDMA->DMACSoftSReq = 0x1;
00272     do {
00273     } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
00274     do {
00275     } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
00276     _CS = 1;
00277 #else // no DMA
00278     for(i=256; i<384; i++) {
00279         wr_dat(buffer[i]);
00280     }
00281 #endif
00282 
00283     //page 3
00284     wr_cmd(0x00);      // set column low nibble 0
00285     wr_cmd(0x10);      // set column hi  nibble 0
00286     wr_cmd(0xB3);      // set page address  3
00287     _A0 = 1;
00288 
00289     _CS = 0;
00290 #if defined TARGET_LPC1768
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 + 384);
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=384; i<512; i++) {
00305         wr_dat(buffer[i]);
00306     }
00307 #endif
00308 }
00309 
00310 void C12832_LCD::cls(void)
00311 {
00312     memset(buffer,0x00,512);  // clear display buffer
00313     copy_to_lcd();
00314 }
00315 
00316 
00317 void C12832_LCD::line(int x0, int y0, int x1, int y1, int color)
00318 {
00319     int   dx = 0, dy = 0;
00320     int   dx_sym = 0, dy_sym = 0;
00321     int   dx_x2 = 0, dy_x2 = 0;
00322     int   di = 0;
00323 
00324     dx = x1-x0;
00325     dy = y1-y0;
00326 
00327     //  if (dx == 0) {        /* vertical line */
00328     //      if (y1 > y0) vline(x0,y0,y1,color);
00329     //      else vline(x0,y1,y0,color);
00330     //      return;
00331     //  }
00332 
00333     if (dx > 0) {
00334         dx_sym = 1;
00335     } else {
00336         dx_sym = -1;
00337     }
00338     //  if (dy == 0) {        /* horizontal line */
00339     //      if (x1 > x0) hline(x0,x1,y0,color);
00340     //      else  hline(x1,x0,y0,color);
00341     //      return;
00342     //  }
00343 
00344     if (dy > 0) {
00345         dy_sym = 1;
00346     } else {
00347         dy_sym = -1;
00348     }
00349 
00350     dx = dx_sym*dx;
00351     dy = dy_sym*dy;
00352 
00353     dx_x2 = dx*2;
00354     dy_x2 = dy*2;
00355 
00356     if (dx >= dy) {
00357         di = dy_x2 - dx;
00358         while (x0 != x1) {
00359 
00360             pixel(x0, y0, color);
00361             x0 += dx_sym;
00362             if (di<0) {
00363                 di += dy_x2;
00364             } else {
00365                 di += dy_x2 - dx_x2;
00366                 y0 += dy_sym;
00367             }
00368         }
00369         pixel(x0, y0, color);
00370     } else {
00371         di = dx_x2 - dy;
00372         while (y0 != y1) {
00373             pixel(x0, y0, color);
00374             y0 += dy_sym;
00375             if (di < 0) {
00376                 di += dx_x2;
00377             } else {
00378                 di += dx_x2 - dy_x2;
00379                 x0 += dx_sym;
00380             }
00381         }
00382         pixel(x0, y0, color);
00383     }
00384     if(auto_up) copy_to_lcd();
00385 }
00386 
00387 void C12832_LCD::rect(int x0, int y0, int x1, int y1, int color)
00388 {
00389 
00390     if (x1 > x0) line(x0,y0,x1,y0,color);
00391     else  line(x1,y0,x0,y0,color);
00392 
00393     if (y1 > y0) line(x0,y0,x0,y1,color);
00394     else line(x0,y1,x0,y0,color);
00395 
00396     if (x1 > x0) line(x0,y1,x1,y1,color);
00397     else  line(x1,y1,x0,y1,color);
00398 
00399     if (y1 > y0) line(x1,y0,x1,y1,color);
00400     else line(x1,y1,x1,y0,color);
00401 
00402     if(auto_up) copy_to_lcd();
00403 }
00404 
00405 void C12832_LCD::fillrect(int x0, int y0, int x1, int y1, int color)
00406 {
00407     int l,c,i;
00408     if(x0 > x1) {
00409         i = x0;
00410         x0 = x1;
00411         x1 = i;
00412     }
00413 
00414     if(y0 > y1) {
00415         i = y0;
00416         y0 = y1;
00417         y1 = i;
00418     }
00419 
00420     for(l = x0; l<= x1; l ++) {
00421         for(c = y0; c<= y1; c++) {
00422             pixel(l,c,color);
00423         }
00424     }
00425     if(auto_up) copy_to_lcd();
00426 }
00427 
00428 
00429 
00430 void C12832_LCD::circle(int x0, int y0, int r, int color)
00431 {
00432 
00433     int draw_x0, draw_y0;
00434     int draw_x1, draw_y1;
00435     int draw_x2, draw_y2;
00436     int draw_x3, draw_y3;
00437     int draw_x4, draw_y4;
00438     int draw_x5, draw_y5;
00439     int draw_x6, draw_y6;
00440     int draw_x7, draw_y7;
00441     int xx, yy;
00442     int di;
00443     //WindowMax();
00444     if (r == 0) {       /* no radius */
00445         return;
00446     }
00447 
00448     draw_x0 = draw_x1 = x0;
00449     draw_y0 = draw_y1 = y0 + r;
00450     if (draw_y0 < height()) {
00451         pixel(draw_x0, draw_y0, color);     /* 90 degree */
00452     }
00453 
00454     draw_x2 = draw_x3 = x0;
00455     draw_y2 = draw_y3 = y0 - r;
00456     if (draw_y2 >= 0) {
00457         pixel(draw_x2, draw_y2, color);    /* 270 degree */
00458     }
00459 
00460     draw_x4 = draw_x6 = x0 + r;
00461     draw_y4 = draw_y6 = y0;
00462     if (draw_x4 < width()) {
00463         pixel(draw_x4, draw_y4, color);     /* 0 degree */
00464     }
00465 
00466     draw_x5 = draw_x7 = x0 - r;
00467     draw_y5 = draw_y7 = y0;
00468     if (draw_x5>=0) {
00469         pixel(draw_x5, draw_y5, color);     /* 180 degree */
00470     }
00471 
00472     if (r == 1) {
00473         return;
00474     }
00475 
00476     di = 3 - 2*r;
00477     xx = 0;
00478     yy = r;
00479     while (xx < yy) {
00480 
00481         if (di < 0) {
00482             di += 4*xx + 6;
00483         } else {
00484             di += 4*(xx - yy) + 10;
00485             yy--;
00486             draw_y0--;
00487             draw_y1--;
00488             draw_y2++;
00489             draw_y3++;
00490             draw_x4--;
00491             draw_x5++;
00492             draw_x6--;
00493             draw_x7++;
00494         }
00495         xx++;
00496         draw_x0++;
00497         draw_x1--;
00498         draw_x2++;
00499         draw_x3--;
00500         draw_y4++;
00501         draw_y5++;
00502         draw_y6--;
00503         draw_y7--;
00504 
00505         if ( (draw_x0 <= width()) && (draw_y0>=0) ) {
00506             pixel(draw_x0, draw_y0, color);
00507         }
00508 
00509         if ( (draw_x1 >= 0) && (draw_y1 >= 0) ) {
00510             pixel(draw_x1, draw_y1, color);
00511         }
00512 
00513         if ( (draw_x2 <= width()) && (draw_y2 <= height()) ) {
00514             pixel(draw_x2, draw_y2, color);
00515         }
00516 
00517         if ( (draw_x3 >=0 ) && (draw_y3 <= height()) ) {
00518             pixel(draw_x3, draw_y3, color);
00519         }
00520 
00521         if ( (draw_x4 <= width()) && (draw_y4 >= 0) ) {
00522             pixel(draw_x4, draw_y4, color);
00523         }
00524 
00525         if ( (draw_x5 >= 0) && (draw_y5 >= 0) ) {
00526             pixel(draw_x5, draw_y5, color);
00527         }
00528         if ( (draw_x6 <=width()) && (draw_y6 <= height()) ) {
00529             pixel(draw_x6, draw_y6, color);
00530         }
00531         if ( (draw_x7 >= 0) && (draw_y7 <= height()) ) {
00532             pixel(draw_x7, draw_y7, color);
00533         }
00534     }
00535     if(auto_up) copy_to_lcd();
00536 }
00537 
00538 void C12832_LCD::fillcircle(int x, int y, int r, int color)
00539 {
00540     int i,up;
00541     up = auto_up;
00542     auto_up = 0;   // off
00543     for (i = 0; i <= r; i++)
00544         circle(x,y,i,color);
00545     auto_up = up;
00546     if(auto_up) copy_to_lcd();
00547 }
00548 
00549 void C12832_LCD::setmode(int mode)
00550 {
00551     draw_mode = mode;
00552 }
00553 
00554 void C12832_LCD::locate(int x, int y)
00555 {
00556     char_x = x;
00557     char_y = y;
00558 }
00559 
00560 
00561 
00562 int C12832_LCD::columns()
00563 {
00564     return width() / font[1];
00565 }
00566 
00567 
00568 
00569 int C12832_LCD::rows()
00570 {
00571     return height() / font[2];
00572 }
00573 
00574 
00575 
00576 int C12832_LCD::_putc(int value)
00577 {
00578     if (value == '\n') {    // new line
00579         char_x = 0;
00580         char_y = char_y + font[2];
00581         if (char_y >= height() - font[2]) {
00582             char_y = 0;
00583         }
00584     } else {
00585         character(char_x, char_y, value);
00586         if(auto_up) copy_to_lcd();
00587     }
00588     return value;
00589 }
00590 
00591 void C12832_LCD::character(int x, int y, int c)
00592 {
00593     unsigned int hor,vert,offset,bpl,j,i,b;
00594     unsigned char* zeichen;
00595     unsigned char z,w;
00596 
00597     if ((c < 31) || (c > 127)) return;   // test char range
00598 
00599     // read font parameter from start of array
00600     offset = font[0];                    // bytes / char
00601     hor = font[1];                       // get hor size of font
00602     vert = font[2];                      // get vert size of font
00603     bpl = font[3];                       // bytes per line
00604 
00605     if (char_x + hor > width()) {
00606         char_x = 0;
00607         char_y = char_y + vert;
00608         if (char_y >= height() - font[2]) {
00609             char_y = 0;
00610         }
00611     }
00612 
00613     zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
00614     w = zeichen[0];                          // width of actual char
00615     // construct the char into the buffer
00616     for (j=0; j<vert; j++) {  //  vert line
00617         for (i=0; i<hor; i++) {   //  horz line
00618             z =  zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
00619             b = 1 << (j & 0x07);
00620             if (( z & b ) == 0x00) {
00621                 pixel(x+i,y+j,0);
00622             } else {
00623                 pixel(x+i,y+j,1);
00624             }
00625 
00626         }
00627     }
00628 
00629     char_x += w;
00630 }
00631 
00632 
00633 void C12832_LCD::set_font(unsigned char* f)
00634 {
00635     font = f;
00636 }
00637 
00638 void C12832_LCD::set_auto_up(unsigned int up)
00639 {
00640     if(up ) auto_up = 1;
00641     else auto_up = 0;
00642 }
00643 
00644 unsigned int C12832_LCD::get_auto_up(void)
00645 {
00646     return (auto_up);
00647 }
00648 
00649 void C12832_LCD::print_bm(Bitmap bm, int x, int y)
00650 {
00651     int h,v,b;
00652     char d;
00653 
00654     for(v=0; v < bm.ySize; v++) {   // lines
00655         for(h=0; h < bm.xSize; h++) { // pixel
00656             if(h + x > 127) break;
00657             if(v + y > 31) break;
00658             d = bm.data[bm.Byte_in_Line * v + ((h & 0xF8) >> 3)];
00659             b = 0x80 >> (h & 0x07);
00660             if((d & b) == 0) {
00661                 pixel(x+h,y+v,0);
00662             } else {
00663                 pixel(x+h,y+v,1);
00664             }
00665         }
00666     }
00667 
00668 }
00669 
00670