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.5 2005/11/13 00:14:09 debug Exp $
 *
 *  LPT (parallel printer) controller.
 */

#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"

#include "lptreg.h"


/*  #define debug fatal  */

#define TICK_SHIFT              18
#define DEV_LPT_LENGTH          3

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

        unsigned char   data;
        unsigned char   control;
};


/*
 *  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 LPT_DATA:
                if (writeflag == MEM_READ)
                        odata = d->data;
                else
                        d->data = idata;
                break;

        case LPT_STATUS:
                odata = LPS_NBSY | LPS_NACK | LPS_SELECT | LPS_NERR;
                break;

        case LPT_CONTROL:
                if (writeflag == MEM_WRITE) {
                        if (idata != d->control) {
                                if (idata & LPC_STROBE) {
                                        /*  data strobe  */
                                        console_putchar(d->console_handle,
                                            d->data);
                                }
                        }
                        d->control = idata;
                }
                break;
        }

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