|  | /* | 
|  | * This file contains miscellaneous low-level functions. | 
|  | *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org) | 
|  | * | 
|  | * Largely rewritten by Cort Dougan (cort@cs.nmt.edu) | 
|  | * and Paul Mackerras. | 
|  | * | 
|  | * Adapted for iSeries by Mike Corrigan (mikejc@us.ibm.com) | 
|  | * PPC64 updates by Dave Engebretsen (engebret@us.ibm.com) | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or | 
|  | * modify it under the terms of the GNU General Public License | 
|  | * as published by the Free Software Foundation; either version | 
|  | * 2 of the License, or (at your option) any later version. | 
|  | */ | 
|  | #include <asm/ppc_asm.h> | 
|  |  | 
|  | .text | 
|  |  | 
|  | #ifdef CONFIG_PPC64 | 
|  | #define IN_SYNC		twi	0,r5,0; isync | 
|  | #define EIEIO_32 | 
|  | #define SYNC_64		sync | 
|  | #else /* CONFIG_PPC32 */ | 
|  | #define IN_SYNC | 
|  | #define EIEIO_32	eieio | 
|  | #define SYNC_64 | 
|  | #endif | 
|  | /* | 
|  | * Returns (address we are running at) - (address we were linked at) | 
|  | * for use before the text and data are mapped to KERNELBASE. | 
|  | */ | 
|  |  | 
|  | _GLOBAL(reloc_offset) | 
|  | mflr	r0 | 
|  | bl	1f | 
|  | 1:	mflr	r3 | 
|  | LOAD_REG_IMMEDIATE(r4,1b) | 
|  | subf	r3,r4,r3 | 
|  | mtlr	r0 | 
|  | blr | 
|  |  | 
|  | /* | 
|  | * add_reloc_offset(x) returns x + reloc_offset(). | 
|  | */ | 
|  | _GLOBAL(add_reloc_offset) | 
|  | mflr	r0 | 
|  | bl	1f | 
|  | 1:	mflr	r5 | 
|  | LOAD_REG_IMMEDIATE(r4,1b) | 
|  | subf	r5,r4,r5 | 
|  | add	r3,r3,r5 | 
|  | mtlr	r0 | 
|  | blr | 
|  |  | 
|  | /* | 
|  | * I/O string operations | 
|  | * | 
|  | * insb(port, buf, len) | 
|  | * outsb(port, buf, len) | 
|  | * insw(port, buf, len) | 
|  | * outsw(port, buf, len) | 
|  | * insl(port, buf, len) | 
|  | * outsl(port, buf, len) | 
|  | * insw_ns(port, buf, len) | 
|  | * outsw_ns(port, buf, len) | 
|  | * insl_ns(port, buf, len) | 
|  | * outsl_ns(port, buf, len) | 
|  | * | 
|  | * The *_ns versions don't do byte-swapping. | 
|  | */ | 
|  | _GLOBAL(_insb) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,1 | 
|  | blelr- | 
|  | 00:	lbz	r5,0(r3) | 
|  | eieio | 
|  | stbu	r5,1(r4) | 
|  | bdnz	00b | 
|  | IN_SYNC | 
|  | blr | 
|  |  | 
|  | _GLOBAL(_outsb) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,1 | 
|  | blelr- | 
|  | 00:	lbzu	r5,1(r4) | 
|  | stb	r5,0(r3) | 
|  | EIEIO_32 | 
|  | bdnz	00b | 
|  | SYNC_64 | 
|  | blr | 
|  |  | 
|  | _GLOBAL(_insw) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,2 | 
|  | blelr- | 
|  | 00:	lhbrx	r5,0,r3 | 
|  | eieio | 
|  | sthu	r5,2(r4) | 
|  | bdnz	00b | 
|  | IN_SYNC | 
|  | blr | 
|  |  | 
|  | _GLOBAL(_outsw) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,2 | 
|  | blelr- | 
|  | 00:	lhzu	r5,2(r4) | 
|  | EIEIO_32 | 
|  | sthbrx	r5,0,r3 | 
|  | bdnz	00b | 
|  | SYNC_64 | 
|  | blr | 
|  |  | 
|  | _GLOBAL(_insl) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,4 | 
|  | blelr- | 
|  | 00:	lwbrx	r5,0,r3 | 
|  | eieio | 
|  | stwu	r5,4(r4) | 
|  | bdnz	00b | 
|  | IN_SYNC | 
|  | blr | 
|  |  | 
|  | _GLOBAL(_outsl) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,4 | 
|  | blelr- | 
|  | 00:	lwzu	r5,4(r4) | 
|  | stwbrx	r5,0,r3 | 
|  | EIEIO_32 | 
|  | bdnz	00b | 
|  | SYNC_64 | 
|  | blr | 
|  |  | 
|  | #ifdef CONFIG_PPC32 | 
|  | _GLOBAL(__ide_mm_insw) | 
|  | #endif | 
|  | _GLOBAL(_insw_ns) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,2 | 
|  | blelr- | 
|  | 00:	lhz	r5,0(r3) | 
|  | eieio | 
|  | sthu	r5,2(r4) | 
|  | bdnz	00b | 
|  | IN_SYNC | 
|  | blr | 
|  |  | 
|  | #ifdef CONFIG_PPC32 | 
|  | _GLOBAL(__ide_mm_outsw) | 
|  | #endif | 
|  | _GLOBAL(_outsw_ns) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,2 | 
|  | blelr- | 
|  | 00:	lhzu	r5,2(r4) | 
|  | sth	r5,0(r3) | 
|  | EIEIO_32 | 
|  | bdnz	00b | 
|  | SYNC_64 | 
|  | blr | 
|  |  | 
|  | #ifdef CONFIG_PPC32 | 
|  | _GLOBAL(__ide_mm_insl) | 
|  | #endif | 
|  | _GLOBAL(_insl_ns) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,4 | 
|  | blelr- | 
|  | 00:	lwz	r5,0(r3) | 
|  | eieio | 
|  | stwu	r5,4(r4) | 
|  | bdnz	00b | 
|  | IN_SYNC | 
|  | blr | 
|  |  | 
|  | #ifdef CONFIG_PPC32 | 
|  | _GLOBAL(__ide_mm_outsl) | 
|  | #endif | 
|  | _GLOBAL(_outsl_ns) | 
|  | cmpwi	0,r5,0 | 
|  | mtctr	r5 | 
|  | subi	r4,r4,4 | 
|  | blelr- | 
|  | 00:	lwzu	r5,4(r4) | 
|  | stw	r5,0(r3) | 
|  | EIEIO_32 | 
|  | bdnz	00b | 
|  | SYNC_64 | 
|  | blr | 
|  |  |