firmware/drivers/lcd-16bit.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2005 by Dave Chapman
  11  *
  12  * Rockbox driver for 16-bit colour LCDs
  13  *
  14  * All files in this archive are subject to the GNU General Public License.
  15  * See the file COPYING in the source tree root for full license agreement.
  16  *
  17  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  18  * KIND, either express or implied.
  19  *
  20  ****************************************************************************/
  21 #include "config.h"
  22
  23 #include "cpu.h"
  24 #include "lcd.h"
  25 #include "kernel.h"
  26 #include "thread.h"
  27 #include <string.h>
  28 #include <stdlib.h>
  29 #include "memory.h"
  30 #include "file.h"
  31 #include "debug.h"
  32 #include "system.h"
  33 #include "font.h"
  34 #include "rbunicode.h"
  35 #include "bidi.h"
  36 #include "scroll_engine.h"
  37
  38 enum fill_opt {
  39     OPT_NONE = 0,
  40     OPT_SET,
  41     OPT_COPY
  42 };
  43
  44 /*** globals ***/
  45 fb_data lcd_framebuffer[LCD_FBHEIGHT][LCD_FBWIDTH]
  46     IRAM_LCDFRAMEBUFFER CACHEALIGN_AT_LEAST_ATTR(16);
  47
  48
  49 static fb_data* lcd_backdrop = NULL;
  50 static long lcd_backdrop_offset IDATA_ATTR = 0;
  51
  52 static struct viewport default_vp =
  53 {
  54     .x        = 0,
  55     .y        = 0,
  56     .width    = LCD_WIDTH,
  57     .height   = LCD_HEIGHT,
  58     .font     = FONT_SYSFIXED,
  59     .drawmode = DRMODE_SOLID,
  60     .xmargin  = 0,
  61     .ymargin  = 0,
  62     .fg_pattern = LCD_DEFAULT_FG,
  63     .bg_pattern = LCD_DEFAULT_BG,
  64     .lss_pattern = LCD_DEFAULT_BG,
  65     .lse_pattern = LCD_DEFAULT_BG,
  66     .lst_pattern = LCD_DEFAULT_BG,
  67 };
  68
  69 /* The Gigabeat target build requires access to the current fg_pattern
  70    in lcd-meg-fx.c */
  71 #if !defined(TOSHIBA_GIGABEAT_F) || defined(SIMULATOR)
  72 static struct viewport* current_vp IDATA_ATTR = &default_vp;
  73 #else
  74 struct viewport* current_vp IDATA_ATTR = &default_vp;
  75 #endif
  76
  77 /* LCD init */
  78 void lcd_init(void)
  79 {
  80     lcd_clear_display();
  81
  82     /* Call device specific init */
  83     lcd_init_device();
  84     scroll_init();
  85 }
  86
  87 /*** Viewports ***/
  88
  89 void lcd_set_viewport(struct viewport* vp)
  90 {
  91     if (vp == NULL)
  92         current_vp = &default_vp;
  93     else
  94         current_vp = vp;
  95 }
  96
  97 void lcd_update_viewport(void)
  98 {
  99     lcd_update_rect(current_vp->x, current_vp->y,
 100                     current_vp->width, current_vp->height);
 101 }
 102
 103 void lcd_update_viewport_rect(int x, int y, int width, int height)
 104 {
 105     lcd_update_rect(current_vp->x + x, current_vp->y + y, width, height);
 106 }
 107
 108 /*** parameter handling ***/
 109
 110 void lcd_set_drawmode(int mode)
 111 {
 112     current_vp->drawmode = mode & (DRMODE_SOLID|DRMODE_INVERSEVID);
 113 }
 114
 115 int lcd_get_drawmode(void)
 116 {
 117     return current_vp->drawmode;
 118 }
 119
 120 void lcd_set_foreground(unsigned color)
 121 {
 122     current_vp->fg_pattern = color;
 123 }
 124
 125 unsigned lcd_get_foreground(void)
 126 {
 127     return current_vp->fg_pattern;
 128 }
 129
 130 void lcd_set_background(unsigned color)
 131 {
 132     current_vp->bg_pattern = color;
 133 }
 134
 135 unsigned lcd_get_background(void)
 136 {
 137     return current_vp->bg_pattern;
 138 }
 139
 140 void lcd_set_selector_start(unsigned color)
 141 {
 142     current_vp->lss_pattern = color;
 143 }
 144
 145 void lcd_set_selector_end(unsigned color)
 146 {
 147     current_vp->lse_pattern = color;
 148 }
 149
 150 void lcd_set_selector_text(unsigned color)
 151 {
 152     current_vp->lst_pattern = color;
 153 }
 154
 155 void lcd_set_drawinfo(int mode, unsigned fg_color, unsigned bg_color)
 156 {
 157     lcd_set_drawmode(mode);
 158     current_vp->fg_pattern = fg_color;
 159     current_vp->bg_pattern = bg_color;
 160 }
 161
 162 void lcd_setmargins(int x, int y)
 163 {
 164     current_vp->xmargin = x;
 165     current_vp->ymargin = y;
 166 }
 167
 168 int lcd_getwidth(void)
 169 {
 170     return current_vp->width;
 171 }
 172
 173 int lcd_getheight(void)
 174 {
 175     return current_vp->height;
 176 }
 177
 178 int lcd_getxmargin(void)
 179 {
 180     return current_vp->xmargin;
 181 }
 182
 183 int lcd_getymargin(void)
 184 {
 185     return current_vp->ymargin;
 186 }
 187
 188 void lcd_setfont(int newfont)
 189 {
 190     current_vp->font = newfont;
 191 }
 192
 193 int lcd_getfont(void)
 194 {
 195     return current_vp->font;
 196 }
 197
 198 int lcd_getstringsize(const unsigned char *str, int *w, int *h)
 199 {
 200     return font_getstringsize(str, w, h, current_vp->font);
 201 }
 202
 203 /*** low-level drawing functions ***/
 204
 205 #define LCDADDR(x, y) (&lcd_framebuffer[(y)][(x)])
 206
 207 static void setpixel(fb_data *address) ICODE_ATTR;
 208 static void setpixel(fb_data *address)
 209 {
 210     *address = current_vp->fg_pattern;
 211 }
 212
 213 static void clearpixel(fb_data *address) ICODE_ATTR;
 214 static void clearpixel(fb_data *address)
 215 {
 216     *address = current_vp->bg_pattern;
 217 }
 218
 219 static void clearimgpixel(fb_data *address) ICODE_ATTR;
 220 static void clearimgpixel(fb_data *address)
 221 {
 222     *address = *(fb_data *)((long)address + lcd_backdrop_offset);
 223 }
 224
 225 static void flippixel(fb_data *address) ICODE_ATTR;
 226 static void flippixel(fb_data *address)
 227 {
 228     *address = ~(*address);
 229 }
 230
 231 static void nopixel(fb_data *address) ICODE_ATTR;
 232 static void nopixel(fb_data *address)
 233 {
 234     (void)address;
 235 }
 236
 237 lcd_fastpixelfunc_type* const lcd_fastpixelfuncs_bgcolor[8] = {
 238     flippixel, nopixel, setpixel, setpixel,
 239     nopixel, clearpixel, nopixel, clearpixel
 240 };
 241
 242 lcd_fastpixelfunc_type* const lcd_fastpixelfuncs_backdrop[8] = {
 243     flippixel, nopixel, setpixel, setpixel,
 244     nopixel, clearimgpixel, nopixel, clearimgpixel
 245 };
 246
 247 lcd_fastpixelfunc_type* const * lcd_fastpixelfuncs = lcd_fastpixelfuncs_bgcolor;
 248
 249 void lcd_set_backdrop(fb_data* backdrop)
 250 {
 251     lcd_backdrop = backdrop;
 252     if (backdrop)
 253     {
 254         lcd_backdrop_offset = (long)backdrop - (long)&lcd_framebuffer[0][0];
 255         lcd_fastpixelfuncs = lcd_fastpixelfuncs_backdrop;
 256     }
 257     else
 258     {
 259         lcd_backdrop_offset = 0;
 260         lcd_fastpixelfuncs = lcd_fastpixelfuncs_bgcolor;
 261     }
 262 }
 263
 264 fb_data* lcd_get_backdrop(void)
 265 {
 266     return lcd_backdrop;
 267 }
 268
 269 /*** drawing functions ***/
 270
 271 /* Clear the current viewport */
 272 void lcd_clear_viewport(void)
 273 {
 274     fb_data *dst, *dst_end;
 275
 276     dst = LCDADDR(current_vp->x, current_vp->y);
 277     dst_end = dst + current_vp->height * LCD_WIDTH;
 278
 279     if (current_vp->drawmode & DRMODE_INVERSEVID)
 280     {
 281         do
 282         {
 283             memset16(dst, current_vp->fg_pattern, current_vp->width);
 284             dst += LCD_WIDTH;
 285         }
 286         while (dst < dst_end);
 287     }
 288     else
 289     {
 290         if (!lcd_backdrop)
 291         {
 292             do
 293             {
 294                 memset16(dst, current_vp->bg_pattern, current_vp->width);
 295                 dst += LCD_WIDTH;
 296             }
 297             while (dst < dst_end);
 298         }
 299         else
 300         {
 301             do
 302             {
 303                 memcpy(dst, (void *)((long)dst + lcd_backdrop_offset),
 304                        current_vp->width * sizeof(fb_data));
 305                 dst += LCD_WIDTH;
 306             }
 307             while (dst < dst_end);
 308         }
 309     }
 310
 311     if (current_vp == &default_vp)
 312     {
 313         lcd_scroll_info.lines = 0;
 314     }
 315     else
 316     {
 317         lcd_scroll_stop(current_vp);
 318     }
 319 }
 320
 321 /* Clear the whole display */
 322 void lcd_clear_display(void)
 323 {
 324     struct viewport* old_vp = current_vp;
 325
 326     current_vp = &default_vp;
 327
 328     lcd_clear_viewport();
 329
 330     current_vp = old_vp;
 331 }
 332
 333 /* Set a single pixel */
 334 void lcd_drawpixel(int x, int y)
 335 {
 336     if (((unsigned)x < (unsigned)current_vp->width) &&
 337         ((unsigned)y < (unsigned)current_vp->height))
 338         lcd_fastpixelfuncs[current_vp->drawmode](LCDADDR(current_vp->x+x, current_vp->y+y));
 339 }
 340
 341 /* Draw a line */
 342 void lcd_drawline(int x1, int y1, int x2, int y2)
 343 {
 344     int numpixels;
 345     int i;
 346     int deltax, deltay;
 347     int d, dinc1, dinc2;
 348     int x, xinc1, xinc2;
 349     int y, yinc1, yinc2;
 350     lcd_fastpixelfunc_type *pfunc = lcd_fastpixelfuncs[current_vp->drawmode];
 351
 352     deltax = abs(x2 - x1);
 353     deltay = abs(y2 - y1);
 354     xinc2 = 1;
 355     yinc2 = 1;
 356
 357     if (deltax >= deltay)
 358     {
 359         numpixels = deltax;
 360         d = 2 * deltay - deltax;
 361         dinc1 = deltay * 2;
 362         dinc2 = (deltay - deltax) * 2;
 363         xinc1 = 1;
 364         yinc1 = 0;
 365     }
 366     else
 367     {
 368         numpixels = deltay;
 369         d = 2 * deltax - deltay;
 370         dinc1 = deltax * 2;
 371         dinc2 = (deltax - deltay) * 2;
 372         xinc1 = 0;
 373         yinc1 = 1;
 374     }
 375     numpixels++; /* include endpoints */
 376
 377     if (x1 > x2)
 378     {
 379         xinc1 = -xinc1;
 380         xinc2 = -xinc2;
 381     }
 382
 383     if (y1 > y2)
 384     {
 385         yinc1 = -yinc1;
 386         yinc2 = -yinc2;
 387     }
 388
 389     x = x1;
 390     y = y1;
 391
 392     for (i = 0; i < numpixels; i++)
 393     {
 394         if (((unsigned)x < (unsigned)current_vp->width) && ((unsigned)y < (unsigned)current_vp->height))
 395             pfunc(LCDADDR(x + current_vp->x, y + current_vp->y));
 396
 397         if (d < 0)
 398         {
 399             d += dinc1;
 400             x += xinc1;
 401             y += yinc1;
 402         }
 403         else
 404         {
 405             d += dinc2;
 406             x += xinc2;
 407             y += yinc2;
 408         }
 409     }
 410 }
 411
 412 /* Draw a horizontal line (optimised) */
 413 void lcd_hline(int x1, int x2, int y)
 414 {
 415     int x, width;
 416     unsigned bits = 0;
 417     enum fill_opt fillopt = OPT_NONE;
 418     fb_data *dst, *dst_end;
 419     lcd_fastpixelfunc_type *pfunc = lcd_fastpixelfuncs[current_vp->drawmode];
 420
 421     /* direction flip */
 422     if (x2 < x1)
 423     {
 424         x = x1;
 425         x1 = x2;
 426         x2 = x;
 427     }
 428
 429     /* nothing to draw? */
 430     if (((unsigned)y >= (unsigned)current_vp->height) ||
 431         (x1 >= current_vp->width) ||
 432         (x2 < 0))
 433         return;
 434
 435     /* clipping */
 436     if (x1 < 0)
 437         x1 = 0;
 438     if (x2 >= current_vp->width)
 439         x2 = current_vp->width-1;
 440
 441     width = x2 - x1 + 1;
 442
 443     /* Adjust x1 and y to viewport */
 444     x1 += current_vp->x;
 445     y += current_vp->y;
 446
 447     if (current_vp->drawmode & DRMODE_INVERSEVID)
 448     {
 449         if (current_vp->drawmode & DRMODE_BG)
 450         {
 451             if (!lcd_backdrop)
 452             {
 453                 fillopt = OPT_SET;
 454                 bits = current_vp->bg_pattern;
 455             }
 456             else
 457                 fillopt = OPT_COPY;
 458         }
 459     }
 460     else
 461     {
 462         if (current_vp->drawmode & DRMODE_FG)
 463         {
 464             fillopt = OPT_SET;
 465             bits = current_vp->fg_pattern;
 466         }
 467     }
 468     dst = LCDADDR(x1, y);
 469
 470     switch (fillopt)
 471     {
 472       case OPT_SET:
 473         memset16(dst, bits, width);
 474         break;
 475
 476       case OPT_COPY:
 477         memcpy(dst, (void *)((long)dst + lcd_backdrop_offset),
 478                width * sizeof(fb_data));
 479         break;
 480
 481       case OPT_NONE:
 482         dst_end = dst + width;
 483         do
 484             pfunc(dst++);
 485         while (dst < dst_end);
 486         break;
 487     }
 488 }
 489
 490 /* Draw a vertical line (optimised) */
 491 void lcd_vline(int x, int y1, int y2)
 492 {
 493     int y;
 494     fb_data *dst, *dst_end;
 495     lcd_fastpixelfunc_type *pfunc = lcd_fastpixelfuncs[current_vp->drawmode];
 496
 497     /* direction flip */
 498     if (y2 < y1)
 499     {
 500         y = y1;
 501         y1 = y2;
 502         y2 = y;
 503     }
 504
 505     /* nothing to draw? */
 506     if ((x >= current_vp->width) ||
 507         (y1 >= current_vp->height) ||
 508         (y2 < 0))
 509         return;
 510
 511     /* clipping */
 512     if (y1 < 0)
 513         y1 = 0;
 514     if (y2 >= current_vp->height)
 515         y2 = current_vp->height-1;
 516
 517     dst = LCDADDR(x + current_vp->x, y1 + current_vp->y);
 518     dst_end = dst + (y2 - y1) * LCD_WIDTH;
 519
 520     do
 521     {
 522         pfunc(dst);
 523         dst += LCD_WIDTH;
 524     }
 525     while (dst <= dst_end);
 526 }
 527
 528 /* Draw a rectangular box */
 529 void lcd_drawrect(int x, int y, int width, int height)
 530 {
 531     if ((width <= 0) || (height <= 0))
 532         return;
 533
 534     int x2 = x + width - 1;
 535     int y2 = y + height - 1;
 536
 537     lcd_vline(x, y, y2);
 538     lcd_vline(x2, y, y2);
 539     lcd_hline(x, x2, y);
 540     lcd_hline(x, x2, y2);
 541 }
 542
 543 /* Fill a rectangular area */
 544 void lcd_fillrect(int x, int y, int width, int height)
 545 {
 546     unsigned bits = 0;
 547     enum fill_opt fillopt = OPT_NONE;
 548     fb_data *dst, *dst_end;
 549     lcd_fastpixelfunc_type *pfunc = lcd_fastpixelfuncs[current_vp->drawmode];
 550
 551     /* nothing to draw? */
 552     if ((width <= 0) || (height <= 0) || (x >= current_vp->width) ||
 553         (y >= current_vp->height) || (x + width <= 0) || (y + height <= 0))
 554         return;
 555
 556     /* clipping */
 557     if (x < 0)
 558     {
 559         width += x;
 560         x = 0;
 561     }
 562     if (y < 0)
 563     {
 564         height += y;
 565         y = 0;
 566     }
 567     if (x + width > current_vp->width)
 568         width = current_vp->width - x;
 569     if (y + height > current_vp->height)
 570         height = current_vp->height - y;
 571
 572     if (current_vp->drawmode & DRMODE_INVERSEVID)
 573     {
 574         if (current_vp->drawmode & DRMODE_BG)
 575         {
 576             if (!lcd_backdrop)
 577             {
 578                 fillopt = OPT_SET;
 579                 bits = current_vp->bg_pattern;
 580             }
 581             else
 582                 fillopt = OPT_COPY;
 583         }
 584     }
 585     else
 586     {
 587         if (current_vp->drawmode & DRMODE_FG)
 588         {
 589             fillopt = OPT_SET;
 590             bits = current_vp->fg_pattern;
 591         }
 592     }
 593     dst = LCDADDR(current_vp->x + x, current_vp->y + y);
 594     dst_end = dst + height * LCD_WIDTH;
 595
 596     do
 597     {
 598         fb_data *dst_row, *row_end;
 599
 600         switch (fillopt)
 601         {
 602           case OPT_SET:
 603             memset16(dst, bits, width);
 604             break;
 605
 606           case OPT_COPY:
 607             memcpy(dst, (void *)((long)dst + lcd_backdrop_offset),
 608                    width * sizeof(fb_data));
 609             break;
 610
 611           case OPT_NONE:
 612             dst_row = dst;
 613             row_end = dst_row + width;
 614             do
 615                 pfunc(dst_row++);
 616             while (dst_row < row_end);
 617             break;
 618         }
 619         dst += LCD_WIDTH;
 620     }
 621     while (dst < dst_end);
 622 }
 623
 624 /* Fill a rectangle with a gradient */
 625 void lcd_gradient_rect(int x1, int x2, int y, int h)
 626 {
 627     int old_pattern = current_vp->fg_pattern;
 628
 629     if (h == 0) return;
 630
 631     int h_r = RGB_UNPACK_RED(current_vp->lss_pattern) << 16;
 632     int h_b = RGB_UNPACK_BLUE(current_vp->lss_pattern) << 16;
 633     int h_g = RGB_UNPACK_GREEN(current_vp->lss_pattern) << 16;
 634     int rstep = (h_r - ((signed)RGB_UNPACK_RED(current_vp->lse_pattern) << 16)) / h;
 635     int gstep = (h_g - ((signed)RGB_UNPACK_GREEN(current_vp->lse_pattern) << 16)) / h;
 636     int bstep = (h_b - ((signed)RGB_UNPACK_BLUE(current_vp->lse_pattern) << 16)) / h;
 637     int count;
 638
 639     current_vp->fg_pattern = current_vp->lss_pattern;
 640     for(count = 0; count < h; count++) {
 641         lcd_hline(x1, x2, y + count);
 642         h_r -= rstep;
 643         h_g -= gstep;
 644         h_b -= bstep;
 645         current_vp->fg_pattern = LCD_RGBPACK(h_r >> 16, h_g >> 16, h_b >> 16);
 646     }
 647
 648     current_vp->fg_pattern = old_pattern;
 649 }
 650
 651 #define H_COLOR(lss, lse, cur_line, max_line) \
 652         (((lse) - (lss)) * (cur_line) / (max_line) + (lss))
 653
 654 /* Fill a rectangle with a gradient for scrolling line. To draw a gradient that
 655    covers several lines, we need to know how many lines will be covered
 656    (the num_lines arg), and which one is the current line within the selection
 657    (the cur_line arg). */
 658 void lcd_gradient_rect_scroll(int x1, int x2, int y, int h,
 659                               unsigned char num_lines, unsigned char cur_line)
 660 {
 661     if (h == 0 || num_lines == 0) return;
 662
 663     unsigned tmp_lss = current_vp->lss_pattern;
 664     unsigned tmp_lse = current_vp->lse_pattern;
 665     int lss_r = (signed)RGB_UNPACK_RED(current_vp->lss_pattern);
 666     int lss_b = (signed)RGB_UNPACK_BLUE(current_vp->lss_pattern);
 667     int lss_g = (signed)RGB_UNPACK_GREEN(current_vp->lss_pattern);
 668     int lse_r = (signed)RGB_UNPACK_RED(current_vp->lse_pattern);
 669     int lse_b = (signed)RGB_UNPACK_BLUE(current_vp->lse_pattern);
 670     int lse_g = (signed)RGB_UNPACK_GREEN(current_vp->lse_pattern);
 671
 672     int h_r = H_COLOR(lss_r, lse_r, cur_line, num_lines);
 673     int h_g = H_COLOR(lss_g, lse_g, cur_line, num_lines);
 674     int h_b = H_COLOR(lss_b, lse_b, cur_line, num_lines);
 675     lcd_set_selector_start(LCD_RGBPACK(h_r, h_g, h_b));
 676
 677     int l_r = H_COLOR(lss_r, lse_r, cur_line+1, num_lines);
 678     int l_g = H_COLOR(lss_g, lse_g, cur_line+1, num_lines);
 679     int l_b = H_COLOR(lss_b, lse_b, cur_line+1, num_lines);
 680     lcd_set_selector_end(LCD_RGBPACK(l_r, l_g, l_b));
 681
 682     lcd_gradient_rect(x1, x2, y, h);
 683
 684     current_vp->lss_pattern = tmp_lss;
 685     current_vp->lse_pattern = tmp_lse;
 686 }
 687
 688 /* About Rockbox' internal monochrome bitmap format:
 689  *
 690  * A bitmap contains one bit for every pixel that defines if that pixel is
 691  * black (1) or white (0). Bits within a byte are arranged vertically, LSB
 692  * at top.
 693  * The bytes are stored in row-major order, with byte 0 being top left,
 694  * byte 1 2nd from left etc. The first row of bytes defines pixel rows
 695  * 0..7, the second row defines pixel row 8..15 etc.
 696  *
 697  * This is the mono bitmap format used on all other targets so far; the
 698  * pixel packing doesn't really matter on a 8bit+ target. */
 699
 700 /* Draw a partial monochrome bitmap */
 701
 702 void lcd_mono_bitmap_part(const unsigned char *src, int src_x, int src_y,
 703                           int stride, int x, int y, int width, int height)
 704                           ICODE_ATTR;
 705 void lcd_mono_bitmap_part(const unsigned char *src, int src_x, int src_y,
 706                           int stride, int x, int y, int width, int height)
 707 {
 708     const unsigned char *src_end;
 709     bool has_backdrop;
 710     fb_data *dst, *dst_end, *backdrop;
 711     lcd_fastpixelfunc_type *fgfunc, *bgfunc;
 712
 713     /* nothing to draw? */
 714     if ((width <= 0) || (height <= 0) || (x >= current_vp->width) ||
 715         (y >= current_vp->height) || (x + width <= 0) || (y + height <= 0))
 716         return;
 717
 718     /* clipping */
 719     if (x < 0)
 720     {
 721         width += x;
 722         src_x -= x;
 723         x = 0;
 724     }
 725     if (y < 0)
 726     {
 727         height += y;
 728         src_y -= y;
 729         y = 0;
 730     }
 731     if (x + width > current_vp->width)
 732         width = current_vp->width - x;
 733     if (y + height > current_vp->height)
 734         height = current_vp->height - y;
 735
 736     src += stride * (src_y >> 3) + src_x; /* move starting point */
 737     src_y  &= 7;
 738     src_end = src + width;
 739
 740     dst = LCDADDR(current_vp->x + x, current_vp->y + y);
 741     has_backdrop = (lcd_backdrop != NULL);
 742     backdrop = lcd_backdrop + (current_vp->y + y) * LCD_WIDTH + current_vp->x + x;
 743     fgfunc = lcd_fastpixelfuncs[current_vp->drawmode];
 744     bgfunc = lcd_fastpixelfuncs[current_vp->drawmode ^ DRMODE_INVERSEVID];
 745     do
 746     {
 747         const unsigned char *src_col = src++;
 748         unsigned data = *src_col >> src_y;
 749         fb_data *dst_col = dst++;
 750         int numbits = 8 - src_y;
 751         fb_data *backdrop_col = backdrop++;
 752         dst_end = dst_col + height * LCD_WIDTH;
 753         do
 754         {
 755             switch (current_vp->drawmode)
 756             {
 757                 case DRMODE_SOLID:
 758                     if (data & 0x01)
 759                         *dst_col = current_vp->fg_pattern;
 760                     else
 761                         *dst_col = has_backdrop ? *backdrop_col : current_vp->bg_pattern;
 762                     break;
 763                 case DRMODE_FG:
 764                     if (data & 0x01)
 765                         *dst_col = current_vp->fg_pattern;
 766                     break;
 767                 case (DRMODE_SOLID|DRMODE_INVERSEVID):
 768                     if (data & 0x01)
 769                         *dst_col = has_backdrop ? *backdrop_col : current_vp->bg_pattern;
 770                     else
 771                         *dst_col = current_vp->fg_pattern;
 772                     break;
 773                 default:
 774                     if (data & 0x01)
 775                         fgfunc(dst_col);
 776                     else
 777                         bgfunc(dst_col);
 778                     break;
 779             }
 780             dst_col += LCD_WIDTH;
 781             backdrop_col += LCD_WIDTH;
 782             data >>= 1;
 783             if (--numbits == 0)
 784             {
 785                 src_col += stride;
 786                 data = *src_col;
 787                 numbits = 8;
 788             }
 789         }
 790         while (dst_col < dst_end);
 791     }
 792     while (src < src_end);
 793 }
 794 /* Draw a full monochrome bitmap */
 795 void lcd_mono_bitmap(const unsigned char *src, int x, int y, int width, int height)
 796 {
 797     lcd_mono_bitmap_part(src, 0, 0, width, x, y, width, height);
 798 }
 799
 800 /* Draw a partial native bitmap */
 801 void lcd_bitmap_part(const fb_data *src, int src_x, int src_y,
 802                      int stride, int x, int y, int width, int height)
 803                      ICODE_ATTR;
 804 void lcd_bitmap_part(const fb_data *src, int src_x, int src_y,
 805                      int stride, int x, int y, int width, int height)
 806 {
 807     fb_data *dst, *dst_end;
 808
 809     /* nothing to draw? */
 810     if ((width <= 0) || (height <= 0) || (x >= current_vp->width) ||
 811         (y >= current_vp->height) || (x + width <= 0) || (y + height <= 0))
 812         return;
 813
 814     /* clipping */
 815     if (x < 0)
 816     {
 817         width += x;
 818         src_x -= x;
 819         x = 0;
 820     }
 821     if (y < 0)
 822     {
 823         height += y;
 824         src_y -= y;
 825         y = 0;
 826     }
 827     if (x + width > current_vp->width)
 828         width = current_vp->width - x;
 829     if (y + height > current_vp->height)
 830         height = current_vp->height - y;
 831
 832     src += stride * src_y + src_x; /* move starting point */
 833     dst = LCDADDR(current_vp->x + x, current_vp->y + y);
 834     dst_end = dst + height * LCD_WIDTH;
 835
 836     do
 837     {
 838         memcpy(dst, src, width * sizeof(fb_data));
 839         src += stride;
 840         dst += LCD_WIDTH;
 841     }
 842     while (dst < dst_end);
 843 }
 844
 845 /* Draw a full native bitmap */
 846 void lcd_bitmap(const fb_data *src, int x, int y, int width, int height)
 847 {
 848     lcd_bitmap_part(src, 0, 0, width, x, y, width, height);
 849 }
 850
 851 #if !defined(TOSHIBA_GIGABEAT_F) && !defined(TOSHIBA_GIGABEAT_S) \
 852     || defined(SIMULATOR)
 853 /* Draw a partial native bitmap */
 854 void lcd_bitmap_transparent_part(const fb_data *src, int src_x, int src_y,
 855                                  int stride, int x, int y, int width,
 856                                  int height) ICODE_ATTR;
 857 void lcd_bitmap_transparent_part(const fb_data *src, int src_x, int src_y,
 858                                  int stride, int x, int y, int width,
 859                                  int height)
 860 {
 861     fb_data *dst, *dst_end;
 862
 863     /* nothing to draw? */
 864     if ((width <= 0) || (height <= 0) || (x >= current_vp->width) ||
 865         (y >= current_vp->height) || (x + width <= 0) || (y + height <= 0))
 866         return;
 867
 868     /* clipping */
 869     if (x < 0)
 870     {
 871         width += x;
 872         src_x -= x;
 873         x = 0;
 874     }
 875     if (y < 0)
 876     {
 877         height += y;
 878         src_y -= y;
 879         y = 0;
 880     }
 881     if (x + width > current_vp->width)
 882         width = current_vp->width - x;
 883     if (y + height > current_vp->height)
 884         height = current_vp->height - y;
 885
 886     src += stride * src_y + src_x; /* move starting point */
 887     dst = LCDADDR(current_vp->x + x, current_vp->y + y);
 888     dst_end = dst + height * LCD_WIDTH;
 889
 890     do
 891     {
 892         int i;
 893         for(i = 0;i < width;i++)
 894         {
 895             if (src[i] == REPLACEWITHFG_COLOR)
 896                 dst[i] = current_vp->fg_pattern;
 897             else if(src[i] != TRANSPARENT_COLOR)
 898                 dst[i] = src[i];
 899         }
 900         src += stride;
 901         dst += LCD_WIDTH;
 902     }
 903     while (dst < dst_end);
 904 }
 905 #endif /* !defined(TOSHIBA_GIGABEAT_F) || defined(SIMULATOR) */
 906
 907 /* Draw a full native bitmap with a transparent color */
 908 void lcd_bitmap_transparent(const fb_data *src, int x, int y,
 909                             int width, int height)
 910 {
 911     lcd_bitmap_transparent_part(src, 0, 0, width, x, y, width, height);
 912 }
 913
 914 /* put a string at a given pixel position, skipping first ofs pixel columns */
 915 static void lcd_putsxyofs(int x, int y, int ofs, const unsigned char *str)
 916 {
 917     unsigned short ch;
 918     unsigned short *ucs;
 919     struct font* pf = font_get(current_vp->font);
 920
 921     ucs = bidi_l2v(str, 1);
 922
 923     while ((ch = *ucs++) != 0 && x < current_vp->width)
 924     {
 925         int width;
 926         const unsigned char *bits;
 927
 928         /* get proportional width and glyph bits */
 929         width = font_get_width(pf,ch);
 930
 931         if (ofs > width)
 932         {
 933             ofs -= width;
 934             continue;
 935         }
 936
 937         bits = font_get_bits(pf, ch);
 938
 939         lcd_mono_bitmap_part(bits, ofs, 0, width, x, y, width - ofs, pf->height);
 940
 941         x += width - ofs;
 942         ofs = 0;
 943     }
 944 }
 945
 946 /* put a string at a given pixel position */
 947 void lcd_putsxy(int x, int y, const unsigned char *str)
 948 {
 949     lcd_putsxyofs(x, y, 0, str);
 950 }
 951
 952 /*** line oriented text output ***/
 953
 954 /* put a string at a given char position */
 955 void lcd_puts(int x, int y, const unsigned char *str)
 956 {
 957     lcd_puts_style_offset(x, y, str, STYLE_DEFAULT, 0);
 958 }
 959
 960 void lcd_puts_style(int x, int y, const unsigned char *str, int style)
 961 {
 962     lcd_puts_style_offset(x, y, str, style, 0);
 963 }
 964
 965 void lcd_puts_offset(int x, int y, const unsigned char *str, int offset)
 966 {
 967     lcd_puts_style_offset(x, y, str, STYLE_DEFAULT, offset);
 968 }
 969
 970 /* put a string at a given char position, style, and pixel position,
 971  * skipping first offset pixel columns */
 972 void lcd_puts_style_offset(int x, int y, const unsigned char *str, int style,
 973                            int offset)
 974 {
 975     int xpos,ypos,w,h,xrect;
 976     int lastmode = current_vp->drawmode;
 977     int oldfgcolor = current_vp->fg_pattern;
 978     int oldbgcolor = current_vp->bg_pattern;
 979
 980     /* make sure scrolling is turned off on the line we are updating */
 981     lcd_scroll_stop_line(current_vp, y);
 982
 983     if(!str || !str[0])
 984         return;
 985
 986     lcd_getstringsize(str, &w, &h);
 987     xpos = current_vp->xmargin + x*w / utf8length(str);
 988     ypos = current_vp->ymargin + y*h;
 989     current_vp->drawmode = (style & STYLE_INVERT) ?
 990                (DRMODE_SOLID|DRMODE_INVERSEVID) : DRMODE_SOLID;
 991     if (style & STYLE_COLORED) {
 992         if (current_vp->drawmode == DRMODE_SOLID)
 993             current_vp->fg_pattern = style & STYLE_COLOR_MASK;
 994         else
 995             current_vp->bg_pattern = style & STYLE_COLOR_MASK;
 996     }
 997     current_vp->drawmode ^= DRMODE_INVERSEVID;
 998     xrect = xpos + MAX(w - offset, 0);
 999
1000     if (style & STYLE_GRADIENT) {
1001         current_vp->drawmode = DRMODE_FG;
1002         if (CURLN_UNPACK(style) == 0)
1003             lcd_gradient_rect(xpos, current_vp->width, ypos, h*NUMLN_UNPACK(style));
1004         current_vp->fg_pattern = current_vp->lst_pattern;
1005     }
1006     else if (style & STYLE_COLORBAR) {
1007         current_vp->drawmode = DRMODE_FG;
1008         current_vp->fg_pattern = current_vp->lss_pattern;
1009         lcd_fillrect(xpos, ypos, current_vp->width - xpos, h);
1010         current_vp->fg_pattern = current_vp->lst_pattern;
1011     }
1012     else {
1013         lcd_fillrect(xrect, ypos, current_vp->width - xrect, h);
1014         current_vp->drawmode = (style & STYLE_INVERT) ?
1015         (DRMODE_SOLID|DRMODE_INVERSEVID) : DRMODE_SOLID;
1016     }
1017     lcd_putsxyofs(xpos, ypos, offset, str);
1018     current_vp->drawmode = lastmode;
1019     current_vp->fg_pattern = oldfgcolor;
1020     current_vp->bg_pattern = oldbgcolor;
1021 }
1022
1023 /*** scrolling ***/
1024 void lcd_puts_scroll(int x, int y, const unsigned char *string)
1025 {
1026     lcd_puts_scroll_style(x, y, string, STYLE_DEFAULT);
1027 }
1028
1029 void lcd_puts_scroll_style(int x, int y, const unsigned char *string, int style)
1030 {
1031      lcd_puts_scroll_style_offset(x, y, string, style, 0);
1032 }
1033
1034 void lcd_puts_scroll_offset(int x, int y, const unsigned char *string, int offset)
1035 {
1036      lcd_puts_scroll_style_offset(x, y, string, STYLE_DEFAULT, offset);
1037 }
1038
1039 /* Initialise a scrolling line at (x,y) in current viewport */
1040
1041 void lcd_puts_scroll_style_offset(int x, int y, const unsigned char *string,
1042                                          int style, int offset)
1043 {
1044     struct scrollinfo* s;
1045     int w, h;
1046
1047     if ((unsigned)y >= (unsigned)current_vp->height)
1048         return;
1049
1050     /* remove any previously scrolling line at the same location */
1051     lcd_scroll_stop_line(current_vp, y);
1052
1053     if (lcd_scroll_info.lines >= LCD_SCROLLABLE_LINES) return;
1054
1055     s = &lcd_scroll_info.scroll[lcd_scroll_info.lines];
1056
1057     s->start_tick = current_tick + lcd_scroll_info.delay;
1058     s->style = style;
1059     lcd_puts_style_offset(x,y,string,style,offset);
1060
1061     lcd_getstringsize(string, &w, &h);
1062
1063     if (current_vp->width - x * 8 - current_vp->xmargin < w) {
1064         /* prepare scroll line */
1065         char *end;
1066
1067         memset(s->line, 0, sizeof s->line);
1068         strcpy(s->line, string);
1069
1070         /* get width */
1071         s->width = lcd_getstringsize(s->line, &w, &h);
1072
1073         /* scroll bidirectional or forward only depending on the string
1074            width */
1075         if ( lcd_scroll_info.bidir_limit ) {
1076             s->bidir = s->width < (current_vp->width - current_vp->xmargin) *
1077                 (100 + lcd_scroll_info.bidir_limit) / 100;
1078         }
1079         else
1080             s->bidir = false;
1081
1082         if (!s->bidir) { /* add spaces if scrolling in the round */
1083             strcat(s->line, "   ");
1084             /* get new width incl. spaces */
1085             s->width = lcd_getstringsize(s->line, &w, &h);
1086         }
1087
1088         end = strchr(s->line, '\0');
1089         strncpy(end, string, current_vp->width/2);
1090
1091         s->vp = current_vp;
1092         s->y = y;
1093         s->len = utf8length(string);
1094         s->offset = offset;
1095         s->startx = current_vp->xmargin + x * s->width / s->len;
1096         s->backward = false;
1097         lcd_scroll_info.lines++;
1098     }
1099 }
1100
1101 void lcd_scroll_fn(void)
1102 {
1103     struct font* pf;
1104     struct scrollinfo* s;
1105     int index;
1106     int xpos, ypos;
1107     int lastmode;
1108     unsigned old_fgcolor;
1109     unsigned old_bgcolor;
1110     struct viewport* old_vp = current_vp;
1111
1112     for ( index = 0; index < lcd_scroll_info.lines; index++ ) {
1113         s = &lcd_scroll_info.scroll[index];
1114
1115         /* check pause */
1116         if (TIME_BEFORE(current_tick, s->start_tick))
1117             continue;
1118
1119         lcd_set_viewport(s->vp);
1120         old_fgcolor = current_vp->fg_pattern;
1121         old_bgcolor = current_vp->bg_pattern;
1122
1123         if (s->style&STYLE_COLORED) {
1124             if (s->style&STYLE_MODE_MASK) {
1125                 current_vp->fg_pattern = old_fgcolor;
1126                 current_vp->bg_pattern = s->style&STYLE_COLOR_MASK;
1127             }
1128             else {
1129                 current_vp->fg_pattern = s->style&STYLE_COLOR_MASK;
1130                 current_vp->bg_pattern = old_bgcolor;
1131             }
1132         }
1133
1134         if (s->backward)
1135             s->offset -= lcd_scroll_info.step;
1136         else
1137             s->offset += lcd_scroll_info.step;
1138
1139         pf = font_get(current_vp->font);
1140         xpos = s->startx;
1141         ypos = current_vp->ymargin + s->y * pf->height;
1142
1143         if (s->bidir) { /* scroll bidirectional */
1144             if (s->offset <= 0) {
1145                 /* at beginning of line */
1146                 s->offset = 0;
1147                 s->backward = false;
1148                 s->start_tick = current_tick + lcd_scroll_info.delay * 2;
1149             }
1150             if (s->offset >= s->width - (current_vp->width - xpos)) {
1151                 /* at end of line */
1152                 s->offset = s->width - (current_vp->width - xpos);
1153                 s->backward = true;
1154                 s->start_tick = current_tick + lcd_scroll_info.delay * 2;
1155             }
1156         }
1157         else {
1158             /* scroll forward the whole time */
1159             if (s->offset >= s->width)
1160                 s->offset %= s->width;
1161         }
1162
1163         lastmode = current_vp->drawmode;
1164         switch (s->style&STYLE_MODE_MASK) {
1165             case STYLE_INVERT:
1166                 current_vp->drawmode = DRMODE_SOLID|DRMODE_INVERSEVID;
1167                 break;
1168             case STYLE_COLORBAR:
1169                 /* Solid colour line selector */
1170                 current_vp->drawmode = DRMODE_FG;
1171                 current_vp->fg_pattern = current_vp->lss_pattern;
1172                 lcd_fillrect(xpos, ypos, current_vp->width - xpos, pf->height);
1173                 current_vp->fg_pattern = current_vp->lst_pattern;
1174                 break;
1175             case STYLE_GRADIENT:
1176                 /* Gradient line selector */
1177                 current_vp->drawmode = DRMODE_FG;
1178                 lcd_gradient_rect_scroll(xpos, current_vp->width, ypos, (signed)pf->height,
1179                                          NUMLN_UNPACK(s->style),
1180                                          CURLN_UNPACK(s->style));
1181                 current_vp->fg_pattern = current_vp->lst_pattern;
1182                 break;
1183             default:
1184                 current_vp->drawmode = DRMODE_SOLID;
1185                 break;
1186         }
1187         lcd_putsxyofs(xpos, ypos, s->offset, s->line);
1188         current_vp->drawmode = lastmode;
1189         current_vp->fg_pattern = old_fgcolor;
1190         current_vp->bg_pattern = old_bgcolor;
1191         lcd_update_viewport_rect(xpos, ypos, current_vp->width - xpos, pf->height);
1192     }
1193
1194     lcd_set_viewport(old_vp);
1195 }