src/devices/dev_malta_lcd.c

/*
 *  Copyright (C) 2005-2007  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.12 2007/06/17 02:05:51 debug Exp $
 *
 *  COMMENT: Malta (evbmips) LCD display
 *
 *  TODO: Write output to somewhere else, not just as a debug message.
 */

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

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

#include "maltareg.h"


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

struct malta_lcd_data {
        uint64_t        base_addr;

        int             display_modified;
        unsigned char   display[LCD_LEN];
};


DEVICE_TICK(malta_lcd)
{ 
        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]);
                else
                        debug("?");
        debug("\" ]\n");

        d->display_modified = 0;
}


DEVICE_ACCESS(malta_lcd)
{
        struct malta_lcd_data *d = extra;
        uint64_t idata = 0, odata = 0;
        int pos;

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

        relative_addr += d->base_addr;

        switch (relative_addr) {

        case MALTA_ASCII_BASE + MALTA_ASCIIPOS0:
        case MALTA_ASCII_BASE + MALTA_ASCIIPOS1:
        case MALTA_ASCII_BASE + MALTA_ASCIIPOS2:
        case MALTA_ASCII_BASE + MALTA_ASCIIPOS3:
        case MALTA_ASCII_BASE + MALTA_ASCIIPOS4:
        case MALTA_ASCII_BASE + MALTA_ASCIIPOS5:
        case MALTA_ASCII_BASE + MALTA_ASCIIPOS6:
        case MALTA_ASCII_BASE + MALTA_ASCIIPOS7:
                pos = (relative_addr - MALTA_ASCII_BASE) / 8;
                if (writeflag == MEM_WRITE) {
                        d->display[pos] = idata;
                        d->display_modified = 1;
                } else {
                        odata = d->display[pos];
                }
                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)
{
        struct malta_lcd_data *d;

        CHECK_ALLOCATION(d = malloc(sizeof(struct malta_lcd_data)));
        memset(d, 0, sizeof(struct malta_lcd_data));

        d->base_addr = devinit->addr;

        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	dpavlin	10	/*
2	dpavlin	34	* Copyright (C) 2005-2007 Anders Gavare. All rights reserved.
3	dpavlin	10	*
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	dpavlin	44	* $Id: dev_malta_lcd.c,v 1.12 2007/06/17 02:05:51 debug Exp $
29	dpavlin	10	*
30	dpavlin	42	* COMMENT: Malta (evbmips) LCD display
31			*
32	dpavlin	44	* TODO: Write output to somewhere else, not just as a debug message.
33	dpavlin	10	*/
34
35			#include <stdio.h>
36			#include <stdlib.h>
37			#include <string.h>
38
39			#include "cpu.h"
40			#include "device.h"
41			#include "emul.h"
42			#include "machine.h"
43			#include "memory.h"
44			#include "misc.h"
45
46	dpavlin	44	#include "maltareg.h"
47	dpavlin	10
48	dpavlin	44
49	dpavlin	10	#define DEV_MALTA_LCD_LENGTH 0x80
50	dpavlin	44	#define MALTA_LCD_TICK_SHIFT 16
51	dpavlin	10	#define LCD_LEN 8
52
53			struct malta_lcd_data {
54	dpavlin	44	uint64_t base_addr;
55
56	dpavlin	10	int display_modified;
57			unsigned char display[LCD_LEN];
58			};
59
60
61	dpavlin	42	DEVICE_TICK(malta_lcd)
62	dpavlin	10	{
63			struct malta_lcd_data *d = extra;
64			int i;
65
66			if (d->display_modified == 0)
67			return;
68			if (d->display_modified == 1) {
69			d->display_modified = 2;
70			return;
71			}
72	dpavlin	42
73	dpavlin	44	debug("[ malta_lcd: \"");
74	dpavlin	10	for (i=0; i<LCD_LEN; i++)
75			if (d->display[i] >= ' ')
76	dpavlin	12	debug("%c", d->display[i]);
77	dpavlin	44	else
78			debug("?");
79			debug("\" ]\n");
80	dpavlin	42
81	dpavlin	10	d->display_modified = 0;
82			}
83
84
85	dpavlin	22	DEVICE_ACCESS(malta_lcd)
86	dpavlin	10	{
87	dpavlin	42	struct malta_lcd_data *d = extra;
88	dpavlin	10	uint64_t idata = 0, odata = 0;
89	dpavlin	44	int pos;
90	dpavlin	10
91	dpavlin	18	if (writeflag == MEM_WRITE)
92			idata = memory_readmax64(cpu, data, len);
93	dpavlin	10
94	dpavlin	44	relative_addr += d->base_addr;
95
96	dpavlin	10	switch (relative_addr) {
97	dpavlin	42
98	dpavlin	44	case MALTA_ASCII_BASE + MALTA_ASCIIPOS0:
99			case MALTA_ASCII_BASE + MALTA_ASCIIPOS1:
100			case MALTA_ASCII_BASE + MALTA_ASCIIPOS2:
101			case MALTA_ASCII_BASE + MALTA_ASCIIPOS3:
102			case MALTA_ASCII_BASE + MALTA_ASCIIPOS4:
103			case MALTA_ASCII_BASE + MALTA_ASCIIPOS5:
104			case MALTA_ASCII_BASE + MALTA_ASCIIPOS6:
105			case MALTA_ASCII_BASE + MALTA_ASCIIPOS7:
106			pos = (relative_addr - MALTA_ASCII_BASE) / 8;
107	dpavlin	10	if (writeflag == MEM_WRITE) {
108	dpavlin	44	d->display[pos] = idata;
109	dpavlin	10	d->display_modified = 1;
110	dpavlin	44	} else {
111			odata = d->display[pos];
112			}
113	dpavlin	10	break;
114	dpavlin	42
115	dpavlin	44	default:
116			if (writeflag == MEM_WRITE) {
117	dpavlin	10	fatal("[ malta_lcd: unimplemented write to "
118			"offset 0x%x: data=0x%02x ]\n", (int)
119			relative_addr, (int)idata);
120			} else {
121			fatal("[ malta_lcd: unimplemented read from "
122			"offset 0x%x ]\n", (int)relative_addr);
123			}
124			}
125
126			if (writeflag == MEM_READ)
127			memory_writemax64(cpu, data, len, odata);
128
129			return 1;
130			}
131
132
133	dpavlin	22	DEVINIT(malta_lcd)
134	dpavlin	10	{
135	dpavlin	42	struct malta_lcd_data *d;
136	dpavlin	10
137	dpavlin	42	CHECK_ALLOCATION(d = malloc(sizeof(struct malta_lcd_data)));
138	dpavlin	10	memset(d, 0, sizeof(struct malta_lcd_data));
139
140	dpavlin	44	d->base_addr = devinit->addr;
141
142	dpavlin	10	memory_device_register(devinit->machine->memory, devinit->name,
143			devinit->addr, DEV_MALTA_LCD_LENGTH,
144	dpavlin	20	dev_malta_lcd_access, (void *)d, DM_DEFAULT, NULL);
145	dpavlin	10
146			machine_add_tickfunction(devinit->machine, dev_malta_lcd_tick,
147	dpavlin	42	d, MALTA_LCD_TICK_SHIFT);
148	dpavlin	10
149			return 1;
150			}
151