src/devices/dev_malta_lcd.c

/*
 *  Copyright (C) 2005  Anders Gavare.  All rights reserved.
 *
 *  Redistribution and use in source and binary forms, with or without
 *  modification, are permitted provided that the following conditions are met:
 *
 *  1. Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *  2. Redistributions in binary form must reproduce the above copyright  
 *     notice, this list of conditions and the following disclaimer in the 
 *     documentation and/or other materials provided with the distribution.
 *  3. The name of the author may not be used to endorse or promote products
 *     derived from this software without specific prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 *  ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 *  ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE   
 *  FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 *  DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 *  OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 *  HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 *  LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 *  OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 *  SUCH DAMAGE.
 *   
 *
 *  $Id: dev_malta_lcd.c,v 1.4 2005/11/13 00:14:09 debug Exp $
 *
 *  Malta (evbmips) LCD thingy. Mostly a dummy device.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "cpu.h"
#include "device.h"
#include "devices.h"
#include "emul.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"


#define DEV_MALTA_LCD_LENGTH            0x80
#define MALTA_LCD_TICK_SHIFT            15
#define LCD_LEN                         8

struct malta_lcd_data {
        int             display_modified;
        unsigned char   display[LCD_LEN];
};


/*
 *  dev_malta_lcd_tick():
 */     
void dev_malta_lcd_tick(struct cpu *cpu, void *extra)
{ 
        struct malta_lcd_data *d = extra;
        int i;

        if (d->display_modified == 0)
                return;
        if (d->display_modified == 1) {
                d->display_modified = 2;
                return;
        }
        debug("[ malta_lcd:  ");
        for (i=0; i<LCD_LEN; i++)
                if (d->display[i] >= ' ')
                        debug("%c", d->display[i]);
        debug("  ]\n");
        d->display_modified = 0;
}


/*
 *  dev_malta_lcd_access():
 */
int dev_malta_lcd_access(struct cpu *cpu, struct memory *mem,
        uint64_t relative_addr, unsigned char *data, size_t len,
        int writeflag, void *extra)
{
        struct malta_lcd_data *d = (struct malta_lcd_data *) extra;
        uint64_t idata = 0, odata = 0;
        int i;

        if (writeflag == MEM_WRITE)
                idata = memory_readmax64(cpu, data, len);

        switch (relative_addr) {
        case 0x18:
        case 0x20:
        case 0x28:
        case 0x30:
        case 0x38:
        case 0x40:
        case 0x48:
        case 0x50:
                i = (relative_addr - 0x18) / 8;
                if (writeflag == MEM_WRITE) {
                        d->display[i] = idata;
                        d->display_modified = 1;
                } else
                        odata = d->display[i];
                break;
        default:if (writeflag == MEM_WRITE) {
                        fatal("[ malta_lcd: unimplemented write to "
                            "offset 0x%x: data=0x%02x ]\n", (int)
                            relative_addr, (int)idata);
                } else {
                        fatal("[ malta_lcd: unimplemented read from "
                            "offset 0x%x ]\n", (int)relative_addr);
                }
        }

        if (writeflag == MEM_READ)
                memory_writemax64(cpu, data, len, odata);

        return 1;
}


/*
 *  devinit_malta_lcd():
 */
int devinit_malta_lcd(struct devinit *devinit)
{
        struct malta_lcd_data *d = malloc(sizeof(struct malta_lcd_data));

        if (d == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct malta_lcd_data));

        memory_device_register(devinit->machine->memory, devinit->name,
            devinit->addr, DEV_MALTA_LCD_LENGTH,
            dev_malta_lcd_access, (void *)d, DM_DEFAULT, NULL);

        machine_add_tickfunction(devinit->machine, dev_malta_lcd_tick,
            d, MALTA_LCD_TICK_SHIFT);

        return 1;
}

1	/*
2	* Copyright (C) 2005 Anders Gavare. All rights reserved.
3	*
4	* Redistribution and use in source and binary forms, with or without
5	* modification, are permitted provided that the following conditions are met:
6	*
7	* 1. Redistributions of source code must retain the above copyright
8	* notice, this list of conditions and the following disclaimer.
9	* 2. Redistributions in binary form must reproduce the above copyright
10	* notice, this list of conditions and the following disclaimer in the
11	* documentation and/or other materials provided with the distribution.
12	* 3. The name of the author may not be used to endorse or promote products
13	* derived from this software without specific prior written permission.
14	*
15	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16	* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18	* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21	* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22	* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23	* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24	* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25	* SUCH DAMAGE.
26	*
27	*
28	* $Id: dev_malta_lcd.c,v 1.4 2005/11/13 00:14:09 debug Exp $
29	*
30	* Malta (evbmips) LCD thingy. Mostly a dummy device.
31	*/
32
33	#include <stdio.h>
34	#include <stdlib.h>
35	#include <string.h>
36
37	#include "cpu.h"
38	#include "device.h"
39	#include "devices.h"
40	#include "emul.h"
41	#include "machine.h"
42	#include "memory.h"
43	#include "misc.h"
44
45
46	#define DEV_MALTA_LCD_LENGTH 0x80
47	#define MALTA_LCD_TICK_SHIFT 15
48	#define LCD_LEN 8
49
50	struct malta_lcd_data {
51	int display_modified;
52	unsigned char display[LCD_LEN];
53	};
54
55
56
57	/*
58	* dev_malta_lcd_tick():
59	*/
60	void dev_malta_lcd_tick(struct cpu cpu, void extra)
61	{
62	struct malta_lcd_data *d = extra;
63	int i;
64
65	if (d->display_modified == 0)
66	return;
67	if (d->display_modified == 1) {
68	d->display_modified = 2;
69	return;
70	}
71	debug("[ malta_lcd: ");
72	for (i=0; i<LCD_LEN; i++)
73	if (d->display[i] >= ' ')
74	debug("%c", d->display[i]);
75	debug(" ]\n");
76	d->display_modified = 0;
77	}
78
79
80	/*
81	* dev_malta_lcd_access():
82	*/
83	int dev_malta_lcd_access(struct cpu cpu, struct memory mem,
84	uint64_t relative_addr, unsigned char *data, size_t len,
85	int writeflag, void *extra)
86	{
87	struct malta_lcd_data d = (struct malta_lcd_data ) extra;
88	uint64_t idata = 0, odata = 0;
89	int i;
90
91	if (writeflag == MEM_WRITE)
92	idata = memory_readmax64(cpu, data, len);
93
94	switch (relative_addr) {
95	case 0x18:
96	case 0x20:
97	case 0x28:
98	case 0x30:
99	case 0x38:
100	case 0x40:
101	case 0x48:
102	case 0x50:
103	i = (relative_addr - 0x18) / 8;
104	if (writeflag == MEM_WRITE) {
105	d->display[i] = idata;
106	d->display_modified = 1;
107	} else
108	odata = d->display[i];
109	break;
110	default:if (writeflag == MEM_WRITE) {
111	fatal("[ malta_lcd: unimplemented write to "
112	"offset 0x%x: data=0x%02x ]\n", (int)
113	relative_addr, (int)idata);
114	} else {
115	fatal("[ malta_lcd: unimplemented read from "
116	"offset 0x%x ]\n", (int)relative_addr);
117	}
118	}
119
120	if (writeflag == MEM_READ)
121	memory_writemax64(cpu, data, len, odata);
122
123	return 1;
124	}
125
126
127	/*
128	* devinit_malta_lcd():
129	*/
130	int devinit_malta_lcd(struct devinit *devinit)
131	{
132	struct malta_lcd_data *d = malloc(sizeof(struct malta_lcd_data));
133
134	if (d == NULL) {
135	fprintf(stderr, "out of memory\n");
136	exit(1);
137	}
138	memset(d, 0, sizeof(struct malta_lcd_data));
139
140	memory_device_register(devinit->machine->memory, devinit->name,
141	devinit->addr, DEV_MALTA_LCD_LENGTH,
142	dev_malta_lcd_access, (void *)d, DM_DEFAULT, NULL);
143
144	machine_add_tickfunction(devinit->machine, dev_malta_lcd_tick,
145	d, MALTA_LCD_TICK_SHIFT);
146
147	return 1;
148	}
149