xref: /titanic_44/usr/src/lib/efcode/packages/memalloc.c (revision 2b4a78020b9c38d1b95e2f3fefa6d6e4be382d1f)
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License (the "License").
6  * You may not use this file except in compliance with the License.
7  *
8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9  * or http://www.opensolaris.org/os/licensing.
10  * See the License for the specific language governing permissions
11  * and limitations under the License.
12  *
13  * When distributing Covered Code, include this CDDL HEADER in each
14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15  * If applicable, add the following below this CDDL HEADER, with the
16  * fields enclosed by brackets "[]" replaced with your own identifying
17  * information: Portions Copyright [yyyy] [name of copyright owner]
18  *
19  * CDDL HEADER END
20  */
21 /*
22  * Copyright 2006 Sun Microsystems, Inc.  All rights reserved.
23  * Use is subject to license terms.
24  */
25 
26 #pragma ident	"%Z%%M%	%I%	%E% SMI"
27 
28 #include <stdio.h>
29 #include <stdlib.h>
30 #include <strings.h>
31 
32 #include <fcode/private.h>
33 #include <fcode/log.h>
34 
35 #include <fcdriver/fcdriver.h>
36 
37 /*
38  * claim under /openprom/client-services is used by schizo and oberon Fcode, we
39  * call "claim-memory" service.
40  */
41 void
42 claim(fcode_env_t *env)
43 {
44 	size_t size;
45 	void *hint;
46 	int align;
47 	fc_cell_t vaddr;
48 	int error;
49 
50 	CHECK_DEPTH(env, 3, "claim-memory");
51 	hint = (void *)POP(DS);
52 	size = POP(DS);
53 	align = POP(DS);
54 	error = fc_run_priv(env->private, "claim-memory", 3, 1,
55 	    fc_int2cell(align), fc_size2cell(size), fc_ptr2cell(hint), &vaddr);
56 	if (error)
57 		throw_from_fclib(env, 1, "client-services/claim failed\n");
58 	vaddr = mapping_to_mcookie(vaddr, size, NULL, NULL);
59 	PUSH(DS, (fstack_t)vaddr);
60 }
61 
62 void
63 release(fcode_env_t *env)
64 {
65 	size_t size;
66 	void *addr;
67 	int error;
68 
69 	CHECK_DEPTH(env, 2, "release-memory");
70 	addr = (void *)POP(DS);
71 	size = POP(DS);
72 	error = fc_run_priv(env->private, "release-memory", 2, 0,
73 	    fc_size2cell(size), fc_ptr2cell(addr));
74 	if (error)
75 		throw_from_fclib(env, 1, "client-services/release failed\n");
76 	delete_mapping((fstack_t)addr);
77 }
78 
79 static void
80 fc_vtop(fcode_env_t *env)
81 {
82 	void *vaddr;
83 	fc_cell_t physlo, physhi;
84 	int error;
85 
86 	CHECK_DEPTH(env, 1, "vtop");
87 	vaddr = (void *)POP(DS);
88 	error = fc_run_priv(env->private, "vtop", 1, 2,
89 	    fc_ptr2cell(vaddr), &physlo, &physhi);
90 	if (error)
91 		throw_from_fclib(env, 1, "fc_vtop: '>physical' failed\n");
92 
93 	PUSH(DS, physlo);
94 	PUSH(DS, physhi);
95 }
96 
97 void
98 install_openprom_nodes(fcode_env_t *env)
99 {
100 	MYSELF = open_instance_chain(env, env->root_node, 0);
101 	if (MYSELF != NULL) {
102 		make_a_node(env, "openprom", 0);
103 		make_a_node(env, "client-services", 0);
104 		FORTH(0,	"claim",	claim);
105 		FORTH(0,	"release",	release);
106 		finish_device(env);
107 		finish_device(env);
108 		close_instance_chain(env, MYSELF, 0);
109 		device_end(env);
110 		MYSELF = 0;
111 	}
112 }
113 
114 #pragma init(_init)
115 
116 static void
117 _init(void)
118 {
119 	fcode_env_t *env = initial_env;
120 
121 	ASSERT(env);
122 	NOTICE;
123 
124 	FORTH(0,	"install-openprom-nodes",	install_openprom_nodes);
125 	FORTH(0,	"claim",			claim);
126 	FORTH(0,	"release",			release);
127 	P1275(0x106,	0,	">physical",		fc_vtop);
128 }
129