Blame view

kernel/linux-imx6_3.14.28/arch/arm/lib/io-writesl.S 1.24 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
  /*
   *  linux/arch/arm/lib/io-writesl.S
   *
   *  Copyright (C) 1995-2000 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>
  
  ENTRY(__raw_writesl)
  		teq	r2, #0		@ do we have to check for the zero len?
  		moveq	pc, lr
  		ands	ip, r1, #3
  		bne	3f
  
  		subs	r2, r2, #4
  		bmi	2f
  		stmfd	sp!, {r4, lr}
  1:		ldmia	r1!, {r3, r4, ip, lr}
  		subs	r2, r2, #4
  		str	r3, [r0, #0]
  		str	r4, [r0, #0]
  		str	ip, [r0, #0]
  		str	lr, [r0, #0]
  		bpl	1b
  		ldmfd	sp!, {r4, lr}
  2:		movs	r2, r2, lsl #31
  		ldmcsia	r1!, {r3, ip}
  		strcs	r3, [r0, #0]
  		ldrne	r3, [r1, #0]
  		strcs	ip, [r0, #0]
  		strne	r3, [r0, #0]
  		mov	pc, lr
  
  3:		bic	r1, r1, #3
  		ldr	r3, [r1], #4
  		cmp	ip, #2
  		blt	5f
  		bgt	6f
  
  4:		mov	ip, r3, pull #16
  		ldr	r3, [r1], #4
  		subs	r2, r2, #1
  		orr	ip, ip, r3, push #16
  		str	ip, [r0]
  		bne	4b
  		mov	pc, lr
  
  5:		mov	ip, r3, pull #8
  		ldr	r3, [r1], #4
  		subs	r2, r2, #1
  		orr	ip, ip, r3, push #24
  		str	ip, [r0]
  		bne	5b
  		mov	pc, lr
  
  6:		mov	ip, r3, pull #24
  		ldr	r3, [r1], #4
  		subs	r2, r2, #1
  		orr	ip, ip, r3, push #8
  		str	ip, [r0]
  		bne	6b
  		mov	pc, lr
  ENDPROC(__raw_writesl)