| 1 | /* SPDX-License-Identifier: GPL-2.0 */
|
| 2 | /*
|
| 3 | * Code that needs to run below 2 GB.
|
| 4 | *
|
| 5 | * Copyright IBM Corp. 2019
|
| 6 | */
|
| 7 |
|
| 8 | |
| 9 | |
| 10 | |
| 11 | |
| 12 | |
| 13 |
|
| 14 | .section .amode31.text,"ax"
|
| 15 | /*
|
| 16 | * Simplified version of expoline thunk. The normal thunks can not be used here,
|
| 17 | * because they might be more than 2 GB away, and not reachable by the relative
|
| 18 | * branch. No comdat, exrl, etc. optimizations used here, because it only
|
| 19 | * affects a few functions that are not performance-relevant.
|
| 20 | */
|
| 21 | .macro BR_EX_AMODE31_r14
|
| 22 | exrl 0,555f
|
| 23 | j .
|
| 24 | 555: br %r14
|
| 25 | .endm
|
| 26 |
|
| 27 | /*
|
| 28 | * int _diag14_amode31(unsigned long rx, unsigned long ry1, unsigned long subcode)
|
| 29 | */
|
| 30 | SYM_TYPED_FUNC_START(_diag14_amode31)
|
| 31 | lgr %r1,%r2
|
| 32 | lgr %r2,%r3
|
| 33 | lgr %r3,%r4
|
| 34 | lhi %r5,-EIO
|
| 35 | sam31
|
| 36 | 0: diag %r1,%r2,0x14
|
| 37 | ipm %r5
|
| 38 | srl %r5,28
|
| 39 | 1: sam64
|
| 40 | lgfr %r2,%r5
|
| 41 | BR_EX_AMODE31_r14
|
| 42 | EX_TABLE_INSN_AMODE31(0b, 1b)
|
| 43 | SYM_FUNC_END(_diag14_amode31)
|
| 44 |
|
| 45 | /*
|
| 46 | * int _diag210_amode31(struct diag210 *addr)
|
| 47 | */
|
| 48 | SYM_TYPED_FUNC_START(_diag210_amode31)
|
| 49 | lgr %r1,%r2
|
| 50 | lhi %r2,-1
|
| 51 | sam31
|
| 52 | 0: diag %r1,%r0,0x210
|
| 53 | ipm %r2
|
| 54 | srl %r2,28
|
| 55 | 1: sam64
|
| 56 | lgfr %r2,%r2
|
| 57 | BR_EX_AMODE31_r14
|
| 58 | EX_TABLE_INSN_AMODE31(0b, 1b)
|
| 59 | SYM_FUNC_END(_diag210_amode31)
|
| 60 |
|
| 61 | /*
|
| 62 | * int diag8c(struct diag8c *addr, struct ccw_dev_id *devno, size_t len)
|
| 63 | */
|
| 64 | SYM_TYPED_FUNC_START(_diag8c_amode31)
|
| 65 | llgf %r3,0(%r3)
|
| 66 | sam31
|
| 67 | 0: diag %r2,%r4,0x8c
|
| 68 | 1: sam64
|
| 69 | lgfr %r2,%r3
|
| 70 | BR_EX_AMODE31_r14
|
| 71 | EX_TABLE_INSN_AMODE31(0b, 1b)
|
| 72 | SYM_FUNC_END(_diag8c_amode31)
|
| 73 | /*
|
| 74 | * int _diag26c_amode31(void *req, void *resp, enum diag26c_sc subcode)
|
| 75 | */
|
| 76 | SYM_TYPED_FUNC_START(_diag26c_amode31)
|
| 77 | lghi %r5,-EOPNOTSUPP
|
| 78 | sam31
|
| 79 | 0: diag %r2,%r4,0x26c
|
| 80 | 1: sam64
|
| 81 | lgfr %r2,%r5
|
| 82 | BR_EX_AMODE31_r14
|
| 83 | EX_TABLE_INSN_AMODE31(0b, 1b)
|
| 84 | SYM_FUNC_END(_diag26c_amode31)
|
| 85 |
|
| 86 | /*
|
| 87 | * void _diag0c_amode31(unsigned long rx)
|
| 88 | */
|
| 89 | SYM_TYPED_FUNC_START(_diag0c_amode31)
|
| 90 | sam31
|
| 91 | diag %r2,%r2,0x0c
|
| 92 | sam64
|
| 93 | BR_EX_AMODE31_r14
|
| 94 | SYM_FUNC_END(_diag0c_amode31)
|
| 95 |
|
| 96 | /*
|
| 97 | * void _diag308_reset_amode31(void)
|
| 98 | *
|
| 99 | * Calls diag 308 subcode 1 and continues execution
|
| 100 | */
|
| 101 | SYM_TYPED_FUNC_START(_diag308_reset_amode31)
|
| 102 | larl %r4,ctlregs |
| 103 | stctg %c0,%c15,0(%r4)
|
| 104 | lg %r2,0(%r4) |
| 105 | nilh %r2,0xefff
|
| 106 | larl %r4,ctlreg0
|
| 107 | stg %r2,0(%r4)
|
| 108 | lctlg %c0,%c0,0(%r4)
|
| 109 | larl %r4,fpctl |
| 110 | stfpc 0(%r4)
|
| 111 | larl %r4,prefix |
| 112 | stpx 0(%r4)
|
| 113 | larl %r4,prefix_zero |
| 114 | spx 0(%r4)
|
| 115 | larl %r4,continue_psw |
| 116 | epsw %r2,%r3
|
| 117 | stm %r2,%r3,0(%r4)
|
| 118 | larl %r4,.Lrestart_part2 |
| 119 | larl %r3,restart_diag308_psw
|
| 120 | og %r4,0(%r3) |
| 121 | lghi %r3,0
|
| 122 | sturg %r4,%r3 |
| 123 | lghi %r1,1
|
| 124 | lghi %r0,0
|
| 125 | diag %r0,%r1,0x308
|
| 126 | .Lrestart_part2:
|
| 127 | lhi %r0,0 |
| 128 | lhi %r1,2 |
| 129 | sigp %r1,%r0,SIGP_SET_ARCHITECTURE |
| 130 | sam64 |
| 131 | larl %r4,ctlregs |
| 132 | lctlg %c0,%c15,0(%r4)
|
| 133 | larl %r4,fpctl |
| 134 | lfpc 0(%r4)
|
| 135 | larl %r4,prefix |
| 136 | spx 0(%r4)
|
| 137 | larl %r4,continue_psw |
| 138 | larl %r2,.Lcontinue
|
| 139 | stg %r2,8(%r4)
|
| 140 | lpswe 0(%r4)
|
| 141 | .Lcontinue:
|
| 142 | BR_EX_AMODE31_r14
|
| 143 | SYM_FUNC_END(_diag308_reset_amode31)
|
| 144 |
|
| 145 | .section .amode31.data,"aw",@progbits
|
| 146 | .balign 8
|
| 147 | SYM_DATA_LOCAL(restart_diag308_psw, .long 0x00080000,0x80000000)
|
| 148 | SYM_DATA_LOCAL(continue_psw, .quad 0,0)
|
| 149 | SYM_DATA_LOCAL(ctlreg0, .quad 0)
|
| 150 | SYM_DATA_LOCAL(ctlregs, .fill 16,8,0)
|
| 151 | SYM_DATA_LOCAL(fpctl, .long 0)
|
| 152 | SYM_DATA_LOCAL(prefix, .long 0)
|
| 153 | SYM_DATA_LOCAL(prefix_zero, .long 0)
|