powerpc/aim/trap_subr32.S

86  *	savearea	r28-r31,DAR,DSISR   (DAR & DSISR only for DSI traps)
90  *	r31		scratch
96 	GET_CPUINFO(%r31);						\
98 	stw	%r30,(savearea+CPUSAVE_SRR0)(%r31);	/* save SRR0 */	\
100 	stw	%r30,(savearea+CPUSAVE_SRR1)(%r31);	/* save SRR1 */	\
105 	mfsprg1	%r31;			/* get saved SP */		\
106 	stwu	%r31,-FRAMELEN(%r1);	/* save it in the callframe */	\
108 	stw	%r31,FRAME_1+8(%r1);	/* save SP   "      "       */	\
116 	lwz	%r31,(savearea+CPUSAVE_R31)(%r2); /* get saved r31 */	\
117 	stw	%r3,  FRAME_3+8(%r1);	/* save r3-r31 */		\
145 	stw	%r31, FRAME_31+8(%r1);					\
149 	lwz	%r31,(savearea+CPUSAVE_SRR1)(%r2); /* saved SRR1 */	\
159 	stw	%r31,FRAME_SRR1+8(1);					\
182 	lwz	%r31,FRAME_31+8(%r1);   /* restore r0-31 */		\
270 	mtsprg1 %r31
271 	mfsrr0  %r31
272 	addi	%r31, %r31, 4
273 	mtsrr0  %r31
275 	li	%r31, 0
276 	mtsprg2 %r31
277 	mfsprg1 %r31
288 	mtsprg1	%r31
289 	mfmsr	%r31
290 	clrldi	%r31,%r31,1
291 	mtmsrd	%r31
292 	mfsprg1	%r31
307 1:	mflr	%r31
308 	lwz	%r31,0(%r31)
309 	mtlr	%r31
366 	stw	%r28,(PC_TEMPSAVE+CPUSAVE_R28)(%r1)	/* free r28-r31 */
369 	stw	%r31,(PC_TEMPSAVE+CPUSAVE_R31)(%r1)
371 	mfdsisr	%r31
373 	stw	%r31,(PC_TEMPSAVE+CPUSAVE_AIM_DSISR)(%r1)
379 	li	%r31, EXC_ALI
380 	mtsprg3	%r31
383 	mfsrr1	%r31
384 	mtcr	%r31
389 1:	mflr	%r31
390 	lwz	%r31,0(%r31)
391 	mtlr	%r31
605 	stw	%r28,(PC_DISISAVE+CPUSAVE_R28)(%r1)	/* free r28-r31 */
608 	stw	%r31,(PC_DISISAVE+CPUSAVE_R31)(%r1)
613 	mfsrr1	%r31			/* test kernel mode */
614 	mtcr	%r31
616 	mfdar	%r31			/* get fault address */
617 	rlwinm	%r31,%r31,7,25,28	/* get segment * 8 */
622 	add	%r31,%r30,%r31
623 	lwz	%r30,0(%r31)
628 	lwz	%r31,4(%r31)
634 	mtdbatl	2,%r31
638 	mtdbatl	3,%r31
645 	lwz	%r28,(PC_DISISAVE+CPUSAVE_R28)(%r1)	/* restore r28-r31 */
648 	lwz	%r31,(PC_DISISAVE+CPUSAVE_R31)(%r1)
675 	lwz	%r31,(PC_DISISAVE+CPUSAVE_R29)(%r1)
676 	stw	%r31,(PC_TEMPSAVE+CPUSAVE_R29)(%r1)
679 	lwz	%r31,(PC_DISISAVE+CPUSAVE_R31)(%r1)
680 	stw	%r31,(PC_TEMPSAVE+CPUSAVE_R31)(%r1)
682 	mfdsisr	%r31
684 	stw	%r31,(PC_TEMPSAVE+CPUSAVE_AIM_DSISR)(%r1)
688 	mfsrr1	%r31
689 	mtcr	%r31
691 	mfsprg1	%r31			/* get old SP */
692 	clrrwi	%r31,%r31,12		/* Round SP down to nearest page */
693 	sub.	%r30,%r31,%r30		/* SP - DAR */
703 	lwz	%r31,(PC_TEMPSAVE+CPUSAVE_AIM_DSISR)(%r1) /* get DSISR */
704 	stw	%r31,(PC_DBSAVE  +CPUSAVE_AIM_DSISR)(%r1) /* save DSISR */
707 	lwz	%r31,(PC_DISISAVE+CPUSAVE_R29)(%r1) /* get  r29 */
708 	stw	%r31,(PC_DBSAVE  +CPUSAVE_R29)(%r1) /* save r29 */
711 	lwz	%r31,(PC_DISISAVE+CPUSAVE_R31)(%r1) /* get  r31 */
712 	stw	%r31,(PC_DBSAVE  +CPUSAVE_R31)(%r1) /* save r31 */
726 	RESTORE_KERN_SRS(%r30,%r31)	/* enable kernel mapping */
741 	mtsprg3	%r31
742 	mfmsr	%r31
743 	clrldi	%r31,%r31,1
744 	mtmsrd	%r31
745 	mfsprg3	%r31
755 	stw	%r28,(PC_TEMPSAVE+CPUSAVE_R28)(%r1)	/* free r28-r31 */
758 	stw	%r31,(PC_TEMPSAVE+CPUSAVE_R31)(%r1)
764 	mfsprg3 %r31
765 	ori	%r31,%r31,0xff00
767 	and	%r30,%r30,%r31
771 	mfsrr1	%r31
772 	mtcr	%r31
779 	RESTORE_KERN_SRS(%r30,%r31)	/* enable kernel mapping */
850 	stw	%r31,(PC_DBSAVE+CPUSAVE_R31)(%r3)
886 	stw	%r31,(PC_TEMPSAVE+CPUSAVE_R31)(%r1)
889 	lwz	%r31,(PC_DBSAVE+CPUSAVE_R31)(%r1)
890 	mtsprg3	%r31			/* SPRG3 was clobbered by FRAME_LEAVE */
927         stw	%r31,(PC_DBSAVE+CPUSAVE_R31)(%r1)	/* free r31 */