usr/src/lib/efcode/upa/upa.c

   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 }