[qemu.git] / hw / syborg_fb.c

/*
 * Syborg Framebuffer
 *
 * Copyright (c) 2009 CodeSourcery
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

#include "sysbus.h"
#include "console.h"
#include "syborg.h"
#include "framebuffer.h"

//#define DEBUG_SYBORG_FB

#ifdef DEBUG_SYBORG_FB
#define DPRINTF(fmt, ...) \
do { printf("syborg_fb: " fmt , ## __VA_ARGS__); } while (0)
#define BADF(fmt, ...) \
do { fprintf(stderr, "syborg_fb: error: " fmt , ## __VA_ARGS__); \
    exit(1);} while (0)
#else
#define DPRINTF(fmt, ...) do {} while(0)
#define BADF(fmt, ...) \
do { fprintf(stderr, "syborg_fb: error: " fmt , ## __VA_ARGS__);} while (0)
#endif

enum {
    FB_ID               = 0,
    FB_BASE             = 1,
    FB_HEIGHT           = 2,
    FB_WIDTH            = 3,
    FB_ORIENTATION      = 4,
    FB_BLANK            = 5,
    FB_INT_MASK         = 6,
    FB_INTERRUPT_CAUSE  = 7,
    FB_BPP              = 8,
    FB_COLOR_ORDER      = 9,
    FB_BYTE_ORDER       = 10,
    FB_PIXEL_ORDER      = 11,
    FB_ROW_PITCH        = 12,
    FB_ENABLED          = 13,
    FB_PALETTE_START    = 0x400 >> 2,
    FB_PALETTE_END   = FB_PALETTE_START+256-1,
};

#define FB_INT_VSYNC            (1U << 0)
#define FB_INT_BASE_UPDATE_DONE (1U << 1)

typedef struct {
    SysBusDevice busdev;
    DisplayState *ds;
    /*QEMUConsole *console;*/
    uint32_t need_update : 1;
    uint32_t need_int : 1;
    uint32_t enabled : 1;
    uint32_t int_status;
    uint32_t int_enable;
    qemu_irq irq;

    uint32_t base;
    uint32_t pitch;
    uint32_t rows;
    uint32_t cols;
    int blank;
    int bpp;
    int rgb; /* 0 = BGR, 1 = RGB */
    int endian; /* 0 = Little, 1 = Big */
    uint32_t raw_palette[256];
    uint32_t palette[256];
} SyborgFBState;

enum {
    BPP_SRC_1,
    BPP_SRC_2,
    BPP_SRC_4,
    BPP_SRC_8,
    BPP_SRC_16,
    BPP_SRC_32,
    /* TODO: Implement these.  */
    BPP_SRC_15 = -1,
    BPP_SRC_24 = -2
};

#include "pixel_ops.h"

#define BITS 8
#include "pl110_template.h"
#define BITS 15
#include "pl110_template.h"
#define BITS 16
#include "pl110_template.h"
#define BITS 24
#include "pl110_template.h"
#define BITS 32
#include "pl110_template.h"

/* Update interrupts.  */
static void syborg_fb_update(SyborgFBState *s)
{
    if ((s->int_status & s->int_enable) != 0) {
        DPRINTF("Raise IRQ\n");
        qemu_irq_raise(s->irq);
    } else {
        DPRINTF("Lower IRQ\n");
        qemu_irq_lower(s->irq);
    }
}

static int syborg_fb_enabled(const SyborgFBState *s)
{
    return s->enabled;
}

static void syborg_fb_update_palette(SyborgFBState *s)
{
    int n, i;
    uint32_t raw;
    unsigned int r, g, b;

    switch (s->bpp) {
    case BPP_SRC_1: n = 2; break;
    case BPP_SRC_2: n = 4; break;
    case BPP_SRC_4: n = 16; break;
    case BPP_SRC_8: n = 256; break;
    default: return;
    }

    for (i = 0; i < n; i++) {
        raw = s->raw_palette[i];
        r = (raw >> 16) & 0xff;
        g = (raw >> 8) & 0xff;
        b = raw & 0xff;
        switch (ds_get_bits_per_pixel(s->ds)) {
        case 8:
            s->palette[i] = rgb_to_pixel8(r, g, b);
            break;
        case 15:
            s->palette[i] = rgb_to_pixel15(r, g, b);
            break;
        case 16:
            s->palette[i] = rgb_to_pixel16(r, g, b);
            break;
        case 24:
        case 32:
            s->palette[i] = rgb_to_pixel32(r, g, b);
            break;
        default:
            abort();
        }
    }

}

static void syborg_fb_update_display(void *opaque)
{
    SyborgFBState *s = (SyborgFBState *)opaque;
    drawfn* fntable;
    drawfn fn;
    int dest_width;
    int src_width;
    int bpp_offset;
    int first;
    int last;

    if (!syborg_fb_enabled(s))
        return;

    switch (ds_get_bits_per_pixel(s->ds)) {
    case 0:
        return;
    case 8:
        fntable = pl110_draw_fn_8;
        dest_width = 1;
        break;
    case 15:
        fntable = pl110_draw_fn_15;
        dest_width = 2;
        break;
    case 16:
        fntable = pl110_draw_fn_16;
        dest_width = 2;
        break;
    case 24:
        fntable = pl110_draw_fn_24;
        dest_width = 3;
        break;
    case 32:
        fntable = pl110_draw_fn_32;
        dest_width = 4;
        break;
    default:
        fprintf(stderr, "syborg_fb: Bad color depth\n");
        exit(1);
    }

    if (s->need_int) {
        s->int_status |= FB_INT_BASE_UPDATE_DONE;
        syborg_fb_update(s);
        s->need_int = 0;
    }

    if (s->rgb) {
        bpp_offset = 18;
    } else {
        bpp_offset = 0;
    }
    if (s->endian) {
        bpp_offset += 6;
    }

    fn = fntable[s->bpp + bpp_offset];

    if (s->pitch) {
        src_width = s->pitch;
    } else {
        src_width = s->cols;
        switch (s->bpp) {
        case BPP_SRC_1:
            src_width >>= 3;
            break;
        case BPP_SRC_2:
            src_width >>= 2;
            break;
        case BPP_SRC_4:
            src_width >>= 1;
            break;
        case BPP_SRC_8:
            break;
        case BPP_SRC_15:
        case BPP_SRC_16:
            src_width <<= 1;
            break;
        case BPP_SRC_24:
            src_width *= 3;
            break;
        case BPP_SRC_32:
            src_width <<= 2;
            break;
        }
    }
    dest_width *= s->cols;
    first = 0;
    /* TODO: Implement blanking.  */
    if (!s->blank) {
        if (s->need_update && s->bpp <= BPP_SRC_8) {
            syborg_fb_update_palette(s);
        }
        framebuffer_update_display(s->ds,
                                   s->base, s->cols, s->rows,
                                   src_width, dest_width, 0,
                                   s->need_update,
                                   fn, s->palette,
                                   &first, &last);
        if (first >= 0) {
            dpy_update(s->ds, 0, first, s->cols, last - first + 1);
        }

        s->int_status |= FB_INT_VSYNC;
        syborg_fb_update(s);
    }

    s->need_update = 0;
}

static void syborg_fb_invalidate_display(void * opaque)
{
    SyborgFBState *s = (SyborgFBState *)opaque;
    s->need_update = 1;
}

static uint32_t syborg_fb_read(void *opaque, target_phys_addr_t offset)
{
    SyborgFBState *s = opaque;

    DPRINTF("read reg %d\n", (int)offset);
    offset &= 0xfff;
    switch (offset >> 2) {
    case FB_ID:
        return SYBORG_ID_FRAMEBUFFER;

    case FB_BASE:
        return s->base;

    case FB_HEIGHT:
        return s->rows;

    case FB_WIDTH:
        return s->cols;

    case FB_ORIENTATION:
        return 0;

    case FB_BLANK:
        return s->blank;

    case FB_INT_MASK:
        return s->int_enable;

    case FB_INTERRUPT_CAUSE:
        return s->int_status;

    case FB_BPP:
        switch (s->bpp) {
        case BPP_SRC_1: return 1;
        case BPP_SRC_2: return 2;
        case BPP_SRC_4: return 4;
        case BPP_SRC_8: return 8;
        case BPP_SRC_15: return 15;
        case BPP_SRC_16: return 16;
        case BPP_SRC_24: return 24;
        case BPP_SRC_32: return 32;
        default: return 0;
        }

    case FB_COLOR_ORDER:
        return s->rgb;

    case FB_BYTE_ORDER:
        return s->endian;

    case FB_PIXEL_ORDER:
        return 0;

    case FB_ROW_PITCH:
        return s->pitch;

    case FB_ENABLED:
        return s->enabled;

    default:
        if ((offset >> 2) >= FB_PALETTE_START
            && (offset >> 2) <= FB_PALETTE_END) {
            return s->raw_palette[(offset >> 2) - FB_PALETTE_START];
        } else {
            cpu_abort (cpu_single_env, "syborg_fb_read: Bad offset %x\n",
                         (int)offset);
        }
        return 0;
    }
}

static void syborg_fb_write(void *opaque, target_phys_addr_t offset,
                            uint32_t val)
{
    SyborgFBState *s = opaque;

    DPRINTF("write reg %d = %d\n", (int)offset, val);
    s->need_update = 1;
    offset &= 0xfff;
    switch (offset >> 2) {
    case FB_BASE:
        s->base = val;
        s->need_int = 1;
        s->need_update = 1;
        syborg_fb_update(s);
        break;

    case FB_HEIGHT:
        s->rows = val;
        break;

    case FB_WIDTH:
        s->cols = val;
        break;

    case FB_ORIENTATION:
        /* TODO: Implement rotation.  */
        break;

    case FB_BLANK:
        s->blank = val & 1;
        break;

    case FB_INT_MASK:
        s->int_enable = val;
        syborg_fb_update(s);
        break;

    case FB_INTERRUPT_CAUSE:
        s->int_status &= ~val;
        syborg_fb_update(s);
        break;

    case FB_BPP:
        switch (val) {
        case 1: val = BPP_SRC_1; break;
        case 2: val = BPP_SRC_2; break;
        case 4: val = BPP_SRC_4; break;
        case 8: val = BPP_SRC_8; break;
        /* case 15: val = BPP_SRC_15; break; */
        case 16: val = BPP_SRC_16; break;
        /* case 24: val = BPP_SRC_24; break; */
        case 32: val = BPP_SRC_32; break;
        default: val = s->bpp; break;
        }
        s->bpp = val;
        break;

    case FB_COLOR_ORDER:
        s->rgb = (val != 0);
        break;

    case FB_BYTE_ORDER:
        s->endian = (val != 0);
        break;

    case FB_PIXEL_ORDER:
        /* TODO: Implement this.  */
        break;

    case FB_ROW_PITCH:
        s->pitch = val;
        break;

    case FB_ENABLED:
        s->enabled = val;
        break;

    default:
        if ((offset >> 2) >= FB_PALETTE_START
            && (offset >> 2) <= FB_PALETTE_END) {
            s->raw_palette[(offset >> 2) - FB_PALETTE_START] = val;
        } else {
            cpu_abort (cpu_single_env, "syborg_fb_write: Bad offset %x\n",
                      (int)offset);
        }
        break;
    }
}

static CPUReadMemoryFunc * const syborg_fb_readfn[] = {
    syborg_fb_read,
    syborg_fb_read,
    syborg_fb_read
};

static CPUWriteMemoryFunc * const syborg_fb_writefn[] = {
    syborg_fb_write,
    syborg_fb_write,
    syborg_fb_write
};

static void syborg_fb_save(QEMUFile *f, void *opaque)
{
    SyborgFBState *s = opaque;
    int i;

    qemu_put_be32(f, s->need_int);
    qemu_put_be32(f, s->int_status);
    qemu_put_be32(f, s->int_enable);
    qemu_put_be32(f, s->enabled);
    qemu_put_be32(f, s->base);
    qemu_put_be32(f, s->pitch);
    qemu_put_be32(f, s->rows);
    qemu_put_be32(f, s->cols);
    qemu_put_be32(f, s->bpp);
    qemu_put_be32(f, s->rgb);
    for (i = 0; i < 256; i++) {
        qemu_put_be32(f, s->raw_palette[i]);
    }
}

static int syborg_fb_load(QEMUFile *f, void *opaque, int version_id)
{
    SyborgFBState *s = opaque;
    int i;

    if (version_id != 1)
        return -EINVAL;

    s->need_int = qemu_get_be32(f);
    s->int_status = qemu_get_be32(f);
    s->int_enable = qemu_get_be32(f);
    s->enabled = qemu_get_be32(f);
    s->base = qemu_get_be32(f);
    s->pitch = qemu_get_be32(f);
    s->rows = qemu_get_be32(f);
    s->cols = qemu_get_be32(f);
    s->bpp = qemu_get_be32(f);
    s->rgb = qemu_get_be32(f);
    for (i = 0; i < 256; i++) {
        s->raw_palette[i] = qemu_get_be32(f);
    }
    s->need_update = 1;

    return 0;
}

static int syborg_fb_init(SysBusDevice *dev)
{
    SyborgFBState *s = FROM_SYSBUS(SyborgFBState, dev);
    int iomemtype;

    sysbus_init_irq(dev, &s->irq);
    iomemtype = cpu_register_io_memory(syborg_fb_readfn,
                                       syborg_fb_writefn, s);
    sysbus_init_mmio(dev, 0x1000, iomemtype);

    s->ds = graphic_console_init(syborg_fb_update_display,
                                 syborg_fb_invalidate_display,
                                 NULL, NULL, s);

    if (s->cols != 0 && s->rows != 0) {
        qemu_console_resize(s->ds, s->cols, s->rows);
    }

    if (!s->cols)
        s->cols = ds_get_width(s->ds);
    if (!s->rows)
        s->rows = ds_get_height(s->ds);

    register_savevm("syborg_framebuffer", -1, 1,
                    syborg_fb_save, syborg_fb_load, s);
    return 0;
}

static SysBusDeviceInfo syborg_fb_info = {
    .init = syborg_fb_init,
    .qdev.name  = "syborg,framebuffer",
    .qdev.size  = sizeof(SyborgFBState),
    .qdev.props = (Property[]) {
        DEFINE_PROP_UINT32("width",  SyborgFBState, cols, 0),
        DEFINE_PROP_UINT32("height", SyborgFBState, rows, 0),
        DEFINE_PROP_END_OF_LIST(),
    }
};

static void syborg_fb_register_devices(void)
{
    sysbus_register_withprop(&syborg_fb_info);
}

device_init(syborg_fb_register_devices)
Commit	Line	Data
4af39611 PB	1	/*
	2	* Syborg Framebuffer
	3	*
	4	* Copyright (c) 2009 CodeSourcery
	5	*
	6	* Permission is hereby granted, free of charge, to any person obtaining a copy
	7	* of this software and associated documentation files (the "Software"), to deal
	8	* in the Software without restriction, including without limitation the rights
	9	* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
	10	* copies of the Software, and to permit persons to whom the Software is
	11	* furnished to do so, subject to the following conditions:
	12	*
	13	* The above copyright notice and this permission notice shall be included in
	14	* all copies or substantial portions of the Software.
	15	*
	16	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	17	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	18	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	19	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	20	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
	21	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
	22	* THE SOFTWARE.
	23	*/
	24
	25	#include "sysbus.h"
	26	#include "console.h"
	27	#include "syborg.h"
	28	#include "framebuffer.h"
	29
	30	//#define DEBUG_SYBORG_FB
	31
	32	#ifdef DEBUG_SYBORG_FB
	33	#define DPRINTF(fmt, ...) \
	34	do { printf("syborg_fb: " fmt , ## __VA_ARGS__); } while (0)
	35	#define BADF(fmt, ...) \
	36	do { fprintf(stderr, "syborg_fb: error: " fmt , ## __VA_ARGS__); \
	37	exit(1);} while (0)
	38	#else
	39	#define DPRINTF(fmt, ...) do {} while(0)
	40	#define BADF(fmt, ...) \
	41	do { fprintf(stderr, "syborg_fb: error: " fmt , ## __VA_ARGS__);} while (0)
	42	#endif
	43
	44	enum {
	45	FB_ID = 0,
	46	FB_BASE = 1,
	47	FB_HEIGHT = 2,
	48	FB_WIDTH = 3,
	49	FB_ORIENTATION = 4,
	50	FB_BLANK = 5,
	51	FB_INT_MASK = 6,
	52	FB_INTERRUPT_CAUSE = 7,
	53	FB_BPP = 8,
	54	FB_COLOR_ORDER = 9,
	55	FB_BYTE_ORDER = 10,
	56	FB_PIXEL_ORDER = 11,
	57	FB_ROW_PITCH = 12,
	58	FB_ENABLED = 13,
	59	FB_PALETTE_START = 0x400 >> 2,
	60	FB_PALETTE_END = FB_PALETTE_START+256-1,
	61	};
	62
	63	#define FB_INT_VSYNC (1U << 0)
	64	#define FB_INT_BASE_UPDATE_DONE (1U << 1)
65
66	typedef struct {
67	SysBusDevice busdev;
68	DisplayState *ds;
69	/QEMUConsole console;*/
70	uint32_t need_update : 1;
71	uint32_t need_int : 1;
72	uint32_t enabled : 1;
73	uint32_t int_status;
74	uint32_t int_enable;
75	qemu_irq irq;
76
77	uint32_t base;
78	uint32_t pitch;
ee6847d1 GH	79	uint32_t rows;
ee6847d1 GH	80	uint32_t cols;
4af39611 PB	81	int blank;
	82	int bpp;
	83	int rgb; /* 0 = BGR, 1 = RGB */
	84	int endian; /* 0 = Little, 1 = Big */
	85	uint32_t raw_palette[256];
	86	uint32_t palette[256];
	87	} SyborgFBState;
	88
	89	enum {
	90	BPP_SRC_1,
	91	BPP_SRC_2,
	92	BPP_SRC_4,
	93	BPP_SRC_8,
	94	BPP_SRC_16,
	95	BPP_SRC_32,
	96	/* TODO: Implement these. */
	97	BPP_SRC_15 = -1,
	98	BPP_SRC_24 = -2
	99	};
	100
	101	#include "pixel_ops.h"
	102
	103	#define BITS 8
	104	#include "pl110_template.h"
	105	#define BITS 15
	106	#include "pl110_template.h"
	107	#define BITS 16
	108	#include "pl110_template.h"
	109	#define BITS 24
	110	#include "pl110_template.h"
	111	#define BITS 32
	112	#include "pl110_template.h"
	113
	114	/* Update interrupts. */
	115	static void syborg_fb_update(SyborgFBState *s)
	116	{
	117	if ((s->int_status & s->int_enable) != 0) {
	118	DPRINTF("Raise IRQ\n");
	119	qemu_irq_raise(s->irq);
	120	} else {
	121	DPRINTF("Lower IRQ\n");
	122	qemu_irq_lower(s->irq);
	123	}
	124	}
	125
	126	static int syborg_fb_enabled(const SyborgFBState *s)
	127	{
	128	return s->enabled;
	129	}
	130
	131	static void syborg_fb_update_palette(SyborgFBState *s)
	132	{
	133	int n, i;
	134	uint32_t raw;
	135	unsigned int r, g, b;
	136
	137	switch (s->bpp) {
	138	case BPP_SRC_1: n = 2; break;
	139	case BPP_SRC_2: n = 4; break;
	140	case BPP_SRC_4: n = 16; break;
	141	case BPP_SRC_8: n = 256; break;
	142	default: return;
	143	}
	144
145	for (i = 0; i < n; i++) {
146	raw = s->raw_palette[i];
147	r = (raw >> 16) & 0xff;
148	g = (raw >> 8) & 0xff;
149	b = raw & 0xff;
150	switch (ds_get_bits_per_pixel(s->ds)) {
151	case 8:
152	s->palette[i] = rgb_to_pixel8(r, g, b);
153	break;
154	case 15:
155	s->palette[i] = rgb_to_pixel15(r, g, b);
156	break;
157	case 16:
158	s->palette[i] = rgb_to_pixel16(r, g, b);
159	break;
160	case 24:
161	case 32:
162	s->palette[i] = rgb_to_pixel32(r, g, b);
163	break;
164	default:
165	abort();
166	}
167	}
168
169	}
170
171	static void syborg_fb_update_display(void *opaque)
172	{
173	SyborgFBState s = (SyborgFBState )opaque;
174	drawfn* fntable;
175	drawfn fn;
176	int dest_width;
177	int src_width;
178	int bpp_offset;
179	int first;
180	int last;
181
182	if (!syborg_fb_enabled(s))
183	return;
184
185	switch (ds_get_bits_per_pixel(s->ds)) {
186	case 0:
187	return;
188	case 8:
189	fntable = pl110_draw_fn_8;
190	dest_width = 1;
191	break;
192	case 15:
193	fntable = pl110_draw_fn_15;
194	dest_width = 2;
195	break;
196	case 16:
197	fntable = pl110_draw_fn_16;
198	dest_width = 2;
199	break;
200	case 24:
201	fntable = pl110_draw_fn_24;
202	dest_width = 3;
203	break;
204	case 32:
205	fntable = pl110_draw_fn_32;
206	dest_width = 4;
207	break;
208	default:
209	fprintf(stderr, "syborg_fb: Bad color depth\n");
210	exit(1);
211	}
212
213	if (s->need_int) {
214	s->int_status \|= FB_INT_BASE_UPDATE_DONE;
215	syborg_fb_update(s);
216	s->need_int = 0;
217	}
218
219	if (s->rgb) {
220	bpp_offset = 18;
221	} else {
222	bpp_offset = 0;
223	}
224	if (s->endian) {
225	bpp_offset += 6;
226	}
227
228	fn = fntable[s->bpp + bpp_offset];
229
230	if (s->pitch) {
231	src_width = s->pitch;
232	} else {
233	src_width = s->cols;
234	switch (s->bpp) {
235	case BPP_SRC_1:
236	src_width >>= 3;
237	break;
238	case BPP_SRC_2:
239	src_width >>= 2;
240	break;
241	case BPP_SRC_4:
242	src_width >>= 1;
243	break;
244	case BPP_SRC_8:
245	break;
246	case BPP_SRC_15:
247	case BPP_SRC_16:
248	src_width <<= 1;
249	break;
250	case BPP_SRC_24:
251	src_width *= 3;
252	break;
253	case BPP_SRC_32:
254	src_width <<= 2;
255	break;
256	}
257	}
258	dest_width *= s->cols;
259	first = 0;
260	/* TODO: Implement blanking. */
261	if (!s->blank) {
262	if (s->need_update && s->bpp <= BPP_SRC_8) {
263	syborg_fb_update_palette(s);
264	}
265	framebuffer_update_display(s->ds,
266	s->base, s->cols, s->rows,
267	src_width, dest_width, 0,
268	s->need_update,
269	fn, s->palette,
270	&first, &last);
271	if (first >= 0) {
272	dpy_update(s->ds, 0, first, s->cols, last - first + 1);
273	}
274
275	s->int_status \|= FB_INT_VSYNC;
276	syborg_fb_update(s);
277	}
278
279	s->need_update = 0;
280	}
281
282	static void syborg_fb_invalidate_display(void * opaque)
283	{
284	SyborgFBState s = (SyborgFBState )opaque;
285	s->need_update = 1;
286	}
287
c227f099	288	static uint32_t syborg_fb_read(void *opaque, target_phys_addr_t offset)
4af39611 PB	289	{
	290	SyborgFBState *s = opaque;
	291
	292	DPRINTF("read reg %d\n", (int)offset);
	293	offset &= 0xfff;
	294	switch (offset >> 2) {
	295	case FB_ID:
	296	return SYBORG_ID_FRAMEBUFFER;
	297
	298	case FB_BASE:
	299	return s->base;
	300
	301	case FB_HEIGHT:
	302	return s->rows;
	303
	304	case FB_WIDTH:
	305	return s->cols;
	306
	307	case FB_ORIENTATION:
	308	return 0;
	309
	310	case FB_BLANK:
	311	return s->blank;
	312
	313	case FB_INT_MASK:
	314	return s->int_enable;
	315
	316	case FB_INTERRUPT_CAUSE:
	317	return s->int_status;
	318
	319	case FB_BPP:
	320	switch (s->bpp) {
	321	case BPP_SRC_1: return 1;
	322	case BPP_SRC_2: return 2;
	323	case BPP_SRC_4: return 4;
	324	case BPP_SRC_8: return 8;
	325	case BPP_SRC_15: return 15;
	326	case BPP_SRC_16: return 16;
	327	case BPP_SRC_24: return 24;
	328	case BPP_SRC_32: return 32;
	329	default: return 0;
	330	}
	331
	332	case FB_COLOR_ORDER:
	333	return s->rgb;
	334
	335	case FB_BYTE_ORDER:
	336	return s->endian;
	337
	338	case FB_PIXEL_ORDER:
	339	return 0;
	340
	341	case FB_ROW_PITCH:
	342	return s->pitch;
	343
	344	case FB_ENABLED:
	345	return s->enabled;
	346
	347	default:
	348	if ((offset >> 2) >= FB_PALETTE_START
	349	&& (offset >> 2) <= FB_PALETTE_END) {
	350	return s->raw_palette[(offset >> 2) - FB_PALETTE_START];
	351	} else {
	352	cpu_abort (cpu_single_env, "syborg_fb_read: Bad offset %x\n",
353	(int)offset);
354	}
355	return 0;
356	}
357	}
358
c227f099	359	static void syborg_fb_write(void *opaque, target_phys_addr_t offset,
4af39611 PB	360	uint32_t val)
	361	{
	362	SyborgFBState *s = opaque;
	363
	364	DPRINTF("write reg %d = %d\n", (int)offset, val);
	365	s->need_update = 1;
	366	offset &= 0xfff;
	367	switch (offset >> 2) {
	368	case FB_BASE:
	369	s->base = val;
	370	s->need_int = 1;
	371	s->need_update = 1;
	372	syborg_fb_update(s);
	373	break;
	374
	375	case FB_HEIGHT:
	376	s->rows = val;
	377	break;
	378
	379	case FB_WIDTH:
	380	s->cols = val;
	381	break;
	382
	383	case FB_ORIENTATION:
	384	/* TODO: Implement rotation. */
	385	break;
	386
	387	case FB_BLANK:
	388	s->blank = val & 1;
	389	break;
	390
	391	case FB_INT_MASK:
	392	s->int_enable = val;
	393	syborg_fb_update(s);
	394	break;
	395
	396	case FB_INTERRUPT_CAUSE:
	397	s->int_status &= ~val;
	398	syborg_fb_update(s);
	399	break;
	400
	401	case FB_BPP:
	402	switch (val) {
	403	case 1: val = BPP_SRC_1; break;
	404	case 2: val = BPP_SRC_2; break;
	405	case 4: val = BPP_SRC_4; break;
	406	case 8: val = BPP_SRC_8; break;
	407	/* case 15: val = BPP_SRC_15; break; */
	408	case 16: val = BPP_SRC_16; break;
	409	/* case 24: val = BPP_SRC_24; break; */
	410	case 32: val = BPP_SRC_32; break;
	411	default: val = s->bpp; break;
	412	}
	413	s->bpp = val;
	414	break;
	415
	416	case FB_COLOR_ORDER:
	417	s->rgb = (val != 0);
	418	break;
	419
	420	case FB_BYTE_ORDER:
	421	s->endian = (val != 0);
	422	break;
	423
424	case FB_PIXEL_ORDER:
425	/* TODO: Implement this. */
426	break;
427
428	case FB_ROW_PITCH:
429	s->pitch = val;
430	break;
431
432	case FB_ENABLED:
433	s->enabled = val;
434	break;
435
436	default:
437	if ((offset >> 2) >= FB_PALETTE_START
438	&& (offset >> 2) <= FB_PALETTE_END) {
439	s->raw_palette[(offset >> 2) - FB_PALETTE_START] = val;
440	} else {
441	cpu_abort (cpu_single_env, "syborg_fb_write: Bad offset %x\n",
442	(int)offset);
443	}
444	break;
445	}
446	}
447
d60efc6b	448	static CPUReadMemoryFunc * const syborg_fb_readfn[] = {
4af39611 PB	449	syborg_fb_read,
	450	syborg_fb_read,
	451	syborg_fb_read
	452	};
	453
d60efc6b	454	static CPUWriteMemoryFunc * const syborg_fb_writefn[] = {
4af39611 PB	455	syborg_fb_write,
	456	syborg_fb_write,
	457	syborg_fb_write
	458	};
	459
	460	static void syborg_fb_save(QEMUFile f, void opaque)
	461	{
	462	SyborgFBState *s = opaque;
	463	int i;
	464
	465	qemu_put_be32(f, s->need_int);
	466	qemu_put_be32(f, s->int_status);
	467	qemu_put_be32(f, s->int_enable);
	468	qemu_put_be32(f, s->enabled);
	469	qemu_put_be32(f, s->base);
	470	qemu_put_be32(f, s->pitch);
	471	qemu_put_be32(f, s->rows);
	472	qemu_put_be32(f, s->cols);
	473	qemu_put_be32(f, s->bpp);
	474	qemu_put_be32(f, s->rgb);
	475	for (i = 0; i < 256; i++) {
	476	qemu_put_be32(f, s->raw_palette[i]);
	477	}
	478	}
	479
	480	static int syborg_fb_load(QEMUFile f, void opaque, int version_id)
	481	{
	482	SyborgFBState *s = opaque;
	483	int i;
	484
	485	if (version_id != 1)
	486	return -EINVAL;
	487
	488	s->need_int = qemu_get_be32(f);
	489	s->int_status = qemu_get_be32(f);
	490	s->int_enable = qemu_get_be32(f);
	491	s->enabled = qemu_get_be32(f);
	492	s->base = qemu_get_be32(f);
	493	s->pitch = qemu_get_be32(f);
	494	s->rows = qemu_get_be32(f);
	495	s->cols = qemu_get_be32(f);
	496	s->bpp = qemu_get_be32(f);
	497	s->rgb = qemu_get_be32(f);
	498	for (i = 0; i < 256; i++) {
	499	s->raw_palette[i] = qemu_get_be32(f);
	500	}
	501	s->need_update = 1;
	502
	503	return 0;
	504	}
	505
81a322d4	506	static int syborg_fb_init(SysBusDevice *dev)
4af39611 PB	507	{
	508	SyborgFBState *s = FROM_SYSBUS(SyborgFBState, dev);
	509	int iomemtype;
4af39611 PB	510
4af39611 PB	511	sysbus_init_irq(dev, &s->irq);
1eed09cb	512	iomemtype = cpu_register_io_memory(syborg_fb_readfn,
4af39611 PB	513	syborg_fb_writefn, s);
	514	sysbus_init_mmio(dev, 0x1000, iomemtype);
	515
4af39611 PB	516	s->ds = graphic_console_init(syborg_fb_update_display,
	517	syborg_fb_invalidate_display,
	518	NULL, NULL, s);
	519
ee6847d1 GH	520	if (s->cols != 0 && s->rows != 0) {
ee6847d1 GH	521	qemu_console_resize(s->ds, s->cols, s->rows);
4af39611 PB	522	}
4af39611 PB	523
ee6847d1 GH	524	if (!s->cols)
	525	s->cols = ds_get_width(s->ds);
	526	if (!s->rows)
	527	s->rows = ds_get_height(s->ds);
4af39611 PB	528
	529	register_savevm("syborg_framebuffer", -1, 1,
	530	syborg_fb_save, syborg_fb_load, s);
81a322d4	531	return 0;
4af39611 PB	532	}
4af39611 PB	533
ee6847d1 GH	534	static SysBusDeviceInfo syborg_fb_info = {
	535	.init = syborg_fb_init,
	536	.qdev.name = "syborg,framebuffer",
	537	.qdev.size = sizeof(SyborgFBState),
	538	.qdev.props = (Property[]) {
c230c4e3 GH	539	DEFINE_PROP_UINT32("width", SyborgFBState, cols, 0),
	540	DEFINE_PROP_UINT32("height", SyborgFBState, rows, 0),
	541	DEFINE_PROP_END_OF_LIST(),
ee6847d1 GH	542	}
	543	};
	544
4af39611 PB	545	static void syborg_fb_register_devices(void)
4af39611 PB	546	{
ee6847d1	547	sysbus_register_withprop(&syborg_fb_info);
4af39611 PB	548	}
	549
	550	device_init(syborg_fb_register_devices)