obp/obp/arch/sun4u/retained.fth

\ ========== Copyright Header Begin ==========================================
\
\ Hypervisor Software File: retained.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: @(#)retained.fth 1.20 06/02/16
purpose:
copyright: Copyright 2006 Sun Microsystems, Inc.  All Rights Reserved
copyright: Use is subject to license terms.

headerless
0 value retained

\  R  E  T  A  I  N  E  D
h# 52.45.54.41.49.4e.45.44 constant retained-magic0
h# 64.65.6e.69.61.74.65.72 constant retained-magic1

\ Following deferred words are needed to support platforms which have
\ system controllers and for platforms which needs to do some extra
\ work outside of OBP in order to retain memory pages over reboots.
defer new-retained-hook  ( name$ size pa.lo -- name$ size pa.lo )
' noop is new-retained-hook

defer release-retained-hook  ( pa.lo pa.hi size -- pa.lo pa.hi size )
' noop is release-retained-hook

defer retained-phys-hook ( pa.lo pa.hi size -- pa.lo' pa.hi' size' )
' noop is retained-phys-hook

pagesize constant /retained
16meg constant retained-min-align

: retained-phys ( -- pa.lo pa.hi size )
   hi-memory-base @
   hi-memory-size @ +  pageshift lshift 1- ( pa.lo )
   retained-min-align round-down
   /retained pagesize round-up -        ( pa.lo )
   obmem /retained                      ( pa.lo pa.hi size )
   \ Call platform hook to inform system controller, etc..
   retained-phys-hook                   ( pa.lo pa.hi size )
;

: map-in-retained ( mem-acf -- vadr )
   >r                                   ( )
   retained-phys  0  mem-claim          ( pa.lo pa.hi )
   /retained dup 1  mmu-claim           ( pa.lo pa.hi len vadr )
   tuck >r       -1  mmu-map            ( )
   r> dup /retained  r> execute         ( vadr )
;
: retained@ ( offset -- n ) retained + x@  ;
: retained! ( n offset -- ) retained + x!  ;

struct
h# 20 field >retained-name
h# 08 field >retained-base-pa
h# 08 field >retained-size
h# 08 field >retained-count
h# 08 field >retained-align
constant /retained-struct

: retained-base-pa@ ( adr -- pa.lo )  >retained-base-pa x@  ;
: retained-base-pa! ( pa.lo adr -- )  >retained-base-pa x!  ;

: retained-size@ ( adr -- size )  >retained-size x@  ;
: retained-size! ( size adr -- )  >retained-size x!  ;

: retained-count@ ( adr -- count )  >retained-count x@  ;
: retained-count! ( count adr -- )  >retained-count x!  ;

: retained-align@ ( adr -- align )  >retained-align x@  ;
: retained-align! ( align adr -- )  >retained-align x!  ;

: free-retained-slot ( offset -- )
   0 swap >retained-name x!
;

: retained-bounds ( -- end,start )
   retained  /retained /retained-struct /string  bounds
;
: find-free-retained-slot ( -- offset true | false )
   retained-bounds  ?do
      i >retained-name cstrlen  0=  if
         i  unloop true  exit
      then
   /retained-struct +loop  false
;

\
\ do not call this routine unless you are sure that physical memory
\ has been 'touched'.
\
: retained-commit-store ( -- )
   retained-phys                        ( pa.lo pa.hi size )
   >r retained-min-align s>d d- r>      ( pa.lo pa.hi size )
   touch-memory                         (  )
;

: claim-retained ( -- )
   retained-bounds  ?do                 (  )
      i retained-count@      if         (  )
         i retained-base-pa@  obmem     ( pa.lo pa.hi )
         i retained-size@               ( pa.lo pa.hi size )
         3dup touch-memory              ( pa.lo pa.hi size )
         0 mem-claim  2drop             (  )
      else                              (  )
         i free-retained-slot           (  )
      then                              (  )
   /retained-struct +loop               (  )
;

: mark-retained ( -- )
   retained-magic0 dup  h# 20 retained!
   -1 xor               h# 18 retained!
   retained-magic1 dup  h# 28 retained!
   -1 xor               h# 10 retained!
;

: init-retained ( por? -- )
  cpu-error-enable@ >r disable-cpu-errors               ( )
  if                                                    ( )
    ['] bzero-region  map-in-retained to retained       ( )
    mark-retained                                       ( )
  else                                                  ( )
    ['] btouch-region map-in-retained to retained       ( )
    h# 20 retained@ retained-magic0 =                   ( flag? )
    h# 28 retained@ retained-magic1 =  and              ( flag? )
    h# 20 retained@  -1 xor  h# 18 retained@ =  and     ( flag? )
    h# 10 retained@  -1 xor  h# 28 retained@ =  and  if ( )
       claim-retained                                   ( )
    else                                                ( )
       retained /retained bzero-region                  ( )
       mark-retained                                    ( )
    then                                                ( )
  then                                                  ( )
  cpu-afsr@ cpu-afsr! r> cpu-error-enable!              ( )
;

: $find-retained ( name$ -- offset true | false )
   retained-bounds  ?do
      2dup i >retained-name cscount $=  if  ( name$ )
         2drop  i  unloop true  exit
      then
   /retained-struct +loop  2drop false
;
: $release-retained ( name$ -- )
   $find-retained  if                   ( offset )
      >r                                (  )  ( r: offset )
      r@ retained-base-pa@  obmem       ( pa.lo pa.hi )
      r@ retained-size@                 ( pa.lo pa.hi size )
      \ Call platform hook to inform system controller, etc..
      release-retained-hook             ( pa.lo pa.hi size )
      mem-release                       (  )
      r>  free-retained-slot            (  )
   then
;

: $new-retained ( name$ size align -- )
   2dup 2>r  mem-claim  2r> 2swap  ( name$ size align pa.lo pa.hi )
   find-free-retained-slot  if     ( name$ size align pa.lo pa.hi offset )
      >r  drop                     ( name$ size align pa.lo ) ( r: offset )
      \ Call platform hook to inform system controller, etc..
      new-retained-hook            ( name$ size align pa.lo ) ( r: offset )
      r@ retained-base-pa!         ( name$ size align ) ( r: offset )
      r@ retained-align!           ( name$ size )       ( r: offset )
      r@ retained-size!            ( name$ )            ( r: offset )
      true r@ retained-count!      ( name$ )            ( r: offset )
      r> >retained-name swap cmove (  )
   else                            ( name$ size align pa.lo pa.hi )
      2>r drop 2r> rot mem-release ( name$ )
      2drop                        (  )
   then                            (  )
;

: alloc-retained ( name$ size align -- pa.lo pa.hi false  |  true )
   retained-min-align  round-up swap   ( name$ align' size )
   mmu-pagesize        round-up swap   ( name$ size' align' )

   2>r 2dup $find-retained  if  ( name$ offset ) ( r: size align )
      dup retained-size@     ( name$ offset osize ) ( r: size align )
      over retained-align@   ( name$ offset osize oalign ) ( r: size align )
      2r@  d=  if            ( name$ offset ) ( r: size align )
         \ prev size/align are same
         true over retained-count!      ( name$ offset ) ( r: size align )
         r>   over retained-align!      ( name$ offset ) ( r: size )
         r>   swap retained-size!       ( name$ )
      else                              ( name$ offset ) ( r: size align )
         \ prev size/align were different
         drop 2dup $release-retained    ( name$ )  ( r: size align )
         2dup 2r> $new-retained         ( name$ )
      then                              ( name$ )
   else                                 ( name$ ) ( r: size align )
      \ This is the first time for this name
      2dup 2r> $new-retained            ( name$ )
   then                                 ( name$ )
   $find-retained  if                   ( offset )
      retained-base-pa@ obmem  false    ( ok )
   else                                 (  )
      true                              ( failed )
   then  retained-commit-store          ( pa.lo pa.hi false | true )
;

\ Touch all of the retained memory regions so that pages are flushed
\ out of caches, done on reset-all
: btouch-retained-pages ( -- true | false )
   lock[  fpu-enable
   retained-bounds  ?do
     i >retained-name cstrlen 0<> if
        i retained-size@                        ( size )
        i retained-align@                       ( align )
        mmu-claim dup                           ( va va )
        i retained-base-pa@ 0                   ( va va pa.lo pa.hi )
        rot i retained-size@ -1                 ( va pa.lo pa.hi va size -1 )
        mmu-map                                 ( va )
        i retained-size@ 2dup                   ( va size va size )
        \ Try touching the retained region using block commit
        ['] btouch-region catch if              ( va size va size )
           \ Retained region inaccessible, invalidate it
           ?cr ." ERROR: Failed to block commit Retain memory region " cr
           ." ERROR: "
           i >retained-name cscount type        ( va size va size )
           ."  retained page is invalidated" cr ( va size va size )
           0 i retained-size!                   ( va size va size )
           nip i retained-base-pa@ 0 rot        ( va size pa.lo pa.hi size )
           \ Call platform hook to inform system controller, etc..
           release-retained-hook                ( va size pa.lo pa.hi size )
           3drop                                ( va size )
        then                                    ( va size )
        2dup mmu-unmap mmu-release              (  )
     then
   /retained-struct +loop

   \ Now btouch the retained OBP page itself
   retained /retained ['] btouch-region catch if
     \ Retained page used by OBP is inaccessible, invalidate it
     ?cr ." ERROR: Failed to block commit Retain page used by OpenBoot " cr
     ." ERROR: Retained pages will not be retained" cr ( va size )
     \ Invalidate all of the retained structures by corrupting the retain magic
     0 h# 20 retained!                          ( va size )
     2drop                                      (  )
     false                                      ( false )
   else
     true                                       ( true )
   then                                         ( r: tba )
   ]unlock
;

headers

" /memory" find-device
   caps @ caps off
   : SUNW,retain ( cname size align -- pa.lo pa.hi )
      ?dup  if                          ( cname size align )
         rot cscount 2swap              ( name$ size align )
         alloc-retained                 ( pa.lo pa.hi false | true )
      else                              ( cname pa.lo pa.hi size )
         \ Deprecate align=0 support
         true                           ( true )
      then  throw                       ( pa.lo pa.hi )
   ;
   : SUNW,free-retain ( cname -- )
      cscount $release-retained retained-commit-store
   ;
   caps !
device-end

stand-init: Init Retained memory
   disable-cpu-errors
   power-on-reset? init-retained
   enable-cpu-errors
;