summaryrefslogtreecommitdiffstats
path: root/arch/s390/boot/ipleckd.S
blob: 63b0330b22d1e8b3f0676f72dbf7bfab2579e8ba (plain)
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
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
#
#  arch/s390/boot/ipleckd.S
#    IPL record for 3380/3390 DASD
#
#  S390 version
#    Copyright (C) 1999 IBM Deutschland Entwicklung GmbH, IBM Corporation
#    Author(s): Holger Smolinski <Holger.Smolinski@de.ibm.com>
#
#
# FIXME:	 should use the countarea to determine the blocksize
# FIXME:	 should insert zeroes into memory when filling holes
# FIXME:	 calculate blkpertrack from rdc data and blksize

# Usage of registers
# r1:	ipl subchannel ( general use, dont overload without save/restore !)
# r10:
# r13:	base register 	index to 0x0000
# r14:	callers address
# r15:	temporary save register (we have no stack!)

# storage layout:

#include <asm/lowcore.h>
	
	.org 0
.psw:	.long 0x00080000,0x80000000+_start
.ccw1:	.long 0x06000000,0x00001000     # Re-Read enough of bootsector to start
.ccw2:	.long 0x00000000,0x00000000	# read countarea of record 1 to s/w.

	.org 0x58
.Lextn:	.long	0x000a0000,0x00000000+.Lextn
.Lsvcn:	.long	0x000a0000,0x00000000+.Lsvcn
.Lprgn:	.long	0x00080000,0x00000000+.Lecs
.Lmcn:	.long	0x000a0000,0x00000000+.Lmcn
.Lion:	.long   0x00080000,0x80000000+.Lionewaddr

	.org 0xe0
.Llstad:.long 	0x00000000,0x00000000	# sectorno + ct of bootlist

	.org 0xf0			# Lets start now...
_start: .globl _start
	l  	%r1,__LC_SUBCHANNEL_ID  # get IPL-subchannel from lowcore
	st	%r1,__LC_IPLDEV         # keep it for reipl
	stsch	.Lrdcdata
	oi      .Lrdcdata+5,0x84        # enable ssch and multipath mode
.Lecs:  xi	.Lrdcdata+27,0x01	# enable concurrent sense
	msch	.Lrdcdata	
        xi      .Lprgn,6                # restore Wait and d/a bit in PCnew PSW
	l	%r2,.Lparm
	mvc     0x0(8,%r2),.Lnull       # set parmarea to null
	lctl	%c6,%c6,.Lc6     	# enable all interrupts
.Lrdc:					# read device characteristics
	la	%r6,.Lrdcccw     
	st      %r6,.Lorb+8		# store cp-address to orb
	bras    %r15,.Lssch		# start I/O
	oi	.Llodata+1,0x80
	lh	%r5,.Lcountarea+6	# init r5 from countarea
	stcm	%r5,3,.Lrdccw+2		# and store into rd template *FIXME*
	stcm	%r5,3,.Llodata+14	# and store into lodata *FIXME*
.Lbootlist:	
	l	%r2,.Llstad	
	l	%r3,.Lblklst     
	lhi	%r4,1
	bras	%r14,.Lreadblks
.Lloader:	
	l	%r10,.Lblklst     	# r10 is index to bootlist
	lhi	%r5,4			# r5:	skip 4 blocks = firstpage....
.Lkloop:
	clc	.Lnull(8),0(%r10)	# test blocklist	
	jz	.Lchkparm		# end of list?
	l	%r2,0(%r10)		# get startblock to r2
	slr	%r4,%r4			# erase r4
	icm	%r4,1,7(%r10)		# get blockcount
	slr	%r3,%r3			# get address to r3
	icm 	%r3,0xe,4(%r10)
	chi	%r5,0			# still blocks to skip?
	jz	.Ldoread		# no: start reading
	cr	%r5,%r4			# #skipblocks >= blockct?
	jm	.L007			# no: skip the blocks one by one
.L006:	
	sr	%r5,%r4			# decrease number of blocks to skip
	j	.Lkcont			# advance to next entry
.L007:	
	ahi	%r2,1			# skip 1 block...
	bctr    %r4,0                   # update blockct
	ah	%r3,.Lcountarea+6       # increment address
	bct	%r5,.L007		# 4 blocks skipped?
.Ldoread:
	ltr	%r2,%r2			# test startblock
	jz	.Lzeroes		# startblocks is zero (hole)
.Ldiskread:	
	bras	%r14,.Lreadblks
	j	.Lkcont
.Lzeroes:
	lr	%r2,%r3
.L001:	slr	%r3,%r3
	icm	%r3,3,.Lcountarea+6     # get blocksize
	slr	%r5,%r5			# no bytes to move
.L008:	mvcle	%r2,%r4,0   		# fill zeroes to storage
	jo	.L008			# until block is filled
	brct	%r4,.L001   		# skip to next block
.Lkcont:	
	ahi	%r10,8
	j	.Lkloop
.Lchkparm:
	lm	%r3,%r4,.Lstart         # load .Lstart and .Lparm
	clc	0x0(4,%r4),.Lnull     
	je	.Lrunkern
	mvc	0x480(128,%r3),0(%r4)	# move 1k-0x80 to parmarea
	mvc	0x500(256,%r3),0x80(%r4)
	mvc	0x600(256,%r3),0x180(%r4)
	mvc	0x700(256,%r3),0x280(%r4)
.Lrunkern:
	lhi	%r2,17
	sll	%r2,12
	st	%r1,0xc6c(%r2)		# store iplsubchannel to lowcore
	st	%r1,0xc6c		# store iplsubchannel to lowcore
	br	%r3
# This function does the start IO
# r2:	number of first block to read ( input by caller )
# r3:	address to read data to ( input by caller )
# r4:	number of blocks to read ( input by caller )
# r5:	destroyed
# r6:	blocks per track ( input by caller )
# r7:	number of heads 
# r8:	
# r9:	
# r10:	
# r11:	temporary register
# r12:	local use for base address
# r13:	base address for module
# r14:	address of caller for subroutine
# r15:	temporary save register (since we have no stack)
.Lreadblks:
	la	%r12,.Ldeccw     
	st	%r12,8+.Lorb		# store cpaddr to orb
	ahi	%r12,0x10		# increment r12 to point to rdccw
	oi	1(%r12),0x40		# set CC in rd template
	# first setup the read CCWs
	lr	%r15,%r4		# save number or blocks
	slr	%r7,%r7
	icm	%r7,3,.Lrdcdata+14      # load heads to r7
	clc	.Lrdcdata+3(2),.L3390     
	jne	.L010			# 3380 or 3390 ?
	lhi	%r6,12			# setup r6 correct!
	j	.L011
.L010:	
        clc     .Lrdcdata+3(2),.L9343
        jne     .L013
        lhi     %r6,9
        j       .L011
.L013:
	lhi	%r6,10	
.L011:	
	# loop for nbl times
.Lrdloop:	
	mvc	0(8,%r12),.Lrdccw     	# copy template to this ccw
	st	%r3,4(%r12)		# store target address to this ccw
	bct	%r4,.L005		# decrement no of blks still to do
	ni	1(%r12),0x3f		# delete CC from last ccw
	lr	%r4,%r15		# restore number of blocks
	# read CCWs are setup now		
	stcm	%r4,3,.Llodata+2     	# store blockno to lodata clears r4
	ar	%r4,%r2			# r4 (clear): ebl = blk + nbl
	bctr    %r4,0			# decrement r4 ( last blk touched 
	srda	%r2,32			# trk = blk / bpt, bot = blk % bpt 
	dr	%r2,%r6			# r3: trk, r2: bot
	ahi	%r2,1			# bot++ ( we start counting at 1 )
	stcm	%r2,1,.Llodata+12     	# store bot to lodata
	xr 	%r2,%r2			# cy  = trk / heads, hd  = trk % heads
	dr	%r2,%r7			# r3: cy, r2: hd
	sll	%r3,16			# combine to CCHH in r3
	or	%r3,%r2
	st	%r3,.Ldedata+8     	# store cchh to dedata	
	st	%r3,.Llodata+4     	# store cchh to lodata	
	st	%r3,.Llodata+8     	# store cchh to lodata	
	lr	%r15,%r5		# save r5
	srda	%r4,32			# tr2 = ebl / bpt
	dr	%r4,%r6			# r5: tr2, r4: bot2
	xr 	%r4,%r4			# cy2 = tr2 / heads, hd2 = hd2 % heads
	dr	%r4,%r7			# r5: cy2, r4: hd2 
	stcm	%r5,3,.Ldedata+12     	# store cy2,hd2 to dedata
	stcm	%r4,3,.Ldedata+14     	# store cy2,hd2 to dedata
	lr	%r5,%r15		# restore r5
	# CCWs are setup now, arent they?
	bras	%r15,.Lssch		# start I/O
	br	%r14			# return to caller
.L005:	
	ah 	%r3,.Lcountarea+6     	# add blocksize to target address
	ahi	%r12,8			# add sizeof(ccw) to base address
	j	.Lrdloop
# end of function
# This function does the start IO
# r1:	Subchannel number
# r8:	ORB address
# r9:	IRB address
.Lssch:
	lhi     %r13,10			# initialize retries
.L012:	
	ssch	.Lorb			# start I/O
	jz	.Ltpi			# ok?
	bras	%r14,.Ldisab		# error
.Ltpi:	
	lpsw	.Lwaitpsw     		# load wait-PSW
.Lionewaddr:	
	c	%r1,0xb8     		# compare to ipl subhchannel
	jnz	.Ltpi			# not equal: loop
	clc	0xbc(4),.Lorb 		# cross check the intparm
	jnz	.Ltpi               	# not equal:	loop 
	tsch    .Lirb			# get status
	tm	.Lirb+9,0xff		# channel status ?
	jz	.L003			# CS == 0x00
	bras	%r14,.Ldisab		# error
.L003:
	tm	.Lirb+8,0xf3		# DS different from CE/DE
	jz	.L004			# ok ?
	bct	%r13,.L012		# retries <= 5 ?
	bras	%r14,.Ldisab		# error
.L004:
	tm	.Lirb+8,0x04		# DE set?
	jz	.Ltpi			# DE not set, loop
.Lsschend:
	br	%r15			# return to caller
# end of function
# In case of error goto disabled wait with %r14 containing the caller
.Ldisab:
	st	%r14,.Ldisabpsw+4     
	lpsw	.Ldisabpsw     

# FIXME pre-initialized data should be listed first
# NULLed storage can be taken from anywhere ;) 
.Lblklst:	
	.long   0x00002000     
	.align 8
.Ldisabpsw: 
	.long 0x000a0000,0x00000000
.Lwaitpsw:
	.long 0x020a0000,0x00000000+.Ltpi
.Lorb:	
	.long 0x0049504c,0x0080ff00	# intparm is " IPL"
.Lc6:	.long 0xff000000
.Lstart:
	.long	0x00010000              # do not separate .Lstart and .Lparm
.Lparm:	
	.long	0x00008000              # they are loaded with a LM
.L3390:
	.word 	0x3390
.L9343:
	.word	0x9343
.Lnull:	
	.long 0x00000000,0x00000000
.Lrdcdata:
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
.Lirb:
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
	.long 0x00000000,0x00000000
.Lcountarea:	
	.word 0x0000			# cyl;
	.word 0x0000			# head;
	.byte 0x00			# record;
	.byte 0x00			# key length;
	.word 0x0000			# data length == blocksize;
.Ldedata:
	.long 0x40c00000,0x00000000
	.long 0x00000000,0x00000000
.Llodata:
	.long 0x06000001,0x00000000
	.long 0x00000000,0x01000000
	.long 0x12345678
	.org 0x7c8
.Lrdcccw:				# CCW read device characteristics
	.long 0x64400040,0x00000000+.Lrdcdata
	.long 0x63400010,0x00000000+.Ldedata
	.long 0x47400010,0x00000000+.Llodata
	.long 0x12000008,0x00000000+.Lcountarea
.Ldeccw:
	.long 0x63400010,0x00000000+.Ldedata
.Lloccw:
	.long 0x47400010,0x00000000+.Llodata
.Lrdccw:	
	.long 0x86400000,0x00000000
	.org 0x800
# end of pre initialized data is here CCWarea follows
# from here we load 1k blocklist 
# end of function