36 lines
		
	
	
	
		
			880 B
			
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
		
		
			
		
	
	
			36 lines
		
	
	
	
		
			880 B
			
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 *  Copyright (C) 2008 Paulius Zaleckas <paulius.zaleckas@teltonika.lt>
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 *  Based on linux/arch/arm/lib/floppydma.S
							 | 
						||
| 
								 | 
							
								 *      Copyright (C) 1995, 1996 Russell King
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * 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.
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								#include <linux/linkage.h>
							 | 
						||
| 
								 | 
							
								#include <asm/assembler.h>
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										.text
							 | 
						||
| 
								 | 
							
										.global	mx1_camera_sof_fiq_end
							 | 
						||
| 
								 | 
							
										.global	mx1_camera_sof_fiq_start
							 | 
						||
| 
								 | 
							
								mx1_camera_sof_fiq_start:
							 | 
						||
| 
								 | 
							
										@ enable dma
							 | 
						||
| 
								 | 
							
										ldr	r12, [r9]
							 | 
						||
| 
								 | 
							
										orr	r12, r12, #0x00000001
							 | 
						||
| 
								 | 
							
										str	r12, [r9]
							 | 
						||
| 
								 | 
							
										@ unmask DMA interrupt
							 | 
						||
| 
								 | 
							
										ldr	r12, [r8]
							 | 
						||
| 
								 | 
							
										bic	r12, r12, r13
							 | 
						||
| 
								 | 
							
										str	r12, [r8]
							 | 
						||
| 
								 | 
							
										@ disable SOF interrupt
							 | 
						||
| 
								 | 
							
										ldr	r12, [r10]
							 | 
						||
| 
								 | 
							
										bic	r12, r12, #0x00010000
							 | 
						||
| 
								 | 
							
										str	r12, [r10]
							 | 
						||
| 
								 | 
							
										@ clear SOF flag
							 | 
						||
| 
								 | 
							
										mov	r12, #0x00010000
							 | 
						||
| 
								 | 
							
										str	r12, [r11]
							 | 
						||
| 
								 | 
							
										@ return from FIQ
							 | 
						||
| 
								 | 
							
										subs	pc, lr, #4
							 | 
						||
| 
								 | 
							
								mx1_camera_sof_fiq_end:
							 |