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