[OpenSPARC-T2-SAM] / obp / obp / dev / ide / atapi / misc.fth

\ ========== Copyright Header Begin ==========================================
\ 
\ Hypervisor Software File: misc.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: @(#)misc.fth 1.3 07/06/14
purpose: 
copyright: Copyright 2007 Sun Microsystems, Inc.  All rights reserved.
copyright: Use is subject to license terms.

headerless

/xfer-pkt	instance buffer: atapi-pkt
d# 16		instance buffer: atapi-cmd
/xfer-pkt	instance buffer: req-pkt
d# 16		instance buffer: req-cmd
d# 40		instance buffer: req-buf
: erase-cdb ( -- ) d#   12 h#  0 fill ;

: run-command ( pkt type -- error? )
   over >xfer-type l!			( pkt )
   " run-command" $call-parent 		( error? )
;
: (run-atapi)	( pkt -- error? ) 1 run-command ;
: run-ata	( pkt -- error? ) 0 run-command ;

: long>cdb ( long cdb -- )  >r lbsplit r> 4 bounds do i c! loop ;

: request-sense ( buffer -- false|status,true )
   req-cmd erase-cdb			( buffer )
   req-cmd				( buffer cdb )
   3 over c! d# 18 over 4 + c!		( buffer cdb )
   h# 400 req-pkt set-pkt-data		( pkt )
   (run-atapi)				( [fail?] )
;

\
\ We define a new run-atapi to harden the interface a little and do
\ some error recovery - the parameters also change a little, this is
\ just to make error recovery simpler for devices using the I/F.
\
\ In order to handle devices that are returning NOT_READY/BECOMING_READY
\ correctly, instead of retrying immediately we now have an exponential
\ delay between command issues.  We start with a 1 second timeout and
\ double it each time resulting in a 1s+2s+4s+8s+16s=31s maximum
\ timeout before we exhaust our 5 retries.
\
: run-atapi ( pkt -- error? )
   \ 1s timeout:
   d# 1000 >r				( r: delay )
   #atapi-retries 0 			( pkt retries error? )
   begin  drop >r			( pkt ) ( r: delay retries )
      dup (run-atapi) dup  if		( pkt )
	 drop dup >status l@		( pkt status )
	 4 >> case
	    6  of	\ ATTENTION	( pkt )
	       req-buf request-sense	( pkt [false | status true] )
	       drop		( pkt )
	    endof
	    2  of	\ Not Ready	( pkt )
	       \ Delay a bit before retrying
	       r> dup 1 >  if		( pkt retries ) ( r: delay )
		  \ If this is the last try, do not delay.
		  r@ ms			( pkt retries ) ( r: delay )
	       then			( pkt retries ) ( r: delay )
	       \ Double next delay time
	       r> 2* >r >r		( pkt ) ( r: delay retries )
	    endof
	 endcase			( pkt )
         true				( pkt true )
      then				( pkt error? )
      r> 1- swap			( pkt retry? error? )
      2dup and				( pkt retry? error? ? )
   0=  until				( pkt retry? error? )
   >r 2drop r> r> drop			( error? )
;

: device-present? ( -- flag )
   atapi-cmd erase-cdb			( -- )
   0 atapi-cmd c!			( -- )
   0 atapi-cmd h# 200			( buffer cdb timeout )
   atapi-pkt set-pkt-data		( pkt )
   run-atapi 0=				( present? )
;
Commit	Line	Data
920dae64 AT	1	\ ========== Copyright Header Begin ==========================================
	2	\
	3	\ Hypervisor Software File: misc.fth
	4	\
	5	\ Copyright (c) 2006 Sun Microsystems, Inc. All Rights Reserved.
	6	\
	7	\ - Do no alter or remove copyright notices
	8	\
	9	\ - Redistribution and use of this software in source and binary forms, with
	10	\ or without modification, are permitted provided that the following
	11	\ conditions are met:
	12	\
	13	\ - Redistribution of source code must retain the above copyright notice,
	14	\ this list of conditions and the following disclaimer.
	15	\
	16	\ - Redistribution in binary form must reproduce the above copyright notice,
	17	\ this list of conditions and the following disclaimer in the
	18	\ documentation and/or other materials provided with the distribution.
	19	\
	20	\ Neither the name of Sun Microsystems, Inc. or the names of contributors
	21	\ may be used to endorse or promote products derived from this software
	22	\ without specific prior written permission.
	23	\
	24	\ This software is provided "AS IS," without a warranty of any kind.
	25	\ ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES,
	26	\ INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A
	27	\ PARTICULAR PURPOSE OR NON-INFRINGEMENT, ARE HEREBY EXCLUDED. SUN
	28	\ MICROSYSTEMS, INC. ("SUN") AND ITS LICENSORS SHALL NOT BE LIABLE FOR
	29	\ ANY DAMAGES SUFFERED BY LICENSEE AS A RESULT OF USING, MODIFYING OR
	30	\ DISTRIBUTING THIS SOFTWARE OR ITS DERIVATIVES. IN NO EVENT WILL SUN
	31	\ OR ITS LICENSORS BE LIABLE FOR ANY LOST REVENUE, PROFIT OR DATA, OR
	32	\ FOR DIRECT, INDIRECT, SPECIAL, CONSEQUENTIAL, INCIDENTAL OR PUNITIVE
	33	\ DAMAGES, HOWEVER CAUSED AND REGARDLESS OF THE THEORY OF LIABILITY,
	34	\ ARISING OUT OF THE USE OF OR INABILITY TO USE THIS SOFTWARE, EVEN IF
	35	\ SUN HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES.
	36	\
	37	\ You acknowledge that this software is not designed, licensed or
	38	\ intended for use in the design, construction, operation or maintenance of
	39	\ any nuclear facility.
	40	\
	41	\ ========== Copyright Header End ============================================
	42	id: @(#)misc.fth 1.3 07/06/14
	43	purpose:
	44	copyright: Copyright 2007 Sun Microsystems, Inc. All rights reserved.
	45	copyright: Use is subject to license terms.
	46
	47	headerless
	48
	49	/xfer-pkt instance buffer: atapi-pkt
	50	d# 16 instance buffer: atapi-cmd
	51	/xfer-pkt instance buffer: req-pkt
	52	d# 16 instance buffer: req-cmd
	53	d# 40 instance buffer: req-buf
	54	: erase-cdb ( -- ) d# 12 h# 0 fill ;
	55
	56	: run-command ( pkt type -- error? )
	57	over >xfer-type l! ( pkt )
	58	" run-command" $call-parent ( error? )
	59	;
	60	: (run-atapi) ( pkt -- error? ) 1 run-command ;
	61	: run-ata ( pkt -- error? ) 0 run-command ;
	62
	63	: long>cdb ( long cdb -- ) >r lbsplit r> 4 bounds do i c! loop ;
	64
65	: request-sense ( buffer -- false\|status,true )
66	req-cmd erase-cdb ( buffer )
67	req-cmd ( buffer cdb )
68	3 over c! d# 18 over 4 + c! ( buffer cdb )
69	h# 400 req-pkt set-pkt-data ( pkt )
70	(run-atapi) ( [fail?] )
71	;
72
73	\
74	\ We define a new run-atapi to harden the interface a little and do
75	\ some error recovery - the parameters also change a little, this is
76	\ just to make error recovery simpler for devices using the I/F.
77	\
78	\ In order to handle devices that are returning NOT_READY/BECOMING_READY
79	\ correctly, instead of retrying immediately we now have an exponential
80	\ delay between command issues. We start with a 1 second timeout and
81	\ double it each time resulting in a 1s+2s+4s+8s+16s=31s maximum
82	\ timeout before we exhaust our 5 retries.
83	\
84	: run-atapi ( pkt -- error? )
85	\ 1s timeout:
86	d# 1000 >r ( r: delay )
87	#atapi-retries 0 ( pkt retries error? )
88	begin drop >r ( pkt ) ( r: delay retries )
89	dup (run-atapi) dup if ( pkt )
90	drop dup >status l@ ( pkt status )
91	4 >> case
92	6 of \ ATTENTION ( pkt )
93	req-buf request-sense ( pkt [false \| status true] )
94	drop ( pkt )
95	endof
96	2 of \ Not Ready ( pkt )
97	\ Delay a bit before retrying
98	r> dup 1 > if ( pkt retries ) ( r: delay )
99	\ If this is the last try, do not delay.
100	r@ ms ( pkt retries ) ( r: delay )
101	then ( pkt retries ) ( r: delay )
102	\ Double next delay time
103	r> 2* >r >r ( pkt ) ( r: delay retries )
104	endof
105	endcase ( pkt )
106	true ( pkt true )
107	then ( pkt error? )
108	r> 1- swap ( pkt retry? error? )
109	2dup and ( pkt retry? error? ? )
110	0= until ( pkt retry? error? )
111	>r 2drop r> r> drop ( error? )
112	;
113
114	: device-present? ( -- flag )
115	atapi-cmd erase-cdb ( -- )
116	0 atapi-cmd c! ( -- )
117	0 atapi-cmd h# 200 ( buffer cdb timeout )
118	atapi-pkt set-pkt-data ( pkt )
119	run-atapi 0= ( present? )
120	;
121