|
1 /* |
|
2 * Copyright (c) 2008-2009 Nokia Corporation and/or its subsidiary(-ies). |
|
3 * All rights reserved. |
|
4 * This component and the accompanying materials are made available |
|
5 * under the terms of "Eclipse Public License v1.0" |
|
6 * which accompanies this distribution, and is available |
|
7 * at the URL "http://www.eclipse.org/legal/epl-v10.html". |
|
8 * |
|
9 * Initial Contributors: |
|
10 * Nokia Corporation - initial contribution. |
|
11 * |
|
12 * Contributors: |
|
13 * |
|
14 * Description: |
|
15 * naviengine_assp\uart\uart16550.cia |
|
16 * PDD for 16550 UART - ARM assembler bits |
|
17 * |
|
18 */ |
|
19 |
|
20 |
|
21 |
|
22 #include <comm.h> |
|
23 #include <assp.h> |
|
24 #include "uart16550_ne.h" |
|
25 #include <e32hal.h> |
|
26 |
|
27 __NAKED__ void T16550Uart::ModifyFCR(TUint /*aClearMask*/, TUint /*aSetMask*/) |
|
28 { |
|
29 asm("mrs ip, cpsr "); |
|
30 asm("orr r3, ip, #0xc0 "); |
|
31 asm("msr cpsr, r3 "); |
|
32 asm("ldrb r3, [r0, #4] "); |
|
33 asm("bic r3, r3, r1 "); |
|
34 asm("ldr r1, [r0, #0] "); |
|
35 asm("orr r3, r3, r2 "); |
|
36 asm("strb r3, [r0, #4] "); |
|
37 asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550FCROffset)); |
|
38 asm("msr cpsr, ip "); |
|
39 __JUMP(,lr); |
|
40 } |
|
41 |
|
42 __NAKED__ void T16550Uart::ModifyLCR(TUint /*aClearMask*/, TUint /*aSetMask*/) |
|
43 { |
|
44 asm("mrs ip, cpsr "); |
|
45 asm("orr r3, ip, #0xc0 "); |
|
46 asm("msr cpsr, r3 "); |
|
47 asm("ldrb r3, [r0, #5] "); |
|
48 asm("bic r3, r3, r1 "); |
|
49 asm("ldr r1, [r0, #0] "); |
|
50 asm("orr r3, r3, r2 "); |
|
51 asm("strb r3, [r0, #5] "); |
|
52 asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550LCROffset)); |
|
53 asm("msr cpsr, ip "); |
|
54 __JUMP(,lr); |
|
55 } |
|
56 |
|
57 __NAKED__ void T16550Uart::ModifyMCR(TUint /*aClearMask*/, TUint /*aSetMask*/) |
|
58 { |
|
59 asm("mrs ip, cpsr "); |
|
60 asm("orr r3, ip, #0xc0 "); |
|
61 asm("msr cpsr, r3 "); |
|
62 asm("ldrb r3, [r0, #6] "); |
|
63 asm("bic r3, r3, r1 "); |
|
64 asm("ldr r1, [r0, #0] "); |
|
65 asm("orr r3, r3, r2 "); |
|
66 asm("strb r3, [r0, #6] "); |
|
67 asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550MCROffset)); |
|
68 asm("msr cpsr, ip "); |
|
69 __JUMP(,lr); |
|
70 } |
|
71 |
|
72 __NAKED__ void T16550Uart::ModifyIER(TUint /*aClearMask*/, TUint /*aSetMask*/) |
|
73 { |
|
74 asm("mrs ip, cpsr "); |
|
75 asm("orr r3, ip, #0xc0 "); |
|
76 asm("msr cpsr, r3 "); |
|
77 asm("ldrb r3, [r0, #7] "); |
|
78 asm("bic r3, r3, r1 "); |
|
79 asm("ldr r1, [r0, #0] "); |
|
80 asm("orr r3, r3, r2 "); |
|
81 asm("strb r3, [r0, #7] "); |
|
82 asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550IEROffset)); |
|
83 asm("msr cpsr, ip "); |
|
84 __JUMP(,lr); |
|
85 } |
|
86 |
|
87 __NAKED__ void T16550Uart::SetFCR(TUint /*aValue*/) |
|
88 { |
|
89 asm("mrs ip, cpsr "); |
|
90 asm("ldr r3, [r0, #0] "); |
|
91 asm("orr r2, ip, #0xc0 "); |
|
92 asm("msr cpsr, r2 "); |
|
93 asm("strb r1, [r0, #4] "); |
|
94 asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550FCROffset)); |
|
95 asm("msr cpsr, ip "); |
|
96 __JUMP(,lr); |
|
97 } |
|
98 |
|
99 __NAKED__ void T16550Uart::SetLCR(TUint /*aValue*/) |
|
100 { |
|
101 asm("mrs ip, cpsr "); |
|
102 asm("ldr r3, [r0, #0] "); |
|
103 asm("orr r2, ip, #0xc0 "); |
|
104 asm("msr cpsr, r2 "); |
|
105 asm("strb r1, [r0, #5] "); |
|
106 asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550LCROffset)); |
|
107 asm("msr cpsr, ip "); |
|
108 __JUMP(,lr); |
|
109 } |
|
110 |
|
111 __NAKED__ void T16550Uart::SetMCR(TUint /*aValue*/) |
|
112 { |
|
113 asm("mrs ip, cpsr "); |
|
114 asm("ldr r3, [r0, #0] "); |
|
115 asm("orr r2, ip, #0xc0 "); |
|
116 asm("msr cpsr, r2 "); |
|
117 asm("strb r1, [r0, #6] "); |
|
118 asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550MCROffset)); |
|
119 asm("msr cpsr, ip "); |
|
120 __JUMP(,lr); |
|
121 } |
|
122 |
|
123 __NAKED__ void T16550Uart::SetIER(TUint /*aValue*/) |
|
124 { |
|
125 asm("mrs ip, cpsr "); |
|
126 asm("ldr r3, [r0, #0] "); |
|
127 asm("orr r2, ip, #0xc0 "); |
|
128 asm("msr cpsr, r2 "); |
|
129 asm("strb r1, [r0, #7] "); |
|
130 asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550IEROffset)); |
|
131 asm("msr cpsr, ip "); |
|
132 __JUMP(,lr); |
|
133 } |