[mirror_qemu.git] / hw / display / ssd0303.c

/*
 * SSD0303 OLED controller with OSRAM Pictiva 96x16 display.
 *
 * Copyright (c) 2006-2007 CodeSourcery.
 * Written by Paul Brook
 *
 * This code is licensed under the GPL.
 */

/* The controller can support a variety of different displays, but we only
   implement one.  Most of the commends relating to brightness and geometry
   setup are ignored. */
#include "hw/i2c/i2c.h"
#include "ui/console.h"

//#define DEBUG_SSD0303 1

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

/* Scaling factor for pixels.  */
#define MAGNIFY 4

enum ssd0303_mode
{
    SSD0303_IDLE,
    SSD0303_DATA,
    SSD0303_CMD
};

enum ssd0303_cmd {
    SSD0303_CMD_NONE,
    SSD0303_CMD_SKIP1
};

#define TYPE_SSD0303 "ssd0303"
#define SSD0303(obj) OBJECT_CHECK(ssd0303_state, (obj), TYPE_SSD0303)

typedef struct {
    I2CSlave parent_obj;

    QemuConsole *con;
    int row;
    int col;
    int start_line;
    int mirror;
    int flash;
    int enabled;
    int inverse;
    int redraw;
    enum ssd0303_mode mode;
    enum ssd0303_cmd cmd_state;
    uint8_t framebuffer[132*8];
} ssd0303_state;

static int ssd0303_recv(I2CSlave *i2c)
{
    BADF("Reads not implemented\n");
    return -1;
}

static int ssd0303_send(I2CSlave *i2c, uint8_t data)
{
    ssd0303_state *s = SSD0303(i2c);
    enum ssd0303_cmd old_cmd_state;

    switch (s->mode) {
    case SSD0303_IDLE:
        DPRINTF("byte 0x%02x\n", data);
        if (data == 0x80)
            s->mode = SSD0303_CMD;
        else if (data == 0x40)
            s->mode = SSD0303_DATA;
        else
            BADF("Unexpected byte 0x%x\n", data);
        break;
    case SSD0303_DATA:
        DPRINTF("data 0x%02x\n", data);
        if (s->col < 132) {
            s->framebuffer[s->col + s->row * 132] = data;
            s->col++;
            s->redraw = 1;
        }
        break;
    case SSD0303_CMD:
        old_cmd_state = s->cmd_state;
        s->cmd_state = SSD0303_CMD_NONE;
        switch (old_cmd_state) {
        case SSD0303_CMD_NONE:
            DPRINTF("cmd 0x%02x\n", data);
            s->mode = SSD0303_IDLE;
            switch (data) {
            case 0x00 ... 0x0f: /* Set lower column address.  */
                s->col = (s->col & 0xf0) | (data & 0xf);
                break;
            case 0x10 ... 0x20: /* Set higher column address.  */
                s->col = (s->col & 0x0f) | ((data & 0xf) << 4);
                break;
            case 0x40 ... 0x7f: /* Set start line.  */
                s->start_line = 0;
                break;
            case 0x81: /* Set contrast (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xa0: /* Mirror off.  */
                s->mirror = 0;
                break;
            case 0xa1: /* Mirror off.  */
                s->mirror = 1;
                break;
            case 0xa4: /* Entire display off.  */
                s->flash = 0;
                break;
            case 0xa5: /* Entire display on.  */
                s->flash = 1;
                break;
            case 0xa6: /* Inverse off.  */
                s->inverse = 0;
                break;
            case 0xa7: /* Inverse on.  */
                s->inverse = 1;
                break;
            case 0xa8: /* Set multiplied ratio (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xad: /* DC-DC power control.  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xae: /* Display off.  */
                s->enabled = 0;
                break;
            case 0xaf: /* Display on.  */
                s->enabled = 1;
                break;
            case 0xb0 ... 0xbf: /* Set Page address.  */
                s->row = data & 7;
                break;
            case 0xc0 ... 0xc8: /* Set COM output direction (Ignored).  */
                break;
            case 0xd3: /* Set display offset (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xd5: /* Set display clock (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xd8: /* Set color and power mode (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xd9: /* Set pre-charge period (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xda: /* Set COM pin configuration (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xdb: /* Set VCOM dselect level (Ignored).  */
                s->cmd_state = SSD0303_CMD_SKIP1;
                break;
            case 0xe3: /* no-op.  */
                break;
            default:
                BADF("Unknown command: 0x%x\n", data);
            }
            break;
        case SSD0303_CMD_SKIP1:
            DPRINTF("skip 0x%02x\n", data);
            break;
        }
        break;
    }
    return 0;
}

static void ssd0303_event(I2CSlave *i2c, enum i2c_event event)
{
    ssd0303_state *s = SSD0303(i2c);

    switch (event) {
    case I2C_FINISH:
        s->mode = SSD0303_IDLE;
        break;
    case I2C_START_RECV:
    case I2C_START_SEND:
    case I2C_NACK:
        /* Nothing to do.  */
        break;
    }
}

static void ssd0303_update_display(void *opaque)
{
    ssd0303_state *s = (ssd0303_state *)opaque;
    DisplaySurface *surface = qemu_console_surface(s->con);
    uint8_t *dest;
    uint8_t *src;
    int x;
    int y;
    int line;
    char *colors[2];
    char colortab[MAGNIFY * 8];
    int dest_width;
    uint8_t mask;

    if (!s->redraw)
        return;

    switch (surface_bits_per_pixel(surface)) {
    case 0:
        return;
    case 15:
        dest_width = 2;
        break;
    case 16:
        dest_width = 2;
        break;
    case 24:
        dest_width = 3;
        break;
    case 32:
        dest_width = 4;
        break;
    default:
        BADF("Bad color depth\n");
        return;
    }
    dest_width *= MAGNIFY;
    memset(colortab, 0xff, dest_width);
    memset(colortab + dest_width, 0, dest_width);
    if (s->flash) {
        colors[0] = colortab;
        colors[1] = colortab;
    } else if (s->inverse) {
        colors[0] = colortab;
        colors[1] = colortab + dest_width;
    } else {
        colors[0] = colortab + dest_width;
        colors[1] = colortab;
    }
    dest = surface_data(surface);
    for (y = 0; y < 16; y++) {
        line = (y + s->start_line) & 63;
        src = s->framebuffer + 132 * (line >> 3) + 36;
        mask = 1 << (line & 7);
        for (x = 0; x < 96; x++) {
            memcpy(dest, colors[(*src & mask) != 0], dest_width);
            dest += dest_width;
            src++;
        }
        for (x = 1; x < MAGNIFY; x++) {
            memcpy(dest, dest - dest_width * 96, dest_width * 96);
            dest += dest_width * 96;
        }
    }
    s->redraw = 0;
    dpy_gfx_update(s->con, 0, 0, 96 * MAGNIFY, 16 * MAGNIFY);
}

static void ssd0303_invalidate_display(void * opaque)
{
    ssd0303_state *s = (ssd0303_state *)opaque;
    s->redraw = 1;
}

static const VMStateDescription vmstate_ssd0303 = {
    .name = "ssd0303_oled",
    .version_id = 1,
    .minimum_version_id = 1,
    .fields = (VMStateField[]) {
        VMSTATE_INT32(row, ssd0303_state),
        VMSTATE_INT32(col, ssd0303_state),
        VMSTATE_INT32(start_line, ssd0303_state),
        VMSTATE_INT32(mirror, ssd0303_state),
        VMSTATE_INT32(flash, ssd0303_state),
        VMSTATE_INT32(enabled, ssd0303_state),
        VMSTATE_INT32(inverse, ssd0303_state),
        VMSTATE_INT32(redraw, ssd0303_state),
        VMSTATE_UINT32(mode, ssd0303_state),
        VMSTATE_UINT32(cmd_state, ssd0303_state),
        VMSTATE_BUFFER(framebuffer, ssd0303_state),
        VMSTATE_I2C_SLAVE(parent_obj, ssd0303_state),
        VMSTATE_END_OF_LIST()
    }
};

static const GraphicHwOps ssd0303_ops = {
    .invalidate  = ssd0303_invalidate_display,
    .gfx_update  = ssd0303_update_display,
};

static int ssd0303_init(I2CSlave *i2c)
{
    ssd0303_state *s = SSD0303(i2c);

    s->con = graphic_console_init(DEVICE(i2c), 0, &ssd0303_ops, s);
    qemu_console_resize(s->con, 96 * MAGNIFY, 16 * MAGNIFY);
    return 0;
}

static void ssd0303_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    I2CSlaveClass *k = I2C_SLAVE_CLASS(klass);

    k->init = ssd0303_init;
    k->event = ssd0303_event;
    k->recv = ssd0303_recv;
    k->send = ssd0303_send;
    dc->vmsd = &vmstate_ssd0303;
}

static const TypeInfo ssd0303_info = {
    .name          = TYPE_SSD0303,
    .parent        = TYPE_I2C_SLAVE,
    .instance_size = sizeof(ssd0303_state),
    .class_init    = ssd0303_class_init,
};

static void ssd0303_register_types(void)
{
    type_register_static(&ssd0303_info);
}

type_init(ssd0303_register_types)
Commit	Line	Data
9ee6e8bb PB	1	/*
	2	* SSD0303 OLED controller with OSRAM Pictiva 96x16 display.
	3	*
	4	* Copyright (c) 2006-2007 CodeSourcery.
	5	* Written by Paul Brook
	6	*
8e31bf38	7	* This code is licensed under the GPL.
9ee6e8bb PB	8	*/
	9
	10	/* The controller can support a variety of different displays, but we only
	11	implement one. Most of the commends relating to brightness and geometry
	12	setup are ignored. */
0d09e41a	13	#include "hw/i2c/i2c.h"
28ecbaee	14	#include "ui/console.h"
9ee6e8bb PB	15
	16	//#define DEBUG_SSD0303 1
	17
	18	#ifdef DEBUG_SSD0303
001faf32 BS	19	#define DPRINTF(fmt, ...) \
	20	do { printf("ssd0303: " fmt , ## __VA_ARGS__); } while (0)
	21	#define BADF(fmt, ...) \
	22	do { fprintf(stderr, "ssd0303: error: " fmt , ## __VA_ARGS__); exit(1);} while (0)
9ee6e8bb	23	#else
001faf32 BS	24	#define DPRINTF(fmt, ...) do {} while(0)
	25	#define BADF(fmt, ...) \
	26	do { fprintf(stderr, "ssd0303: error: " fmt , ## __VA_ARGS__);} while (0)
9ee6e8bb PB	27	#endif
	28
	29	/* Scaling factor for pixels. */
	30	#define MAGNIFY 4
	31
	32	enum ssd0303_mode
	33	{
	34	SSD0303_IDLE,
	35	SSD0303_DATA,
	36	SSD0303_CMD
	37	};
	38
	39	enum ssd0303_cmd {
	40	SSD0303_CMD_NONE,
	41	SSD0303_CMD_SKIP1
	42	};
	43
b1be4515 AF	44	#define TYPE_SSD0303 "ssd0303"
	45	#define SSD0303(obj) OBJECT_CHECK(ssd0303_state, (obj), TYPE_SSD0303)
	46
9ee6e8bb	47	typedef struct {
b1be4515 AF	48	I2CSlave parent_obj;
b1be4515 AF	49
c78f7137	50	QemuConsole *con;
9ee6e8bb PB	51	int row;
	52	int col;
	53	int start_line;
	54	int mirror;
	55	int flash;
	56	int enabled;
	57	int inverse;
	58	int redraw;
	59	enum ssd0303_mode mode;
	60	enum ssd0303_cmd cmd_state;
	61	uint8_t framebuffer[132*8];
	62	} ssd0303_state;
	63
9e07bdf8	64	static int ssd0303_recv(I2CSlave *i2c)
9ee6e8bb PB	65	{
	66	BADF("Reads not implemented\n");
	67	return -1;
	68	}
	69
9e07bdf8	70	static int ssd0303_send(I2CSlave *i2c, uint8_t data)
9ee6e8bb	71	{
b1be4515	72	ssd0303_state *s = SSD0303(i2c);
9ee6e8bb	73	enum ssd0303_cmd old_cmd_state;
b1be4515	74
9ee6e8bb PB	75	switch (s->mode) {
	76	case SSD0303_IDLE:
	77	DPRINTF("byte 0x%02x\n", data);
	78	if (data == 0x80)
	79	s->mode = SSD0303_CMD;
	80	else if (data == 0x40)
	81	s->mode = SSD0303_DATA;
	82	else
	83	BADF("Unexpected byte 0x%x\n", data);
	84	break;
	85	case SSD0303_DATA:
	86	DPRINTF("data 0x%02x\n", data);
	87	if (s->col < 132) {
	88	s->framebuffer[s->col + s->row * 132] = data;
	89	s->col++;
	90	s->redraw = 1;
	91	}
	92	break;
	93	case SSD0303_CMD:
	94	old_cmd_state = s->cmd_state;
	95	s->cmd_state = SSD0303_CMD_NONE;
	96	switch (old_cmd_state) {
	97	case SSD0303_CMD_NONE:
	98	DPRINTF("cmd 0x%02x\n", data);
	99	s->mode = SSD0303_IDLE;
	100	switch (data) {
4e9a0b5b	101	case 0x00 ... 0x0f: /* Set lower column address. */
9ee6e8bb PB	102	s->col = (s->col & 0xf0) \| (data & 0xf);
	103	break;
	104	case 0x10 ... 0x20: /* Set higher column address. */
	105	s->col = (s->col & 0x0f) \| ((data & 0xf) << 4);
	106	break;
	107	case 0x40 ... 0x7f: /* Set start line. */
	108	s->start_line = 0;
	109	break;
	110	case 0x81: /* Set contrast (Ignored). */
	111	s->cmd_state = SSD0303_CMD_SKIP1;
	112	break;
	113	case 0xa0: /* Mirror off. */
	114	s->mirror = 0;
	115	break;
	116	case 0xa1: /* Mirror off. */
	117	s->mirror = 1;
	118	break;
	119	case 0xa4: /* Entire display off. */
	120	s->flash = 0;
	121	break;
	122	case 0xa5: /* Entire display on. */
	123	s->flash = 1;
	124	break;
	125	case 0xa6: /* Inverse off. */
	126	s->inverse = 0;
	127	break;
	128	case 0xa7: /* Inverse on. */
	129	s->inverse = 1;
	130	break;
26404edc	131	case 0xa8: /* Set multiplied ratio (Ignored). */
9ee6e8bb PB	132	s->cmd_state = SSD0303_CMD_SKIP1;
	133	break;
	134	case 0xad: /* DC-DC power control. */
	135	s->cmd_state = SSD0303_CMD_SKIP1;
	136	break;
	137	case 0xae: /* Display off. */
	138	s->enabled = 0;
	139	break;
	140	case 0xaf: /* Display on. */
	141	s->enabled = 1;
	142	break;
	143	case 0xb0 ... 0xbf: /* Set Page address. */
	144	s->row = data & 7;
	145	break;
	146	case 0xc0 ... 0xc8: /* Set COM output direction (Ignored). */
	147	break;
	148	case 0xd3: /* Set display offset (Ignored). */
	149	s->cmd_state = SSD0303_CMD_SKIP1;
	150	break;
	151	case 0xd5: /* Set display clock (Ignored). */
	152	s->cmd_state = SSD0303_CMD_SKIP1;
	153	break;
	154	case 0xd8: /* Set color and power mode (Ignored). */
	155	s->cmd_state = SSD0303_CMD_SKIP1;
	156	break;
	157	case 0xd9: /* Set pre-charge period (Ignored). */
	158	s->cmd_state = SSD0303_CMD_SKIP1;
	159	break;
	160	case 0xda: /* Set COM pin configuration (Ignored). */
	161	s->cmd_state = SSD0303_CMD_SKIP1;
	162	break;
	163	case 0xdb: /* Set VCOM dselect level (Ignored). */
	164	s->cmd_state = SSD0303_CMD_SKIP1;
	165	break;
	166	case 0xe3: /* no-op. */
	167	break;
	168	default:
	169	BADF("Unknown command: 0x%x\n", data);
	170	}
	171	break;
	172	case SSD0303_CMD_SKIP1:
	173	DPRINTF("skip 0x%02x\n", data);
	174	break;
	175	}
	176	break;
	177	}
	178	return 0;
	179	}
	180
9e07bdf8	181	static void ssd0303_event(I2CSlave *i2c, enum i2c_event event)
9ee6e8bb	182	{
b1be4515 AF	183	ssd0303_state *s = SSD0303(i2c);
b1be4515 AF	184
9ee6e8bb PB	185	switch (event) {
	186	case I2C_FINISH:
	187	s->mode = SSD0303_IDLE;
	188	break;
	189	case I2C_START_RECV:
	190	case I2C_START_SEND:
	191	case I2C_NACK:
	192	/* Nothing to do. */
	193	break;
	194	}
	195	}
	196
	197	static void ssd0303_update_display(void *opaque)
	198	{
	199	ssd0303_state s = (ssd0303_state )opaque;
c78f7137	200	DisplaySurface *surface = qemu_console_surface(s->con);
9ee6e8bb PB	201	uint8_t *dest;
	202	uint8_t *src;
	203	int x;
	204	int y;
	205	int line;
	206	char *colors[2];
	207	char colortab[MAGNIFY * 8];
	208	int dest_width;
	209	uint8_t mask;
	210
b115bb3f PB	211	if (!s->redraw)
	212	return;
	213
c78f7137	214	switch (surface_bits_per_pixel(surface)) {
b115bb3f PB	215	case 0:
	216	return;
	217	case 15:
	218	dest_width = 2;
	219	break;
	220	case 16:
	221	dest_width = 2;
	222	break;
	223	case 24:
	224	dest_width = 3;
	225	break;
	226	case 32:
	227	dest_width = 4;
	228	break;
	229	default:
	230	BADF("Bad color depth\n");
	231	return;
	232	}
	233	dest_width *= MAGNIFY;
	234	memset(colortab, 0xff, dest_width);
	235	memset(colortab + dest_width, 0, dest_width);
	236	if (s->flash) {
	237	colors[0] = colortab;
	238	colors[1] = colortab;
	239	} else if (s->inverse) {
	240	colors[0] = colortab;
	241	colors[1] = colortab + dest_width;
	242	} else {
	243	colors[0] = colortab + dest_width;
	244	colors[1] = colortab;
	245	}
c78f7137	246	dest = surface_data(surface);
b115bb3f PB	247	for (y = 0; y < 16; y++) {
	248	line = (y + s->start_line) & 63;
	249	src = s->framebuffer + 132 * (line >> 3) + 36;
	250	mask = 1 << (line & 7);
	251	for (x = 0; x < 96; x++) {
	252	memcpy(dest, colors[(*src & mask) != 0], dest_width);
	253	dest += dest_width;
	254	src++;
9ee6e8bb	255	}
b115bb3f PB	256	for (x = 1; x < MAGNIFY; x++) {
	257	memcpy(dest, dest - dest_width * 96, dest_width * 96);
	258	dest += dest_width * 96;
9ee6e8bb PB	259	}
9ee6e8bb PB	260	}
b115bb3f	261	s->redraw = 0;
c78f7137	262	dpy_gfx_update(s->con, 0, 0, 96 * MAGNIFY, 16 * MAGNIFY);
9ee6e8bb PB	263	}
	264
	265	static void ssd0303_invalidate_display(void * opaque)
	266	{
	267	ssd0303_state s = (ssd0303_state )opaque;
	268	s->redraw = 1;
	269	}
	270
aed7278d JQ	271	static const VMStateDescription vmstate_ssd0303 = {
	272	.name = "ssd0303_oled",
	273	.version_id = 1,
	274	.minimum_version_id = 1,
8f1e884b	275	.fields = (VMStateField[]) {
aed7278d JQ	276	VMSTATE_INT32(row, ssd0303_state),
	277	VMSTATE_INT32(col, ssd0303_state),
	278	VMSTATE_INT32(start_line, ssd0303_state),
	279	VMSTATE_INT32(mirror, ssd0303_state),
	280	VMSTATE_INT32(flash, ssd0303_state),
	281	VMSTATE_INT32(enabled, ssd0303_state),
	282	VMSTATE_INT32(inverse, ssd0303_state),
	283	VMSTATE_INT32(redraw, ssd0303_state),
	284	VMSTATE_UINT32(mode, ssd0303_state),
	285	VMSTATE_UINT32(cmd_state, ssd0303_state),
	286	VMSTATE_BUFFER(framebuffer, ssd0303_state),
b1be4515	287	VMSTATE_I2C_SLAVE(parent_obj, ssd0303_state),
aed7278d JQ	288	VMSTATE_END_OF_LIST()
	289	}
	290	};
23e39294	291
380cd056 GH	292	static const GraphicHwOps ssd0303_ops = {
	293	.invalidate = ssd0303_invalidate_display,
	294	.gfx_update = ssd0303_update_display,
	295	};
	296
9e07bdf8	297	static int ssd0303_init(I2CSlave *i2c)
9ee6e8bb	298	{
b1be4515	299	ssd0303_state *s = SSD0303(i2c);
9ee6e8bb	300
5643706a	301	s->con = graphic_console_init(DEVICE(i2c), 0, &ssd0303_ops, s);
c78f7137	302	qemu_console_resize(s->con, 96 * MAGNIFY, 16 * MAGNIFY);
81a322d4	303	return 0;
9ee6e8bb	304	}
d2199005	305
b5ea9327 AL	306	static void ssd0303_class_init(ObjectClass klass, void data)
b5ea9327 AL	307	{
39bffca2	308	DeviceClass *dc = DEVICE_CLASS(klass);
b5ea9327 AL	309	I2CSlaveClass *k = I2C_SLAVE_CLASS(klass);
	310
	311	k->init = ssd0303_init;
	312	k->event = ssd0303_event;
	313	k->recv = ssd0303_recv;
	314	k->send = ssd0303_send;
39bffca2	315	dc->vmsd = &vmstate_ssd0303;
b5ea9327 AL	316	}
b5ea9327 AL	317
8c43a6f0	318	static const TypeInfo ssd0303_info = {
b1be4515	319	.name = TYPE_SSD0303,
39bffca2 AL	320	.parent = TYPE_I2C_SLAVE,
	321	.instance_size = sizeof(ssd0303_state),
	322	.class_init = ssd0303_class_init,
d2199005 PB	323	};
d2199005 PB	324
83f7d43a	325	static void ssd0303_register_types(void)
d2199005	326	{
39bffca2	327	type_register_static(&ssd0303_info);
d2199005 PB	328	}
d2199005 PB	329
83f7d43a	330	type_init(ssd0303_register_types)