Commit | Line | Data |
---|---|---|
5f97f7f9 HS |
1 | /* |
2 | * Copyright (C) 2004-2006 Atmel Corporation | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License version 2 as | |
6 | * published by the Free Software Foundation. | |
7 | */ | |
8 | ||
9 | .Lnot_word_aligned: | |
10 | /* | |
11 | * Bad alignment will cause a hardware exception, which is as | |
12 | * good as anything. No need for us to check for proper alignment. | |
13 | */ | |
14 | ld.uh r8, r12[0] | |
15 | sub r10, 1 | |
16 | st.h r11++, r8 | |
17 | ||
18 | /* fall through */ | |
19 | ||
20 | .global __raw_readsw | |
21 | .type __raw_readsw,@function | |
22 | __raw_readsw: | |
23 | cp.w r10, 0 | |
24 | reteq r12 | |
25 | mov r9, 3 | |
26 | tst r11, r9 | |
27 | brne .Lnot_word_aligned | |
28 | ||
29 | sub r10, 2 | |
30 | brlt 2f | |
31 | ||
32 | 1: ldins.h r8:t, r12[0] | |
33 | ldins.h r8:b, r12[0] | |
34 | st.w r11++, r8 | |
35 | sub r10, 2 | |
36 | brge 1b | |
37 | ||
38 | 2: sub r10, -2 | |
39 | reteq r12 | |
40 | ||
41 | ld.uh r8, r12[0] | |
42 | st.h r11++, r8 | |
43 | retal r12 |