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 (c) 2000 by Sun Microsystems, Inc.
24*0Sstevel@tonic-gate * All rights reserved.
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 <string.h>
31*0Sstevel@tonic-gate #include <fcode/private.h>
32*0Sstevel@tonic-gate
33*0Sstevel@tonic-gate static void
do_decode_unit(fcode_env_t * env)34*0Sstevel@tonic-gate do_decode_unit(fcode_env_t *env)
35*0Sstevel@tonic-gate {
36*0Sstevel@tonic-gate CHECK_DEPTH(env, 2, "upa:decode-unit");
37*0Sstevel@tonic-gate parse_two_int(env);
38*0Sstevel@tonic-gate if ((TOS & 0x1c0) == 0) {
39*0Sstevel@tonic-gate TOS = ((TOS << 1) | 0x1c0);
40*0Sstevel@tonic-gate }
41*0Sstevel@tonic-gate }
42*0Sstevel@tonic-gate
43*0Sstevel@tonic-gate static void
do_encode_unit(fcode_env_t * env)44*0Sstevel@tonic-gate do_encode_unit(fcode_env_t *env)
45*0Sstevel@tonic-gate {
46*0Sstevel@tonic-gate static char buf[8];
47*0Sstevel@tonic-gate fstack_t hi, mid, lo;
48*0Sstevel@tonic-gate int dev, fn, len;
49*0Sstevel@tonic-gate
50*0Sstevel@tonic-gate CHECK_DEPTH(env, 2, "upa:encode-unit");
51*0Sstevel@tonic-gate hi = POP(DS);
52*0Sstevel@tonic-gate lo = POP(DS);
53*0Sstevel@tonic-gate hi = ((hi >> 1) & 0x1f);
54*0Sstevel@tonic-gate sprintf(buf, "%x,%x", hi, lo);
55*0Sstevel@tonic-gate push_a_string(env, buf);
56*0Sstevel@tonic-gate }
57*0Sstevel@tonic-gate
58*0Sstevel@tonic-gate #pragma init(_init)
59*0Sstevel@tonic-gate
60*0Sstevel@tonic-gate static void
_init(void)61*0Sstevel@tonic-gate _init(void)
62*0Sstevel@tonic-gate {
63*0Sstevel@tonic-gate fcode_env_t *env = initial_env;
64*0Sstevel@tonic-gate
65*0Sstevel@tonic-gate ASSERT(env);
66*0Sstevel@tonic-gate NOTICE;
67*0Sstevel@tonic-gate
68*0Sstevel@tonic-gate create_int_prop(env, "#address-cells", 2);
69*0Sstevel@tonic-gate create_int_prop(env, "#size-cells", 2);
70*0Sstevel@tonic-gate
71*0Sstevel@tonic-gate FORTH(0, "decode-unit", do_decode_unit);
72*0Sstevel@tonic-gate FORTH(0, "encode-unit", do_encode_unit);
73*0Sstevel@tonic-gate
74*0Sstevel@tonic-gate }
75