src/devices/dev_lpt.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_lpt.c,v 1.2 2005/10/26 14:37:04 debug Exp $
 *
 *  LPT (parallel printer) controller.
 *
 *  TODO: This is just a dummy.
 */

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

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


#define debug fatal

#define TICK_SHIFT              15
#define DEV_LPT_LENGTH          3

struct lpt_data {
        int             in_use;
        int             irqnr;
        char            *name;
        int             console_handle;

        unsigned char   data;
};


/*
 *  dev_lpt_tick():
 */
void dev_lpt_tick(struct cpu *cpu, void *extra)
{
        /*  struct lpt_data *d = extra;  */

        /*  TODO  */
}


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

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

        switch (relative_addr) {

        case 0: if (writeflag == MEM_READ)
                        odata = d->data;
                else
                        d->data = idata;
                break;

        default:
                if (writeflag == MEM_READ) {
                        debug("[ lpt (%s): read from %i: UNIMPLEMENTED ]\n",
                            d->name, (int)relative_addr);
                } else {
                        debug("[ lpt (%s): write to %i, data = 0x%llx: "
                            "UNIMPLEMENTED ]\n", d->name, (int)relative_addr,
                            (long long)idata);
                }
        }

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

        return 1;
}


/*
 *  devinit_lpt():
 */
int devinit_lpt(struct devinit *devinit)
{
        struct lpt_data *d = malloc(sizeof(struct lpt_data));
        size_t nlen;
        char *name;

        if (d == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct lpt_data));
        d->irqnr        = devinit->irq_nr;
        d->in_use       = devinit->in_use;
        d->name         = devinit->name2 != NULL? devinit->name2 : "";
        d->console_handle =
            console_start_slave(devinit->machine, devinit->name);

        nlen = strlen(devinit->name) + 10;
        if (devinit->name2 != NULL)
                nlen += strlen(devinit->name2);
        name = malloc(nlen);
        if (name == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        if (devinit->name2 != NULL && devinit->name2[0])
                snprintf(name, nlen, "%s [%s]", devinit->name, devinit->name2);
        else
                snprintf(name, nlen, "%s", devinit->name);

        memory_device_register(devinit->machine->memory, name, devinit->addr,
            DEV_LPT_LENGTH, dev_lpt_access, d, MEM_DEFAULT, NULL);
        machine_add_tickfunction(devinit->machine, dev_lpt_tick, d, TICK_SHIFT);

        /*
         *  NOTE:  Ugly cast into a pointer, because this is a convenient way
         *         to return the console handle to code in src/machine.c.
         */
        devinit->return_ptr = (void *)(size_t)d->console_handle;

        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_lpt.c,v 1.2 2005/10/26 14:37:04 debug Exp $
29	*
30	* LPT (parallel printer) controller.
31	*
32	* TODO: This is just a dummy.
33	*/
34
35	#include <stdio.h>
36	#include <stdlib.h>
37	#include <string.h>
38
39	#include "console.h"
40	#include "cpu.h"
41	#include "device.h"
42	#include "machine.h"
43	#include "memory.h"
44	#include "misc.h"
45
46
47	#define debug fatal
48
49	#define TICK_SHIFT 15
50	#define DEV_LPT_LENGTH 3
51
52	struct lpt_data {
53	int in_use;
54	int irqnr;
55	char *name;
56	int console_handle;
57
58	unsigned char data;
59	};
60
61
62	/*
63	* dev_lpt_tick():
64	*/
65	void dev_lpt_tick(struct cpu cpu, void extra)
66	{
67	/* struct lpt_data d = extra; /
68
69	/* TODO */
70	}
71
72
73	/*
74	* dev_lpt_access():
75	*/
76	int dev_lpt_access(struct cpu cpu, struct memory mem,
77	uint64_t relative_addr, unsigned char *data, size_t len,
78	int writeflag, void *extra)
79	{
80	uint64_t idata = 0, odata=0;
81	struct lpt_data *d = extra;
82
83	if (writeflag == MEM_WRITE)
84	idata = memory_readmax64(cpu, data, len);
85
86	switch (relative_addr) {
87
88	case 0: if (writeflag == MEM_READ)
89	odata = d->data;
90	else
91	d->data = idata;
92	break;
93
94	default:
95	if (writeflag == MEM_READ) {
96	debug("[ lpt (%s): read from %i: UNIMPLEMENTED ]\n",
97	d->name, (int)relative_addr);
98	} else {
99	debug("[ lpt (%s): write to %i, data = 0x%llx: "
100	"UNIMPLEMENTED ]\n", d->name, (int)relative_addr,
101	(long long)idata);
102	}
103	}
104
105	if (writeflag == MEM_READ)
106	memory_writemax64(cpu, data, len, odata);
107
108	return 1;
109	}
110
111
112	/*
113	* devinit_lpt():
114	*/
115	int devinit_lpt(struct devinit *devinit)
116	{
117	struct lpt_data *d = malloc(sizeof(struct lpt_data));
118	size_t nlen;
119	char *name;
120
121	if (d == NULL) {
122	fprintf(stderr, "out of memory\n");
123	exit(1);
124	}
125	memset(d, 0, sizeof(struct lpt_data));
126	d->irqnr = devinit->irq_nr;
127	d->in_use = devinit->in_use;
128	d->name = devinit->name2 != NULL? devinit->name2 : "";
129	d->console_handle =
130	console_start_slave(devinit->machine, devinit->name);
131
132	nlen = strlen(devinit->name) + 10;
133	if (devinit->name2 != NULL)
134	nlen += strlen(devinit->name2);
135	name = malloc(nlen);
136	if (name == NULL) {
137	fprintf(stderr, "out of memory\n");
138	exit(1);
139	}
140	if (devinit->name2 != NULL && devinit->name2[0])
141	snprintf(name, nlen, "%s [%s]", devinit->name, devinit->name2);
142	else
143	snprintf(name, nlen, "%s", devinit->name);
144
145	memory_device_register(devinit->machine->memory, name, devinit->addr,
146	DEV_LPT_LENGTH, dev_lpt_access, d, MEM_DEFAULT, NULL);
147	machine_add_tickfunction(devinit->machine, dev_lpt_tick, d, TICK_SHIFT);
148
149	/*
150	* NOTE: Ugly cast into a pointer, because this is a convenient way
151	* to return the console handle to code in src/machine.c.
152	*/
153	devinit->return_ptr = (void *)(size_t)d->console_handle;
154
155	return 1;
156	}
157