Commit | Line | Data |
---|---|---|
15d014d1 LB |
1 | /* |
2 | * Helper functions for the PM3386s on the Radisys ENP2611 | |
3 | * Copyright (C) 2004, 2005 Lennert Buytenhek <buytenh@wantstofly.org> | |
4 | * Dedicated to Marija Kulikova. | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | */ | |
11 | ||
12 | #include <linux/config.h> | |
13 | #include <linux/module.h> | |
14 | #include <linux/delay.h> | |
15 | #include <linux/netdevice.h> | |
16 | #include <asm/io.h> | |
6744a506 | 17 | #include "pm3386.h" |
15d014d1 LB |
18 | |
19 | /* | |
20 | * Read from register 'reg' of PM3386 device 'pm'. | |
21 | */ | |
22 | static u16 pm3386_reg_read(int pm, int reg) | |
23 | { | |
24 | void *_reg; | |
25 | u16 value; | |
26 | ||
27 | _reg = (void *)ENP2611_PM3386_0_VIRT_BASE; | |
28 | if (pm == 1) | |
29 | _reg = (void *)ENP2611_PM3386_1_VIRT_BASE; | |
30 | ||
31 | value = *((volatile u16 *)(_reg + (reg << 1))); | |
32 | ||
33 | // printk(KERN_INFO "pm3386_reg_read(%d, %.3x) = %.8x\n", pm, reg, value); | |
34 | ||
35 | return value; | |
36 | } | |
37 | ||
38 | /* | |
39 | * Write to register 'reg' of PM3386 device 'pm', and perform | |
40 | * a readback from the identification register. | |
41 | */ | |
42 | static void pm3386_reg_write(int pm, int reg, u16 value) | |
43 | { | |
44 | void *_reg; | |
45 | u16 dummy; | |
46 | ||
47 | // printk(KERN_INFO "pm3386_reg_write(%d, %.3x, %.8x)\n", pm, reg, value); | |
48 | ||
49 | _reg = (void *)ENP2611_PM3386_0_VIRT_BASE; | |
50 | if (pm == 1) | |
51 | _reg = (void *)ENP2611_PM3386_1_VIRT_BASE; | |
52 | ||
53 | *((volatile u16 *)(_reg + (reg << 1))) = value; | |
54 | ||
55 | dummy = *((volatile u16 *)_reg); | |
56 | __asm__ __volatile__("mov %0, %0" : "+r" (dummy)); | |
57 | } | |
58 | ||
59 | /* | |
60 | * Read from port 'port' register 'reg', where the registers | |
61 | * for the different ports are 'spacing' registers apart. | |
62 | */ | |
63 | static u16 pm3386_port_reg_read(int port, int _reg, int spacing) | |
64 | { | |
65 | int reg; | |
66 | ||
67 | reg = _reg; | |
68 | if (port & 1) | |
69 | reg += spacing; | |
70 | ||
71 | return pm3386_reg_read(port >> 1, reg); | |
72 | } | |
73 | ||
74 | /* | |
75 | * Write to port 'port' register 'reg', where the registers | |
76 | * for the different ports are 'spacing' registers apart. | |
77 | */ | |
78 | static void pm3386_port_reg_write(int port, int _reg, int spacing, u16 value) | |
79 | { | |
80 | int reg; | |
81 | ||
82 | reg = _reg; | |
83 | if (port & 1) | |
84 | reg += spacing; | |
85 | ||
86 | pm3386_reg_write(port >> 1, reg, value); | |
87 | } | |
88 | ||
89 | ||
90 | void pm3386_reset(void) | |
91 | { | |
92 | /* @@@ Implement me. */ | |
93 | } | |
94 | ||
95 | static u16 swaph(u16 x) | |
96 | { | |
97 | return ((x << 8) | (x >> 8)) & 0xffff; | |
98 | } | |
99 | ||
100 | void pm3386_init_port(int port) | |
101 | { | |
102 | int pm = port >> 1; | |
103 | ||
104 | /* | |
105 | * Work around ENP2611 bootloader programming MAC address | |
106 | * in reverse. | |
107 | */ | |
108 | if (pm3386_port_reg_read(port, 0x30a, 0x100) == 0x0000 && | |
109 | (pm3386_port_reg_read(port, 0x309, 0x100) & 0xff00) == 0x5000) { | |
110 | u16 temp[3]; | |
111 | ||
112 | temp[0] = pm3386_port_reg_read(port, 0x308, 0x100); | |
113 | temp[1] = pm3386_port_reg_read(port, 0x309, 0x100); | |
114 | temp[2] = pm3386_port_reg_read(port, 0x30a, 0x100); | |
115 | pm3386_port_reg_write(port, 0x308, 0x100, swaph(temp[2])); | |
116 | pm3386_port_reg_write(port, 0x309, 0x100, swaph(temp[1])); | |
117 | pm3386_port_reg_write(port, 0x30a, 0x100, swaph(temp[0])); | |
118 | } | |
119 | ||
120 | /* | |
121 | * Initialise narrowbanding mode. See application note 2010486 | |
122 | * for more information. (@@@ We also need to issue a reset | |
123 | * when ROOL or DOOL are detected.) | |
124 | */ | |
125 | pm3386_port_reg_write(port, 0x708, 0x10, 0xd055); | |
126 | udelay(500); | |
127 | pm3386_port_reg_write(port, 0x708, 0x10, 0x5055); | |
128 | ||
129 | /* | |
130 | * SPI-3 ingress block. Set 64 bytes SPI-3 burst size | |
131 | * towards SPI-3 bridge. | |
132 | */ | |
133 | pm3386_port_reg_write(port, 0x122, 0x20, 0x0002); | |
134 | ||
135 | /* | |
136 | * Enable ingress protocol checking, and soft reset the | |
137 | * SPI-3 ingress block. | |
138 | */ | |
139 | pm3386_reg_write(pm, 0x103, 0x0003); | |
140 | while (!(pm3386_reg_read(pm, 0x103) & 0x80)) | |
141 | ; | |
142 | ||
143 | /* | |
144 | * SPI-3 egress block. Gather 12288 bytes of the current | |
145 | * packet in the TX fifo before initiating transmit on the | |
146 | * SERDES interface. (Prevents TX underflows.) | |
147 | */ | |
148 | pm3386_port_reg_write(port, 0x221, 0x20, 0x0007); | |
149 | ||
150 | /* | |
151 | * Enforce odd parity from the SPI-3 bridge, and soft reset | |
152 | * the SPI-3 egress block. | |
153 | */ | |
154 | pm3386_reg_write(pm, 0x203, 0x000d & ~(4 << (port & 1))); | |
155 | while ((pm3386_reg_read(pm, 0x203) & 0x000c) != 0x000c) | |
156 | ; | |
157 | ||
158 | /* | |
159 | * EGMAC block. Set this channels to reject long preambles, | |
160 | * not send or transmit PAUSE frames, enable preamble checking, | |
161 | * disable frame length checking, enable FCS appending, enable | |
162 | * TX frame padding. | |
163 | */ | |
164 | pm3386_port_reg_write(port, 0x302, 0x100, 0x0113); | |
165 | ||
166 | /* | |
167 | * Soft reset the EGMAC block. | |
168 | */ | |
169 | pm3386_port_reg_write(port, 0x301, 0x100, 0x8000); | |
15d014d1 | 170 | pm3386_port_reg_write(port, 0x301, 0x100, 0x0000); |
15d014d1 LB |
171 | |
172 | /* | |
173 | * Auto-sense autonegotiation status. | |
174 | */ | |
175 | pm3386_port_reg_write(port, 0x306, 0x100, 0x0100); | |
176 | ||
177 | /* | |
178 | * Allow reception of jumbo frames. | |
179 | */ | |
180 | pm3386_port_reg_write(port, 0x310, 0x100, 9018); | |
181 | ||
182 | /* | |
183 | * Allow transmission of jumbo frames. | |
184 | */ | |
185 | pm3386_port_reg_write(port, 0x336, 0x100, 9018); | |
186 | ||
187 | /* @@@ Should set 0x337/0x437 (RX forwarding threshold.) */ | |
188 | ||
189 | /* | |
190 | * Set autonegotiation parameters to 'no PAUSE, full duplex.' | |
191 | */ | |
192 | pm3386_port_reg_write(port, 0x31c, 0x100, 0x0020); | |
15d014d1 LB |
193 | |
194 | /* | |
195 | * Enable and restart autonegotiation. | |
196 | */ | |
197 | pm3386_port_reg_write(port, 0x318, 0x100, 0x0003); | |
15d014d1 | 198 | pm3386_port_reg_write(port, 0x318, 0x100, 0x0002); |
15d014d1 LB |
199 | } |
200 | ||
201 | void pm3386_get_mac(int port, u8 *mac) | |
202 | { | |
203 | u16 temp; | |
204 | ||
205 | temp = pm3386_port_reg_read(port, 0x308, 0x100); | |
206 | mac[0] = temp & 0xff; | |
207 | mac[1] = (temp >> 8) & 0xff; | |
208 | ||
209 | temp = pm3386_port_reg_read(port, 0x309, 0x100); | |
210 | mac[2] = temp & 0xff; | |
211 | mac[3] = (temp >> 8) & 0xff; | |
212 | ||
213 | temp = pm3386_port_reg_read(port, 0x30a, 0x100); | |
214 | mac[4] = temp & 0xff; | |
215 | mac[5] = (temp >> 8) & 0xff; | |
216 | } | |
217 | ||
0b85c0eb LB |
218 | void pm3386_set_mac(int port, u8 *mac) |
219 | { | |
220 | pm3386_port_reg_write(port, 0x308, 0x100, (mac[1] << 8) | mac[0]); | |
221 | pm3386_port_reg_write(port, 0x309, 0x100, (mac[3] << 8) | mac[2]); | |
222 | pm3386_port_reg_write(port, 0x30a, 0x100, (mac[5] << 8) | mac[4]); | |
223 | } | |
224 | ||
15d014d1 LB |
225 | static u32 pm3386_get_stat(int port, u16 base) |
226 | { | |
227 | u32 value; | |
228 | ||
229 | value = pm3386_port_reg_read(port, base, 0x100); | |
230 | value |= pm3386_port_reg_read(port, base + 1, 0x100) << 16; | |
231 | ||
232 | return value; | |
233 | } | |
234 | ||
235 | void pm3386_get_stats(int port, struct net_device_stats *stats) | |
236 | { | |
237 | /* | |
238 | * Snapshot statistics counters. | |
239 | */ | |
240 | pm3386_port_reg_write(port, 0x500, 0x100, 0x0001); | |
241 | while (pm3386_port_reg_read(port, 0x500, 0x100) & 0x0001) | |
242 | ; | |
243 | ||
178f171d | 244 | memset(stats, 0, sizeof(*stats)); |
15d014d1 LB |
245 | |
246 | stats->rx_packets = pm3386_get_stat(port, 0x510); | |
247 | stats->tx_packets = pm3386_get_stat(port, 0x590); | |
248 | stats->rx_bytes = pm3386_get_stat(port, 0x514); | |
249 | stats->tx_bytes = pm3386_get_stat(port, 0x594); | |
250 | /* @@@ Add other stats. */ | |
251 | } | |
252 | ||
253 | int pm3386_is_link_up(int port) | |
254 | { | |
255 | u16 temp; | |
256 | ||
257 | temp = pm3386_port_reg_read(port, 0x31a, 0x100); | |
258 | temp = pm3386_port_reg_read(port, 0x31a, 0x100); | |
259 | ||
260 | return !!(temp & 0x0002); | |
261 | } | |
262 | ||
263 | void pm3386_enable_rx(int port) | |
264 | { | |
265 | u16 temp; | |
266 | ||
267 | temp = pm3386_port_reg_read(port, 0x303, 0x100); | |
268 | temp |= 0x1000; | |
269 | pm3386_port_reg_write(port, 0x303, 0x100, temp); | |
15d014d1 LB |
270 | } |
271 | ||
272 | void pm3386_disable_rx(int port) | |
273 | { | |
274 | u16 temp; | |
275 | ||
276 | temp = pm3386_port_reg_read(port, 0x303, 0x100); | |
277 | temp &= 0xefff; | |
278 | pm3386_port_reg_write(port, 0x303, 0x100, temp); | |
15d014d1 LB |
279 | } |
280 | ||
281 | void pm3386_enable_tx(int port) | |
282 | { | |
283 | u16 temp; | |
284 | ||
285 | temp = pm3386_port_reg_read(port, 0x303, 0x100); | |
286 | temp |= 0x4000; | |
287 | pm3386_port_reg_write(port, 0x303, 0x100, temp); | |
15d014d1 LB |
288 | } |
289 | ||
290 | void pm3386_disable_tx(int port) | |
291 | { | |
292 | u16 temp; | |
293 | ||
294 | temp = pm3386_port_reg_read(port, 0x303, 0x100); | |
295 | temp &= 0xbfff; | |
296 | pm3386_port_reg_write(port, 0x303, 0x100, temp); | |
15d014d1 LB |
297 | } |
298 | ||
299 | MODULE_LICENSE("GPL"); |