WebSVN – HelenOS – Diff – /trunk/boot/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 <ofwarch.h>
#include <printf.h>
#include <asm.h>
#include <types.h>
 
uintptr_t ofw_cif;
 
phandle ofw_chosen;
ihandle ofw_stdout;
phandle ofw_root;
ihandle ofw_mmu;
phandle ofw_memory;
phandle ofw_aliases;
 
void ofw_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();
    }
}
 
/** Perform a call to OpenFirmware client interface.
 *
 * @param service String identifying the service requested.
 * @param nargs Number of input arguments.
 * @param nret Number of output arguments. This includes the return value.
 * @param rets Buffer for output arguments or NULL. The buffer must accommodate nret - 1 items.
 *
 * @return Return value returned by the client interface.
 */
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 = (ofw_arg_t) 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;
   
    (void) 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);
}
 
 
unsigned int ofw_get_address_cells(const phandle device)
{
    unsigned int ret = 1;
   
    if (ofw_get_property(device, "#address-cells", &ret, sizeof(ret)) <= 0)
        if (ofw_get_property(ofw_root, "#address-cells", &ret, sizeof(ret)) <= 0)
            ret = OFW_ADDRESS_CELLS;
   
    return ret;
}
 
 
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 = OFW_SIZE_CELLS;
   
    return ret;
}
 
phandle ofw_get_child_node(const phandle node)
{
    return ofw_call("child", 1, 1, NULL, node);
}
 
phandle ofw_get_peer_node(const phandle node)
{
    return ofw_call("peer", 1, 1, NULL, node);
}
 
static ihandle ofw_open(const char *name)
{
    return ofw_call("open", 1, 1, NULL, name);
}
 
 
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[4];
    int shift;
 
    if (ofw_call("call-method", 3, 5, result, "translate", ofw_mmu, virt) != 0) {
        puts("Error: MMU method translate() failed, halting.\n");
        halt();
    }
 
    if (ofw_translate_failed(result[0]))
        return NULL;
 
    if (sizeof(unative_t) == 8)
        shift = 32;
    else
        shift = 0;
 
    return (void *) ((result[2]<<shift)|result[3]);
}
 
void *ofw_claim(const void *virt, const int len)
{
    ofw_arg_t retaddr;
    int shift;
 
    if (ofw_call("call-method", 5, 2, &retaddr, "claim", ofw_mmu, 0, len, virt) != 0) {
        puts("Error: MMU method claim() failed, halting.\n");
        halt();
    }
 
    return (void *) retaddr;
}
 
int ofw_map(const void *phys, const void *virt, const int size, const int mode)
{
    uintptr_t phys_hi, phys_lo;
 
    if (sizeof(unative_t) == 8) {
        int shift = 32;
        phys_hi = (uintptr_t) phys >> shift;
        phys_lo = (uintptr_t) phys & 0xffffffff;
    } else {
        phys_hi = 0;
        phys_lo = (uintptr_t) phys;
    }
 
    return ofw_call("call-method", 7, 1, NULL, "map", ofw_mmu, mode, size, virt,
        phys_hi, phys_lo);
}
 
 
int ofw_memmap(memmap_t *map)
{
    unsigned int ac = ofw_get_address_cells(ofw_memory);
    unsigned int sc = ofw_get_size_cells(ofw_memory);
 
    uint32_t buf[((ac+sc)*MEMMAP_MAX_RECORDS)];
    int ret = ofw_get_property(ofw_memory, "reg", buf, sizeof(buf));
    if (ret <= 0)       /* ret is the number of written bytes */
        return false;
 
    int pos;
    map->total = 0;
    map->count = 0;
    for (pos = 0; (pos < ret / sizeof(uint32_t)) && (map->count < MEMMAP_MAX_RECORDS); pos += ac + sc) {
        void * start = (void *) ((uintptr_t) 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;
        }
    }
   
    return true;
}
 
 
int ofw_screen(screen_t *screen)
{
    char device_name[BUF_SIZE];
    uint32_t virtaddr;
   
    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", &virtaddr, sizeof(virtaddr)) <= 0)
        return false;
 
    screen->addr = (void *) ((uintptr_t) virtaddr);
 
    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 1790	Rev 1881
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 <ofwarch.h>	30	#include <ofwarch.h>
31	#include <printf.h>	31	#include <printf.h>
32	#include <asm.h>	32	#include <asm.h>
33	#include <types.h>	33	#include <types.h>
34		34
35	uintptr_t ofw_cif;	35	uintptr_t ofw_cif;
36		36
37	phandle ofw_chosen;	37	phandle ofw_chosen;
38	ihandle ofw_stdout;	38	ihandle ofw_stdout;
39	phandle ofw_root;	39	phandle ofw_root;
40	ihandle ofw_mmu;	40	ihandle ofw_mmu;
41	phandle ofw_memory;	41	phandle ofw_memory;
42	phandle ofw_aliases;	42	phandle ofw_aliases;
43		43
44	void ofw_init(void)	44	void ofw_init(void)
45	{	45	{
46	ofw_chosen = ofw_find_device("/chosen");	46	ofw_chosen = ofw_find_device("/chosen");
47	if (ofw_chosen == -1)	47	if (ofw_chosen == -1)
48	halt();	48	halt();
49		49
50	if (ofw_get_property(ofw_chosen, "stdout", &ofw_stdout, sizeof(ofw_stdout)) <= 0)	50	if (ofw_get_property(ofw_chosen, "stdout", &ofw_stdout, sizeof(ofw_stdout)) <= 0)
51	ofw_stdout = 0;	51	ofw_stdout = 0;
52		52
53	ofw_root = ofw_find_device("/");	53	ofw_root = ofw_find_device("/");
54	if (ofw_root == -1) {	54	if (ofw_root == -1) {
55	puts("\r\nError: Unable to find / device, halted.\r\n");	55	puts("\r\nError: Unable to find / device, halted.\r\n");
56	halt();	56	halt();
57	}	57	}
58		58
59	if (ofw_get_property(ofw_chosen, "mmu", &ofw_mmu, sizeof(ofw_mmu)) <= 0) {	59	if (ofw_get_property(ofw_chosen, "mmu", &ofw_mmu, sizeof(ofw_mmu)) <= 0) {
60	puts("\r\nError: Unable to get mmu property, halted.\r\n");	60	puts("\r\nError: Unable to get mmu property, halted.\r\n");
61	halt();	61	halt();
62	}	62	}
63		63
64	ofw_memory = ofw_find_device("/memory");	64	ofw_memory = ofw_find_device("/memory");
65	if (ofw_memory == -1) {	65	if (ofw_memory == -1) {
66	puts("\r\nError: Unable to find /memory device, halted.\r\n");	66	puts("\r\nError: Unable to find /memory device, halted.\r\n");
67	halt();	67	halt();
68	}	68	}
69		69
70	ofw_aliases = ofw_find_device("/aliases");	70	ofw_aliases = ofw_find_device("/aliases");
71	if (ofw_aliases == -1) {	71	if (ofw_aliases == -1) {
72	puts("\r\nError: Unable to find /aliases device, halted.\r\n");	72	puts("\r\nError: Unable to find /aliases device, halted.\r\n");
73	halt();	73	halt();
74	}	74	}
75	}	75	}
76		76
77	/** Perform a call to OpenFirmware client interface.	77	/** Perform a call to OpenFirmware client interface.
78	*	78	*
79	* @param service String identifying the service requested.	79	* @param service String identifying the service requested.
80	* @param nargs Number of input arguments.	80	* @param nargs Number of input arguments.
81	* @param nret Number of output arguments. This includes the return value.	81	* @param nret Number of output arguments. This includes the return value.
82	* @param rets Buffer for output arguments or NULL. The buffer must accommodate nret - 1 items.	82	* @param rets Buffer for output arguments or NULL. The buffer must accommodate nret - 1 items.
83	*	83	*
84	* @return Return value returned by the client interface.	84	* @return Return value returned by the client interface.
85	*/	85	*/
86	static unsigned long ofw_call(const char service, const int nargs, const int nret, ofw_arg_t rets, ...)	86	static unsigned long ofw_call(const char service, const int nargs, const int nret, ofw_arg_t rets, ...)
87	{	87	{
88	va_list list;	88	va_list list;
89	ofw_args_t args;	89	ofw_args_t args;
90	int i;	90	int i;
91		91
92	args.service = (ofw_arg_t) service;	92	args.service = (ofw_arg_t) service;
93	args.nargs = nargs;	93	args.nargs = nargs;
94	args.nret = nret;	94	args.nret = nret;
95		95
96	va_start(list, rets);	96	va_start(list, rets);
97	for (i = 0; i < nargs; i++)	97	for (i = 0; i < nargs; i++)
98	args.args[i] = va_arg(list, ofw_arg_t);	98	args.args[i] = va_arg(list, ofw_arg_t);
99	va_end(list);	99	va_end(list);
100		100
101	for (i = 0; i < nret; i++)	101	for (i = 0; i < nret; i++)
102	args.args[i + nargs] = 0;	102	args.args[i + nargs] = 0;
103		103
104	(void) ofw(&args);	104	(void) ofw(&args);
105		105
106	for (i = 1; i < nret; i++)	106	for (i = 1; i < nret; i++)
107	rets[i - 1] = args.args[i + nargs];	107	rets[i - 1] = args.args[i + nargs];
108		108
109	return args.args[nargs];	109	return args.args[nargs];
110	}	110	}
111		111
112		112
113	phandle ofw_find_device(const char *name)	113	phandle ofw_find_device(const char *name)
114	{	114	{
115	return ofw_call("finddevice", 1, 1, NULL, name);	115	return ofw_call("finddevice", 1, 1, NULL, name);
116	}	116	}
117		117
118		118
119	int ofw_get_property(const phandle device, const char name, const void buf, const int buflen)	119	int ofw_get_property(const phandle device, const char name, const void buf, const int buflen)
120	{	120	{
121	return ofw_call("getprop", 4, 1, NULL, device, name, buf, buflen);	121	return ofw_call("getprop", 4, 1, NULL, device, name, buf, buflen);
122	}	122	}
123		123
124		124
125	unsigned int ofw_get_address_cells(const phandle device)	125	unsigned int ofw_get_address_cells(const phandle device)
126	{	126	{
127	unsigned int ret = 1;	127	unsigned int ret = 1;
128		128
129	if (ofw_get_property(device, "#address-cells", &ret, sizeof(ret)) <= 0)	129	if (ofw_get_property(device, "#address-cells", &ret, sizeof(ret)) <= 0)
130	if (ofw_get_property(ofw_root, "#address-cells", &ret, sizeof(ret)) <= 0)	130	if (ofw_get_property(ofw_root, "#address-cells", &ret, sizeof(ret)) <= 0)
131	ret = OFW_ADDRESS_CELLS;	131	ret = OFW_ADDRESS_CELLS;
132		132
133	return ret;	133	return ret;
134	}	134	}
135		135
136		136
137	unsigned int ofw_get_size_cells(const phandle device)	137	unsigned int ofw_get_size_cells(const phandle device)
138	{	138	{
139	unsigned int ret;	139	unsigned int ret;
140		140
141	if (ofw_get_property(device, "#size-cells", &ret, sizeof(ret)) <= 0)	141	if (ofw_get_property(device, "#size-cells", &ret, sizeof(ret)) <= 0)
142	if (ofw_get_property(ofw_root, "#size-cells", &ret, sizeof(ret)) <= 0)	142	if (ofw_get_property(ofw_root, "#size-cells", &ret, sizeof(ret)) <= 0)
143	ret = OFW_SIZE_CELLS;	143	ret = OFW_SIZE_CELLS;
144		144
145	return ret;	145	return ret;
146	}	146	}
147		147
-		148	phandle ofw_get_child_node(const phandle node)
-		149	{
-		150	return ofw_call("child", 1, 1, NULL, node);
-		151	}
-		152
-		153	phandle ofw_get_peer_node(const phandle node)
-		154	{
-		155	return ofw_call("peer", 1, 1, NULL, node);
-		156	}
148		157
149	static ihandle ofw_open(const char *name)	158	static ihandle ofw_open(const char *name)
150	{	159	{
151	return ofw_call("open", 1, 1, NULL, name);	160	return ofw_call("open", 1, 1, NULL, name);
152	}	161	}
153		162
154		163
155	void ofw_write(const char *str, const int len)	164	void ofw_write(const char *str, const int len)
156	{	165	{
157	if (ofw_stdout == 0)	166	if (ofw_stdout == 0)
158	return;	167	return;
159		168
160	ofw_call("write", 3, 1, NULL, ofw_stdout, str, len);	169	ofw_call("write", 3, 1, NULL, ofw_stdout, str, len);
161	}	170	}
162		171
163		172
164	void ofw_translate(const void virt)	173	void ofw_translate(const void virt)
165	{	174	{
166	ofw_arg_t result[4];	175	ofw_arg_t result[4];
167	int shift;	176	int shift;
168		177
169	if (ofw_call("call-method", 3, 5, result, "translate", ofw_mmu, virt) != 0) {	178	if (ofw_call("call-method", 3, 5, result, "translate", ofw_mmu, virt) != 0) {
170	puts("Error: MMU method translate() failed, halting.\n");	179	puts("Error: MMU method translate() failed, halting.\n");
171	halt();	180	halt();
172	}	181	}
173		182
174	if (ofw_translate_failed(result[0]))	183	if (ofw_translate_failed(result[0]))
175	return NULL;	184	return NULL;
176		185
177	if (sizeof(unative_t) == 8)	186	if (sizeof(unative_t) == 8)
178	shift = 32;	187	shift = 32;
179	else	188	else
180	shift = 0;	189	shift = 0;
181		190
182	return (void *) ((result[2]<<shift)\|result[3]);	191	return (void *) ((result[2]<<shift)\|result[3]);
183	}	192	}
184		193
185	void ofw_claim(const void virt, const int len)	194	void ofw_claim(const void virt, const int len)
186	{	195	{
187	ofw_arg_t retaddr;	196	ofw_arg_t retaddr;
188	int shift;	197	int shift;
189		198
190	if (ofw_call("call-method", 5, 2, &retaddr, "claim", ofw_mmu, 0, len, virt) != 0) {	199	if (ofw_call("call-method", 5, 2, &retaddr, "claim", ofw_mmu, 0, len, virt) != 0) {
191	puts("Error: MMU method claim() failed, halting.\n");	200	puts("Error: MMU method claim() failed, halting.\n");
192	halt();	201	halt();
193	}	202	}
194		203
195	return (void *) retaddr;	204	return (void *) retaddr;
196	}	205	}
197		206
198	int ofw_map(const void phys, const void virt, const int size, const int mode)	207	int ofw_map(const void phys, const void virt, const int size, const int mode)
199	{	208	{
200	uintptr_t phys_hi, phys_lo;	209	uintptr_t phys_hi, phys_lo;
201		210
202	if (sizeof(unative_t) == 8) {	211	if (sizeof(unative_t) == 8) {
203	int shift = 32;	212	int shift = 32;
204	phys_hi = (uintptr_t) phys >> shift;	213	phys_hi = (uintptr_t) phys >> shift;
205	phys_lo = (uintptr_t) phys & 0xffffffff;	214	phys_lo = (uintptr_t) phys & 0xffffffff;
206	} else {	215	} else {
207	phys_hi = 0;	216	phys_hi = 0;
208	phys_lo = (uintptr_t) phys;	217	phys_lo = (uintptr_t) phys;
209	}	218	}
210		219
211	return ofw_call("call-method", 7, 1, NULL, "map", ofw_mmu, mode, size, virt,	220	return ofw_call("call-method", 7, 1, NULL, "map", ofw_mmu, mode, size, virt,
212	phys_hi, phys_lo);	221	phys_hi, phys_lo);
213	}	222	}
214		223
215		224
216	int ofw_memmap(memmap_t *map)	225	int ofw_memmap(memmap_t *map)
217	{	226	{
218	unsigned int ac = ofw_get_address_cells(ofw_memory);	227	unsigned int ac = ofw_get_address_cells(ofw_memory);
219	unsigned int sc = ofw_get_size_cells(ofw_memory);	228	unsigned int sc = ofw_get_size_cells(ofw_memory);
220		229
221	uint32_t buf[((ac+sc)*MEMMAP_MAX_RECORDS)];	230	uint32_t buf[((ac+sc)*MEMMAP_MAX_RECORDS)];
222	int ret = ofw_get_property(ofw_memory, "reg", buf, sizeof(buf));	231	int ret = ofw_get_property(ofw_memory, "reg", buf, sizeof(buf));
223	if (ret <= 0) /* ret is the number of written bytes */	232	if (ret <= 0) /* ret is the number of written bytes */
224	return false;	233	return false;
225		234
226	int pos;	235	int pos;
227	map->total = 0;	236	map->total = 0;
228	map->count = 0;	237	map->count = 0;
229	for (pos = 0; (pos < ret / sizeof(uint32_t)) && (map->count < MEMMAP_MAX_RECORDS); pos += ac + sc) {	238	for (pos = 0; (pos < ret / sizeof(uint32_t)) && (map->count < MEMMAP_MAX_RECORDS); pos += ac + sc) {
230	void * start = (void *) ((uintptr_t) buf[pos + ac - 1]);	239	void * start = (void *) ((uintptr_t) buf[pos + ac - 1]);
231	unsigned int size = buf[pos + ac + sc - 1];	240	unsigned int size = buf[pos + ac + sc - 1];
232		241
233	if (size > 0) {	242	if (size > 0) {
234	map->zones[map->count].start = start;	243	map->zones[map->count].start = start;
235	map->zones[map->count].size = size;	244	map->zones[map->count].size = size;
236	map->count++;	245	map->count++;
237	map->total += size;	246	map->total += size;
238	}	247	}
239	}	248	}
240		249
241	return true;	250	return true;
242	}	251	}
243		252
244		253
245	int ofw_screen(screen_t *screen)	254	int ofw_screen(screen_t *screen)
246	{	255	{
247	char device_name[BUF_SIZE];	256	char device_name[BUF_SIZE];
248	uint32_t virtaddr;	257	uint32_t virtaddr;
249		258
250	if (ofw_get_property(ofw_aliases, "screen", device_name, sizeof(device_name)) <= 0)	259	if (ofw_get_property(ofw_aliases, "screen", device_name, sizeof(device_name)) <= 0)
251	return false;	260	return false;
252		261
253	phandle device = ofw_find_device(device_name);	262	phandle device = ofw_find_device(device_name);
254	if (device == -1)	263	if (device == -1)
255	return false;	264	return false;
256		265
257	if (ofw_get_property(device, "address", &virtaddr, sizeof(virtaddr)) <= 0)	266	if (ofw_get_property(device, "address", &virtaddr, sizeof(virtaddr)) <= 0)
258	return false;	267	return false;
259		268
260	screen->addr = (void *) ((uintptr_t) virtaddr);	269	screen->addr = (void *) ((uintptr_t) virtaddr);
261		270
262	if (ofw_get_property(device, "width", &screen->width, sizeof(screen->width)) <= 0)	271	if (ofw_get_property(device, "width", &screen->width, sizeof(screen->width)) <= 0)
263	return false;	272	return false;
264		273
265	if (ofw_get_property(device, "height", &screen->height, sizeof(screen->height)) <= 0)	274	if (ofw_get_property(device, "height", &screen->height, sizeof(screen->height)) <= 0)
266	return false;	275	return false;
267		276
268	if (ofw_get_property(device, "depth", &screen->bpp, sizeof(screen->bpp)) <= 0)	277	if (ofw_get_property(device, "depth", &screen->bpp, sizeof(screen->bpp)) <= 0)
269	return false;	278	return false;
270		279
271	if (ofw_get_property(device, "linebytes", &screen->scanline, sizeof(screen->scanline)) <= 0)	280	if (ofw_get_property(device, "linebytes", &screen->scanline, sizeof(screen->scanline)) <= 0)
272	return false;	281	return false;
273		282
274	return true;	283	return true;
275	}	284	}
276		285

Subversion Repositories HelenOS

(root)/trunk/boot/genarch/ofw.c @ 1790 – Rev 1790 → 1881