| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  *  linux/arch/arm/vfp/entry.S | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  Copyright (C) 2004 ARM Limited. | 
					
						
							|  |  |  |  *  Written by Deep Blue Solutions Limited. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is free software; you can redistribute it and/or modify
 | 
					
						
							|  |  |  |  * it under the terms of the GNU General Public License version 2 as | 
					
						
							|  |  |  |  * published by the Free Software Foundation. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Basic entry code, called from the kernel's undefined instruction trap. | 
					
						
							|  |  |  |  *  r0  = faulted instruction | 
					
						
							|  |  |  |  *  r5  = faulted PC+4 | 
					
						
							|  |  |  |  *  r9  = successful return | 
					
						
							|  |  |  |  *  r10 = thread_info structure | 
					
						
							|  |  |  |  *  lr  = failure return | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2009-04-01 20:27:18 +01:00
										 |  |  | #include <asm/thread_info.h> | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <asm/vfpmacros.h> | 
					
						
							| 
									
										
										
										
											2009-04-01 20:27:18 +01:00
										 |  |  | #include "../kernel/entry-header.S" | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENTRY(do_vfp) | 
					
						
							| 
									
										
										
										
											2009-04-01 20:27:18 +01:00
										 |  |  | #ifdef CONFIG_PREEMPT | 
					
						
							|  |  |  | 	ldr	r4, [r10, #TI_PREEMPT]	@ get preempt count | 
					
						
							|  |  |  | 	add	r11, r4, #1		@ increment it
 | 
					
						
							|  |  |  | 	str	r11, [r10, #TI_PREEMPT] | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2006-03-15 12:33:43 +00:00
										 |  |  | 	enable_irq | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  	ldr	r4, .LCvfp | 
					
						
							| 
									
										
										
										
											2007-01-24 18:47:08 +01:00
										 |  |  | 	ldr	r11, [r10, #TI_CPU]	@ CPU number | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	add	r10, r10, #TI_VFPSTATE	@ r10 = workspace | 
					
						
							|  |  |  | 	ldr	pc, [r4]		@ call VFP entry point
 | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(do_vfp) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-06-10 12:22:20 +01:00
										 |  |  | ENTRY(vfp_null_entry) | 
					
						
							| 
									
										
										
										
											2009-04-01 20:27:18 +01:00
										 |  |  | #ifdef CONFIG_PREEMPT | 
					
						
							|  |  |  | 	get_thread_info	r10 | 
					
						
							|  |  |  | 	ldr	r4, [r10, #TI_PREEMPT]	@ get preempt count | 
					
						
							|  |  |  | 	sub	r11, r4, #1		@ decrement it
 | 
					
						
							|  |  |  | 	str	r11, [r10, #TI_PREEMPT] | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2007-06-10 12:22:20 +01:00
										 |  |  | 	mov	pc, lr | 
					
						
							|  |  |  | ENDPROC(vfp_null_entry) | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-07-24 12:32:52 +01:00
										 |  |  | 	.align	2
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | .LCvfp: | 
					
						
							|  |  |  | 	.word	vfp_vector
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | @ This code is called if the VFP does not exist. It needs to flag the
 | 
					
						
							|  |  |  | @ failure to the VFP initialisation code.
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__INIT | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENTRY(vfp_testing_entry) | 
					
						
							| 
									
										
										
										
											2009-04-01 20:27:18 +01:00
										 |  |  | #ifdef CONFIG_PREEMPT | 
					
						
							|  |  |  | 	get_thread_info	r10 | 
					
						
							|  |  |  | 	ldr	r4, [r10, #TI_PREEMPT]	@ get preempt count | 
					
						
							|  |  |  | 	sub	r11, r4, #1		@ decrement it
 | 
					
						
							|  |  |  | 	str	r11, [r10, #TI_PREEMPT] | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	ldr	r0, VFP_arch_address | 
					
						
							|  |  |  | 	str	r5, [r0]		@ known non-zero value
 | 
					
						
							|  |  |  | 	mov	pc, r9			@ we have handled the fault
 | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(vfp_testing_entry) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-07-24 12:32:52 +01:00
										 |  |  | 	.align	2
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | VFP_arch_address: | 
					
						
							|  |  |  | 	.word	VFP_arch
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__FINIT |