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