path: root/apps/plugins/lib/gray.c

/***************************************************************************
*             __________               __   ___.
*   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
*   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
*   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
*   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
*                     \/            \/     \/    \/            \/
* $Id$
*
* Grayscale framework
*
* Copyright (C) 2004 Jens Arnold
*
* All files in this archive are subject to the GNU General Public License.
* See the file COPYING in the source tree root for full license agreement.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/

#ifndef SIMULATOR /* not for simulator by now */
#include "plugin.h"

#ifdef HAVE_LCD_BITMAP /* and also not for the Player */
#include "gray.h"

/* This is a generic framework to use grayscale display within rockbox
 * plugins. It obviously does not work for the player.
 */

/**** internal core functions and definitions ****/

/* You do not want to touch these if you don't know exactly what you're
 * doing. */

#define GRAY_RUNNING          0x0001  /* grayscale overlay is running */
#define GRAY_DEFERRED_UPDATE  0x0002  /* lcd_update() requested */

/* unsigned 16 bit multiplication (a single instruction on the SH) */
#define MULU16(a, b) (((unsigned short) (a)) * ((unsigned short) (b)))

typedef struct
{
    int x;
    int by;        /* 8-pixel units */
    int width;
    int height;
    int bheight;   /* 8-pixel units */
    int plane_size;
    int depth;     /* number_of_bitplanes  = (number_of_grayscales - 1) */
    int cur_plane; /* for the timer isr */
    unsigned long randmask; /* mask for random value in graypixel() */
    unsigned long flags;    /* various flags, see #defines */
    unsigned char *data;    /* pointer to start of bitplane data */
    unsigned long *bitpattern; /* pointer to start of pattern table */
} tGraybuf;

static struct plugin_api *rb = NULL;    /* global api struct pointer */
static tGraybuf *graybuf = NULL;
static short gray_random_buffer;

/* timer interrupt handler: display next bitplane */
static void gray_timer_isr(void)
{
    rb->lcd_blit(graybuf->data + MULU16(graybuf->plane_size, graybuf->cur_plane),
                 graybuf->x, graybuf->by, graybuf->width, graybuf->bheight,
                 graybuf->width);

    if (++graybuf->cur_plane >= graybuf->depth)
        graybuf->cur_plane = 0;

    if (graybuf->flags & GRAY_DEFERRED_UPDATE)  /* lcd_update() requested? */
    {
        int x1 = MAX(graybuf->x, 0);
        int x2 = MIN(graybuf->x + graybuf->width, LCD_WIDTH);
        int y1 = MAX(graybuf->by << 3, 0);
        int y2 = MIN((graybuf->by + graybuf->bheight) << 3, LCD_HEIGHT);

        if (y1 > 0)  /* refresh part above overlay, full width */
            rb->lcd_update_rect(0, 0, LCD_WIDTH, y1);

        if (y2 < LCD_HEIGHT) /* refresh part below overlay, full width */
            rb->lcd_update_rect(0, y2, LCD_WIDTH, LCD_HEIGHT - y2);

        if (x1 > 0) /* refresh part to the left of overlay */
            rb->lcd_update_rect(0, y1, x1, y2 - y1);

        if (x2 < LCD_WIDTH) /* refresh part to the right of overlay */
            rb->lcd_update_rect(x2, y1, LCD_WIDTH - x2, y2 - y1);

        graybuf->flags &= ~GRAY_DEFERRED_UPDATE; /* clear request */
    }
}

/* Set a pixel to a specific bit pattern
 * This is the fundamental graphics primitive, asm optimized */
static void graypixel(int x, int y, unsigned long pattern)
{
    register long address, mask, random;

    /* Some (pseudo-)random function must be used here to shift the bit
     * pattern randomly, otherwise you would get flicker and/or moire.
     * Since rand() is relatively slow, I've implemented a simple, but very
     * fast pseudo-random generator based on linear congruency in assembler.
     * It delivers 16 pseudo-random bits in each iteration. */

    /* simple but fast pseudo-random generator */
    asm(
        "mov.w   @%1,%0          \n"  /* load last value */
        "mov     #75,r1          \n"
        "mulu    %0,r1           \n"  /* multiply by 75 */
        "sts     macl,%0         \n"  /* get result */
        "add     #74,%0          \n"  /* add another 74 */
        "mov.w   %0,@%1          \n"  /* store new value */
        /* Since the lower bits are not very random: */
        "shlr8   %0              \n"  /* get bits 8..15 (need max. 5) */
        "and     %2,%0           \n"  /* mask out unneeded bits */
        : /* outputs */
        /* %0 */ "=&r"(random)
        : /* inputs */
        /* %1 */ "r"(&gray_random_buffer),
        /* %2 */ "r"(graybuf->randmask)
        : /* clobbers */
        "r1","macl"
    );

    /* precalculate mask and byte address in first bitplane */
    asm(
        "mov     %3,%0           \n"  /* take y as base for address offset */
        "shlr2   %0              \n"  /* shift right by 3 (= divide by 8) */
        "shlr    %0              \n"
        "mulu    %0,%2           \n"  /* multiply with width */
        "and     #7,%3           \n"  /* get lower 3 bits of y */
        "sts     macl,%0         \n"  /* get mulu result */
        "add     %4,%0           \n"  /* add base + x to get final address */

        "mov     %3,%1           \n"  /* move lower 3 bits of y out of r0 */
        "mova    .pp_table,%3    \n"  /* get address of mask table in r0 */
        "bra     .pp_end         \n"  /* skip the table */
        "mov.b   @(%3,%1),%1     \n"  /* get entry from mask table */
        
        ".align  2               \n"
    ".pp_table:                  \n"  /* mask table */
        ".byte   0x01            \n"
        ".byte   0x02            \n"
        ".byte   0x04            \n"
        ".byte   0x08            \n"
        ".byte   0x10            \n"
        ".byte   0x20            \n"
        ".byte   0x40            \n"
        ".byte   0x80            \n"

    ".pp_end:                    \n"
        : /* outputs */
        /* %0 */ "=&r"(address),    
        /* %1 */ "=&r"(mask)
        : /* inputs */
        /* %2 */ "r"(graybuf->width),
        /* %3 = r0 */ "z"(y),
        /* %4 */ "r"(graybuf->data + x)
        : /* clobbers */
        "macl"
    );

    /* the hard part: set bits in all bitplanes according to pattern */
    asm(
        "cmp/hs  %1,%5           \n"  /* random >= depth ? */
        "bf      .p_ntrim        \n"
        "sub     %1,%5           \n"  /* yes: random -= depth */
        /* it's sufficient to do this once, since the mask guarantees
         * random < 2 * depth */
    ".p_ntrim:                   \n"
    
        /* calculate some addresses */
        "mulu    %4,%1           \n"  /* end address offset */
        "not     %3,r1           \n"  /* get inverse mask (for "and") */
        "sts     macl,%1         \n"  /* result of mulu */
        "mulu    %4,%5           \n"  /* address offset of <random>'th plane */
        "add     %2,%1           \n"  /* end offset -> end address */
        "sts     macl,%5         \n"  /* result of mulu */
        "add     %2,%5           \n"  /* address of <random>'th plane */
        "bra     .p_start1       \n"
        "mov     %5,r2           \n"  /* copy address */

        /* first loop: set bits from <random>'th bitplane to last */
    ".p_loop1:                   \n"
        "mov.b   @r2,r3          \n"  /* get data byte */
        "shlr    %0              \n"  /* shift bit mask, sets t bit */
        "and     r1,r3           \n"  /* reset bit (-> "white") */
        "bf      .p_white1       \n"  /* t=0? -> "white" bit */
        "or      %3,r3           \n"  /* set bit ("black" bit) */
    ".p_white1:                  \n"
        "mov.b   r3,@r2          \n"  /* store data byte */
        "add     %4,r2           \n"  /* advance address to next bitplane */
    ".p_start1:                  \n"
        "cmp/hi  r2,%1           \n"  /* address < end address ? */
        "bt      .p_loop1        \n"
        
        "bra     .p_start2       \n"
        "nop                     \n"

        /* second loop: set bits from first to <random-1>'th bitplane
         * Bit setting works the other way round here to equalize average
         * execution times for bright and dark pixels */
    ".p_loop2:                   \n"
        "mov.b   @%2,r3          \n"  /* get data byte */
        "shlr    %0              \n"  /* shift bit mask, sets t bit */
        "or      %3,r3           \n"  /* set bit (-> "black") */
        "bt      .p_black2       \n"  /* t=1? -> "black" bit */
        "and     r1,r3           \n"  /* reset bit ("white" bit) */
    ".p_black2:                  \n"
        "mov.b   r3,@%2          \n"  /* store data byte */
        "add     %4,%2           \n"  /* advance address to next bitplane */
    ".p_start2:                  \n"
        "cmp/hi  %2,%5           \n"  /* address < <random>'th address ? */
        "bt      .p_loop2        \n"
        : /* outputs */
        : /* inputs */
        /* %0 */ "r"(pattern),
        /* %1 */ "r"(graybuf->depth),
        /* %2 */ "r"(address),
        /* %3 */ "r"(mask),
        /* %4 */ "r"(graybuf->plane_size),
        /* %5 */ "r"(random)
        : /* clobbers */
        "r1", "r2", "r3", "macl"
    );
}

/* Set 8 pixels to specific gray values at once, asm optimized
 * This greatly enhances performance of gray_fillrect() and gray_drawgraymap()
 * for larger rectangles and graymaps */
static void grayblock(int x, int by, unsigned char* src, int stride)
{
    /* precalculate the bit patterns with random shifts (same RNG as graypixel,
     * see there for an explanation) for all 8 pixels and put them on the 
     * stack (!) */
    asm(
        "mova    .gb_reload,r0   \n"  /* set default loopback address */
        "tst     %1,%1           \n"  /* stride == 0 ? */
        "bf      .gb_needreload  \n"  /* no: keep that address */
        "mova    .gb_reuse,r0    \n"  /* yes: set shortcut (no reload) */
    ".gb_needreload:             \n"
        "mov     r0,r2           \n"  /* loopback address to r2 */
        "mov     #7,r3           \n"  /* loop count in r3: 8 pixels */

        ".align  2               \n"  /** load pattern for pixel **/
    ".gb_reload:                 \n"
        "mov.b   @%0,r0          \n"  /* load src byte */
        "extu.b  r0,r0           \n"  /* extend unsigned */
        "mulu    %2,r0           \n"  /* macl = byte * depth; */
        "add     %1,%0           \n"  /* src += stride; */
        "sts     macl,r4         \n"  /* r4 = macl; */
        "add     r4,r0           \n"  /* byte += r4; */
        "shlr8   r0              \n"  /* byte >>= 8; */
        "shll2   r0              \n"
        "mov.l   @(r0,%3),r4     \n"  /* r4 = bitpattern[byte]; */

        ".align  2               \n"  /** RNG **/
    ".gb_reuse:                  \n"
        "mov.w   @%4,r1          \n"  /* load last value */
        "mov     #75,r0          \n"
        "mulu    r0,r1           \n"  /* multiply by 75 */
        "sts     macl,r1         \n"
        "add     #74,r1          \n"  /* add another 74 */
        "mov.w   r1,@%4          \n"  /* store new value */
        /* Since the lower bits are not very random: */
        "shlr8   r1              \n"  /* get bits 8..15 (need max. 5) */
        "and     %5,r1           \n"  /* mask out unneeded bits */

        "cmp/hs  %2,r1           \n"  /* random >= depth ? */
        "bf      .gb_ntrim       \n"
        "sub     %2,r1           \n"  /* yes: random -= depth; */
    ".gb_ntrim:                  \n"

        "mov.l   .ashlsi3,r0     \n"  /** rotate pattern **/
        "jsr     @r0             \n"  /* shift r4 left by r1 */
        "mov     r1,r5           \n"

        "mov     %2,r5           \n"
        "sub     r1,r5           \n"  /* r5 = depth - r1 */
        "mov.l   .lshrsi3,r1     \n"
        "jsr     @r1             \n"  /* shift r4 right by r5 */
        "mov     r0,r1           \n"  /* last result stored in r1 */

        "or      r1,r0           \n"  /* rotated_pattern = r0 | r1 */
        "mov.l   r0,@-r15        \n"  /* push pattern */
        
        "cmp/pl  r3              \n"  /* loop count > 0? */
        "bf      .gb_patdone     \n"  /* no: done */

        "jmp     @r2             \n"  /* yes: loop */
        "add     #-1,r3          \n"  /* decrease loop count */

        ".align  2               \n"
    ".ashlsi3:                   \n"  /* C library routine: */
        ".long   ___ashlsi3      \n"  /* shift r4 left by r5, return in r0 */
    ".lshrsi3:                   \n"  /* C library routine: */
        ".long   ___lshrsi3      \n"  /* shift r4 right by r5, return in r0 */
        /* both routines preserve r4, destroy r5 and take ~16 cycles */

    ".gb_patdone:                \n"
        : /* outputs */
        : /* inputs */
        /* %0 */ "r"(src),
        /* %1 */ "r"(stride),
        /* %2 */ "r"(graybuf->depth),
        /* %3 */ "r"(graybuf->bitpattern),
        /* %4 */ "r"(&gray_random_buffer),
        /* %5 */ "r"(graybuf->randmask)
        : /* clobbers */
        "r0", "r1", "r2", "r3", "r4", "r5", "macl"
    );

    /* calculate start address in first bitplane and end address */
    register unsigned char *address = graybuf->data + x
                                    + MULU16(graybuf->width, by);
    register unsigned char *end_addr = address
                           + MULU16(graybuf->depth, graybuf->plane_size);

    /* set the bits for all 8 pixels in all bytes according to the
     * precalculated patterns on the stack */
    asm (
        "mov.l   @r15+,r1        \n"  /* pop all 8 patterns */
        "mov.l   @r15+,r2        \n"
        "mov.l   @r15+,r3        \n"
        "mov.l   @r15+,r4        \n"
        "mov.l   @r15+,r5        \n"
        "mov.l   @r15+,r6        \n"
        "mov.l   @r15+,r7        \n"
        "mov.l   @r15+,r8        \n"

    ".gb_loop:                   \n"  /* loop for all bitplanes */
        "shlr    r1              \n"  /* rotate lsb of pattern 1 to t bit */
        "rotcl   r0              \n"  /* rotate t bit into r0 */
        "shlr    r2              \n"
        "rotcl   r0              \n"
        "shlr    r3              \n"
        "rotcl   r0              \n"
        "shlr    r4              \n"
        "rotcl   r0              \n"
        "shlr    r5              \n"
        "rotcl   r0              \n"
        "shlr    r6              \n"
        "rotcl   r0              \n"
        "shlr    r7              \n"
        "rotcl   r0              \n"
        "shlr    r8              \n"
        "rotcl   r0              \n"
        "mov.b   r0,@%0          \n"  /* store byte to bitplane */
        "add     %2,%0           \n"  /* advance to next bitplane */
        "cmp/hi  %0,%1           \n"  /* last bitplane done? */
        "bt      .gb_loop        \n"  /* no: loop */
        : /* outputs */
        : /* inputs */
        /* %0 */ "r"(address),
        /* %1 */ "r"(end_addr),
        /* %2 */ "r"(graybuf->plane_size)
        : /* clobbers */
        "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8"
    );
}

/* Invert the bits for 1-8 pixels within the buffer */
static void grayinvertmasked(int x, int by, unsigned char mask)
{
    asm(
        "mulu    %4,%5           \n"  /* width * by (offset of row) */
        "mov     #0,r1           \n"  /* current_plane = 0 */
        "sts     macl,r2         \n"  /* get mulu result */
        "add     r2,%1           \n"  /* -> address in 1st bitplane */

    ".i_loop:                    \n"
        "mov.b   @%1,r2          \n"  /* get data byte */
        "add     #1,r1           \n"  /* current_plane++; */
        "xor     %2,r2           \n"  /* invert bits */
        "mov.b   r2,@%1          \n"  /* store data byte */
        "add     %3,%1           \n"  /* advance address to next bitplane */
        "cmp/hi  r1,%0           \n"  /* current_plane < depth ? */
        "bt      .i_loop         \n"
        : /* outputs */
        : /* inputs */
        /* %0 */ "r"(graybuf->depth),
        /* %1 */ "r"(graybuf->data + x),
        /* %2 */ "r"(mask),
        /* %3 */ "r"(graybuf->plane_size),
        /* %4 */ "r"(graybuf->width),
        /* %5 */ "r"(by)
        : /* clobbers */
        "r1", "r2", "macl"
    );
}

/*** public core functions ***/

/* Initialize the framework */
void gray_init(struct plugin_api* newrb)
{
    rb = newrb;
}

/* Prepare the grayscale display buffer
 *
 * arguments:
 *   gbuf      = pointer to the memory area to use (e.g. plugin buffer)
 *   gbuf_size = max usable size of the buffer
 *   width     = width in pixels  (1..112)
 *   bheight   = height in 8-pixel units  (1..8)
 *   depth     = desired number of shades - 1  (1..32)
 *
 * result:
 *   = depth  if there was enough memory
 *   < depth  if there wasn't enough memory. The number of displayable
 *            shades is smaller than desired, but it still works
 *   = 0      if there wasn't even enough memory for 1 bitplane (black & white)
 *
 * You can request any depth from 1 to 32, not just powers of 2. The routine
 * performs "graceful degradation" if the memory is not sufficient for the
 * desired depth. As long as there is at least enough memory for 1 bitplane,
 * it creates as many bitplanes as fit into memory, although 1 bitplane will
 * only deliver black & white display.
 *
 * The total memory needed can be calculated as follows:
 *   total_mem =
 *     sizeof(tGraybuf)      (= 48 bytes currently)
 *   + sizeof(long)          (=  4 bytes)
 *   + (width * bheight + sizeof(long)) * depth
 *   + 0..3                  (longword alignment of grayscale display buffer)
 */
int gray_init_buffer(unsigned char *gbuf, int gbuf_size, int width,
                     int bheight, int depth, int *buf_taken)
{
    int possible_depth, plane_size;
    int i, j, align;

    if (rb == NULL
        || (unsigned) width > LCD_WIDTH
        || (unsigned) bheight > (LCD_HEIGHT/8)
        || depth < 1)
        return 0;

    /* the buffer has to be long aligned */
    align = 3 - (((unsigned long)gbuf + 3) & 3);
    gbuf += align;
    gbuf_size -= align;

    plane_size = width * bheight;
    possible_depth = (gbuf_size - sizeof(tGraybuf) - sizeof(long))
                     / (plane_size + sizeof(long));

    if (possible_depth < 1)
        return 0;

    depth = MIN(depth, 32);
    depth = MIN(depth, possible_depth);

    graybuf = (tGraybuf *) gbuf;  /* global pointer to buffer structure */
                                  
    graybuf->x = 0;
    graybuf->by = 0;
    graybuf->width = width;
    graybuf->height = bheight << 3;
    graybuf->bheight = bheight;
    graybuf->plane_size = plane_size;
    graybuf->depth = depth;
    graybuf->cur_plane = 0;
    graybuf->flags = 0;
    graybuf->data = gbuf + sizeof(tGraybuf);
    graybuf->bitpattern = (unsigned long *) (graybuf->data
                           + depth * plane_size);

    i = depth;
    j = 8;
    while (i != 0)
    {
        i >>= 1;
        j--;
    }
    graybuf->randmask = 0xFF >> j;

    /* initial state is all white */
    rb->memset(graybuf->data, 0, depth * plane_size);
    
    /* Precalculate the bit patterns for all possible pixel values */
    for (i = 0; i <= depth; i++)
    {
        unsigned long pattern = 0;
        int value = 0;

        for (j = 0; j < depth; j++)
        {
            pattern <<= 1;
            value += i;

            if (value >= depth)
                value -= depth;   /* "white" bit */
            else
                pattern |= 1;     /* "black" bit */
        }  
        /* now the lower <depth> bits contain the pattern */

        graybuf->bitpattern[i] = pattern;
    }
    
    if (buf_taken)  /* caller requested info about space taken */
    {
        *buf_taken = sizeof(tGraybuf) + sizeof(long)
                   + (plane_size + sizeof(long)) * depth + align;
    }

    return depth;
}

/* Release the grayscale display buffer
 *
 * Switches the grayscale overlay off at first if it is still running,
 * then sets the pointer to NULL.
 * DO CALL either this function or at least gray_show_display(false)
 * before you exit, otherwise nasty things may happen.
 */
void gray_release_buffer(void)
{
    gray_show_display(false);
    graybuf = NULL;
}

/* Set position of the top left corner of the grayscale overlay
 *
 * arguments:
 *   x  = left margin in pixels
 *   by = top margin in 8-pixel units
 *
 * You may set this in a way that the overlay spills across the right or
 * bottom display border. In this case it will simply be clipped by the 
 * LCD controller. You can even set negative values, this will clip at the
 * left or top border. I did not test it, but the limits may be +127 / -128
 *
 * If you use this while the grayscale overlay is running, the now-freed area
 * will be restored.
 */
void gray_position_display(int x, int by)
{
    if (graybuf == NULL)
        return;

    graybuf->x = x;
    graybuf->by = by;
    
    if (graybuf->flags & GRAY_RUNNING)
        graybuf->flags |= GRAY_DEFERRED_UPDATE;
}

/* Switch the grayscale overlay on or off
 *
 * arguments:
 *   enable = true:  the grayscale overlay is switched on if initialized
 *          = false: the grayscale overlay is switched off and the regular lcd
 *                   content is restored
 *
 * DO NOT call lcd_update() or any other api function that directly accesses
 * the lcd while the grayscale overlay is running! If you need to do
 * lcd_update() to update something outside the grayscale overlay area, use 
 * gray_deferred_update() instead.
 *
 * Other functions to avoid are:
 *   lcd_blit() (obviously), lcd_update_rect(), lcd_set_contrast(),
 *   lcd_set_invert_display(), lcd_set_flip(), lcd_roll()
 *
 * The grayscale display consumes ~50 % CPU power (for a full screen overlay,
 * less if the overlay is smaller) when switched on. You can switch the overlay
 * on and off as many times as you want.
 */
void gray_show_display(bool enable)
{
    if (graybuf == NULL)
        return;

    if (enable)
    {
        graybuf->flags |= GRAY_RUNNING;
        rb->plugin_register_timer(FREQ / 67, 1, gray_timer_isr);
    }
    else
    {
        rb->plugin_unregister_timer();
        graybuf->flags &= ~GRAY_RUNNING;
        rb->lcd_update(); /* restore whatever there was before */
    }
}

/*** public optional functions ***/

/* Here are the various graphics primitives. Cut out functions you do not
 * need in order to keep plugin code size down.
 */

/* Clear the grayscale display (sets all pixels to white)
 */
void gray_clear_display(void)
{
    if (graybuf == NULL)
        return;

    rb->memset(graybuf->data, 0, MULU16(graybuf->depth, graybuf->plane_size));
}

/* Set the grayscale display to all black
 */
void gray_black_display(void)
{
    if (graybuf == NULL)
        return;

    rb->memset(graybuf->data, 0xFF, MULU16(graybuf->depth, graybuf->plane_size));
}

/* Do an lcd_update() to show changes done by rb->lcd_xxx() functions (in areas
 * of the screen not covered by the grayscale overlay). If the grayscale 
 * overlay is running, the update will be done in the next call of the
 * interrupt routine, otherwise it will be performed right away. See also
 * comment for the gray_show_display() function.
 */
void gray_deferred_update(void)
{
    if (graybuf != NULL && (graybuf->flags & GRAY_RUNNING))
        graybuf->flags |= GRAY_DEFERRED_UPDATE;
    else
        rb->lcd_update();
}

/* Scroll the whole grayscale buffer left by <count> pixels
 *
 * black_border determines if the pixels scrolled in at the right are black
 * or white
 *
 * Scrolling left/right by an even pixel count is almost twice as fast as
 * scrolling by an odd pixel count.
 */
void gray_scroll_left(int count, bool black_border)
{
    int by, d;
    unsigned char *ptr;
    unsigned char filler;

    if (graybuf == NULL || (unsigned) count >= (unsigned) graybuf->width)
        return;
        
    if (black_border)
        filler = 0xFF;
    else
        filler = 0;

    /* Scroll row by row to minimize flicker (byte rows = 8 pixels each) */
    for (by = 0; by < graybuf->bheight; by++)
    {
        ptr = graybuf->data + MULU16(graybuf->width, by);
        for (d = 0; d < graybuf->depth; d++)
        {   
            if (count & 1)  /* odd count: scroll byte-wise */
                asm volatile (
                ".sl_loop1:                   \n"
                    "mov.b   @%0+,r1          \n"
                    "mov.b   r1,@(%2,%0)      \n"
                    "cmp/hi  %0,%1            \n"
                    "bt      .sl_loop1        \n"
                    : /* outputs */
                    : /* inputs */
                    /* %0 */ "r"(ptr + count),
                    /* %1 */ "r"(ptr + graybuf->width),
                    /* %2 */ "z"(-count - 1)
                    : /* clobbers */
                    "r1"
                );
            else           /* even count: scroll word-wise */
                asm volatile (
                ".sl_loop2:                   \n"
                    "mov.w   @%0+,r1          \n"
                    "mov.w   r1,@(%2,%0)      \n"
                    "cmp/hi  %0,%1            \n"
                    "bt      .sl_loop2        \n"
                    : /* outputs */
                    : /* inputs */
                    /* %0 */ "r"(ptr + count),
                    /* %1 */ "r"(ptr + graybuf->width),
                    /* %2 */ "z"(-count - 2)
                    : /* clobbers */
                    "r1"
                );

            rb->memset(ptr + graybuf->width - count, filler, count);
            ptr += graybuf->plane_size;
        }
    }
}

/* Scroll the whole grayscale buffer right by <count> pixels
 *
 * black_border determines if the pixels scrolled in at the left are black
 * or white
 *
 * Scrolling left/right by an even pixel count is almost twice as fast as
 * scrolling by an odd pixel count.
 */
void gray_scroll_right(int count, bool black_border)
{
    int by, d;
    unsigned char *ptr;
    unsigned char filler;

    if (graybuf == NULL || (unsigned) count >= (unsigned) graybuf->width)
        return;

    if (black_border)
        filler = 0xFF;
    else
        filler = 0;

    /* Scroll row by row to minimize flicker (byte rows = 8 pixels each) */
    for (by = 0; by < graybuf->bheight; by++)
    {
        ptr = graybuf->data + MULU16(graybuf->width, by);
        for (d = 0; d < graybuf->depth; d++)
        {
            if (count & 1)  /* odd count: scroll byte-wise */
                asm volatile (
                ".sr_loop1:                   \n"
                    "mov.b   @(%2,%0),r1      \n"
                    "mov.b   r1,@-%0          \n"
                    "cmp/hi  %1,%0            \n"
                    "bt      .sr_loop1        \n"
                    : /* outputs */
                    : /* inputs */
                    /* %0 */ "r"(ptr + graybuf->width),
                    /* %1 */ "r"(ptr + count),
                    /* %2 */ "z"(-count - 1)
                    : /* clobbers */
                    "r1"
                );
            else            /* even count: scroll word-wise */
                asm volatile (
                ".sr_loop2:                   \n"
                    "mov.w   @(%2,%0),r1      \n"
                    "mov.w   r1,@-%0          \n"
                    "cmp/hi  %1,%0            \n"
                    "bt      .sr_loop2        \n"
                    : /* outputs */
                    : /* inputs */
                    /* %0 */ "r"(ptr + graybuf->width),
                    /* %1 */ "r"(ptr + count),
                    /* %2 */ "z"(-count - 2)
                    : /* clobbers */
                    "r1"
                );

            rb->memset(ptr, filler, count);
            ptr += graybuf->plane_size;
        }
    }
}

/* Scroll the whole grayscale buffer up by 8 pixels
 *
 * black_border determines if the pixels scrolled in at the bottom are black
 * or white
 *
 * Scrolling up/down by 8 pixels is very fast.
 */
void gray_scroll_up8(bool black_border)
{
    int by, d;
    unsigned char *ptr;
    unsigned char filler;

    if (graybuf == NULL)
        return;
        
    if (black_border)
        filler = 0xFF;
    else
        filler = 0;

    /* Scroll row by row to minimize flicker (byte rows = 8 pixels each) */
    for (by = 1; by < graybuf->bheight; by++)
    {
        ptr = graybuf->data + MULU16(graybuf->width, by);
        for (d = 0; d < graybuf->depth; d++)
        {
            rb->memcpy(ptr - graybuf->width, ptr, graybuf->width);
            ptr += graybuf->plane_size;
        }
    }
    /* fill last row */
    ptr = graybuf->data + graybuf->plane_size - graybuf->width;
    for (d = 0; d < graybuf->depth; d++) 
    {
        rb->memset(ptr, filler, graybuf->width);
        ptr += graybuf->plane_size;
    }
}

/* Scroll the whole grayscale buffer down by 8 pixels
 *
 * black_border determines if the pixels scrolled in at the top are black
 * or white
 *
 * Scrolling up/down by 8 pixels is very fast.
 */
void gray_scroll_down8(bool black_border)
{
    int by, d;
    unsigned char *ptr;
    unsigned char filler;

    if (graybuf == NULL)
        return;
        
    if (black_border)
        filler = 0xFF;
    else
        filler = 0;

    /* Scroll row by row to minimize flicker (byte rows = 8 pixels each) */
    for (by = graybuf->bheight - 1; by > 0; by--)
    {
        ptr = graybuf->data + MULU16(graybuf->width, by);
        for (d = 0; d < graybuf->depth; d++)
        {
            rb->memcpy(ptr, ptr - graybuf->width, graybuf->width);
            ptr += graybuf->plane_size;
        }
    }
    /* fill first row */
    ptr = graybuf->data;
    for (d = 0; d < graybuf->depth; d++) 
    {
        rb->memset(ptr, filler, graybuf->width);
        ptr += graybuf->plane_size;
    }
}

/* Scroll the whole grayscale buffer up by <count> pixels (<= 7)
 *
 * black_border determines if the pixels scrolled in at the bottom are black
 * or white
 *
 * Scrolling up/down pixel-wise is significantly slower than scrolling
 * left/right or scrolling up/down byte-wise because it involves bit
 * shifting. That's why it is asm optimized.
 */
void gray_scroll_up(int count, bool black_border)
{
    unsigned long filler;

    if (graybuf == NULL || (unsigned) count > 7)
        return;

    if (black_border)
        filler = 0xFF;
    else
        filler = 0;
    
    /* scroll column by column to minimize flicker */
    asm(
        "mov     #0,r6           \n"  /* x = 0 */
        "mova    .su_shifttbl,r0 \n"  /* calculate jump destination for */
        "mov.b   @(r0,%6),%6     \n"  /*   shift amount from table */
        "bra     .su_cloop       \n"  /* skip table */
        "add     r0,%6           \n"

        ".align  2               \n"
    ".su_shifttbl:               \n"  /* shift jump offset table */
        ".byte   .su_shift0 - .su_shifttbl \n"
        ".byte   .su_shift1 - .su_shifttbl \n"
        ".byte   .su_shift2 - .su_shifttbl \n"
        ".byte   .su_shift3 - .su_shifttbl \n"
        ".byte   .su_shift4 - .su_shifttbl \n"
        ".byte   .su_shift5 - .su_shifttbl \n"
        ".byte   .su_shift6 - .su_shifttbl \n"
        ".byte   .su_shift7 - .su_shifttbl \n"

    ".su_cloop:                  \n"  /* repeat for every column */
        "mov     %1,r2           \n"  /* get start address */
        "mov     #0,r3           \n"  /* current_plane = 0 */
        
    ".su_oloop:                  \n"  /* repeat for every bitplane */
        "mov     r2,r4           \n"  /* get start address */
        "mov     #0,r5           \n"  /* current_row = 0 */
        "mov     %5,r1           \n"  /* get filler bits */
        
    ".su_iloop:                  \n"  /* repeat for all rows */
        "sub     %2,r4           \n"  /* address -= width */
        "mov.b   @r4,r0          \n"  /* get data byte */
        "shll8   r1              \n"  /* old data to 2nd byte */
        "extu.b  r0,r0           \n"  /* extend unsigned */
        "or      r1,r0           \n"  /* combine old data */
        "jmp     @%6             \n"  /* jump into shift "path" */
        "extu.b  r0,r1           \n"  /* store data for next round */
        
    ".su_shift6:                 \n"  /* shift right by 0..7 bits */
        "shlr2   r0              \n"
    ".su_shift4:                 \n"
        "shlr2   r0              \n"
    ".su_shift2:                 \n"
        "bra     .su_shift0      \n"
        "shlr2   r0              \n"
    ".su_shift7:                 \n"
        "shlr2   r0              \n"
    ".su_shift5:                 \n"
        "shlr2   r0              \n"
    ".su_shift3:                 \n"
        "shlr2   r0              \n"
    ".su_shift1:                 \n"
        "shlr    r0              \n"
    ".su_shift0:                 \n"

        "mov.b   r0,@r4          \n"  /* store data */
        "add     #1,r5           \n"  /* current_row++ */
        "cmp/hi  r5,%3           \n"  /* current_row < bheight ? */
        "bt      .su_iloop       \n"

        "add     %4,r2           \n"  /* start_address += plane_size */
        "add     #1,r3           \n"  /* current_plane++ */
        "cmp/hi  r3,%0           \n"  /* current_plane < depth ? */
        "bt      .su_oloop       \n"

        "add     #1,%1           \n"  /* start_address++ */
        "add     #1,r6           \n"  /* x++ */
        "cmp/hi  r6,%2           \n"  /* x < width ? */
        "bt      .su_cloop       \n"
        : /* outputs */
        : /* inputs */
        /* %0 */ "r"(graybuf->depth),
        /* %1 */ "r"(graybuf->data + graybuf->plane_size),
        /* %2 */ "r"(graybuf->width),
        /* %3 */ "r"(graybuf->bheight),
        /* %4 */ "r"(graybuf->plane_size),
        /* %5 */ "r"(filler),
        /* %6 */ "r"(count)
        : /* clobbers */
        "r0", "r1", "r2", "r3", "r4", "r5", "r6"
    );
}

/* Scroll the whole grayscale buffer down by <count> pixels (<= 7)
 *
 * black_border determines if the pixels scrolled in at the top are black
 * or white
 *
 * Scrolling up/down pixel-wise is significantly slower than scrolling
 * left/right or scrolling up/down byte-wise because it involves bit
 * shifting. That's why it is asm optimized.
 */
void gray_scroll_down(int count, bool black_border)
{
    unsigned long filler;

    if (graybuf == NULL || (unsigned) count > 7)
        return;

    if (black_border)
        filler = 0xFF << count; /* calculate filler bits */
    else
        filler = 0;
    
    /* scroll column by column to minimize flicker */
    asm(
        "mov     #0,r6           \n"  /* x = 0 */
        "mova    .sd_shifttbl,r0 \n"  /* calculate jump destination for */
        "mov.b   @(r0,%6),%6     \n"  /*   shift amount from table */
        "bra     .sd_cloop       \n"  /* skip table */
        "add     r0,%6           \n"
        
        ".align  2               \n"
    ".sd_shifttbl:               \n"  /* shift jump offset table */
        ".byte   .sd_shift0 - .sd_shifttbl \n"
        ".byte   .sd_shift1 - .sd_shifttbl \n"
        ".byte   .sd_shift2 - .sd_shifttbl \n"
        ".byte   .sd_shift3 - .sd_shifttbl \n"
        ".byte   .sd_shift4 - .sd_shifttbl \n"
        ".byte   .sd_shift5 - .sd_shifttbl \n"
        ".byte   .sd_shift6 - .sd_shifttbl \n"
        ".byte   .sd_shift7 - .sd_shifttbl \n"

    ".sd_cloop:                  \n"  /* repeat for every column */
        "mov     %1,r2           \n"  /* get start address */
        "mov     #0,r3           \n"  /* current_plane = 0 */
        
    ".sd_oloop:                  \n"  /* repeat for every bitplane */
        "mov     r2,r4           \n"  /* get start address */
        "mov     #0,r5           \n"  /* current_row = 0 */
        "mov     %5,r1           \n"  /* get filler bits */
        
    ".sd_iloop:                  \n"  /* repeat for all rows */
        "shlr8   r1              \n"  /* shift right to get residue */
        "mov.b   @r4,r0          \n"  /* get data byte */
        "jmp     @%6             \n"  /* jump into shift "path" */
        "extu.b  r0,r0           \n"  /* extend unsigned */
        
    ".sd_shift6:                 \n"  /* shift left by 0..7 bits */
        "shll2   r0              \n"
    ".sd_shift4:                 \n"
        "shll2   r0              \n"
    ".sd_shift2:                 \n"
        "bra     .sd_shift0      \n"
        "shll2   r0              \n"
    ".sd_shift7:                 \n"
        "shll2   r0              \n"
    ".sd_shift5:                 \n"
        "shll2   r0              \n"
    ".sd_shift3:                 \n"
        "shll2   r0              \n"
    ".sd_shift1:                 \n"
        "shll    r0              \n"
    ".sd_shift0:                 \n"

        "or      r0,r1           \n"  /* combine with last residue */
        "mov.b   r1,@r4          \n"  /* store data */
        "add     %2,r4           \n"  /* address += width */
        "add     #1,r5           \n"  /* current_row++ */
        "cmp/hi  r5,%3           \n"  /* current_row < bheight ? */
        "bt      .sd_iloop       \n"

        "add     %4,r2           \n"  /* start_address += plane_size */
        "add     #1,r3           \n"  /* current_plane++ */
        "cmp/hi  r3,%0           \n"  /* current_plane < depth ? */
        "bt      .sd_oloop       \n"

        "add     #1,%1           \n"  /* start_address++ */
        "add     #1,r6           \n"  /* x++ */
        "cmp/hi  r6,%2           \n"  /* x < width ? */
        "bt      .sd_cloop       \n"
        : /* outputs */
        : /* inputs */
        /* %0 */ "r"(graybuf->depth),
        /* %1 */ "r"(graybuf->data),
        /* %2 */ "r"(graybuf->width),
        /* %3 */ "r"(graybuf->bheight),
        /* %4 */ "r"(graybuf->plane_size),
        /* %5 */ "r"(filler),
        /* %6 */ "r"(count)
        : /* clobbers */
        "r0", "r1", "r2", "r3", "r4", "r5", "r6"
    );
}

/* Set a pixel to a specific gray value
 *
 * brightness is 0..255 (black to white) regardless of real bit depth
 */
void gray_drawpixel(int x, int y, int brightness)
{
    if (graybuf == NULL 
        || (unsigned) x >= (unsigned) graybuf->width
        || (unsigned) y >= (unsigned) graybuf->height
        || (unsigned) brightness > 255)
        return;

    graypixel(x, y, graybuf->bitpattern[MULU16(brightness,
                    graybuf->depth + 1) >> 8]);
}

/* Invert a pixel
 *
 * The bit pattern for that pixel in the buffer is inverted, so white becomes
 * black, light gray becomes dark gray etc.
 */
void gray_invertpixel(int x, int y)
{
    if (graybuf == NULL 
        || (unsigned) x >= (unsigned) graybuf->width
        || (unsigned) y >= (unsigned) graybuf->height)
        return;

    grayinvertmasked(x, (y >> 3), 1 << (y & 7));
}

/* Draw a line from (x1, y1) to (x2, y2) with a specific gray value
 *
 * brightness is 0..255 (black to white) regardless of real bit depth
 */
void gray_drawline(int x1, int y1, int x2, int y2, int brightness)
{
    int numpixels;
    int i;
    int deltax, deltay;
    int d, dinc1, dinc2;
    int x, xinc1, xinc2;
    int y, yinc1, yinc2;
    unsigned long pattern;

    if (graybuf == NULL 
        || (unsigned) x1 >= (unsigned) graybuf->width
        || (unsigned) y1 >= (unsigned) graybuf->height
        || (unsigned) x2 >= (unsigned) graybuf->width
        || (unsigned) y2 >= (unsigned) graybuf->height
        || (unsigned) brightness > 255)
        return;

    pattern = graybuf->bitpattern[MULU16(brightness, graybuf->depth + 1) >> 8];

    deltax = abs(x2 - x1);
    deltay = abs(y2 - y1);
    xinc2 = 1;
    yinc2 = 1;

    if (deltax >= deltay)
    {
        numpixels = deltax;
        d = 2 * deltay - deltax;
        dinc1 = deltay * 2;
        dinc2 = (deltay - deltax) * 2;
        xinc1 = 1;
        yinc1 = 0;
    }
    else
    {
        numpixels = deltay;
        d = 2 * deltax - deltay;
        dinc1 = deltax * 2;
        dinc2 = (deltax - deltay) * 2;
        xinc1 = 0;
        yinc1 = 1;
    }
    numpixels++; /* include endpoints */

    if (x1 > x2)
    {
        xinc1 = -xinc1;
        xinc2 = -xinc2;
    }

    if (y1 > y2)
    {
        yinc1 = -yinc1;
        yinc2 = -yinc2;
    }

    x = x1;
    y = y1;

    for (i=0; i<numpixels; i++)
    {
        graypixel(x, y, pattern);

        if (d < 0)
        {
            d += dinc1;
            x += xinc1;
            y += yinc1;
        }
        else
        {
            d += dinc2;
            x += xinc2;
            y += yinc2;
        }
    }
}

/* Invert a line from (x1, y1) to (x2, y2)
 *
 * The bit patterns for the pixels of the line are inverted, so white becomes
 * black, light gray becomes dark gray etc.
 */
void gray_invertline(int x1, int y1, int x2, int y2)
{
    int numpixels;
    int i;
    int deltax, deltay;
    int d, dinc1, dinc2;
    int x, xinc1, xinc2;
    int y, yinc1, yinc2;

    if (graybuf == NULL 
        || (unsigned) x1 >= (unsigned) graybuf->width
        || (unsigned) y1 >= (unsigned) graybuf->height
        || (unsigned) x2 >= (unsigned) graybuf->width
        || (unsigned) y2 >= (unsigned) graybuf->height)
        return;

    deltax = abs(x2 - x1);
    deltay = abs(y2 - y1);
    xinc2 = 1;
    yinc2 = 1;

    if (deltax >= deltay)
    {
        numpixels = deltax;
        d = 2 * deltay - deltax;
        dinc1 = deltay * 2;
        dinc2 = (deltay - deltax) * 2;
        xinc1 = 1;
        yinc1 = 0;
    }
    else
    {
        numpixels = deltay;
        d = 2 * deltax - deltay;
        dinc1 = deltax * 2;
        dinc2 = (deltax - deltay) * 2;
        xinc1 = 0;
        yinc1 = 1;
    }
    numpixels++; /* include endpoints */

    if (x1 > x2)
    {
        xinc1 = -xinc1;
        xinc2 = -xinc2;
    }

    if (y1 > y2)
    {
        yinc1 = -yinc1;
        yinc2 = -yinc2;
    }

    x = x1;
    y = y1;

    for (i=0; i<numpixels; i++)
    {
        grayinvertmasked(x, (y >> 3), 1 << (y & 7));

        if (d < 0)
        {
            d += dinc1;
            x += xinc1;
            y += yinc1;
        }
        else
        {
            d += dinc2;
            x += xinc2;
            y += yinc2;
        }
    }
}

/* Draw a (hollow) rectangle with a specific gray value,
 * corners are (x1, y1) and (x2, y2)
 *
 * brightness is 0..255 (black to white) regardless of real bit depth
 */
void gray_drawrect(int x1, int y1, int x2, int y2, int brightness)
{
    int x, y;
    unsigned long pattern;
    unsigned char srcpixel;

    if (graybuf == NULL 
        || (unsigned) x1 >= (unsigned) graybuf->width
        || (unsigned) y1 >= (unsigned) graybuf->height
        || (unsigned) x2 >= (unsigned) graybuf->width
        || (unsigned) y2 >= (unsigned) graybuf->height
        || (unsigned) brightness > 255)
        return;

    if (y1 > y2)
    {
        y = y1;
        y1 = y2;
        y2 = y;
    }
    if (x1 > x2)
    {
        x = x1;
        x1 = x2; 
        x2 = x;
    }

    pattern = graybuf->bitpattern[MULU16(brightness, graybuf->depth + 1) >> 8];
    srcpixel = brightness;

    for (x = x1 + 1; x < x2; x++)
    {
        graypixel(x, y1, pattern);
        graypixel(x, y2, pattern);
    }
    for (y = y1; y <= y2; )
    {
        if (!(y & 7) && (y2 - y >= 7))
        /* current row byte aligned in fb & at least 8 rows left */
        {
            /* shortcut: draw all 8 rows at once: 2..3 times faster */
            grayblock(x1, y >> 3, &srcpixel, 0);
            grayblock(x2, y >> 3, &srcpixel, 0);
            y += 8;
        }
        else
        {
            graypixel(x1, y, pattern);
            graypixel(x2, y, pattern);
            y++;
        }
    }
}

/* Fill a rectangle with a specific gray value 
 * corners are (x1, y1) and (x2, y2)
 *
 * brightness is 0..255 (black to white) regardless of real bit depth
 */
void gray_fillrect(int x1, int y1, int x2, int y2, int brightness)
{
    int x, y;
    unsigned long pattern;
    unsigned char srcpixel;

    if (graybuf == NULL 
        || (unsigned) x1 >= (unsigned) graybuf->width
        || (unsigned) y1 >= (unsigned) graybuf->height
        || (unsigned) x2 >= (unsigned) graybuf->width
        || (unsigned) y2 >= (unsigned) graybuf->height
        || (unsigned) brightness > 255)
        return;
        
    if (y1 > y2)
    {
        y = y1;
        y1 = y2;
        y2 = y;
    }
    if (x1 > x2)
    {
        x = x1;
        x1 = x2; 
        x2 = x;
    }

    pattern = graybuf->bitpattern[MULU16(brightness, graybuf->depth + 1) >> 8];
    srcpixel = brightness;

    for (y = y1; y <= y2; )
    {
        if (!(y & 7) && (y2 - y >= 7))
        /* current row byte aligned in fb & at least 8 rows left */
        {
            for (x = x1; x <= x2; x++)
            {
                /* shortcut: draw all 8 rows at once: 2..3 times faster */
                grayblock(x, y >> 3, &srcpixel, 0);
            }
            y += 8;
        }
        else
        {
            for (x = x1; x <= x2; x++)
            {
                graypixel(x, y, pattern);
            }
            y++;
        }
    }
}

/* Invert a (solid) rectangle, corners are (x1, y1) and (x2, y2)
 *
 * The bit patterns for all pixels of the rectangle are inverted, so white
 * becomes black, light gray becomes dark gray etc. This is the fastest of
 * all gray_xxxrect() functions! Perfectly suited for cursors.
 */
void gray_invertrect(int x1, int y1, int x2, int y2)
{
    int x, yb, yb1, yb2;
    unsigned char mask;

    if (graybuf == NULL 
        || (unsigned) x1 >= (unsigned) graybuf->width
        || (unsigned) y1 >= (unsigned) graybuf->height
        || (unsigned) x2 >= (unsigned) graybuf->width
        || (unsigned) y2 >= (unsigned) graybuf->height)
        return;

    if (y1 > y2)
    {
        yb = y1;
        y1 = y2;
        y2 = yb;
    }
    if (x1 > x2)
    {
        x = x1;
        x1 = x2; 
        x2 = x;
    }
    
    yb1 = y1 >> 3;
    yb2 = y2 >> 3;

    if (yb1 == yb2)
    {
        mask = 0xFF << (y1 & 7);
        mask &= 0xFF >> (7 - (y2 & 7));

        for (x = x1; x <= x2; x++)
            grayinvertmasked(x, yb1, mask);
    }
    else
    {
        mask = 0xFF << (y1 & 7);

        for (x = x1; x <= x2; x++)
            grayinvertmasked(x, yb1, mask);
            
        for (yb = yb1 + 1; yb < yb2; yb++)
        {
            for (x = x1; x <= x2; x++)
                grayinvertmasked(x, yb, 0xFF);
        }
        
        mask = 0xFF >> (7 - (y2 & 7));

        for (x = x1; x <= x2; x++)
            grayinvertmasked(x, yb2, mask);
    }
}

/* Copy a grayscale bitmap into the display
 * 
 * A grayscale bitmap contains one byte for every pixel that defines the
 * brightness of the pixel (0..255). Bytes are read in row-major order.
 * The <stride> parameter is useful if you want to show only a part of a
 * bitmap. It should always be set to the "row length" of the bitmap, so
 * for displaying the whole bitmap, nx == stride.
 */
void gray_drawgraymap(unsigned char *src, int x, int y, int nx, int ny,
                      int stride)
{
    int xi, yi;
    unsigned char *row;

    if (graybuf == NULL 
        || (unsigned) x >= (unsigned) graybuf->width
        || (unsigned) y >= (unsigned) graybuf->height)
        return;
    
    if ((y + ny) >= graybuf->height) /* clip bottom */
        ny = graybuf->height - y;

    if ((x + nx) >= graybuf->width) /* clip right */
        nx = graybuf->width - x;

    for (yi = y; yi < y + ny; )
    {
        row = src;

        if (!(yi & 7) && (y + ny - yi > 7))
        /* current row byte aligned in fb & at least 8 rows left */
        {
            for (xi = x; xi < x + nx; xi++)
            {
                /* shortcut: draw all 8 rows at once: 2..3 times faster */
                grayblock(xi, yi >> 3, row++, stride);
            }
            yi += 8;
            src += stride << 3;
        }
        else
        {
            for (xi = x; xi < x + nx; xi++)
            {
                graypixel(xi, yi, graybuf->bitpattern[MULU16(*row++,
                                  graybuf->depth + 1) >> 8]);
            }
            yi++;
            src += stride;
        }
    }
}

/* Display a bitmap with specific foreground and background gray values
 *
 * This (now) uses the same bitmap format as the core b&w graphics routines,
 * so you can use bmp2rb to generate bitmaps for use with this function as
 * well.
 *
 * A bitmap contains one bit for every pixel that defines if that pixel is
 * foreground (1) or background (0). Bits within a byte are arranged
 * vertically, LSB at top.
 * The bytes are stored in row-major order, with byte 0 being top left,
 * byte 1 2nd from left etc. The first row of bytes defines pixel rows
 * 0..7, the second row defines pixel row 8..15 etc.
 *
 * The <stride> parameter is useful if you want to show only a part of a
 * bitmap. It should always be set to the "row length" of the bitmap.
 *
 * If draw_bg is false, only foreground pixels are drawn, so the background
 * is transparent. In this case bg_brightness is ignored.
 */
void gray_drawbitmap(unsigned char *src, int x, int y, int nx, int ny,
                     int stride, bool draw_bg, int fg_brightness,
                     int bg_brightness)
{
    int xi, dy;
    int bits = 0;  /* Have to initialize to prevent warning */
    unsigned long fg_pattern, bg_pattern;
    unsigned char *col;

    if (graybuf == NULL
        || (unsigned) x >= (unsigned) graybuf->width
        || (unsigned) y >= (unsigned) graybuf->height
        || (unsigned) fg_brightness > 255
        || (unsigned) bg_brightness > 255)
        return;

    if ((y + ny) >= graybuf->height) /* clip bottom */
        ny = graybuf->height - y;

    if ((x + nx) >= graybuf->width) /* clip right */
        nx = graybuf->width - x;

    fg_pattern = graybuf->bitpattern[MULU16(fg_brightness,
                                     graybuf->depth + 1) >> 8];

    bg_pattern = graybuf->bitpattern[MULU16(bg_brightness,
                                     graybuf->depth + 1) >> 8];

    for (xi = x; xi < x + nx; xi++)
    {
        col = src++;
        for (dy = 0; dy < ny; dy++)
        {
            if (!(dy & 7))   /* get next 8 bits */
            {
                bits = (int)(*col);
                col += stride;
            }

            if (bits & 0x01)
                graypixel(xi, y + dy, fg_pattern);
            else
                if (draw_bg)
                    graypixel(xi, y + dy, bg_pattern);

            bits >>= 1;
        }
    }
}

#endif // #ifdef HAVE_LCD_BITMAP
#endif // #ifndef SIMULATOR