| Benjamin Herrenschmidt | 4c75a6f | 2006-11-11 17:24:53 +1100 | [diff] [blame] | 1 | /* | 
 | 2 |  * "Indirect" DCR access | 
 | 3 |  * | 
 | 4 |  * Copyright (c) 2004 Eugene Surovegin <ebs@ebshome.net> | 
 | 5 |  * | 
 | 6 |  * This program is free software; you can redistribute it and/or modify it | 
 | 7 |  * under  the terms of  the GNU General Public License as published by the | 
 | 8 |  * Free Software Foundation;  either version 2 of the License, or (at your | 
 | 9 |  * option) any later version. | 
 | 10 |  */ | 
 | 11 |  | 
 | 12 | #include <asm/ppc_asm.h> | 
 | 13 | #include <asm/processor.h> | 
| Benjamin Herrenschmidt | 6d2170b | 2008-12-18 19:13:22 +0000 | [diff] [blame] | 14 | #include <asm/bug.h> | 
| Benjamin Herrenschmidt | 4c75a6f | 2006-11-11 17:24:53 +1100 | [diff] [blame] | 15 |  | 
 | 16 | #define DCR_ACCESS_PROLOG(table) \ | 
| Benjamin Herrenschmidt | 6d2170b | 2008-12-18 19:13:22 +0000 | [diff] [blame] | 17 | 	cmpli	cr0,r3,1024;	 \ | 
| Benjamin Herrenschmidt | 4c75a6f | 2006-11-11 17:24:53 +1100 | [diff] [blame] | 18 | 	rlwinm  r3,r3,4,18,27;   \ | 
 | 19 | 	lis     r5,table@h;      \ | 
 | 20 | 	ori     r5,r5,table@l;   \ | 
 | 21 | 	add     r3,r3,r5;        \ | 
| Benjamin Herrenschmidt | 6d2170b | 2008-12-18 19:13:22 +0000 | [diff] [blame] | 22 | 	bge-	1f;		 \ | 
| Benjamin Herrenschmidt | 4c75a6f | 2006-11-11 17:24:53 +1100 | [diff] [blame] | 23 | 	mtctr   r3;              \ | 
| Benjamin Herrenschmidt | 6d2170b | 2008-12-18 19:13:22 +0000 | [diff] [blame] | 24 | 	bctr;			 \ | 
 | 25 | 1:	trap;			 \ | 
 | 26 | 	EMIT_BUG_ENTRY 1b,__FILE__,__LINE__,0;	\ | 
 | 27 | 	blr | 
| Benjamin Herrenschmidt | 4c75a6f | 2006-11-11 17:24:53 +1100 | [diff] [blame] | 28 |  | 
 | 29 | _GLOBAL(__mfdcr) | 
 | 30 | 	DCR_ACCESS_PROLOG(__mfdcr_table) | 
 | 31 |  | 
 | 32 | _GLOBAL(__mtdcr) | 
 | 33 | 	DCR_ACCESS_PROLOG(__mtdcr_table) | 
 | 34 |  | 
 | 35 | __mfdcr_table: | 
 | 36 | 	mfdcr  r3,0; blr | 
 | 37 | __mtdcr_table: | 
 | 38 | 	mtdcr  0,r4; blr | 
 | 39 |  | 
 | 40 | dcr     = 1 | 
 | 41 |         .rept   1023 | 
 | 42 | 	mfdcr   r3,dcr; blr | 
 | 43 | 	mtdcr   dcr,r4; blr | 
 | 44 | 	dcr     = dcr + 1 | 
 | 45 | 	.endr |