\ ========== Copyright Header Begin ==========================================
\ 
\ Hypervisor Software File: util.fth
\ 
\ Copyright (c) 2006 Sun Microsystems, Inc. All Rights Reserved.
\ 
\  - Do no alter or remove copyright notices
\ 
\  - Redistribution and use of this software in source and binary forms, with 
\    or without modification, are permitted provided that the following 
\    conditions are met: 
\ 
\  - Redistribution of source code must retain the above copyright notice, 
\    this list of conditions and the following disclaimer.
\ 
\  - Redistribution in binary form must reproduce the above copyright notice,
\    this list of conditions and the following disclaimer in the
\    documentation and/or other materials provided with the distribution. 
\ 
\    Neither the name of Sun Microsystems, Inc. or the names of contributors 
\ may be used to endorse or promote products derived from this software 
\ without specific prior written permission. 
\ 
\     This software is provided "AS IS," without a warranty of any kind. 
\ ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES, 
\ INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A 
\ PARTICULAR PURPOSE OR NON-INFRINGEMENT, ARE HEREBY EXCLUDED. SUN 
\ MICROSYSTEMS, INC. ("SUN") AND ITS LICENSORS SHALL NOT BE LIABLE FOR 
\ ANY DAMAGES SUFFERED BY LICENSEE AS A RESULT OF USING, MODIFYING OR 
\ DISTRIBUTING THIS SOFTWARE OR ITS DERIVATIVES. IN NO EVENT WILL SUN 
\ OR ITS LICENSORS BE LIABLE FOR ANY LOST REVENUE, PROFIT OR DATA, OR 
\ FOR DIRECT, INDIRECT, SPECIAL, CONSEQUENTIAL, INCIDENTAL OR PUNITIVE 
\ DAMAGES, HOWEVER CAUSED AND REGARDLESS OF THE THEORY OF LIABILITY, 
\ ARISING OUT OF THE USE OF OR INABILITY TO USE THIS SOFTWARE, EVEN IF 
\ SUN HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES.
\ 
\ You acknowledge that this software is not designed, licensed or
\ intended for use in the design, construction, operation or maintenance of
\ any nuclear facility. 
\ 
\ ========== Copyright Header End ============================================
id: @(#)util.fth 1.1 06/02/16 
purpose: Intel Ophir/82571 utility routines
copyright: Copyright 2006 Sun Microsystems, Inc. All Rights Reserved
copyright: Use is subject to license terms.

headerless

1 d# 31 lshift constant bit31

\ Shift right - works for 64 bit.
: rshift	( data shift -- data )
   >r xlsplit r>			( lo hi shift )
   0 ?do				( lo hi )
      dup 1 and d# 31 lshift -rot	( bit lo hi )
      1 rshift -rot			( hi' bit lo )
      1 rshift bit31 invert and or	( hi' lo' )
      swap				( lo' hi' )
   loop					( lo' hi' )
   lxjoin				( data )
;

-1 d# 32 rshift constant 32bit-mask

\ Logical operations only work on 32 bits for this code.
: or32		( a b -- c ) or 32bit-mask and ;
: and32		( a b -- c ) and 32bit-mask and ;

: wait-status	( timeout check-acf -- ok? )
   swap 0 ?do
      dup execute if unloop drop true exit then
      1 ms
   loop drop false
;

: timed-out?	( when -- flag ) get-msecs - 0< ;

: diag-type	( adr,len -- ) diagnostic-mode? if type else 2drop then ;
: diag-cr	( -- ) diagnostic-mode? if cr then ;
: diag-type-cr	( adr,len -- ) diag-type diag-cr ;


\ Round-up - to a given power of 2.
: round-up 	( val 2^^N -- val' )
   1 - tuck + swap invert and
;

headers