diff --git a/src/setjmp/arm/longjmp.s b/src/setjmp/arm/longjmp.s index 690a008..11e6b58 100644 --- a/src/setjmp/arm/longjmp.s +++ b/src/setjmp/arm/longjmp.s @@ -8,6 +8,31 @@ longjmp: movs r0,r1 moveq r0,#1 ldmia ip!, {v1,v2,v3,v4,v5,v6,sl,fp,sp,lr} - tst lr,#1 + + adr r1,1f + ldr r2,1f + ldr r1,[r1,r2] + + tst r1,#0x20 + ldcne p2, cr4, [ip], #48 + + tst r1,#0x40 + ldcne p11, cr8, [ip], #68 + ldrne r2, [ip], #4 + mcrne p10, 7, r2, cr1, cr0, 0 + + tst r1,#0x200 + beq 2f + ldcl p1, cr10, [ip], #8 + ldcl p1, cr11, [ip], #8 + ldcl p1, cr12, [ip], #8 + ldcl p1, cr13, [ip], #8 + ldcl p1, cr14, [ip], #8 + ldcl p1, cr15, [ip], #8 + +2: tst lr,#1 moveq pc,lr bx lr + +.hidden __hwcap +1: .word __hwcap-1b diff --git a/src/setjmp/arm/setjmp.s b/src/setjmp/arm/setjmp.s index 6985caa..763f959 100644 --- a/src/setjmp/arm/setjmp.s +++ b/src/setjmp/arm/setjmp.s @@ -10,6 +10,31 @@ setjmp: mov ip,r0 stmia ip!,{v1,v2,v3,v4,v5,v6,sl,fp,sp,lr} mov r0,#0 - tst lr,#1 + + adr r1,1f + ldr r2,1f + ldr r1,[r1,r2] + + tst r1,#0x20 + stcne p2, cr4, [ip], #48 + + tst r1,#0x40 + stcne p11, cr8, [ip], #68 + mrcne p10, 7, r2, cr1, cr0, 0 + strne r2, [ip], #4 + + tst r1,#0x200 + beq 2f + stcl p1, cr10, [ip], #8 + stcl p1, cr11, [ip], #8 + stcl p1, cr12, [ip], #8 + stcl p1, cr13, [ip], #8 + stcl p1, cr14, [ip], #8 + stcl p1, cr15, [ip], #8 + +2: tst lr,#1 moveq pc,lr bx lr + +.hidden __hwcap +1: .word __hwcap-1b