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