WebSVN – HelenOS-historic – Diff – /boot/trunk/genarch/ofw.c


/*
 * Copyright (C) 2005 Martin Decky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - 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.
 * - 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 ``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 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.
 */
 
#include "ofw.h"
#include <printf.h>
#include <asm.h>
 
#define MAX_OFW_ARGS        10
 
/** OpenFirmware command structure
 *
 */
typedef struct {
    const char *service;          /**< Command name */
    unsigned long nargs;          /**< Number of in arguments */
    unsigned long nret;           /**< Number of out arguments */
    ofw_arg_t args[MAX_OFW_ARGS]; /**< List of arguments */
} ofw_args_t;
 
typedef void (*ofw_entry)(ofw_args_t *);
 
ofw_entry ofw;
 
phandle ofw_chosen;
ihandle ofw_stdout;
phandle ofw_root;
ihandle ofw_mmu;
phandle ofw_memory;
phandle ofw_aliases;
 
static unsigned long ofw_call(const char *service, const int nargs, const int nret, ofw_arg_t *rets, ...)
{
    va_list list;
    ofw_args_t args;
    int i;
   
    args.service = service;
    args.nargs = nargs;
    args.nret = nret;
   
    va_start(list, rets);
    for (i = 0; i < nargs; i++)
        args.args[i] = va_arg(list, ofw_arg_t);
    va_end(list);
   
    for (i = 0; i < nret; i++)
        args.args[i + nargs] = 0;
   
    ofw(&args);
   
    for (i = 1; i < nret; i++)
        rets[i - 1] = args.args[i + nargs];
   
    return args.args[nargs];
}
 
 
phandle ofw_find_device(const char *name)
{
    return ofw_call("finddevice", 1, 1, NULL, name);
}
 
 
int ofw_get_property(const phandle device, const char *name, const void *buf, const int buflen)
{
    return ofw_call("getprop", 4, 1, NULL, device, name, buf, buflen);
}
 
 
static unsigned int ofw_get_address_cells(const phandle device)
{
    unsigned int ret;
   
    if (ofw_get_property(device, "#address-cells", &ret, sizeof(ret)) <= 0)
        if (ofw_get_property(ofw_root, "#address-cells", &ret, sizeof(ret)) <= 0)
            ret = 1;
   
    return ret;
}
 
 
static unsigned int ofw_get_size_cells(const phandle device)
{
    unsigned int ret;
   
    if (ofw_get_property(device, "#size-cells", &ret, sizeof(ret)) <= 0)
        if (ofw_get_property(ofw_root, "#size-cells", &ret, sizeof(ret)) <= 0)
            ret = 1;
   
    return ret;
}
 
 
static ihandle ofw_open(const char *name)
{
    return ofw_call("open", 1, 1, NULL, name);
}
 
 
void init(void)
{
    ofw_chosen = ofw_find_device("/chosen");
    if (ofw_chosen == -1)
        halt();
   
    if (ofw_get_property(ofw_chosen, "stdout",  &ofw_stdout, sizeof(ofw_stdout)) <= 0)
        ofw_stdout = 0;
   
    ofw_root = ofw_find_device("/");
    if (ofw_root == -1) {
        puts("\r\nError: Unable to find / device, halted.\r\n");
        halt();
    }
   
    if (ofw_get_property(ofw_chosen, "mmu",  &ofw_mmu, sizeof(ofw_mmu)) <= 0) {
        puts("\r\nError: Unable to get mmu property, halted.\r\n");
        halt();
    }
   
    ofw_memory = ofw_find_device("/memory");
    if (ofw_memory == -1) {
        puts("\r\nError: Unable to find /memory device, halted.\r\n");
        halt();
    }
   
    ofw_aliases = ofw_find_device("/aliases");
    if (ofw_aliases == -1) {
        puts("\r\nError: Unable to find /aliases device, halted.\r\n");
        halt();
    }
}
 
 
void ofw_write(const char *str, const int len)
{
    if (ofw_stdout == 0)
        return;
   
    ofw_call("write", 3, 1, NULL, ofw_stdout, str, len);
}
 
 
void *ofw_translate(const void *virt)
{
    ofw_arg_t result[3];
   
    if (ofw_call("call-method", 4, 4, result, "translate", ofw_mmu, virt, 1) != 0) {
        puts("Error: MMU method translate() failed, halting.\n");
        halt();
    }
    return (void *) result[2];
}
 
 
int ofw_map(const void *phys, const void *virt, const int size, const int mode)
{
    return ofw_call("call-method", 6, 1, NULL, "map", ofw_mmu, mode, size, virt, phys);
}
 
 
int ofw_memmap(memmap_t *map)
{
    unsigned long buf[BUF_SIZE];
    int ret = ofw_get_property(ofw_memory, "reg", buf, sizeof(buf));
    if (ret <= 0)
        return false;
       
    unsigned int ac = ofw_get_address_cells(ofw_memory);
    unsigned int sc = ofw_get_size_cells(ofw_memory);
   
    int pos;
    map->total = 0;
    map->count = 0;
    for (pos = 0; (pos < ret / sizeof(unsigned long)) && (map->count < MEMMAP_MAX_RECORDS); pos += ac + sc) {
        void * start = (void *) buf[pos + ac - 1];
        unsigned int size = buf[pos + ac + sc - 1];
       
        if (size > 0) {
            map->zones[map->count].start = start;
            map->zones[map->count].size = size;
            map->count++;
            map->total += size;
        }
    }
}
 
 
int ofw_screen(screen_t *screen)
{
    char device_name[BUF_SIZE];
   
    if (ofw_get_property(ofw_aliases, "screen", device_name, sizeof(device_name)) <= 0)
        return false;
   
    phandle device = ofw_find_device(device_name);
    if (device == -1)
        return false;
   
    if (ofw_get_property(device, "address", &screen->addr, sizeof(screen->addr)) <= 0)
        return false;
   
    if (ofw_get_property(device, "width", &screen->width, sizeof(screen->width)) <= 0)
        return false;
   
    if (ofw_get_property(device, "height", &screen->height, sizeof(screen->height)) <= 0)
        return false;
   
    if (ofw_get_property(device, "depth", &screen->bpp, sizeof(screen->bpp)) <= 0)
        return false;
   
    if (ofw_get_property(device, "linebytes", &screen->scanline, sizeof(screen->scanline)) <= 0)
        return false;
   
    return true;
}
 
 

Rev 1771	Rev 1772
1	/*	1	/*
2	* Copyright (C) 2005 Martin Decky	2	* Copyright (C) 2005 Martin Decky
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	#include "ofw.h"	29	#include "ofw.h"
30	#include <printf.h>	30	#include <printf.h>
31	#include <asm.h>	31	#include <asm.h>
32		32
33	#define MAX_OFW_ARGS 10	33	#define MAX_OFW_ARGS 10
34		34
35	/** OpenFirmware command structure	35	/** OpenFirmware command structure
36	*	36	*
37	*/	37	*/
38	typedef struct {	38	typedef struct {
39	const char service; /< Command name /	39	const char service; /< Command name /
40	unsigned int nargs; /*< Number of in arguments /	40	unsigned long nargs; /*< Number of in arguments /
41	unsigned int nret; /*< Number of out arguments /	41	unsigned long nret; /*< Number of out arguments /
42	ofw_arg_t args[MAX_OFW_ARGS]; /*< List of arguments /	42	ofw_arg_t args[MAX_OFW_ARGS]; /*< List of arguments /
43	} ofw_args_t;	43	} ofw_args_t;
44		44
45	typedef void (ofw_entry)(ofw_args_t );	45	typedef void (ofw_entry)(ofw_args_t );
46		46
47	ofw_entry ofw;	47	ofw_entry ofw;
48		48
49	phandle ofw_chosen;	49	phandle ofw_chosen;
50	ihandle ofw_stdout;	50	ihandle ofw_stdout;
51	phandle ofw_root;	51	phandle ofw_root;
52	ihandle ofw_mmu;	52	ihandle ofw_mmu;
53	phandle ofw_memory;	53	phandle ofw_memory;
54	phandle ofw_aliases;	54	phandle ofw_aliases;
55		55
56	static int ofw_call(const char service, const int nargs, const int nret, ofw_arg_t rets, ...)	56	static unsigned long ofw_call(const char service, const int nargs, const int nret, ofw_arg_t rets, ...)
57	{	57	{
58	va_list list;	58	va_list list;
59	ofw_args_t args;	59	ofw_args_t args;
60	int i;	60	int i;
61		61
62	args.service = service;	62	args.service = service;
63	args.nargs = nargs;	63	args.nargs = nargs;
64	args.nret = nret;	64	args.nret = nret;
65		65
66	va_start(list, rets);	66	va_start(list, rets);
67	for (i = 0; i < nargs; i++)	67	for (i = 0; i < nargs; i++)
68	args.args[i] = va_arg(list, ofw_arg_t);	68	args.args[i] = va_arg(list, ofw_arg_t);
69	va_end(list);	69	va_end(list);
70		70
71	for (i = 0; i < nret; i++)	71	for (i = 0; i < nret; i++)
72	args.args[i + nargs] = 0;	72	args.args[i + nargs] = 0;
73		73
74	ofw(&args);	74	ofw(&args);
75		75
76	for (i = 1; i < nret; i++)	76	for (i = 1; i < nret; i++)
77	rets[i - 1] = args.args[i + nargs];	77	rets[i - 1] = args.args[i + nargs];
78		78
79	return args.args[nargs];	79	return args.args[nargs];
80	}	80	}
81		81
82		82
83	phandle ofw_find_device(const char *name)	83	phandle ofw_find_device(const char *name)
84	{	84	{
85	return ofw_call("finddevice", 1, 1, NULL, name);	85	return ofw_call("finddevice", 1, 1, NULL, name);
86	}	86	}
87		87
88		88
89	int ofw_get_property(const phandle device, const char name, const void buf, const int buflen)	89	int ofw_get_property(const phandle device, const char name, const void buf, const int buflen)
90	{	90	{
91	return ofw_call("getprop", 4, 1, NULL, device, name, buf, buflen);	91	return ofw_call("getprop", 4, 1, NULL, device, name, buf, buflen);
92	}	92	}
93		93
94		94
95	static unsigned int ofw_get_address_cells(const phandle device)	95	static unsigned int ofw_get_address_cells(const phandle device)
96	{	96	{
97	unsigned int ret;	97	unsigned int ret;
98		98
99	if (ofw_get_property(device, "#address-cells", &ret, sizeof(ret)) <= 0)	99	if (ofw_get_property(device, "#address-cells", &ret, sizeof(ret)) <= 0)
100	if (ofw_get_property(ofw_root, "#address-cells", &ret, sizeof(ret)) <= 0)	100	if (ofw_get_property(ofw_root, "#address-cells", &ret, sizeof(ret)) <= 0)
101	ret = 1;	101	ret = 1;
102		102
103	return ret;	103	return ret;
104	}	104	}
105		105
106		106
107	static unsigned int ofw_get_size_cells(const phandle device)	107	static unsigned int ofw_get_size_cells(const phandle device)
108	{	108	{
109	unsigned int ret;	109	unsigned int ret;
110		110
111	if (ofw_get_property(device, "#size-cells", &ret, sizeof(ret)) <= 0)	111	if (ofw_get_property(device, "#size-cells", &ret, sizeof(ret)) <= 0)
112	if (ofw_get_property(ofw_root, "#size-cells", &ret, sizeof(ret)) <= 0)	112	if (ofw_get_property(ofw_root, "#size-cells", &ret, sizeof(ret)) <= 0)
113	ret = 1;	113	ret = 1;
114		114
115	return ret;	115	return ret;
116	}	116	}
117		117
118		118
119	static ihandle ofw_open(const char *name)	119	static ihandle ofw_open(const char *name)
120	{	120	{
121	return ofw_call("open", 1, 1, NULL, name);	121	return ofw_call("open", 1, 1, NULL, name);
122	}	122	}
123		123
124		124
125	void init(void)	125	void init(void)
126	{	126	{
127	ofw_chosen = ofw_find_device("/chosen");	127	ofw_chosen = ofw_find_device("/chosen");
128	if (ofw_chosen == -1)	128	if (ofw_chosen == -1)
129	halt();	129	halt();
130		130
131	if (ofw_get_property(ofw_chosen, "stdout", &ofw_stdout, sizeof(ofw_stdout)) <= 0)	131	if (ofw_get_property(ofw_chosen, "stdout", &ofw_stdout, sizeof(ofw_stdout)) <= 0)
132	ofw_stdout = 0;	132	ofw_stdout = 0;
133		133
134	ofw_root = ofw_find_device("/");	134	ofw_root = ofw_find_device("/");
135	if (ofw_root == -1) {	135	if (ofw_root == -1) {
136	puts("\r\nError: Unable to find / device, halted.\r\n");	136	puts("\r\nError: Unable to find / device, halted.\r\n");
137	halt();	137	halt();
138	}	138	}
139		139
140	if (ofw_get_property(ofw_chosen, "mmu", &ofw_mmu, sizeof(ofw_mmu)) <= 0) {	140	if (ofw_get_property(ofw_chosen, "mmu", &ofw_mmu, sizeof(ofw_mmu)) <= 0) {
141	puts("\r\nError: Unable to get mmu property, halted.\r\n");	141	puts("\r\nError: Unable to get mmu property, halted.\r\n");
142	halt();	142	halt();
143	}	143	}
144		144
145	ofw_memory = ofw_find_device("/memory");	145	ofw_memory = ofw_find_device("/memory");
146	if (ofw_memory == -1) {	146	if (ofw_memory == -1) {
147	puts("\r\nError: Unable to find /memory device, halted.\r\n");	147	puts("\r\nError: Unable to find /memory device, halted.\r\n");
148	halt();	148	halt();
149	}	149	}
150		150
151	ofw_aliases = ofw_find_device("/aliases");	151	ofw_aliases = ofw_find_device("/aliases");
152	if (ofw_aliases == -1) {	152	if (ofw_aliases == -1) {
153	puts("\r\nError: Unable to find /aliases device, halted.\r\n");	153	puts("\r\nError: Unable to find /aliases device, halted.\r\n");
154	halt();	154	halt();
155	}	155	}
156	}	156	}
157		157
158		158
159	void ofw_write(const char *str, const int len)	159	void ofw_write(const char *str, const int len)
160	{	160	{
161	if (ofw_stdout == 0)	161	if (ofw_stdout == 0)
162	return;	162	return;
163		163
164	ofw_call("write", 3, 1, NULL, ofw_stdout, str, len);	164	ofw_call("write", 3, 1, NULL, ofw_stdout, str, len);
165	}	165	}
166		166
167		167
168	void ofw_translate(const void virt)	168	void ofw_translate(const void virt)
169	{	169	{
170	ofw_arg_t result[3];	170	ofw_arg_t result[3];
171		171
172	if (ofw_call("call-method", 4, 4, result, "translate", ofw_mmu, virt, 1) != 0) {	172	if (ofw_call("call-method", 4, 4, result, "translate", ofw_mmu, virt, 1) != 0) {
173	puts("Error: MMU method translate() failed, halting.\n");	173	puts("Error: MMU method translate() failed, halting.\n");
174	halt();	174	halt();
175	}	175	}
176	return (void *) result[2];	176	return (void *) result[2];
177	}	177	}
178		178
179		179
180	int ofw_map(const void phys, const void virt, const int size, const int mode)	180	int ofw_map(const void phys, const void virt, const int size, const int mode)
181	{	181	{
182	return ofw_call("call-method", 6, 1, NULL, "map", ofw_mmu, mode, size, virt, phys);	182	return ofw_call("call-method", 6, 1, NULL, "map", ofw_mmu, mode, size, virt, phys);
183	}	183	}
184		184
185		185
186	int ofw_memmap(memmap_t *map)	186	int ofw_memmap(memmap_t *map)
187	{	187	{
188	unsigned long buf[BUF_SIZE];	188	unsigned long buf[BUF_SIZE];
189	int ret = ofw_get_property(ofw_memory, "reg", buf, sizeof(buf));	189	int ret = ofw_get_property(ofw_memory, "reg", buf, sizeof(buf));
190	if (ret <= 0)	190	if (ret <= 0)
191	return false;	191	return false;
192		192
193	unsigned int ac = ofw_get_address_cells(ofw_memory);	193	unsigned int ac = ofw_get_address_cells(ofw_memory);
194	unsigned int sc = ofw_get_size_cells(ofw_memory);	194	unsigned int sc = ofw_get_size_cells(ofw_memory);
195		195
196	int pos;	196	int pos;
197	map->total = 0;	197	map->total = 0;
198	map->count = 0;	198	map->count = 0;
199	for (pos = 0; (pos < ret / sizeof(unsigned long)) && (map->count < MEMMAP_MAX_RECORDS); pos += ac + sc) {	199	for (pos = 0; (pos < ret / sizeof(unsigned long)) && (map->count < MEMMAP_MAX_RECORDS); pos += ac + sc) {
200	void * start = (void *) buf[pos + ac - 1];	200	void * start = (void *) buf[pos + ac - 1];
201	unsigned int size = buf[pos + ac + sc - 1];	201	unsigned int size = buf[pos + ac + sc - 1];
202		202
203	if (size > 0) {	203	if (size > 0) {
204	map->zones[map->count].start = start;	204	map->zones[map->count].start = start;
205	map->zones[map->count].size = size;	205	map->zones[map->count].size = size;
206	map->count++;	206	map->count++;
207	map->total += size;	207	map->total += size;
208	}	208	}
209	}	209	}
210	}	210	}
211		211
212		212
213	int ofw_screen(screen_t *screen)	213	int ofw_screen(screen_t *screen)
214	{	214	{
215	char device_name[BUF_SIZE];	215	char device_name[BUF_SIZE];
216		216
217	if (ofw_get_property(ofw_aliases, "screen", device_name, sizeof(device_name)) <= 0)	217	if (ofw_get_property(ofw_aliases, "screen", device_name, sizeof(device_name)) <= 0)
218	return false;	218	return false;
219		219
220	phandle device = ofw_find_device(device_name);	220	phandle device = ofw_find_device(device_name);
221	if (device == -1)	221	if (device == -1)
222	return false;	222	return false;
223		223
224	if (ofw_get_property(device, "address", &screen->addr, sizeof(screen->addr)) <= 0)	224	if (ofw_get_property(device, "address", &screen->addr, sizeof(screen->addr)) <= 0)
225	return false;	225	return false;
226		226
227	if (ofw_get_property(device, "width", &screen->width, sizeof(screen->width)) <= 0)	227	if (ofw_get_property(device, "width", &screen->width, sizeof(screen->width)) <= 0)
228	return false;	228	return false;
229		229
230	if (ofw_get_property(device, "height", &screen->height, sizeof(screen->height)) <= 0)	230	if (ofw_get_property(device, "height", &screen->height, sizeof(screen->height)) <= 0)
231	return false;	231	return false;
232		232
233	if (ofw_get_property(device, "depth", &screen->bpp, sizeof(screen->bpp)) <= 0)	233	if (ofw_get_property(device, "depth", &screen->bpp, sizeof(screen->bpp)) <= 0)
234	return false;	234	return false;
235		235
236	if (ofw_get_property(device, "linebytes", &screen->scanline, sizeof(screen->scanline)) <= 0)	236	if (ofw_get_property(device, "linebytes", &screen->scanline, sizeof(screen->scanline)) <= 0)
237	return false;	237	return false;
238		238
239	return true;	239	return true;
240	}	240	}
241		241
242		242

Subversion Repositories HelenOS-historic

(root)/boot/trunk/genarch/ofw.c – Rev 1771 → 1772