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, Version 1.0 only 6 * (the "License"). You may not use this file except in compliance 7 * with the License. 8 * 9 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 10 * or http://www.opensolaris.org/os/licensing. 11 * See the License for the specific language governing permissions 12 * and limitations under the License. 13 * 14 * When distributing Covered Code, include this CDDL HEADER in each 15 * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 16 * If applicable, add the following below this CDDL HEADER, with the 17 * fields enclosed by brackets "[]" replaced with your own identifying 18 * information: Portions Copyright [yyyy] [name of copyright owner] 19 * 20 * CDDL HEADER END 21 */ 22 /* 23 * Copyright (c) 2000 by Sun Microsystems, Inc. 24 * All rights reserved. 25 */ 26 27 #pragma ident "%Z%%M% %I% %E% SMI" 28 29 #include <stdio.h> 30 #include <string.h> 31 #include <fcode/private.h> 32 33 static void 34 do_decode_unit(fcode_env_t *env) 35 { 36 CHECK_DEPTH(env, 2, "upa:decode-unit"); 37 parse_two_int(env); 38 if ((TOS & 0x1c0) == 0) { 39 TOS = ((TOS << 1) | 0x1c0); 40 } 41 } 42 43 static void 44 do_encode_unit(fcode_env_t *env) 45 { 46 static char buf[8]; 47 fstack_t hi, mid, lo; 48 int dev, fn, len; 49 50 CHECK_DEPTH(env, 2, "upa:encode-unit"); 51 hi = POP(DS); 52 lo = POP(DS); 53 hi = ((hi >> 1) & 0x1f); 54 sprintf(buf, "%x,%x", hi, lo); 55 push_a_string(env, buf); 56 } 57 58 #pragma init(_init) 59 60 static void 61 _init(void) 62 { 63 fcode_env_t *env = initial_env; 64 65 ASSERT(env); 66 NOTICE; 67 68 create_int_prop(env, "#address-cells", 2); 69 create_int_prop(env, "#size-cells", 2); 70 71 FORTH(0, "decode-unit", do_decode_unit); 72 FORTH(0, "encode-unit", do_encode_unit); 73 74 } 75