0001
0002
0003
0004
0005
0006
0007
0008
0009
0010 #include <linux/linkage.h>
0011 #include <asm/asm-offsets.h>
0012 #include <asm/page.h>
0013 #include <asm/sigp.h>
0014 #include <asm/ptrace.h>
0015
0016
0017
0018
0019
0020
0021
0022
0023
0024
0025
0026
0027
0028
0029
0030
0031
0032
0033
0034 #define bufsz purgatory_end-stack
0035
0036 .macro MEMCPY dst,src,len
0037 lgr %r0,\dst
0038 lgr %r1,\len
0039 lgr %r2,\src
0040 lgr %r3,\len
0041
0042 20: mvcle %r0,%r2,0
0043 jo 20b
0044 .endm
0045
0046 .macro MEMSWAP dst,src,buf,len
0047 10: larl %r0,purgatory_end
0048 larl %r1,stack
0049 slgr %r0,%r1
0050 cgr \len,%r0
0051 jh 11f
0052 lgr %r4,\len
0053 j 12f
0054 11: lgr %r4,%r0
0055
0056 12: MEMCPY \buf,\dst,%r4
0057 MEMCPY \dst,\src,%r4
0058 MEMCPY \src,\buf,%r4
0059
0060 agr \dst,%r4
0061 agr \src,%r4
0062 sgr \len,%r4
0063
0064 cghi \len,0
0065 jh 10b
0066 .endm
0067
0068 .macro START_NEXT_KERNEL base subcode
0069 lg %r4,kernel_entry-\base(%r13)
0070 lg %r5,load_psw_mask-\base(%r13)
0071 ogr %r4,%r5
0072 stg %r4,0(%r0)
0073
0074 xgr %r0,%r0
0075 lghi %r1,\subcode
0076 diag %r0,%r1,0x308
0077 .endm
0078
0079 .text
0080 .align PAGE_SIZE
0081 ENTRY(purgatory_start)
0082
0083
0084
0085 lhi %r1,1
0086 sigp %r1,%r0,SIGP_SET_ARCHITECTURE
0087 sam64
0088
0089 larl %r5,gprregs
0090 stmg %r6,%r15,0(%r5)
0091
0092 basr %r13,0
0093 .base_crash:
0094
0095
0096 larl %r15,purgatory_end-STACK_FRAME_OVERHEAD
0097
0098
0099
0100
0101
0102
0103
0104
0105
0106
0107 lghi %r10,0
0108 lg %r11,kernel_type-.base_crash(%r13)
0109 cghi %r11,1
0110 jne .do_checksum_verification
0111 cghi %r2,0
0112 jne .do_checksum_verification
0113 lghi %r10,1
0114
0115 .do_checksum_verification:
0116 brasl %r14,verify_sha256_digest
0117
0118 cghi %r10,1
0119 je .return_old_kernel
0120 cghi %r2,0
0121 jne .disabled_wait
0122
0123
0124
0125
0126 cghi %r11,1
0127 je .start_crash_kernel
0128
0129
0130 START_NEXT_KERNEL .base_crash 0
0131
0132 .return_old_kernel:
0133 lmg %r6,%r15,gprregs-.base_crash(%r13)
0134 br %r14
0135
0136 .disabled_wait:
0137 lpswe disabled_wait_psw-.base_crash(%r13)
0138
0139 .start_crash_kernel:
0140
0141 larl %r0,.base_crash
0142 larl %r1,purgatory_start
0143 slgr %r0,%r1
0144 lgr %r8,%r13
0145 sgr %r8,%r0
0146
0147
0148 larl %r0,purgatory_end
0149 larl %r1,purgatory_start
0150 slgr %r0,%r1
0151 lg %r9,crash_size-.base_crash(%r13)
0152 sgr %r9,%r0
0153
0154
0155 lg %r10,crash_start-.base_crash(%r13)
0156 agr %r10,%r9
0157
0158
0159
0160
0161 larl %r11,purgatory_end
0162 larl %r12,stack
0163 slgr %r11,%r12
0164
0165 MEMCPY %r12,%r9,%r11
0166 MEMCPY %r9,%r8,%r11
0167
0168
0169 lgr %r7,%r9
0170 larl %r0,.jump_to_dst
0171 larl %r1,purgatory_start
0172 slgr %r0,%r1
0173 agr %r7,%r0
0174 br %r7
0175
0176 .jump_to_dst:
0177 basr %r13,0
0178 .base_dst:
0179
0180
0181 MEMCPY %r12,%r10,%r11
0182
0183
0184 larl %r7,stack
0185 lgr %r0,%r7
0186 larl %r1,purgatory_start
0187 slgr %r0,%r1
0188 agr %r10,%r0
0189 MEMCPY %r10,%r7,%r11
0190
0191
0192
0193
0194
0195
0196
0197
0198
0199
0200
0201
0202
0203
0204
0205 lgr %r12,%r7
0206 lgr %r11,%r9
0207 lghi %r10,0
0208 lg %r9,crash_start-.base_dst(%r13)
0209 lghi %r8,16
0210 larl %r7,purgatory_sha_regions
0211
0212 j .loop_first
0213
0214
0215 .loop_next:
0216 aghi %r8,-1
0217 cghi %r8,0
0218 je .loop_out
0219
0220 aghi %r7,__KEXEC_SHA_REGION_SIZE
0221
0222 .loop_first:
0223 lg %r5,__KEXEC_SHA_REGION_START(%r7)
0224 cghi %r5,0
0225 je .loop_next
0226
0227
0228
0229 sgr %r5,%r9
0230 MEMCPY %r9,%r10,%r5
0231
0232 agr %r9,%r5
0233 agr %r10,%r5
0234 sgr %r11,%r5
0235
0236
0237 lg %r6,__KEXEC_SHA_REGION_LEN(%r7)
0238 MEMSWAP %r9,%r10,%r12,%r6
0239 sg %r11,__KEXEC_SHA_REGION_LEN(%r7)
0240 j .loop_next
0241
0242 .loop_out:
0243
0244 MEMCPY %r9,%r10,%r11
0245
0246
0247 START_NEXT_KERNEL .base_dst 1
0248
0249
0250 load_psw_mask:
0251 .long 0x00080000,0x80000000
0252
0253 .align 8
0254 disabled_wait_psw:
0255 .quad 0x0002000180000000
0256 .quad 0x0000000000000000 + .do_checksum_verification
0257
0258 gprregs:
0259 .rept 10
0260 .quad 0
0261 .endr
0262
0263
0264
0265
0266
0267
0268
0269 .macro GLOBAL_VARIABLE name,size
0270 \name:
0271 .global \name
0272 .size \name,\size
0273 .type \name,object
0274 .skip \size,0
0275 .endm
0276
0277 GLOBAL_VARIABLE purgatory_sha256_digest,32
0278 GLOBAL_VARIABLE purgatory_sha_regions,16*__KEXEC_SHA_REGION_SIZE
0279 GLOBAL_VARIABLE kernel_entry,8
0280 GLOBAL_VARIABLE kernel_type,8
0281 GLOBAL_VARIABLE crash_start,8
0282 GLOBAL_VARIABLE crash_size,8
0283
0284 .align PAGE_SIZE
0285 stack:
0286
0287 .skip stack-purgatory_start
0288 .align PAGE_SIZE
0289 purgatory_end: