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