Root/arch/s390/kernel/sclp.S

1/*
2 * Mini SCLP driver.
3 *
4 * Copyright IBM Corp. 2004,2009
5 *
6 * Author(s): Peter Oberparleiter <Peter.Oberparleiter@de.ibm.com>,
7 * Heiko Carstens <heiko.carstens@de.ibm.com>,
8 *
9 */
10
11LC_EXT_NEW_PSW = 0x58 # addr of ext int handler
12LC_EXT_NEW_PSW_64 = 0x1b0 # addr of ext int handler 64 bit
13LC_EXT_INT_PARAM = 0x80 # addr of ext int parameter
14LC_EXT_INT_CODE = 0x86 # addr of ext int code
15LC_AR_MODE_ID = 0xa3
16
17#
18# Subroutine which waits synchronously until either an external interruption
19# or a timeout occurs.
20#
21# Parameters:
22# R2 = 0 for no timeout, non-zero for timeout in (approximated) seconds
23#
24# Returns:
25# R2 = 0 on interrupt, 2 on timeout
26# R3 = external interruption parameter if R2=0
27#
28
29_sclp_wait_int:
30    stm %r6,%r15,24(%r15) # save registers
31    basr %r13,0 # get base register
32.LbaseS1:
33    ahi %r15,-96 # create stack frame
34    la %r8,LC_EXT_NEW_PSW # register int handler
35    la %r9,.LextpswS1-.LbaseS1(%r13)
36#ifdef CONFIG_64BIT
37    tm LC_AR_MODE_ID,1
38    jno .Lesa1
39    la %r8,LC_EXT_NEW_PSW_64 # register int handler 64 bit
40    la %r9,.LextpswS1_64-.LbaseS1(%r13)
41.Lesa1:
42#endif
43    mvc .LoldpswS1-.LbaseS1(16,%r13),0(%r8)
44    mvc 0(16,%r8),0(%r9)
45    lhi %r6,0x0200 # cr mask for ext int (cr0.54)
46    ltr %r2,%r2
47    jz .LsetctS1
48    ahi %r6,0x0800 # cr mask for clock int (cr0.52)
49    stck .LtimeS1-.LbaseS1(%r13) # initiate timeout
50    al %r2,.LtimeS1-.LbaseS1(%r13)
51    st %r2,.LtimeS1-.LbaseS1(%r13)
52    sckc .LtimeS1-.LbaseS1(%r13)
53
54.LsetctS1:
55    stctl %c0,%c0,.LctlS1-.LbaseS1(%r13) # enable required interrupts
56    l %r0,.LctlS1-.LbaseS1(%r13)
57    lhi %r1,~(0x200 | 0x800) # clear old values
58    nr %r1,%r0
59    or %r1,%r6 # set new value
60    st %r1,.LctlS1-.LbaseS1(%r13)
61    lctl %c0,%c0,.LctlS1-.LbaseS1(%r13)
62    st %r0,.LctlS1-.LbaseS1(%r13)
63    lhi %r2,2 # return code for timeout
64.LloopS1:
65    lpsw .LwaitpswS1-.LbaseS1(%r13) # wait until interrupt
66.LwaitS1:
67    lh %r7,LC_EXT_INT_CODE
68    chi %r7,0x1004 # timeout?
69    je .LtimeoutS1
70    chi %r7,0x2401 # service int?
71    jne .LloopS1
72    sr %r2,%r2
73    l %r3,LC_EXT_INT_PARAM
74.LtimeoutS1:
75    lctl %c0,%c0,.LctlS1-.LbaseS1(%r13) # restore interrupt setting
76    # restore old handler
77    mvc 0(16,%r8),.LoldpswS1-.LbaseS1(%r13)
78    lm %r6,%r15,120(%r15) # restore registers
79    br %r14 # return to caller
80
81    .align 8
82.LoldpswS1:
83    .long 0, 0, 0, 0 # old ext int PSW
84.LextpswS1:
85    .long 0x00080000, 0x80000000+.LwaitS1 # PSW to handle ext int
86#ifdef CONFIG_64BIT
87.LextpswS1_64:
88    .quad 0x0000000180000000, .LwaitS1 # PSW to handle ext int, 64 bit
89#endif
90.LwaitpswS1:
91    .long 0x010a0000, 0x00000000+.LloopS1 # PSW to wait for ext int
92.LtimeS1:
93    .quad 0 # current time
94.LctlS1:
95    .long 0 # CT0 contents
96
97#
98# Subroutine to synchronously issue a service call.
99#
100# Parameters:
101# R2 = command word
102# R3 = sccb address
103#
104# Returns:
105# R2 = 0 on success, 1 on failure
106# R3 = sccb response code if R2 = 0
107#
108
109_sclp_servc:
110    stm %r6,%r15,24(%r15) # save registers
111    ahi %r15,-96 # create stack frame
112    lr %r6,%r2 # save command word
113    lr %r7,%r3 # save sccb address
114.LretryS2:
115    lhi %r2,1 # error return code
116    .insn rre,0xb2200000,%r6,%r7 # servc
117    brc 1,.LendS2 # exit if not operational
118    brc 8,.LnotbusyS2 # go on if not busy
119    sr %r2,%r2 # wait until no longer busy
120    bras %r14,_sclp_wait_int
121    j .LretryS2 # retry
122.LnotbusyS2:
123    sr %r2,%r2 # wait until result
124    bras %r14,_sclp_wait_int
125    sr %r2,%r2
126    lh %r3,6(%r7)
127.LendS2:
128    lm %r6,%r15,120(%r15) # restore registers
129    br %r14
130
131#
132# Subroutine to set up the SCLP interface.
133#
134# Parameters:
135# R2 = 0 to activate, non-zero to deactivate
136#
137# Returns:
138# R2 = 0 on success, non-zero on failure
139#
140
141_sclp_setup:
142    stm %r6,%r15,24(%r15) # save registers
143    ahi %r15,-96 # create stack frame
144    basr %r13,0 # get base register
145.LbaseS3:
146    l %r6,.LsccbS0-.LbaseS3(%r13) # prepare init mask sccb
147    mvc 0(.LinitendS3-.LinitsccbS3,%r6),.LinitsccbS3-.LbaseS3(%r13)
148    ltr %r2,%r2 # initialization?
149    jz .LdoinitS3 # go ahead
150    # clear masks
151    xc .LinitmaskS3-.LinitsccbS3(8,%r6),.LinitmaskS3-.LinitsccbS3(%r6)
152.LdoinitS3:
153    l %r2,.LwritemaskS3-.LbaseS3(%r13)# get command word
154    lr %r3,%r6 # get sccb address
155    bras %r14,_sclp_servc # issue service call
156    ltr %r2,%r2 # servc successful?
157    jnz .LerrorS3
158    chi %r3,0x20 # write mask successful?
159    jne .LerrorS3
160    # check masks
161    la %r2,.LinitmaskS3-.LinitsccbS3(%r6)
162    l %r1,0(%r2) # receive mask ok?
163    n %r1,12(%r2)
164    cl %r1,0(%r2)
165    jne .LerrorS3
166    l %r1,4(%r2) # send mask ok?
167    n %r1,8(%r2)
168    cl %r1,4(%r2)
169    sr %r2,%r2
170    je .LendS3
171.LerrorS3:
172    lhi %r2,1 # error return code
173.LendS3:
174    lm %r6,%r15,120(%r15) # restore registers
175    br %r14
176.LwritemaskS3:
177    .long 0x00780005 # SCLP command for write mask
178.LinitsccbS3:
179    .word .LinitendS3-.LinitsccbS3
180    .byte 0,0,0,0
181    .word 0
182    .word 0
183    .word 4
184.LinitmaskS3:
185    .long 0x80000000
186    .long 0x40000000
187    .long 0
188    .long 0
189.LinitendS3:
190
191#
192# Subroutine which prints a given text to the SCLP console.
193#
194# Parameters:
195# R2 = address of nil-terminated ASCII text
196#
197# Returns:
198# R2 = 0 on success, 1 on failure
199#
200
201_sclp_print:
202    stm %r6,%r15,24(%r15) # save registers
203    ahi %r15,-96 # create stack frame
204    basr %r13,0 # get base register
205.LbaseS4:
206    l %r8,.LsccbS0-.LbaseS4(%r13) # prepare write data sccb
207    mvc 0(.LmtoS4-.LwritesccbS4,%r8),.LwritesccbS4-.LbaseS4(%r13)
208    la %r7,.LmtoS4-.LwritesccbS4(%r8) # current mto addr
209    sr %r0,%r0
210    l %r10,.Lascebc-.LbaseS4(%r13) # address of translation table
211.LinitmtoS4:
212    # initialize mto
213    mvc 0(.LmtoendS4-.LmtoS4,%r7),.LmtoS4-.LbaseS4(%r13)
214    lhi %r6,.LmtoendS4-.LmtoS4 # current mto length
215.LloopS4:
216    ic %r0,0(%r2) # get character
217    ahi %r2,1
218    ltr %r0,%r0 # end of string?
219    jz .LfinalizemtoS4
220    chi %r0,0x15 # end of line (NL)?
221    jz .LfinalizemtoS4
222    stc %r0,0(%r6,%r7) # copy to mto
223    la %r11,0(%r6,%r7)
224    tr 0(1,%r11),0(%r10) # translate to EBCDIC
225    ahi %r6,1
226    j .LloopS4
227.LfinalizemtoS4:
228    sth %r6,0(%r7) # update mto length
229    lh %r9,.LmdbS4-.LwritesccbS4(%r8) # update mdb length
230    ar %r9,%r6
231    sth %r9,.LmdbS4-.LwritesccbS4(%r8)
232    lh %r9,.LevbufS4-.LwritesccbS4(%r8)# update evbuf length
233    ar %r9,%r6
234    sth %r9,.LevbufS4-.LwritesccbS4(%r8)
235    lh %r9,0(%r8) # update sccb length
236    ar %r9,%r6
237    sth %r9,0(%r8)
238    ar %r7,%r6 # update current mto address
239    ltr %r0,%r0 # more characters?
240    jnz .LinitmtoS4
241    l %r2,.LwritedataS4-.LbaseS4(%r13)# write data
242    lr %r3,%r8
243    bras %r14,_sclp_servc
244    ltr %r2,%r2 # servc successful?
245    jnz .LendS4
246    chi %r3,0x20 # write data successful?
247    je .LendS4
248    lhi %r2,1 # error return code
249.LendS4:
250    lm %r6,%r15,120(%r15) # restore registers
251    br %r14
252
253#
254# Function which prints a given text to the SCLP console.
255#
256# Parameters:
257# R2 = address of nil-terminated ASCII text
258#
259# Returns:
260# R2 = 0 on success, 1 on failure
261#
262
263    .globl _sclp_print_early
264_sclp_print_early:
265    stm %r6,%r15,24(%r15) # save registers
266    ahi %r15,-96 # create stack frame
267#ifdef CONFIG_64BIT
268    tm LC_AR_MODE_ID,1
269    jno .Lesa2
270    ahi %r15,-80
271    stmh %r6,%r15,96(%r15) # store upper register halves
272.Lesa2:
273#endif
274    lr %r10,%r2 # save string pointer
275    lhi %r2,0
276    bras %r14,_sclp_setup # enable console
277    ltr %r2,%r2
278    jnz .LendS5
279    lr %r2,%r10
280    bras %r14,_sclp_print # print string
281    ltr %r2,%r2
282    jnz .LendS5
283    lhi %r2,1
284    bras %r14,_sclp_setup # disable console
285.LendS5:
286#ifdef CONFIG_64BIT
287    tm LC_AR_MODE_ID,1
288    jno .Lesa3
289    lmh %r6,%r15,96(%r15) # store upper register halves
290    ahi %r15,80
291.Lesa3:
292#endif
293    lm %r6,%r15,120(%r15) # restore registers
294    br %r14
295
296.LwritedataS4:
297    .long 0x00760005 # SCLP command for write data
298.LwritesccbS4:
299    # sccb
300    .word .LmtoS4-.LwritesccbS4
301    .byte 0
302    .byte 0,0,0
303    .word 0
304
305    # evbuf
306.LevbufS4:
307    .word .LmtoS4-.LevbufS4
308    .byte 0x02
309    .byte 0
310    .word 0
311
312.LmdbS4:
313    # mdb
314    .word .LmtoS4-.LmdbS4
315    .word 1
316    .long 0xd4c4c240
317    .long 1
318
319    # go
320.LgoS4:
321    .word .LmtoS4-.LgoS4
322    .word 1
323    .long 0
324    .byte 0,0,0,0,0,0,0,0
325    .byte 0,0,0
326    .byte 0
327    .byte 0,0,0,0,0,0,0
328    .byte 0
329    .word 0
330    .byte 0,0,0,0,0,0,0,0,0,0
331    .byte 0,0,0,0,0,0,0,0
332    .byte 0,0,0,0,0,0,0,0
333
334.LmtoS4:
335    .word .LmtoendS4-.LmtoS4
336    .word 4
337    .word 0x1000
338    .byte 0
339    .byte 0,0,0
340.LmtoendS4:
341
342    # Global constants
343.LsccbS0:
344    .long _sclp_work_area
345.Lascebc:
346    .long _ascebc
347
348.section .data,"aw",@progbits
349    .balign 4096
350_sclp_work_area:
351    .fill 4096
352.previous
353

Archive Download this file



interactive