0.3.1/devices/dev_sfb.c

/*
 *  Copyright (C) 2004-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_sfb.c,v 1.6 2005/02/18 07:22:30 debug Exp $
 *  
 *  SFB TURBOchannel framebuffer.
 *
 *  See include/sfbreg.h (and NetBSD's arch/pmax/dev/sfb.c) for more info.
 *
 *
 *  TODO:  This is not really implemented yet. It "happens" to work with
 *         NetBSD and OpenBSD, but not with Ultrix yet.
 */

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

#include "devices.h"
#include "memory.h"
#include "misc.h"

#include "sfbreg.h"

#define SFB_XSIZE       1280
#define SFB_YSIZE       1024


/*  #define debug fatal  */


#define SFB_REG_SIZE    0x80
#define N_SFB_REGS      (SFB_REG_SIZE / 4)


struct sfb_data {
        struct vfb_data *vfb_data;

        uint32_t        reg[N_SFB_REGS];
};


/*
 *  dev_sfb_access():
 */
int dev_sfb_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 sfb_data *d = extra;

        idata = memory_readmax64(cpu, data, len);

        if (writeflag==MEM_READ) {
                odata = d->reg[(relative_addr >> 2) & (N_SFB_REGS - 1)];
                debug("[ sfb: read from addr 0x%x: 0x%llx ]\n",
                    (int)relative_addr, (long long)odata);
        } else {
                d->reg[(relative_addr >> 2) & (N_SFB_REGS - 1)] = idata;
                debug("[ sfb: write to addr 0x%x: 0x%llx ]\n",
                    (int)relative_addr, (long long)idata);
        }

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

        return 1;
}


/*
 *  dev_sfb_init():
 */
void dev_sfb_init(struct machine *machine, struct memory *mem,
        uint64_t baseaddr, struct vfb_data *fb)
{
        struct sfb_data *d;

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

        d->vfb_data = fb;

        d->reg[(SFB_VHORIZONTAL - SFB_ASIC_OFFSET) / 4] = SFB_XSIZE >> 2;
        d->reg[(SFB_VVERTICAL - SFB_ASIC_OFFSET) / 4]   = SFB_YSIZE;

        memory_device_register(mem, "sfb", baseaddr, SFB_REG_SIZE,
            dev_sfb_access, d, MEM_DEFAULT, NULL);
}

1	/*
2	* Copyright (C) 2004-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_sfb.c,v 1.6 2005/02/18 07:22:30 debug Exp $
29	*
30	* SFB TURBOchannel framebuffer.
31	*
32	* See include/sfbreg.h (and NetBSD's arch/pmax/dev/sfb.c) for more info.
33	*
34	*
35	* TODO: This is not really implemented yet. It "happens" to work with
36	* NetBSD and OpenBSD, but not with Ultrix yet.
37	*/
38
39	#include <stdio.h>
40	#include <stdlib.h>
41	#include <string.h>
42
43	#include "devices.h"
44	#include "memory.h"
45	#include "misc.h"
46
47	#include "sfbreg.h"
48
49	#define SFB_XSIZE 1280
50	#define SFB_YSIZE 1024
51
52
53	/* #define debug fatal */
54
55
56	#define SFB_REG_SIZE 0x80
57	#define N_SFB_REGS (SFB_REG_SIZE / 4)
58
59
60	struct sfb_data {
61	struct vfb_data *vfb_data;
62
63	uint32_t reg[N_SFB_REGS];
64	};
65
66
67	/*
68	* dev_sfb_access():
69	*/
70	int dev_sfb_access(struct cpu cpu, struct memory mem, uint64_t relative_addr,
71	unsigned char data, size_t len, int writeflag, void extra)
72	{
73	uint64_t idata = 0, odata = 0;
74	struct sfb_data *d = extra;
75
76	idata = memory_readmax64(cpu, data, len);
77
78	if (writeflag==MEM_READ) {
79	odata = d->reg[(relative_addr >> 2) & (N_SFB_REGS - 1)];
80	debug("[ sfb: read from addr 0x%x: 0x%llx ]\n",
81	(int)relative_addr, (long long)odata);
82	} else {
83	d->reg[(relative_addr >> 2) & (N_SFB_REGS - 1)] = idata;
84	debug("[ sfb: write to addr 0x%x: 0x%llx ]\n",
85	(int)relative_addr, (long long)idata);
86	}
87
88	if (writeflag == MEM_READ)
89	memory_writemax64(cpu, data, len, odata);
90
91	return 1;
92	}
93
94
95	/*
96	* dev_sfb_init():
97	*/
98	void dev_sfb_init(struct machine machine, struct memory mem,
99	uint64_t baseaddr, struct vfb_data *fb)
100	{
101	struct sfb_data *d;
102
103	d = malloc(sizeof(struct sfb_data));
104	if (d == NULL) {
105	fprintf(stderr, "out of memory\n");
106	exit(1);
107	}
108	memset(d, 0, sizeof(struct sfb_data));
109
110	d->vfb_data = fb;
111
112	d->reg[(SFB_VHORIZONTAL - SFB_ASIC_OFFSET) / 4] = SFB_XSIZE >> 2;
113	d->reg[(SFB_VVERTICAL - SFB_ASIC_OFFSET) / 4] = SFB_YSIZE;
114
115	memory_device_register(mem, "sfb", baseaddr, SFB_REG_SIZE,
116	dev_sfb_access, d, MEM_DEFAULT, NULL);
117	}
118