src/devices/dev_8253.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_8253.c,v 1.4 2005/05/21 07:41:11 debug Exp $
 *  
 *  8253/8254 Programmable Interval Timer.
 *
 *  This is mostly bogus.
 */

#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_8253_LENGTH         4
#define TICK_SHIFT              14


struct pit8253_data {
        int             irq_nr;
        int             counter_select;
};


/*
 *  dev_8253_tick():
 */     
void dev_8253_tick(struct cpu *cpu, void *extra)
{
        struct pit8253_data *d = (struct pit8253_data *) extra;
        cpu_interrupt(cpu, d->irq_nr);
}


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

        idata = memory_readmax64(cpu, data, len);

        /*  TODO: ack somewhere else  */
        cpu_interrupt_ack(cpu, d->irq_nr);

        switch (relative_addr) {
        case 0x00:
                if (writeflag == MEM_WRITE) {
                        /*  TODO  */
                } else {
                        /*  TODO  */
                        odata = 1;
odata = random();
                }
                break;
        case 0x03:
                if (writeflag == MEM_WRITE) {
                        d->counter_select = idata >> 6;
                        /*  TODO: other bits  */
                } else {
                        odata = d->counter_select << 6;
                }
                break;
        default:
                if (writeflag == MEM_WRITE) {
                        fatal("[ 8253: unimplemented write to address 0x%x"
                            " data=0x%02x ]\n", (int)relative_addr, (int)idata);
                } else {
                        fatal("[ 8253: unimplemented read from address 0x%x "
                            "]\n", (int)relative_addr);
                }
        }

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

        return 1;
}


/*
 *  devinit_8253():
 */
int devinit_8253(struct devinit *devinit)
{
        struct pit8253_data *d = malloc(sizeof(struct pit8253_data));

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

        memory_device_register(devinit->machine->memory, devinit->name,
            devinit->addr, DEV_8253_LENGTH, dev_8253_access, (void *)d,
            MEM_DEFAULT, NULL);

        machine_add_tickfunction(devinit->machine, dev_8253_tick,
            d, TICK_SHIFT);

        return 1;
}

1	dpavlin	6	/*
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_8253.c,v 1.4 2005/05/21 07:41:11 debug Exp $
29			*
30			* 8253/8254 Programmable Interval Timer.
31			*
32			* This is mostly bogus.
33			*/
34
35			#include <stdio.h>
36			#include <stdlib.h>
37			#include <string.h>
38
39			#include "cpu.h"
40			#include "device.h"
41			#include "devices.h"
42			#include "emul.h"
43			#include "machine.h"
44			#include "memory.h"
45			#include "misc.h"
46
47
48			#define DEV_8253_LENGTH 4
49			#define TICK_SHIFT 14
50
51
52			struct pit8253_data {
53			int irq_nr;
54			int counter_select;
55			};
56
57
58			/*
59			* dev_8253_tick():
60			*/
61			void dev_8253_tick(struct cpu cpu, void extra)
62			{
63			struct pit8253_data d = (struct pit8253_data ) extra;
64			cpu_interrupt(cpu, d->irq_nr);
65			}
66
67
68			/*
69			* dev_8253_access():
70			*/
71			int dev_8253_access(struct cpu cpu, struct memory mem,
72			uint64_t relative_addr, unsigned char *data, size_t len,
73			int writeflag, void *extra)
74			{
75			struct pit8253_data d = (struct pit8253_data ) extra;
76			uint64_t idata = 0, odata = 0;
77
78			idata = memory_readmax64(cpu, data, len);
79
80			/* TODO: ack somewhere else */
81			cpu_interrupt_ack(cpu, d->irq_nr);
82
83			switch (relative_addr) {
84			case 0x00:
85			if (writeflag == MEM_WRITE) {
86			/* TODO */
87			} else {
88			/* TODO */
89			odata = 1;
90			odata = random();
91			}
92			break;
93			case 0x03:
94			if (writeflag == MEM_WRITE) {
95			d->counter_select = idata >> 6;
96			/* TODO: other bits */
97			} else {
98			odata = d->counter_select << 6;
99			}
100			break;
101			default:
102			if (writeflag == MEM_WRITE) {
103			fatal("[ 8253: unimplemented write to address 0x%x"
104			" data=0x%02x ]\n", (int)relative_addr, (int)idata);
105			} else {
106			fatal("[ 8253: unimplemented read from address 0x%x "
107			"]\n", (int)relative_addr);
108			}
109			}
110
111			if (writeflag == MEM_READ)
112			memory_writemax64(cpu, data, len, odata);
113
114			return 1;
115			}
116
117
118			/*
119			* devinit_8253():
120			*/
121			int devinit_8253(struct devinit *devinit)
122			{
123			struct pit8253_data *d = malloc(sizeof(struct pit8253_data));
124
125			if (d == NULL) {
126			fprintf(stderr, "out of memory\n");
127			exit(1);
128			}
129			memset(d, 0, sizeof(struct pit8253_data));
130			d->irq_nr = devinit->irq_nr;
131
132			memory_device_register(devinit->machine->memory, devinit->name,
133			devinit->addr, DEV_8253_LENGTH, dev_8253_access, (void *)d,
134			MEM_DEFAULT, NULL);
135
136			machine_add_tickfunction(devinit->machine, dev_8253_tick,
137			d, TICK_SHIFT);
138
139			return 1;
140			}
141