/*

 * Toshiba TC6393XB I/O Controller.

 * Found in Sharp Zaurus SL-6000 (tosa) or some

 * Toshiba e-Series PDAs.

 *

 * FB support code. Based on G364 fb emulator

 *

 * Copyright (c) 2007 Hervé Poussineau

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License as

 * published by the Free Software Foundation; either version 2 of

 * the License, or (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,

 * MA 02111-1307 USA

 */

#if BITS == 8

# define SET_PIXEL(addr, color)	*(uint8_t*)addr = color;

#elif BITS == 15 || BITS == 16

# define SET_PIXEL(addr, color)	*(uint16_t*)addr = color;

#elif BITS == 24

# define SET_PIXEL(addr, color)	\

    addr[0] = color; addr[1] = (color) >> 8; addr[2] = (color) >> 16;

#elif BITS == 32

# define SET_PIXEL(addr, color)	*(uint32_t*)addr = color;

#else

# error unknown bit depth

#endif

static void glue(tc6393xb_draw_graphic, BITS)(struct tc6393xb_s *s)

{

    int i;

    int w_display;

    uint16_t *data_buffer;

    uint8_t *data_display;

    /* FIXME: This is broken if it spans multiple regions.  */

    data_buffer = (uint16_t*)host_ram_addr(s->vram_addr);

    w_display = s->scr_width * BITS / 8;

    data_display = ds_get_data(s->ds);

    for(i = 0; i < s->scr_height; i++) {

#if (BITS == 16)

        memcpy(data_display, data_buffer, s->scr_width * 2);

        data_buffer += s->scr_width;

        data_display += ds_get_linesize(s->ds);

#else

        int j;

        for (j = 0; j < s->scr_width; j++, data_display += BITS / 8, data_buffer++) {

            uint16_t color = *data_buffer;

            uint32_t dest_color = glue(rgb_to_pixel, BITS)(

                           ((color & 0xf800) * 0x108) >> 11,

                           ((color & 0x7e0) * 0x41) >> 9,

                           ((color & 0x1f) * 0x21) >> 2

                           );

            SET_PIXEL(data_display, dest_color);

        }

#endif

    }

}

#undef BITS

#undef SET_PIXEL