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
do_decode_unit(fcode_env_t * env)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
do_encode_unit(fcode_env_t * env)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
_init(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