blob: 30fbaf04773f5856fd0330292daa1753c302d5f9 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/************************************************************************
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002 * s2io.c: A Linux PCI-X Ethernet driver for Neterion 10GbE Server NIC
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 * Copyright(c) 2002-2005 Neterion Inc.
4
5 * This software may be used and distributed according to the terms of
6 * the GNU General Public License (GPL), incorporated herein by reference.
7 * Drivers based on or derived from this code fall under the GPL and must
8 * retain the authorship, copyright and license notice. This file is not
9 * a complete program and may only be used when the entire operating
10 * system is licensed under the GPL.
11 * See the file COPYING in this distribution for more information.
12 *
13 * Credits:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070014 * Jeff Garzik : For pointing out the improper error condition
15 * check in the s2io_xmit routine and also some
16 * issues in the Tx watch dog function. Also for
17 * patiently answering all those innumerable
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 * questions regaring the 2.6 porting issues.
19 * Stephen Hemminger : Providing proper 2.6 porting mechanism for some
20 * macros available only in 2.6 Kernel.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070021 * Francois Romieu : For pointing out all code part that were
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 * deprecated and also styling related comments.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070023 * Grant Grundler : For helping me get rid of some Architecture
Linus Torvalds1da177e2005-04-16 15:20:36 -070024 * dependent code.
25 * Christopher Hellwig : Some more 2.6 specific issues in the driver.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070026 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070027 * The module loadable parameters that are supported by the driver and a brief
28 * explaination of all the variables.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070029 * rx_ring_num : This can be used to program the number of receive rings used
30 * in the driver.
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -070031 * rx_ring_sz: This defines the number of descriptors each ring can have. This
Linus Torvalds1da177e2005-04-16 15:20:36 -070032 * is also an array of size 8.
33 * tx_fifo_num: This defines the number of Tx FIFOs thats used int the driver.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070034 * tx_fifo_len: This too is an array of 8. Each element defines the number of
Linus Torvalds1da177e2005-04-16 15:20:36 -070035 * Tx descriptors that can be associated with each corresponding FIFO.
Linus Torvalds1da177e2005-04-16 15:20:36 -070036 ************************************************************************/
37
38#include <linux/config.h>
39#include <linux/module.h>
40#include <linux/types.h>
41#include <linux/errno.h>
42#include <linux/ioport.h>
43#include <linux/pci.h>
Domen Puncer1e7f0bd2005-06-26 18:22:14 -040044#include <linux/dma-mapping.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070045#include <linux/kernel.h>
46#include <linux/netdevice.h>
47#include <linux/etherdevice.h>
48#include <linux/skbuff.h>
49#include <linux/init.h>
50#include <linux/delay.h>
51#include <linux/stddef.h>
52#include <linux/ioctl.h>
53#include <linux/timex.h>
54#include <linux/sched.h>
55#include <linux/ethtool.h>
56#include <linux/version.h>
57#include <linux/workqueue.h>
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -070058#include <linux/if_vlan.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070059
Linus Torvalds1da177e2005-04-16 15:20:36 -070060#include <asm/system.h>
61#include <asm/uaccess.h>
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070062#include <asm/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070063
64/* local include */
65#include "s2io.h"
66#include "s2io-regs.h"
67
John Linville6c1792f2005-10-04 07:51:45 -040068#define DRV_VERSION "Version 2.0.9.1"
69
Linus Torvalds1da177e2005-04-16 15:20:36 -070070/* S2io Driver name & version. */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070071static char s2io_driver_name[] = "Neterion";
John Linville6c1792f2005-10-04 07:51:45 -040072static char s2io_driver_version[] = DRV_VERSION;
Linus Torvalds1da177e2005-04-16 15:20:36 -070073
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -070074static inline int RXD_IS_UP2DT(RxD_t *rxdp)
75{
76 int ret;
77
78 ret = ((!(rxdp->Control_1 & RXD_OWN_XENA)) &&
79 (GET_RXD_MARKER(rxdp->Control_2) != THE_RXD_MARK));
80
81 return ret;
82}
83
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -070084/*
Linus Torvalds1da177e2005-04-16 15:20:36 -070085 * Cards with following subsystem_id have a link state indication
86 * problem, 600B, 600C, 600D, 640B, 640C and 640D.
87 * macro below identifies these cards given the subsystem_id.
88 */
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -070089#define CARDS_WITH_FAULTY_LINK_INDICATORS(dev_type, subid) \
90 (dev_type == XFRAME_I_DEVICE) ? \
91 ((((subid >= 0x600B) && (subid <= 0x600D)) || \
92 ((subid >= 0x640B) && (subid <= 0x640D))) ? 1 : 0) : 0
Linus Torvalds1da177e2005-04-16 15:20:36 -070093
94#define LINK_IS_UP(val64) (!(val64 & (ADAPTER_STATUS_RMAC_REMOTE_FAULT | \
95 ADAPTER_STATUS_RMAC_LOCAL_FAULT)))
96#define TASKLET_IN_USE test_and_set_bit(0, (&sp->tasklet_status))
97#define PANIC 1
98#define LOW 2
99static inline int rx_buffer_level(nic_t * sp, int rxb_size, int ring)
100{
101 int level = 0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700102 mac_info_t *mac_control;
103
104 mac_control = &sp->mac_control;
105 if ((mac_control->rings[ring].pkt_cnt - rxb_size) > 16) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106 level = LOW;
raghavendra.koushik@neterion.comfe113632005-08-03 12:32:00 -0700107 if (rxb_size <= MAX_RXDS_PER_BLOCK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 level = PANIC;
109 }
110 }
111
112 return level;
113}
114
115/* Ethtool related variables and Macros. */
116static char s2io_gstrings[][ETH_GSTRING_LEN] = {
117 "Register test\t(offline)",
118 "Eeprom test\t(offline)",
119 "Link test\t(online)",
120 "RLDRAM test\t(offline)",
121 "BIST Test\t(offline)"
122};
123
124static char ethtool_stats_keys[][ETH_GSTRING_LEN] = {
125 {"tmac_frms"},
126 {"tmac_data_octets"},
127 {"tmac_drop_frms"},
128 {"tmac_mcst_frms"},
129 {"tmac_bcst_frms"},
130 {"tmac_pause_ctrl_frms"},
131 {"tmac_any_err_frms"},
132 {"tmac_vld_ip_octets"},
133 {"tmac_vld_ip"},
134 {"tmac_drop_ip"},
135 {"tmac_icmp"},
136 {"tmac_rst_tcp"},
137 {"tmac_tcp"},
138 {"tmac_udp"},
139 {"rmac_vld_frms"},
140 {"rmac_data_octets"},
141 {"rmac_fcs_err_frms"},
142 {"rmac_drop_frms"},
143 {"rmac_vld_mcst_frms"},
144 {"rmac_vld_bcst_frms"},
145 {"rmac_in_rng_len_err_frms"},
146 {"rmac_long_frms"},
147 {"rmac_pause_ctrl_frms"},
148 {"rmac_discarded_frms"},
149 {"rmac_usized_frms"},
150 {"rmac_osized_frms"},
151 {"rmac_frag_frms"},
152 {"rmac_jabber_frms"},
153 {"rmac_ip"},
154 {"rmac_ip_octets"},
155 {"rmac_hdr_err_ip"},
156 {"rmac_drop_ip"},
157 {"rmac_icmp"},
158 {"rmac_tcp"},
159 {"rmac_udp"},
160 {"rmac_err_drp_udp"},
161 {"rmac_pause_cnt"},
162 {"rmac_accepted_ip"},
163 {"rmac_err_tcp"},
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -0700164 {"\n DRIVER STATISTICS"},
165 {"single_bit_ecc_errs"},
166 {"double_bit_ecc_errs"},
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167};
168
169#define S2IO_STAT_LEN sizeof(ethtool_stats_keys)/ ETH_GSTRING_LEN
170#define S2IO_STAT_STRINGS_LEN S2IO_STAT_LEN * ETH_GSTRING_LEN
171
172#define S2IO_TEST_LEN sizeof(s2io_gstrings) / ETH_GSTRING_LEN
173#define S2IO_STRINGS_LEN S2IO_TEST_LEN * ETH_GSTRING_LEN
174
raghavendra.koushik@neterion.com25fff882005-08-03 12:34:11 -0700175#define S2IO_TIMER_CONF(timer, handle, arg, exp) \
176 init_timer(&timer); \
177 timer.function = handle; \
178 timer.data = (unsigned long) arg; \
179 mod_timer(&timer, (jiffies + exp)) \
180
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -0700181/* Add the vlan */
182static void s2io_vlan_rx_register(struct net_device *dev,
183 struct vlan_group *grp)
184{
185 nic_t *nic = dev->priv;
186 unsigned long flags;
187
188 spin_lock_irqsave(&nic->tx_lock, flags);
189 nic->vlgrp = grp;
190 spin_unlock_irqrestore(&nic->tx_lock, flags);
191}
192
193/* Unregister the vlan */
194static void s2io_vlan_rx_kill_vid(struct net_device *dev, unsigned long vid)
195{
196 nic_t *nic = dev->priv;
197 unsigned long flags;
198
199 spin_lock_irqsave(&nic->tx_lock, flags);
200 if (nic->vlgrp)
201 nic->vlgrp->vlan_devices[vid] = NULL;
202 spin_unlock_irqrestore(&nic->tx_lock, flags);
203}
204
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700205/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206 * Constants to be programmed into the Xena's registers, to configure
207 * the XAUI.
208 */
209
210#define SWITCH_SIGN 0xA5A5A5A5A5A5A5A5ULL
211#define END_SIGN 0x0
212
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700213static u64 herc_act_dtx_cfg[] = {
214 /* Set address */
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -0700215 0x8000051536750000ULL, 0x80000515367500E0ULL,
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700216 /* Write data */
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -0700217 0x8000051536750004ULL, 0x80000515367500E4ULL,
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700218 /* Set address */
219 0x80010515003F0000ULL, 0x80010515003F00E0ULL,
220 /* Write data */
221 0x80010515003F0004ULL, 0x80010515003F00E4ULL,
222 /* Set address */
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -0700223 0x801205150D440000ULL, 0x801205150D4400E0ULL,
224 /* Write data */
225 0x801205150D440004ULL, 0x801205150D4400E4ULL,
226 /* Set address */
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700227 0x80020515F2100000ULL, 0x80020515F21000E0ULL,
228 /* Write data */
229 0x80020515F2100004ULL, 0x80020515F21000E4ULL,
230 /* Done */
231 END_SIGN
232};
233
234static u64 xena_mdio_cfg[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235 /* Reset PMA PLL */
236 0xC001010000000000ULL, 0xC0010100000000E0ULL,
237 0xC0010100008000E4ULL,
238 /* Remove Reset from PMA PLL */
239 0xC001010000000000ULL, 0xC0010100000000E0ULL,
240 0xC0010100000000E4ULL,
241 END_SIGN
242};
243
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700244static u64 xena_dtx_cfg[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 0x8000051500000000ULL, 0x80000515000000E0ULL,
246 0x80000515D93500E4ULL, 0x8001051500000000ULL,
247 0x80010515000000E0ULL, 0x80010515001E00E4ULL,
248 0x8002051500000000ULL, 0x80020515000000E0ULL,
249 0x80020515F21000E4ULL,
250 /* Set PADLOOPBACKN */
251 0x8002051500000000ULL, 0x80020515000000E0ULL,
252 0x80020515B20000E4ULL, 0x8003051500000000ULL,
253 0x80030515000000E0ULL, 0x80030515B20000E4ULL,
254 0x8004051500000000ULL, 0x80040515000000E0ULL,
255 0x80040515B20000E4ULL, 0x8005051500000000ULL,
256 0x80050515000000E0ULL, 0x80050515B20000E4ULL,
257 SWITCH_SIGN,
258 /* Remove PADLOOPBACKN */
259 0x8002051500000000ULL, 0x80020515000000E0ULL,
260 0x80020515F20000E4ULL, 0x8003051500000000ULL,
261 0x80030515000000E0ULL, 0x80030515F20000E4ULL,
262 0x8004051500000000ULL, 0x80040515000000E0ULL,
263 0x80040515F20000E4ULL, 0x8005051500000000ULL,
264 0x80050515000000E0ULL, 0x80050515F20000E4ULL,
265 END_SIGN
266};
267
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700268/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 * Constants for Fixing the MacAddress problem seen mostly on
270 * Alpha machines.
271 */
272static u64 fix_mac[] = {
273 0x0060000000000000ULL, 0x0060600000000000ULL,
274 0x0040600000000000ULL, 0x0000600000000000ULL,
275 0x0020600000000000ULL, 0x0060600000000000ULL,
276 0x0020600000000000ULL, 0x0060600000000000ULL,
277 0x0020600000000000ULL, 0x0060600000000000ULL,
278 0x0020600000000000ULL, 0x0060600000000000ULL,
279 0x0020600000000000ULL, 0x0060600000000000ULL,
280 0x0020600000000000ULL, 0x0060600000000000ULL,
281 0x0020600000000000ULL, 0x0060600000000000ULL,
282 0x0020600000000000ULL, 0x0060600000000000ULL,
283 0x0020600000000000ULL, 0x0060600000000000ULL,
284 0x0020600000000000ULL, 0x0060600000000000ULL,
285 0x0020600000000000ULL, 0x0000600000000000ULL,
286 0x0040600000000000ULL, 0x0060600000000000ULL,
287 END_SIGN
288};
289
290/* Module Loadable parameters. */
291static unsigned int tx_fifo_num = 1;
292static unsigned int tx_fifo_len[MAX_TX_FIFOS] =
293 {[0 ...(MAX_TX_FIFOS - 1)] = 0 };
294static unsigned int rx_ring_num = 1;
295static unsigned int rx_ring_sz[MAX_RX_RINGS] =
296 {[0 ...(MAX_RX_RINGS - 1)] = 0 };
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700297static unsigned int rts_frm_len[MAX_RX_RINGS] =
298 {[0 ...(MAX_RX_RINGS - 1)] = 0 };
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -0700299static unsigned int use_continuous_tx_intrs = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300static unsigned int rmac_pause_time = 65535;
301static unsigned int mc_pause_threshold_q0q3 = 187;
302static unsigned int mc_pause_threshold_q4q7 = 187;
303static unsigned int shared_splits;
304static unsigned int tmac_util_period = 5;
305static unsigned int rmac_util_period = 5;
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -0700306static unsigned int bimodal = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307#ifndef CONFIG_S2IO_NAPI
308static unsigned int indicate_max_pkts;
309#endif
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -0700310/* Frequency of Rx desc syncs expressed as power of 2 */
311static unsigned int rxsync_frequency = 3;
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -0400312/* Interrupt type. Values can be 0(INTA), 1(MSI), 2(MSI_X) */
313static unsigned int intr_type = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700314
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700315/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 * S2IO device table.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700317 * This table lists all the devices that this driver supports.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318 */
319static struct pci_device_id s2io_tbl[] __devinitdata = {
320 {PCI_VENDOR_ID_S2IO, PCI_DEVICE_ID_S2IO_WIN,
321 PCI_ANY_ID, PCI_ANY_ID},
322 {PCI_VENDOR_ID_S2IO, PCI_DEVICE_ID_S2IO_UNI,
323 PCI_ANY_ID, PCI_ANY_ID},
324 {PCI_VENDOR_ID_S2IO, PCI_DEVICE_ID_HERC_WIN,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700325 PCI_ANY_ID, PCI_ANY_ID},
326 {PCI_VENDOR_ID_S2IO, PCI_DEVICE_ID_HERC_UNI,
327 PCI_ANY_ID, PCI_ANY_ID},
Linus Torvalds1da177e2005-04-16 15:20:36 -0700328 {0,}
329};
330
331MODULE_DEVICE_TABLE(pci, s2io_tbl);
332
333static struct pci_driver s2io_driver = {
334 .name = "S2IO",
335 .id_table = s2io_tbl,
336 .probe = s2io_init_nic,
337 .remove = __devexit_p(s2io_rem_nic),
338};
339
340/* A simplifier macro used both by init and free shared_mem Fns(). */
341#define TXD_MEM_PAGE_CNT(len, per_each) ((len+per_each - 1) / per_each)
342
343/**
344 * init_shared_mem - Allocation and Initialization of Memory
345 * @nic: Device private variable.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700346 * Description: The function allocates all the memory areas shared
347 * between the NIC and the driver. This includes Tx descriptors,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348 * Rx descriptors and the statistics block.
349 */
350
351static int init_shared_mem(struct s2io_nic *nic)
352{
353 u32 size;
354 void *tmp_v_addr, *tmp_v_addr_next;
355 dma_addr_t tmp_p_addr, tmp_p_addr_next;
356 RxD_block_t *pre_rxd_blk = NULL;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700357 int i, j, blk_cnt, rx_sz, tx_sz;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 int lst_size, lst_per_page;
359 struct net_device *dev = nic->dev;
360#ifdef CONFIG_2BUFF_MODE
viro@zenIV.linux.org.uk8ae418c2005-09-02 20:15:29 +0100361 unsigned long tmp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 buffAdd_t *ba;
363#endif
364
365 mac_info_t *mac_control;
366 struct config_param *config;
367
368 mac_control = &nic->mac_control;
369 config = &nic->config;
370
371
372 /* Allocation and initialization of TXDLs in FIOFs */
373 size = 0;
374 for (i = 0; i < config->tx_fifo_num; i++) {
375 size += config->tx_cfg[i].fifo_len;
376 }
377 if (size > MAX_AVAILABLE_TXDS) {
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -0700378 DBG_PRINT(ERR_DBG, "%s: Requested TxDs too high, ",
379 __FUNCTION__);
380 DBG_PRINT(ERR_DBG, "Requested: %d, max supported: 8192\n", size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381 return FAILURE;
382 }
383
384 lst_size = (sizeof(TxD_t) * config->max_txds);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700385 tx_sz = lst_size * size;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386 lst_per_page = PAGE_SIZE / lst_size;
387
388 for (i = 0; i < config->tx_fifo_num; i++) {
389 int fifo_len = config->tx_cfg[i].fifo_len;
390 int list_holder_size = fifo_len * sizeof(list_info_hold_t);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700391 mac_control->fifos[i].list_info = kmalloc(list_holder_size,
392 GFP_KERNEL);
393 if (!mac_control->fifos[i].list_info) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394 DBG_PRINT(ERR_DBG,
395 "Malloc failed for list_info\n");
396 return -ENOMEM;
397 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700398 memset(mac_control->fifos[i].list_info, 0, list_holder_size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 }
400 for (i = 0; i < config->tx_fifo_num; i++) {
401 int page_num = TXD_MEM_PAGE_CNT(config->tx_cfg[i].fifo_len,
402 lst_per_page);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700403 mac_control->fifos[i].tx_curr_put_info.offset = 0;
404 mac_control->fifos[i].tx_curr_put_info.fifo_len =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405 config->tx_cfg[i].fifo_len - 1;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700406 mac_control->fifos[i].tx_curr_get_info.offset = 0;
407 mac_control->fifos[i].tx_curr_get_info.fifo_len =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 config->tx_cfg[i].fifo_len - 1;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700409 mac_control->fifos[i].fifo_no = i;
410 mac_control->fifos[i].nic = nic;
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -0700411 mac_control->fifos[i].max_txds = MAX_SKB_FRAGS + 1;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700412
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 for (j = 0; j < page_num; j++) {
414 int k = 0;
415 dma_addr_t tmp_p;
416 void *tmp_v;
417 tmp_v = pci_alloc_consistent(nic->pdev,
418 PAGE_SIZE, &tmp_p);
419 if (!tmp_v) {
420 DBG_PRINT(ERR_DBG,
421 "pci_alloc_consistent ");
422 DBG_PRINT(ERR_DBG, "failed for TxDL\n");
423 return -ENOMEM;
424 }
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -0700425 /* If we got a zero DMA address(can happen on
426 * certain platforms like PPC), reallocate.
427 * Store virtual address of page we don't want,
428 * to be freed later.
429 */
430 if (!tmp_p) {
431 mac_control->zerodma_virt_addr = tmp_v;
432 DBG_PRINT(INIT_DBG,
433 "%s: Zero DMA address for TxDL. ", dev->name);
434 DBG_PRINT(INIT_DBG,
Andrew Morton6b4d6172005-09-12 23:21:55 -0700435 "Virtual address %p\n", tmp_v);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -0700436 tmp_v = pci_alloc_consistent(nic->pdev,
437 PAGE_SIZE, &tmp_p);
438 if (!tmp_v) {
439 DBG_PRINT(ERR_DBG,
440 "pci_alloc_consistent ");
441 DBG_PRINT(ERR_DBG, "failed for TxDL\n");
442 return -ENOMEM;
443 }
444 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445 while (k < lst_per_page) {
446 int l = (j * lst_per_page) + k;
447 if (l == config->tx_cfg[i].fifo_len)
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700448 break;
449 mac_control->fifos[i].list_info[l].list_virt_addr =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450 tmp_v + (k * lst_size);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700451 mac_control->fifos[i].list_info[l].list_phy_addr =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452 tmp_p + (k * lst_size);
453 k++;
454 }
455 }
456 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457
458 /* Allocation and initialization of RXDs in Rings */
459 size = 0;
460 for (i = 0; i < config->rx_ring_num; i++) {
461 if (config->rx_cfg[i].num_rxd % (MAX_RXDS_PER_BLOCK + 1)) {
462 DBG_PRINT(ERR_DBG, "%s: RxD count of ", dev->name);
463 DBG_PRINT(ERR_DBG, "Ring%d is not a multiple of ",
464 i);
465 DBG_PRINT(ERR_DBG, "RxDs per Block");
466 return FAILURE;
467 }
468 size += config->rx_cfg[i].num_rxd;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700469 mac_control->rings[i].block_count =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700470 config->rx_cfg[i].num_rxd / (MAX_RXDS_PER_BLOCK + 1);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700471 mac_control->rings[i].pkt_cnt =
472 config->rx_cfg[i].num_rxd - mac_control->rings[i].block_count;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700474 size = (size * (sizeof(RxD_t)));
475 rx_sz = size;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476
477 for (i = 0; i < config->rx_ring_num; i++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700478 mac_control->rings[i].rx_curr_get_info.block_index = 0;
479 mac_control->rings[i].rx_curr_get_info.offset = 0;
480 mac_control->rings[i].rx_curr_get_info.ring_len =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 config->rx_cfg[i].num_rxd - 1;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700482 mac_control->rings[i].rx_curr_put_info.block_index = 0;
483 mac_control->rings[i].rx_curr_put_info.offset = 0;
484 mac_control->rings[i].rx_curr_put_info.ring_len =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 config->rx_cfg[i].num_rxd - 1;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700486 mac_control->rings[i].nic = nic;
487 mac_control->rings[i].ring_no = i;
488
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489 blk_cnt =
490 config->rx_cfg[i].num_rxd / (MAX_RXDS_PER_BLOCK + 1);
491 /* Allocating all the Rx blocks */
492 for (j = 0; j < blk_cnt; j++) {
493#ifndef CONFIG_2BUFF_MODE
494 size = (MAX_RXDS_PER_BLOCK + 1) * (sizeof(RxD_t));
495#else
496 size = SIZE_OF_BLOCK;
497#endif
498 tmp_v_addr = pci_alloc_consistent(nic->pdev, size,
499 &tmp_p_addr);
500 if (tmp_v_addr == NULL) {
501 /*
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700502 * In case of failure, free_shared_mem()
503 * is called, which should free any
504 * memory that was alloced till the
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 * failure happened.
506 */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700507 mac_control->rings[i].rx_blocks[j].block_virt_addr =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 tmp_v_addr;
509 return -ENOMEM;
510 }
511 memset(tmp_v_addr, 0, size);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700512 mac_control->rings[i].rx_blocks[j].block_virt_addr =
513 tmp_v_addr;
514 mac_control->rings[i].rx_blocks[j].block_dma_addr =
515 tmp_p_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516 }
517 /* Interlinking all Rx Blocks */
518 for (j = 0; j < blk_cnt; j++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700519 tmp_v_addr =
520 mac_control->rings[i].rx_blocks[j].block_virt_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 tmp_v_addr_next =
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700522 mac_control->rings[i].rx_blocks[(j + 1) %
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 blk_cnt].block_virt_addr;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700524 tmp_p_addr =
525 mac_control->rings[i].rx_blocks[j].block_dma_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526 tmp_p_addr_next =
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700527 mac_control->rings[i].rx_blocks[(j + 1) %
Linus Torvalds1da177e2005-04-16 15:20:36 -0700528 blk_cnt].block_dma_addr;
529
530 pre_rxd_blk = (RxD_block_t *) tmp_v_addr;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700531 pre_rxd_blk->reserved_1 = END_OF_BLOCK; /* last RxD
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 * marker.
533 */
534#ifndef CONFIG_2BUFF_MODE
535 pre_rxd_blk->reserved_2_pNext_RxD_block =
536 (unsigned long) tmp_v_addr_next;
537#endif
538 pre_rxd_blk->pNext_RxD_Blk_physical =
539 (u64) tmp_p_addr_next;
540 }
541 }
542
543#ifdef CONFIG_2BUFF_MODE
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700544 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 * Allocation of Storages for buffer addresses in 2BUFF mode
546 * and the buffers as well.
547 */
548 for (i = 0; i < config->rx_ring_num; i++) {
549 blk_cnt =
550 config->rx_cfg[i].num_rxd / (MAX_RXDS_PER_BLOCK + 1);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700551 mac_control->rings[i].ba = kmalloc((sizeof(buffAdd_t *) * blk_cnt),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552 GFP_KERNEL);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700553 if (!mac_control->rings[i].ba)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700554 return -ENOMEM;
555 for (j = 0; j < blk_cnt; j++) {
556 int k = 0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700557 mac_control->rings[i].ba[j] = kmalloc((sizeof(buffAdd_t) *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558 (MAX_RXDS_PER_BLOCK + 1)),
559 GFP_KERNEL);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700560 if (!mac_control->rings[i].ba[j])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 return -ENOMEM;
562 while (k != MAX_RXDS_PER_BLOCK) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700563 ba = &mac_control->rings[i].ba[j][k];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700565 ba->ba_0_org = (void *) kmalloc
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566 (BUF0_LEN + ALIGN_SIZE, GFP_KERNEL);
567 if (!ba->ba_0_org)
568 return -ENOMEM;
viro@zenIV.linux.org.uk8ae418c2005-09-02 20:15:29 +0100569 tmp = (unsigned long) ba->ba_0_org;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570 tmp += ALIGN_SIZE;
viro@zenIV.linux.org.uk8ae418c2005-09-02 20:15:29 +0100571 tmp &= ~((unsigned long) ALIGN_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 ba->ba_0 = (void *) tmp;
573
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700574 ba->ba_1_org = (void *) kmalloc
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 (BUF1_LEN + ALIGN_SIZE, GFP_KERNEL);
576 if (!ba->ba_1_org)
577 return -ENOMEM;
viro@zenIV.linux.org.uk8ae418c2005-09-02 20:15:29 +0100578 tmp = (unsigned long) ba->ba_1_org;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579 tmp += ALIGN_SIZE;
viro@zenIV.linux.org.uk8ae418c2005-09-02 20:15:29 +0100580 tmp &= ~((unsigned long) ALIGN_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 ba->ba_1 = (void *) tmp;
582 k++;
583 }
584 }
585 }
586#endif
587
588 /* Allocation and initialization of Statistics block */
589 size = sizeof(StatInfo_t);
590 mac_control->stats_mem = pci_alloc_consistent
591 (nic->pdev, size, &mac_control->stats_mem_phy);
592
593 if (!mac_control->stats_mem) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700594 /*
595 * In case of failure, free_shared_mem() is called, which
596 * should free any memory that was alloced till the
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597 * failure happened.
598 */
599 return -ENOMEM;
600 }
601 mac_control->stats_mem_sz = size;
602
603 tmp_v_addr = mac_control->stats_mem;
604 mac_control->stats_info = (StatInfo_t *) tmp_v_addr;
605 memset(tmp_v_addr, 0, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606 DBG_PRINT(INIT_DBG, "%s:Ring Mem PHY: 0x%llx\n", dev->name,
607 (unsigned long long) tmp_p_addr);
608
609 return SUCCESS;
610}
611
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700612/**
613 * free_shared_mem - Free the allocated Memory
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 * @nic: Device private variable.
615 * Description: This function is to free all memory locations allocated by
616 * the init_shared_mem() function and return it to the kernel.
617 */
618
619static void free_shared_mem(struct s2io_nic *nic)
620{
621 int i, j, blk_cnt, size;
622 void *tmp_v_addr;
623 dma_addr_t tmp_p_addr;
624 mac_info_t *mac_control;
625 struct config_param *config;
626 int lst_size, lst_per_page;
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -0700627 struct net_device *dev = nic->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628
629 if (!nic)
630 return;
631
632 mac_control = &nic->mac_control;
633 config = &nic->config;
634
635 lst_size = (sizeof(TxD_t) * config->max_txds);
636 lst_per_page = PAGE_SIZE / lst_size;
637
638 for (i = 0; i < config->tx_fifo_num; i++) {
639 int page_num = TXD_MEM_PAGE_CNT(config->tx_cfg[i].fifo_len,
640 lst_per_page);
641 for (j = 0; j < page_num; j++) {
642 int mem_blks = (j * lst_per_page);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -0700643 if (!mac_control->fifos[i].list_info)
644 return;
645 if (!mac_control->fifos[i].list_info[mem_blks].
646 list_virt_addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647 break;
648 pci_free_consistent(nic->pdev, PAGE_SIZE,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700649 mac_control->fifos[i].
650 list_info[mem_blks].
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 list_virt_addr,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700652 mac_control->fifos[i].
653 list_info[mem_blks].
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 list_phy_addr);
655 }
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -0700656 /* If we got a zero DMA address during allocation,
657 * free the page now
658 */
659 if (mac_control->zerodma_virt_addr) {
660 pci_free_consistent(nic->pdev, PAGE_SIZE,
661 mac_control->zerodma_virt_addr,
662 (dma_addr_t)0);
663 DBG_PRINT(INIT_DBG,
Andrew Morton6b4d6172005-09-12 23:21:55 -0700664 "%s: Freeing TxDL with zero DMA addr. ",
665 dev->name);
666 DBG_PRINT(INIT_DBG, "Virtual address %p\n",
667 mac_control->zerodma_virt_addr);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -0700668 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700669 kfree(mac_control->fifos[i].list_info);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 }
671
672#ifndef CONFIG_2BUFF_MODE
673 size = (MAX_RXDS_PER_BLOCK + 1) * (sizeof(RxD_t));
674#else
675 size = SIZE_OF_BLOCK;
676#endif
677 for (i = 0; i < config->rx_ring_num; i++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700678 blk_cnt = mac_control->rings[i].block_count;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 for (j = 0; j < blk_cnt; j++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700680 tmp_v_addr = mac_control->rings[i].rx_blocks[j].
681 block_virt_addr;
682 tmp_p_addr = mac_control->rings[i].rx_blocks[j].
683 block_dma_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684 if (tmp_v_addr == NULL)
685 break;
686 pci_free_consistent(nic->pdev, size,
687 tmp_v_addr, tmp_p_addr);
688 }
689 }
690
691#ifdef CONFIG_2BUFF_MODE
692 /* Freeing buffer storage addresses in 2BUFF mode. */
693 for (i = 0; i < config->rx_ring_num; i++) {
694 blk_cnt =
695 config->rx_cfg[i].num_rxd / (MAX_RXDS_PER_BLOCK + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 for (j = 0; j < blk_cnt; j++) {
697 int k = 0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700698 if (!mac_control->rings[i].ba[j])
699 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700 while (k != MAX_RXDS_PER_BLOCK) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700701 buffAdd_t *ba = &mac_control->rings[i].ba[j][k];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 kfree(ba->ba_0_org);
703 kfree(ba->ba_1_org);
704 k++;
705 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700706 kfree(mac_control->rings[i].ba[j]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700708 if (mac_control->rings[i].ba)
709 kfree(mac_control->rings[i].ba);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711#endif
712
713 if (mac_control->stats_mem) {
714 pci_free_consistent(nic->pdev,
715 mac_control->stats_mem_sz,
716 mac_control->stats_mem,
717 mac_control->stats_mem_phy);
718 }
719}
720
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700721/**
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700722 * s2io_verify_pci_mode -
723 */
724
725static int s2io_verify_pci_mode(nic_t *nic)
726{
viro@ftp.linux.org.uk509a2672005-09-05 03:25:58 +0100727 XENA_dev_config_t __iomem *bar0 = nic->bar0;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700728 register u64 val64 = 0;
729 int mode;
730
731 val64 = readq(&bar0->pci_mode);
732 mode = (u8)GET_PCI_MODE(val64);
733
734 if ( val64 & PCI_MODE_UNKNOWN_MODE)
735 return -1; /* Unknown PCI mode */
736 return mode;
737}
738
739
740/**
741 * s2io_print_pci_mode -
742 */
743static int s2io_print_pci_mode(nic_t *nic)
744{
viro@ftp.linux.org.uk509a2672005-09-05 03:25:58 +0100745 XENA_dev_config_t __iomem *bar0 = nic->bar0;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700746 register u64 val64 = 0;
747 int mode;
748 struct config_param *config = &nic->config;
749
750 val64 = readq(&bar0->pci_mode);
751 mode = (u8)GET_PCI_MODE(val64);
752
753 if ( val64 & PCI_MODE_UNKNOWN_MODE)
754 return -1; /* Unknown PCI mode */
755
756 if (val64 & PCI_MODE_32_BITS) {
757 DBG_PRINT(ERR_DBG, "%s: Device is on 32 bit ", nic->dev->name);
758 } else {
759 DBG_PRINT(ERR_DBG, "%s: Device is on 64 bit ", nic->dev->name);
760 }
761
762 switch(mode) {
763 case PCI_MODE_PCI_33:
764 DBG_PRINT(ERR_DBG, "33MHz PCI bus\n");
765 config->bus_speed = 33;
766 break;
767 case PCI_MODE_PCI_66:
768 DBG_PRINT(ERR_DBG, "66MHz PCI bus\n");
769 config->bus_speed = 133;
770 break;
771 case PCI_MODE_PCIX_M1_66:
772 DBG_PRINT(ERR_DBG, "66MHz PCIX(M1) bus\n");
773 config->bus_speed = 133; /* Herc doubles the clock rate */
774 break;
775 case PCI_MODE_PCIX_M1_100:
776 DBG_PRINT(ERR_DBG, "100MHz PCIX(M1) bus\n");
777 config->bus_speed = 200;
778 break;
779 case PCI_MODE_PCIX_M1_133:
780 DBG_PRINT(ERR_DBG, "133MHz PCIX(M1) bus\n");
781 config->bus_speed = 266;
782 break;
783 case PCI_MODE_PCIX_M2_66:
784 DBG_PRINT(ERR_DBG, "133MHz PCIX(M2) bus\n");
785 config->bus_speed = 133;
786 break;
787 case PCI_MODE_PCIX_M2_100:
788 DBG_PRINT(ERR_DBG, "200MHz PCIX(M2) bus\n");
789 config->bus_speed = 200;
790 break;
791 case PCI_MODE_PCIX_M2_133:
792 DBG_PRINT(ERR_DBG, "266MHz PCIX(M2) bus\n");
793 config->bus_speed = 266;
794 break;
795 default:
796 return -1; /* Unsupported bus speed */
797 }
798
799 return mode;
800}
801
802/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700803 * init_nic - Initialization of hardware
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804 * @nic: device peivate variable
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700805 * Description: The function sequentially configures every block
806 * of the H/W from their reset values.
807 * Return Value: SUCCESS on success and
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808 * '-1' on failure (endian settings incorrect).
809 */
810
811static int init_nic(struct s2io_nic *nic)
812{
813 XENA_dev_config_t __iomem *bar0 = nic->bar0;
814 struct net_device *dev = nic->dev;
815 register u64 val64 = 0;
816 void __iomem *add;
817 u32 time;
818 int i, j;
819 mac_info_t *mac_control;
820 struct config_param *config;
821 int mdio_cnt = 0, dtx_cnt = 0;
822 unsigned long long mem_share;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700823 int mem_size;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824
825 mac_control = &nic->mac_control;
826 config = &nic->config;
827
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -0700828 /* to set the swapper controle on the card */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700829 if(s2io_set_swapper(nic)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830 DBG_PRINT(ERR_DBG,"ERROR: Setting Swapper failed\n");
831 return -1;
832 }
833
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700834 /*
835 * Herc requires EOI to be removed from reset before XGXS, so..
836 */
837 if (nic->device_type & XFRAME_II_DEVICE) {
838 val64 = 0xA500000000ULL;
839 writeq(val64, &bar0->sw_reset);
840 msleep(500);
841 val64 = readq(&bar0->sw_reset);
842 }
843
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 /* Remove XGXS from reset state */
845 val64 = 0;
846 writeq(val64, &bar0->sw_reset);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847 msleep(500);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700848 val64 = readq(&bar0->sw_reset);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849
850 /* Enable Receiving broadcasts */
851 add = &bar0->mac_cfg;
852 val64 = readq(&bar0->mac_cfg);
853 val64 |= MAC_RMAC_BCAST_ENABLE;
854 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
855 writel((u32) val64, add);
856 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
857 writel((u32) (val64 >> 32), (add + 4));
858
859 /* Read registers in all blocks */
860 val64 = readq(&bar0->mac_int_mask);
861 val64 = readq(&bar0->mc_int_mask);
862 val64 = readq(&bar0->xgxs_int_mask);
863
864 /* Set MTU */
865 val64 = dev->mtu;
866 writeq(vBIT(val64, 2, 14), &bar0->rmac_max_pyld_len);
867
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700868 /*
869 * Configuring the XAUI Interface of Xena.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870 * ***************************************
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700871 * To Configure the Xena's XAUI, one has to write a series
872 * of 64 bit values into two registers in a particular
873 * sequence. Hence a macro 'SWITCH_SIGN' has been defined
874 * which will be defined in the array of configuration values
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700875 * (xena_dtx_cfg & xena_mdio_cfg) at appropriate places
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700876 * to switch writing from one regsiter to another. We continue
Linus Torvalds1da177e2005-04-16 15:20:36 -0700877 * writing these values until we encounter the 'END_SIGN' macro.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700878 * For example, After making a series of 21 writes into
879 * dtx_control register the 'SWITCH_SIGN' appears and hence we
Linus Torvalds1da177e2005-04-16 15:20:36 -0700880 * start writing into mdio_control until we encounter END_SIGN.
881 */
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700882 if (nic->device_type & XFRAME_II_DEVICE) {
883 while (herc_act_dtx_cfg[dtx_cnt] != END_SIGN) {
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -0700884 SPECIAL_REG_WRITE(herc_act_dtx_cfg[dtx_cnt],
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885 &bar0->dtx_control, UF);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700886 if (dtx_cnt & 0x1)
887 msleep(1); /* Necessary!! */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888 dtx_cnt++;
889 }
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700890 } else {
891 while (1) {
892 dtx_cfg:
893 while (xena_dtx_cfg[dtx_cnt] != END_SIGN) {
894 if (xena_dtx_cfg[dtx_cnt] == SWITCH_SIGN) {
895 dtx_cnt++;
896 goto mdio_cfg;
897 }
898 SPECIAL_REG_WRITE(xena_dtx_cfg[dtx_cnt],
899 &bar0->dtx_control, UF);
900 val64 = readq(&bar0->dtx_control);
901 dtx_cnt++;
902 }
903 mdio_cfg:
904 while (xena_mdio_cfg[mdio_cnt] != END_SIGN) {
905 if (xena_mdio_cfg[mdio_cnt] == SWITCH_SIGN) {
906 mdio_cnt++;
907 goto dtx_cfg;
908 }
909 SPECIAL_REG_WRITE(xena_mdio_cfg[mdio_cnt],
910 &bar0->mdio_control, UF);
911 val64 = readq(&bar0->mdio_control);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912 mdio_cnt++;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700913 }
914 if ((xena_dtx_cfg[dtx_cnt] == END_SIGN) &&
915 (xena_mdio_cfg[mdio_cnt] == END_SIGN)) {
916 break;
917 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918 goto dtx_cfg;
919 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700920 }
921 }
922
923 /* Tx DMA Initialization */
924 val64 = 0;
925 writeq(val64, &bar0->tx_fifo_partition_0);
926 writeq(val64, &bar0->tx_fifo_partition_1);
927 writeq(val64, &bar0->tx_fifo_partition_2);
928 writeq(val64, &bar0->tx_fifo_partition_3);
929
930
931 for (i = 0, j = 0; i < config->tx_fifo_num; i++) {
932 val64 |=
933 vBIT(config->tx_cfg[i].fifo_len - 1, ((i * 32) + 19),
934 13) | vBIT(config->tx_cfg[i].fifo_priority,
935 ((i * 32) + 5), 3);
936
937 if (i == (config->tx_fifo_num - 1)) {
938 if (i % 2 == 0)
939 i++;
940 }
941
942 switch (i) {
943 case 1:
944 writeq(val64, &bar0->tx_fifo_partition_0);
945 val64 = 0;
946 break;
947 case 3:
948 writeq(val64, &bar0->tx_fifo_partition_1);
949 val64 = 0;
950 break;
951 case 5:
952 writeq(val64, &bar0->tx_fifo_partition_2);
953 val64 = 0;
954 break;
955 case 7:
956 writeq(val64, &bar0->tx_fifo_partition_3);
957 break;
958 }
959 }
960
961 /* Enable Tx FIFO partition 0. */
962 val64 = readq(&bar0->tx_fifo_partition_0);
963 val64 |= BIT(0); /* To enable the FIFO partition. */
964 writeq(val64, &bar0->tx_fifo_partition_0);
965
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -0700966 /*
967 * Disable 4 PCCs for Xena1, 2 and 3 as per H/W bug
968 * SXE-008 TRANSMIT DMA ARBITRATION ISSUE.
969 */
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -0700970 if ((nic->device_type == XFRAME_I_DEVICE) &&
971 (get_xena_rev_id(nic->pdev) < 4))
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -0700972 writeq(PCC_ENABLE_FOUR, &bar0->pcc_enable);
973
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974 val64 = readq(&bar0->tx_fifo_partition_0);
975 DBG_PRINT(INIT_DBG, "Fifo partition at: 0x%p is: 0x%llx\n",
976 &bar0->tx_fifo_partition_0, (unsigned long long) val64);
977
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700978 /*
979 * Initialization of Tx_PA_CONFIG register to ignore packet
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980 * integrity checking.
981 */
982 val64 = readq(&bar0->tx_pa_cfg);
983 val64 |= TX_PA_CFG_IGNORE_FRM_ERR | TX_PA_CFG_IGNORE_SNAP_OUI |
984 TX_PA_CFG_IGNORE_LLC_CTRL | TX_PA_CFG_IGNORE_L2_ERR;
985 writeq(val64, &bar0->tx_pa_cfg);
986
987 /* Rx DMA intialization. */
988 val64 = 0;
989 for (i = 0; i < config->rx_ring_num; i++) {
990 val64 |=
991 vBIT(config->rx_cfg[i].ring_priority, (5 + (i * 8)),
992 3);
993 }
994 writeq(val64, &bar0->rx_queue_priority);
995
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -0700996 /*
997 * Allocating equal share of memory to all the
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998 * configured Rings.
999 */
1000 val64 = 0;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001001 if (nic->device_type & XFRAME_II_DEVICE)
1002 mem_size = 32;
1003 else
1004 mem_size = 64;
1005
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006 for (i = 0; i < config->rx_ring_num; i++) {
1007 switch (i) {
1008 case 0:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001009 mem_share = (mem_size / config->rx_ring_num +
1010 mem_size % config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001011 val64 |= RX_QUEUE_CFG_Q0_SZ(mem_share);
1012 continue;
1013 case 1:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001014 mem_share = (mem_size / config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001015 val64 |= RX_QUEUE_CFG_Q1_SZ(mem_share);
1016 continue;
1017 case 2:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001018 mem_share = (mem_size / config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001019 val64 |= RX_QUEUE_CFG_Q2_SZ(mem_share);
1020 continue;
1021 case 3:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001022 mem_share = (mem_size / config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023 val64 |= RX_QUEUE_CFG_Q3_SZ(mem_share);
1024 continue;
1025 case 4:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001026 mem_share = (mem_size / config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001027 val64 |= RX_QUEUE_CFG_Q4_SZ(mem_share);
1028 continue;
1029 case 5:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001030 mem_share = (mem_size / config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001031 val64 |= RX_QUEUE_CFG_Q5_SZ(mem_share);
1032 continue;
1033 case 6:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001034 mem_share = (mem_size / config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001035 val64 |= RX_QUEUE_CFG_Q6_SZ(mem_share);
1036 continue;
1037 case 7:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001038 mem_share = (mem_size / config->rx_ring_num);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 val64 |= RX_QUEUE_CFG_Q7_SZ(mem_share);
1040 continue;
1041 }
1042 }
1043 writeq(val64, &bar0->rx_queue_cfg);
1044
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001045 /*
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001046 * Filling Tx round robin registers
1047 * as per the number of FIFOs
Linus Torvalds1da177e2005-04-16 15:20:36 -07001048 */
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001049 switch (config->tx_fifo_num) {
1050 case 1:
1051 val64 = 0x0000000000000000ULL;
1052 writeq(val64, &bar0->tx_w_round_robin_0);
1053 writeq(val64, &bar0->tx_w_round_robin_1);
1054 writeq(val64, &bar0->tx_w_round_robin_2);
1055 writeq(val64, &bar0->tx_w_round_robin_3);
1056 writeq(val64, &bar0->tx_w_round_robin_4);
1057 break;
1058 case 2:
1059 val64 = 0x0000010000010000ULL;
1060 writeq(val64, &bar0->tx_w_round_robin_0);
1061 val64 = 0x0100000100000100ULL;
1062 writeq(val64, &bar0->tx_w_round_robin_1);
1063 val64 = 0x0001000001000001ULL;
1064 writeq(val64, &bar0->tx_w_round_robin_2);
1065 val64 = 0x0000010000010000ULL;
1066 writeq(val64, &bar0->tx_w_round_robin_3);
1067 val64 = 0x0100000000000000ULL;
1068 writeq(val64, &bar0->tx_w_round_robin_4);
1069 break;
1070 case 3:
1071 val64 = 0x0001000102000001ULL;
1072 writeq(val64, &bar0->tx_w_round_robin_0);
1073 val64 = 0x0001020000010001ULL;
1074 writeq(val64, &bar0->tx_w_round_robin_1);
1075 val64 = 0x0200000100010200ULL;
1076 writeq(val64, &bar0->tx_w_round_robin_2);
1077 val64 = 0x0001000102000001ULL;
1078 writeq(val64, &bar0->tx_w_round_robin_3);
1079 val64 = 0x0001020000000000ULL;
1080 writeq(val64, &bar0->tx_w_round_robin_4);
1081 break;
1082 case 4:
1083 val64 = 0x0001020300010200ULL;
1084 writeq(val64, &bar0->tx_w_round_robin_0);
1085 val64 = 0x0100000102030001ULL;
1086 writeq(val64, &bar0->tx_w_round_robin_1);
1087 val64 = 0x0200010000010203ULL;
1088 writeq(val64, &bar0->tx_w_round_robin_2);
1089 val64 = 0x0001020001000001ULL;
1090 writeq(val64, &bar0->tx_w_round_robin_3);
1091 val64 = 0x0203000100000000ULL;
1092 writeq(val64, &bar0->tx_w_round_robin_4);
1093 break;
1094 case 5:
1095 val64 = 0x0001000203000102ULL;
1096 writeq(val64, &bar0->tx_w_round_robin_0);
1097 val64 = 0x0001020001030004ULL;
1098 writeq(val64, &bar0->tx_w_round_robin_1);
1099 val64 = 0x0001000203000102ULL;
1100 writeq(val64, &bar0->tx_w_round_robin_2);
1101 val64 = 0x0001020001030004ULL;
1102 writeq(val64, &bar0->tx_w_round_robin_3);
1103 val64 = 0x0001000000000000ULL;
1104 writeq(val64, &bar0->tx_w_round_robin_4);
1105 break;
1106 case 6:
1107 val64 = 0x0001020304000102ULL;
1108 writeq(val64, &bar0->tx_w_round_robin_0);
1109 val64 = 0x0304050001020001ULL;
1110 writeq(val64, &bar0->tx_w_round_robin_1);
1111 val64 = 0x0203000100000102ULL;
1112 writeq(val64, &bar0->tx_w_round_robin_2);
1113 val64 = 0x0304000102030405ULL;
1114 writeq(val64, &bar0->tx_w_round_robin_3);
1115 val64 = 0x0001000200000000ULL;
1116 writeq(val64, &bar0->tx_w_round_robin_4);
1117 break;
1118 case 7:
1119 val64 = 0x0001020001020300ULL;
1120 writeq(val64, &bar0->tx_w_round_robin_0);
1121 val64 = 0x0102030400010203ULL;
1122 writeq(val64, &bar0->tx_w_round_robin_1);
1123 val64 = 0x0405060001020001ULL;
1124 writeq(val64, &bar0->tx_w_round_robin_2);
1125 val64 = 0x0304050000010200ULL;
1126 writeq(val64, &bar0->tx_w_round_robin_3);
1127 val64 = 0x0102030000000000ULL;
1128 writeq(val64, &bar0->tx_w_round_robin_4);
1129 break;
1130 case 8:
1131 val64 = 0x0001020300040105ULL;
1132 writeq(val64, &bar0->tx_w_round_robin_0);
1133 val64 = 0x0200030106000204ULL;
1134 writeq(val64, &bar0->tx_w_round_robin_1);
1135 val64 = 0x0103000502010007ULL;
1136 writeq(val64, &bar0->tx_w_round_robin_2);
1137 val64 = 0x0304010002060500ULL;
1138 writeq(val64, &bar0->tx_w_round_robin_3);
1139 val64 = 0x0103020400000000ULL;
1140 writeq(val64, &bar0->tx_w_round_robin_4);
1141 break;
1142 }
1143
1144 /* Filling the Rx round robin registers as per the
1145 * number of Rings and steering based on QoS.
1146 */
1147 switch (config->rx_ring_num) {
1148 case 1:
1149 val64 = 0x8080808080808080ULL;
1150 writeq(val64, &bar0->rts_qos_steering);
1151 break;
1152 case 2:
1153 val64 = 0x0000010000010000ULL;
1154 writeq(val64, &bar0->rx_w_round_robin_0);
1155 val64 = 0x0100000100000100ULL;
1156 writeq(val64, &bar0->rx_w_round_robin_1);
1157 val64 = 0x0001000001000001ULL;
1158 writeq(val64, &bar0->rx_w_round_robin_2);
1159 val64 = 0x0000010000010000ULL;
1160 writeq(val64, &bar0->rx_w_round_robin_3);
1161 val64 = 0x0100000000000000ULL;
1162 writeq(val64, &bar0->rx_w_round_robin_4);
1163
1164 val64 = 0x8080808040404040ULL;
1165 writeq(val64, &bar0->rts_qos_steering);
1166 break;
1167 case 3:
1168 val64 = 0x0001000102000001ULL;
1169 writeq(val64, &bar0->rx_w_round_robin_0);
1170 val64 = 0x0001020000010001ULL;
1171 writeq(val64, &bar0->rx_w_round_robin_1);
1172 val64 = 0x0200000100010200ULL;
1173 writeq(val64, &bar0->rx_w_round_robin_2);
1174 val64 = 0x0001000102000001ULL;
1175 writeq(val64, &bar0->rx_w_round_robin_3);
1176 val64 = 0x0001020000000000ULL;
1177 writeq(val64, &bar0->rx_w_round_robin_4);
1178
1179 val64 = 0x8080804040402020ULL;
1180 writeq(val64, &bar0->rts_qos_steering);
1181 break;
1182 case 4:
1183 val64 = 0x0001020300010200ULL;
1184 writeq(val64, &bar0->rx_w_round_robin_0);
1185 val64 = 0x0100000102030001ULL;
1186 writeq(val64, &bar0->rx_w_round_robin_1);
1187 val64 = 0x0200010000010203ULL;
1188 writeq(val64, &bar0->rx_w_round_robin_2);
1189 val64 = 0x0001020001000001ULL;
1190 writeq(val64, &bar0->rx_w_round_robin_3);
1191 val64 = 0x0203000100000000ULL;
1192 writeq(val64, &bar0->rx_w_round_robin_4);
1193
1194 val64 = 0x8080404020201010ULL;
1195 writeq(val64, &bar0->rts_qos_steering);
1196 break;
1197 case 5:
1198 val64 = 0x0001000203000102ULL;
1199 writeq(val64, &bar0->rx_w_round_robin_0);
1200 val64 = 0x0001020001030004ULL;
1201 writeq(val64, &bar0->rx_w_round_robin_1);
1202 val64 = 0x0001000203000102ULL;
1203 writeq(val64, &bar0->rx_w_round_robin_2);
1204 val64 = 0x0001020001030004ULL;
1205 writeq(val64, &bar0->rx_w_round_robin_3);
1206 val64 = 0x0001000000000000ULL;
1207 writeq(val64, &bar0->rx_w_round_robin_4);
1208
1209 val64 = 0x8080404020201008ULL;
1210 writeq(val64, &bar0->rts_qos_steering);
1211 break;
1212 case 6:
1213 val64 = 0x0001020304000102ULL;
1214 writeq(val64, &bar0->rx_w_round_robin_0);
1215 val64 = 0x0304050001020001ULL;
1216 writeq(val64, &bar0->rx_w_round_robin_1);
1217 val64 = 0x0203000100000102ULL;
1218 writeq(val64, &bar0->rx_w_round_robin_2);
1219 val64 = 0x0304000102030405ULL;
1220 writeq(val64, &bar0->rx_w_round_robin_3);
1221 val64 = 0x0001000200000000ULL;
1222 writeq(val64, &bar0->rx_w_round_robin_4);
1223
1224 val64 = 0x8080404020100804ULL;
1225 writeq(val64, &bar0->rts_qos_steering);
1226 break;
1227 case 7:
1228 val64 = 0x0001020001020300ULL;
1229 writeq(val64, &bar0->rx_w_round_robin_0);
1230 val64 = 0x0102030400010203ULL;
1231 writeq(val64, &bar0->rx_w_round_robin_1);
1232 val64 = 0x0405060001020001ULL;
1233 writeq(val64, &bar0->rx_w_round_robin_2);
1234 val64 = 0x0304050000010200ULL;
1235 writeq(val64, &bar0->rx_w_round_robin_3);
1236 val64 = 0x0102030000000000ULL;
1237 writeq(val64, &bar0->rx_w_round_robin_4);
1238
1239 val64 = 0x8080402010080402ULL;
1240 writeq(val64, &bar0->rts_qos_steering);
1241 break;
1242 case 8:
1243 val64 = 0x0001020300040105ULL;
1244 writeq(val64, &bar0->rx_w_round_robin_0);
1245 val64 = 0x0200030106000204ULL;
1246 writeq(val64, &bar0->rx_w_round_robin_1);
1247 val64 = 0x0103000502010007ULL;
1248 writeq(val64, &bar0->rx_w_round_robin_2);
1249 val64 = 0x0304010002060500ULL;
1250 writeq(val64, &bar0->rx_w_round_robin_3);
1251 val64 = 0x0103020400000000ULL;
1252 writeq(val64, &bar0->rx_w_round_robin_4);
1253
1254 val64 = 0x8040201008040201ULL;
1255 writeq(val64, &bar0->rts_qos_steering);
1256 break;
1257 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001258
1259 /* UDP Fix */
1260 val64 = 0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001261 for (i = 0; i < 8; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001262 writeq(val64, &bar0->rts_frm_len_n[i]);
1263
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001264 /* Set the default rts frame length for the rings configured */
1265 val64 = MAC_RTS_FRM_LEN_SET(dev->mtu+22);
1266 for (i = 0 ; i < config->rx_ring_num ; i++)
1267 writeq(val64, &bar0->rts_frm_len_n[i]);
1268
1269 /* Set the frame length for the configured rings
1270 * desired by the user
1271 */
1272 for (i = 0; i < config->rx_ring_num; i++) {
1273 /* If rts_frm_len[i] == 0 then it is assumed that user not
1274 * specified frame length steering.
1275 * If the user provides the frame length then program
1276 * the rts_frm_len register for those values or else
1277 * leave it as it is.
1278 */
1279 if (rts_frm_len[i] != 0) {
1280 writeq(MAC_RTS_FRM_LEN_SET(rts_frm_len[i]),
1281 &bar0->rts_frm_len_n[i]);
1282 }
1283 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001284
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001285 /* Program statistics memory */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001286 writeq(mac_control->stats_mem_phy, &bar0->stat_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001288 if (nic->device_type == XFRAME_II_DEVICE) {
1289 val64 = STAT_BC(0x320);
1290 writeq(val64, &bar0->stat_byte_cnt);
1291 }
1292
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001293 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294 * Initializing the sampling rate for the device to calculate the
1295 * bandwidth utilization.
1296 */
1297 val64 = MAC_TX_LINK_UTIL_VAL(tmac_util_period) |
1298 MAC_RX_LINK_UTIL_VAL(rmac_util_period);
1299 writeq(val64, &bar0->mac_link_util);
1300
1301
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001302 /*
1303 * Initializing the Transmit and Receive Traffic Interrupt
Linus Torvalds1da177e2005-04-16 15:20:36 -07001304 * Scheme.
1305 */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001306 /*
1307 * TTI Initialization. Default Tx timer gets us about
Linus Torvalds1da177e2005-04-16 15:20:36 -07001308 * 250 interrupts per sec. Continuous interrupts are enabled
1309 * by default.
1310 */
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001311 if (nic->device_type == XFRAME_II_DEVICE) {
1312 int count = (nic->config.bus_speed * 125)/2;
1313 val64 = TTI_DATA1_MEM_TX_TIMER_VAL(count);
1314 } else {
1315
1316 val64 = TTI_DATA1_MEM_TX_TIMER_VAL(0x2078);
1317 }
1318 val64 |= TTI_DATA1_MEM_TX_URNG_A(0xA) |
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319 TTI_DATA1_MEM_TX_URNG_B(0x10) |
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001320 TTI_DATA1_MEM_TX_URNG_C(0x30) | TTI_DATA1_MEM_TX_TIMER_AC_EN;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001321 if (use_continuous_tx_intrs)
1322 val64 |= TTI_DATA1_MEM_TX_TIMER_CI_EN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 writeq(val64, &bar0->tti_data1_mem);
1324
1325 val64 = TTI_DATA2_MEM_TX_UFC_A(0x10) |
1326 TTI_DATA2_MEM_TX_UFC_B(0x20) |
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001327 TTI_DATA2_MEM_TX_UFC_C(0x70) | TTI_DATA2_MEM_TX_UFC_D(0x80);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328 writeq(val64, &bar0->tti_data2_mem);
1329
1330 val64 = TTI_CMD_MEM_WE | TTI_CMD_MEM_STROBE_NEW_CMD;
1331 writeq(val64, &bar0->tti_command_mem);
1332
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001333 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001334 * Once the operation completes, the Strobe bit of the command
1335 * register will be reset. We poll for this particular condition
1336 * We wait for a maximum of 500ms for the operation to complete,
1337 * if it's not complete by then we return error.
1338 */
1339 time = 0;
1340 while (TRUE) {
1341 val64 = readq(&bar0->tti_command_mem);
1342 if (!(val64 & TTI_CMD_MEM_STROBE_NEW_CMD)) {
1343 break;
1344 }
1345 if (time > 10) {
1346 DBG_PRINT(ERR_DBG, "%s: TTI init Failed\n",
1347 dev->name);
1348 return -1;
1349 }
1350 msleep(50);
1351 time++;
1352 }
1353
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07001354 if (nic->config.bimodal) {
1355 int k = 0;
1356 for (k = 0; k < config->rx_ring_num; k++) {
1357 val64 = TTI_CMD_MEM_WE | TTI_CMD_MEM_STROBE_NEW_CMD;
1358 val64 |= TTI_CMD_MEM_OFFSET(0x38+k);
1359 writeq(val64, &bar0->tti_command_mem);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001360
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001361 /*
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07001362 * Once the operation completes, the Strobe bit of the command
1363 * register will be reset. We poll for this particular condition
1364 * We wait for a maximum of 500ms for the operation to complete,
1365 * if it's not complete by then we return error.
1366 */
1367 time = 0;
1368 while (TRUE) {
1369 val64 = readq(&bar0->tti_command_mem);
1370 if (!(val64 & TTI_CMD_MEM_STROBE_NEW_CMD)) {
1371 break;
1372 }
1373 if (time > 10) {
1374 DBG_PRINT(ERR_DBG,
1375 "%s: TTI init Failed\n",
1376 dev->name);
1377 return -1;
1378 }
1379 time++;
1380 msleep(50);
1381 }
1382 }
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001383 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001384
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07001385 /* RTI Initialization */
1386 if (nic->device_type == XFRAME_II_DEVICE) {
1387 /*
1388 * Programmed to generate Apprx 500 Intrs per
1389 * second
1390 */
1391 int count = (nic->config.bus_speed * 125)/4;
1392 val64 = RTI_DATA1_MEM_RX_TIMER_VAL(count);
1393 } else {
1394 val64 = RTI_DATA1_MEM_RX_TIMER_VAL(0xFFF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395 }
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07001396 val64 |= RTI_DATA1_MEM_RX_URNG_A(0xA) |
1397 RTI_DATA1_MEM_RX_URNG_B(0x10) |
1398 RTI_DATA1_MEM_RX_URNG_C(0x30) | RTI_DATA1_MEM_RX_TIMER_AC_EN;
1399
1400 writeq(val64, &bar0->rti_data1_mem);
1401
1402 val64 = RTI_DATA2_MEM_RX_UFC_A(0x1) |
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04001403 RTI_DATA2_MEM_RX_UFC_B(0x2) ;
1404 if (nic->intr_type == MSI_X)
1405 val64 |= (RTI_DATA2_MEM_RX_UFC_C(0x20) | \
1406 RTI_DATA2_MEM_RX_UFC_D(0x40));
1407 else
1408 val64 |= (RTI_DATA2_MEM_RX_UFC_C(0x40) | \
1409 RTI_DATA2_MEM_RX_UFC_D(0x80));
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07001410 writeq(val64, &bar0->rti_data2_mem);
1411
1412 for (i = 0; i < config->rx_ring_num; i++) {
1413 val64 = RTI_CMD_MEM_WE | RTI_CMD_MEM_STROBE_NEW_CMD
1414 | RTI_CMD_MEM_OFFSET(i);
1415 writeq(val64, &bar0->rti_command_mem);
1416
1417 /*
1418 * Once the operation completes, the Strobe bit of the
1419 * command register will be reset. We poll for this
1420 * particular condition. We wait for a maximum of 500ms
1421 * for the operation to complete, if it's not complete
1422 * by then we return error.
1423 */
1424 time = 0;
1425 while (TRUE) {
1426 val64 = readq(&bar0->rti_command_mem);
1427 if (!(val64 & RTI_CMD_MEM_STROBE_NEW_CMD)) {
1428 break;
1429 }
1430 if (time > 10) {
1431 DBG_PRINT(ERR_DBG, "%s: RTI init Failed\n",
1432 dev->name);
1433 return -1;
1434 }
1435 time++;
1436 msleep(50);
1437 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001438 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001439 }
1440
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001441 /*
1442 * Initializing proper values as Pause threshold into all
Linus Torvalds1da177e2005-04-16 15:20:36 -07001443 * the 8 Queues on Rx side.
1444 */
1445 writeq(0xffbbffbbffbbffbbULL, &bar0->mc_pause_thresh_q0q3);
1446 writeq(0xffbbffbbffbbffbbULL, &bar0->mc_pause_thresh_q4q7);
1447
1448 /* Disable RMAC PAD STRIPPING */
viro@ftp.linux.org.uk509a2672005-09-05 03:25:58 +01001449 add = &bar0->mac_cfg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450 val64 = readq(&bar0->mac_cfg);
1451 val64 &= ~(MAC_CFG_RMAC_STRIP_PAD);
1452 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
1453 writel((u32) (val64), add);
1454 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
1455 writel((u32) (val64 >> 32), (add + 4));
1456 val64 = readq(&bar0->mac_cfg);
1457
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001458 /*
1459 * Set the time value to be inserted in the pause frame
Linus Torvalds1da177e2005-04-16 15:20:36 -07001460 * generated by xena.
1461 */
1462 val64 = readq(&bar0->rmac_pause_cfg);
1463 val64 &= ~(RMAC_PAUSE_HG_PTIME(0xffff));
1464 val64 |= RMAC_PAUSE_HG_PTIME(nic->mac_control.rmac_pause_time);
1465 writeq(val64, &bar0->rmac_pause_cfg);
1466
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001467 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001468 * Set the Threshold Limit for Generating the pause frame
1469 * If the amount of data in any Queue exceeds ratio of
1470 * (mac_control.mc_pause_threshold_q0q3 or q4q7)/256
1471 * pause frame is generated
1472 */
1473 val64 = 0;
1474 for (i = 0; i < 4; i++) {
1475 val64 |=
1476 (((u64) 0xFF00 | nic->mac_control.
1477 mc_pause_threshold_q0q3)
1478 << (i * 2 * 8));
1479 }
1480 writeq(val64, &bar0->mc_pause_thresh_q0q3);
1481
1482 val64 = 0;
1483 for (i = 0; i < 4; i++) {
1484 val64 |=
1485 (((u64) 0xFF00 | nic->mac_control.
1486 mc_pause_threshold_q4q7)
1487 << (i * 2 * 8));
1488 }
1489 writeq(val64, &bar0->mc_pause_thresh_q4q7);
1490
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001491 /*
1492 * TxDMA will stop Read request if the number of read split has
Linus Torvalds1da177e2005-04-16 15:20:36 -07001493 * exceeded the limit pointed by shared_splits
1494 */
1495 val64 = readq(&bar0->pic_control);
1496 val64 |= PIC_CNTL_SHARED_SPLITS(shared_splits);
1497 writeq(val64, &bar0->pic_control);
1498
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001499 /*
1500 * Programming the Herc to split every write transaction
1501 * that does not start on an ADB to reduce disconnects.
1502 */
1503 if (nic->device_type == XFRAME_II_DEVICE) {
1504 val64 = WREQ_SPLIT_MASK_SET_MASK(255);
1505 writeq(val64, &bar0->wreq_split_mask);
1506 }
1507
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07001508 /* Setting Link stability period to 64 ms */
1509 if (nic->device_type == XFRAME_II_DEVICE) {
1510 val64 = MISC_LINK_STABILITY_PRD(3);
1511 writeq(val64, &bar0->misc_control);
1512 }
1513
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514 return SUCCESS;
1515}
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07001516#define LINK_UP_DOWN_INTERRUPT 1
1517#define MAC_RMAC_ERR_TIMER 2
1518
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07001519int s2io_link_fault_indication(nic_t *nic)
1520{
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04001521 if (nic->intr_type != INTA)
1522 return MAC_RMAC_ERR_TIMER;
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07001523 if (nic->device_type == XFRAME_II_DEVICE)
1524 return LINK_UP_DOWN_INTERRUPT;
1525 else
1526 return MAC_RMAC_ERR_TIMER;
1527}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001529/**
1530 * en_dis_able_nic_intrs - Enable or Disable the interrupts
Linus Torvalds1da177e2005-04-16 15:20:36 -07001531 * @nic: device private variable,
1532 * @mask: A mask indicating which Intr block must be modified and,
1533 * @flag: A flag indicating whether to enable or disable the Intrs.
1534 * Description: This function will either disable or enable the interrupts
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001535 * depending on the flag argument. The mask argument can be used to
1536 * enable/disable any Intr block.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537 * Return Value: NONE.
1538 */
1539
1540static void en_dis_able_nic_intrs(struct s2io_nic *nic, u16 mask, int flag)
1541{
1542 XENA_dev_config_t __iomem *bar0 = nic->bar0;
1543 register u64 val64 = 0, temp64 = 0;
1544
1545 /* Top level interrupt classification */
1546 /* PIC Interrupts */
1547 if ((mask & (TX_PIC_INTR | RX_PIC_INTR))) {
1548 /* Enable PIC Intrs in the general intr mask register */
1549 val64 = TXPIC_INT_M | PIC_RX_INT_M;
1550 if (flag == ENABLE_INTRS) {
1551 temp64 = readq(&bar0->general_int_mask);
1552 temp64 &= ~((u64) val64);
1553 writeq(temp64, &bar0->general_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001554 /*
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07001555 * If Hercules adapter enable GPIO otherwise
1556 * disabled all PCIX, Flash, MDIO, IIC and GPIO
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001557 * interrupts for now.
1558 * TODO
Linus Torvalds1da177e2005-04-16 15:20:36 -07001559 */
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07001560 if (s2io_link_fault_indication(nic) ==
1561 LINK_UP_DOWN_INTERRUPT ) {
1562 temp64 = readq(&bar0->pic_int_mask);
1563 temp64 &= ~((u64) PIC_INT_GPIO);
1564 writeq(temp64, &bar0->pic_int_mask);
1565 temp64 = readq(&bar0->gpio_int_mask);
1566 temp64 &= ~((u64) GPIO_INT_MASK_LINK_UP);
1567 writeq(temp64, &bar0->gpio_int_mask);
1568 } else {
1569 writeq(DISABLE_ALL_INTRS, &bar0->pic_int_mask);
1570 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001571 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001572 * No MSI Support is available presently, so TTI and
1573 * RTI interrupts are also disabled.
1574 */
1575 } else if (flag == DISABLE_INTRS) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001576 /*
1577 * Disable PIC Intrs in the general
1578 * intr mask register
Linus Torvalds1da177e2005-04-16 15:20:36 -07001579 */
1580 writeq(DISABLE_ALL_INTRS, &bar0->pic_int_mask);
1581 temp64 = readq(&bar0->general_int_mask);
1582 val64 |= temp64;
1583 writeq(val64, &bar0->general_int_mask);
1584 }
1585 }
1586
1587 /* DMA Interrupts */
1588 /* Enabling/Disabling Tx DMA interrupts */
1589 if (mask & TX_DMA_INTR) {
1590 /* Enable TxDMA Intrs in the general intr mask register */
1591 val64 = TXDMA_INT_M;
1592 if (flag == ENABLE_INTRS) {
1593 temp64 = readq(&bar0->general_int_mask);
1594 temp64 &= ~((u64) val64);
1595 writeq(temp64, &bar0->general_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001596 /*
1597 * Keep all interrupts other than PFC interrupt
Linus Torvalds1da177e2005-04-16 15:20:36 -07001598 * and PCC interrupt disabled in DMA level.
1599 */
1600 val64 = DISABLE_ALL_INTRS & ~(TXDMA_PFC_INT_M |
1601 TXDMA_PCC_INT_M);
1602 writeq(val64, &bar0->txdma_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001603 /*
1604 * Enable only the MISC error 1 interrupt in PFC block
Linus Torvalds1da177e2005-04-16 15:20:36 -07001605 */
1606 val64 = DISABLE_ALL_INTRS & (~PFC_MISC_ERR_1);
1607 writeq(val64, &bar0->pfc_err_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001608 /*
1609 * Enable only the FB_ECC error interrupt in PCC block
Linus Torvalds1da177e2005-04-16 15:20:36 -07001610 */
1611 val64 = DISABLE_ALL_INTRS & (~PCC_FB_ECC_ERR);
1612 writeq(val64, &bar0->pcc_err_mask);
1613 } else if (flag == DISABLE_INTRS) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001614 /*
1615 * Disable TxDMA Intrs in the general intr mask
1616 * register
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617 */
1618 writeq(DISABLE_ALL_INTRS, &bar0->txdma_int_mask);
1619 writeq(DISABLE_ALL_INTRS, &bar0->pfc_err_mask);
1620 temp64 = readq(&bar0->general_int_mask);
1621 val64 |= temp64;
1622 writeq(val64, &bar0->general_int_mask);
1623 }
1624 }
1625
1626 /* Enabling/Disabling Rx DMA interrupts */
1627 if (mask & RX_DMA_INTR) {
1628 /* Enable RxDMA Intrs in the general intr mask register */
1629 val64 = RXDMA_INT_M;
1630 if (flag == ENABLE_INTRS) {
1631 temp64 = readq(&bar0->general_int_mask);
1632 temp64 &= ~((u64) val64);
1633 writeq(temp64, &bar0->general_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001634 /*
1635 * All RxDMA block interrupts are disabled for now
1636 * TODO
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637 */
1638 writeq(DISABLE_ALL_INTRS, &bar0->rxdma_int_mask);
1639 } else if (flag == DISABLE_INTRS) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001640 /*
1641 * Disable RxDMA Intrs in the general intr mask
1642 * register
Linus Torvalds1da177e2005-04-16 15:20:36 -07001643 */
1644 writeq(DISABLE_ALL_INTRS, &bar0->rxdma_int_mask);
1645 temp64 = readq(&bar0->general_int_mask);
1646 val64 |= temp64;
1647 writeq(val64, &bar0->general_int_mask);
1648 }
1649 }
1650
1651 /* MAC Interrupts */
1652 /* Enabling/Disabling MAC interrupts */
1653 if (mask & (TX_MAC_INTR | RX_MAC_INTR)) {
1654 val64 = TXMAC_INT_M | RXMAC_INT_M;
1655 if (flag == ENABLE_INTRS) {
1656 temp64 = readq(&bar0->general_int_mask);
1657 temp64 &= ~((u64) val64);
1658 writeq(temp64, &bar0->general_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001659 /*
1660 * All MAC block error interrupts are disabled for now
Linus Torvalds1da177e2005-04-16 15:20:36 -07001661 * TODO
1662 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001663 } else if (flag == DISABLE_INTRS) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001664 /*
1665 * Disable MAC Intrs in the general intr mask register
Linus Torvalds1da177e2005-04-16 15:20:36 -07001666 */
1667 writeq(DISABLE_ALL_INTRS, &bar0->mac_int_mask);
1668 writeq(DISABLE_ALL_INTRS,
1669 &bar0->mac_rmac_err_mask);
1670
1671 temp64 = readq(&bar0->general_int_mask);
1672 val64 |= temp64;
1673 writeq(val64, &bar0->general_int_mask);
1674 }
1675 }
1676
1677 /* XGXS Interrupts */
1678 if (mask & (TX_XGXS_INTR | RX_XGXS_INTR)) {
1679 val64 = TXXGXS_INT_M | RXXGXS_INT_M;
1680 if (flag == ENABLE_INTRS) {
1681 temp64 = readq(&bar0->general_int_mask);
1682 temp64 &= ~((u64) val64);
1683 writeq(temp64, &bar0->general_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001684 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001685 * All XGXS block error interrupts are disabled for now
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001686 * TODO
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687 */
1688 writeq(DISABLE_ALL_INTRS, &bar0->xgxs_int_mask);
1689 } else if (flag == DISABLE_INTRS) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001690 /*
1691 * Disable MC Intrs in the general intr mask register
Linus Torvalds1da177e2005-04-16 15:20:36 -07001692 */
1693 writeq(DISABLE_ALL_INTRS, &bar0->xgxs_int_mask);
1694 temp64 = readq(&bar0->general_int_mask);
1695 val64 |= temp64;
1696 writeq(val64, &bar0->general_int_mask);
1697 }
1698 }
1699
1700 /* Memory Controller(MC) interrupts */
1701 if (mask & MC_INTR) {
1702 val64 = MC_INT_M;
1703 if (flag == ENABLE_INTRS) {
1704 temp64 = readq(&bar0->general_int_mask);
1705 temp64 &= ~((u64) val64);
1706 writeq(temp64, &bar0->general_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001707 /*
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001708 * Enable all MC Intrs.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001709 */
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001710 writeq(0x0, &bar0->mc_int_mask);
1711 writeq(0x0, &bar0->mc_err_mask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001712 } else if (flag == DISABLE_INTRS) {
1713 /*
1714 * Disable MC Intrs in the general intr mask register
1715 */
1716 writeq(DISABLE_ALL_INTRS, &bar0->mc_int_mask);
1717 temp64 = readq(&bar0->general_int_mask);
1718 val64 |= temp64;
1719 writeq(val64, &bar0->general_int_mask);
1720 }
1721 }
1722
1723
1724 /* Tx traffic interrupts */
1725 if (mask & TX_TRAFFIC_INTR) {
1726 val64 = TXTRAFFIC_INT_M;
1727 if (flag == ENABLE_INTRS) {
1728 temp64 = readq(&bar0->general_int_mask);
1729 temp64 &= ~((u64) val64);
1730 writeq(temp64, &bar0->general_int_mask);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001731 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001732 * Enable all the Tx side interrupts
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001733 * writing 0 Enables all 64 TX interrupt levels
Linus Torvalds1da177e2005-04-16 15:20:36 -07001734 */
1735 writeq(0x0, &bar0->tx_traffic_mask);
1736 } else if (flag == DISABLE_INTRS) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001737 /*
1738 * Disable Tx Traffic Intrs in the general intr mask
Linus Torvalds1da177e2005-04-16 15:20:36 -07001739 * register.
1740 */
1741 writeq(DISABLE_ALL_INTRS, &bar0->tx_traffic_mask);
1742 temp64 = readq(&bar0->general_int_mask);
1743 val64 |= temp64;
1744 writeq(val64, &bar0->general_int_mask);
1745 }
1746 }
1747
1748 /* Rx traffic interrupts */
1749 if (mask & RX_TRAFFIC_INTR) {
1750 val64 = RXTRAFFIC_INT_M;
1751 if (flag == ENABLE_INTRS) {
1752 temp64 = readq(&bar0->general_int_mask);
1753 temp64 &= ~((u64) val64);
1754 writeq(temp64, &bar0->general_int_mask);
1755 /* writing 0 Enables all 8 RX interrupt levels */
1756 writeq(0x0, &bar0->rx_traffic_mask);
1757 } else if (flag == DISABLE_INTRS) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001758 /*
1759 * Disable Rx Traffic Intrs in the general intr mask
Linus Torvalds1da177e2005-04-16 15:20:36 -07001760 * register.
1761 */
1762 writeq(DISABLE_ALL_INTRS, &bar0->rx_traffic_mask);
1763 temp64 = readq(&bar0->general_int_mask);
1764 val64 |= temp64;
1765 writeq(val64, &bar0->general_int_mask);
1766 }
1767 }
1768}
1769
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001770static int check_prc_pcc_state(u64 val64, int flag, int rev_id, int herc)
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001771{
1772 int ret = 0;
1773
1774 if (flag == FALSE) {
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001775 if ((!herc && (rev_id >= 4)) || herc) {
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001776 if (!(val64 & ADAPTER_STATUS_RMAC_PCC_IDLE) &&
1777 ((val64 & ADAPTER_STATUS_RC_PRC_QUIESCENT) ==
1778 ADAPTER_STATUS_RC_PRC_QUIESCENT)) {
1779 ret = 1;
1780 }
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001781 }else {
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001782 if (!(val64 & ADAPTER_STATUS_RMAC_PCC_FOUR_IDLE) &&
1783 ((val64 & ADAPTER_STATUS_RC_PRC_QUIESCENT) ==
1784 ADAPTER_STATUS_RC_PRC_QUIESCENT)) {
1785 ret = 1;
1786 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001787 }
1788 } else {
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001789 if ((!herc && (rev_id >= 4)) || herc) {
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001790 if (((val64 & ADAPTER_STATUS_RMAC_PCC_IDLE) ==
1791 ADAPTER_STATUS_RMAC_PCC_IDLE) &&
1792 (!(val64 & ADAPTER_STATUS_RC_PRC_QUIESCENT) ||
1793 ((val64 & ADAPTER_STATUS_RC_PRC_QUIESCENT) ==
1794 ADAPTER_STATUS_RC_PRC_QUIESCENT))) {
1795 ret = 1;
1796 }
1797 } else {
1798 if (((val64 & ADAPTER_STATUS_RMAC_PCC_FOUR_IDLE) ==
1799 ADAPTER_STATUS_RMAC_PCC_FOUR_IDLE) &&
1800 (!(val64 & ADAPTER_STATUS_RC_PRC_QUIESCENT) ||
1801 ((val64 & ADAPTER_STATUS_RC_PRC_QUIESCENT) ==
1802 ADAPTER_STATUS_RC_PRC_QUIESCENT))) {
1803 ret = 1;
1804 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001805 }
1806 }
1807
1808 return ret;
1809}
1810/**
1811 * verify_xena_quiescence - Checks whether the H/W is ready
Linus Torvalds1da177e2005-04-16 15:20:36 -07001812 * @val64 : Value read from adapter status register.
1813 * @flag : indicates if the adapter enable bit was ever written once
1814 * before.
1815 * Description: Returns whether the H/W is ready to go or not. Depending
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001816 * on whether adapter enable bit was written or not the comparison
Linus Torvalds1da177e2005-04-16 15:20:36 -07001817 * differs and the calling function passes the input argument flag to
1818 * indicate this.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001819 * Return: 1 If xena is quiescence
Linus Torvalds1da177e2005-04-16 15:20:36 -07001820 * 0 If Xena is not quiescence
1821 */
1822
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001823static int verify_xena_quiescence(nic_t *sp, u64 val64, int flag)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001824{
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001825 int ret = 0, herc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001826 u64 tmp64 = ~((u64) val64);
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07001827 int rev_id = get_xena_rev_id(sp->pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001828
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001829 herc = (sp->device_type == XFRAME_II_DEVICE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001830 if (!
1831 (tmp64 &
1832 (ADAPTER_STATUS_TDMA_READY | ADAPTER_STATUS_RDMA_READY |
1833 ADAPTER_STATUS_PFC_READY | ADAPTER_STATUS_TMAC_BUF_EMPTY |
1834 ADAPTER_STATUS_PIC_QUIESCENT | ADAPTER_STATUS_MC_DRAM_READY |
1835 ADAPTER_STATUS_MC_QUEUES_READY | ADAPTER_STATUS_M_PLL_LOCK |
1836 ADAPTER_STATUS_P_PLL_LOCK))) {
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001837 ret = check_prc_pcc_state(val64, flag, rev_id, herc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001838 }
1839
1840 return ret;
1841}
1842
1843/**
1844 * fix_mac_address - Fix for Mac addr problem on Alpha platforms
1845 * @sp: Pointer to device specifc structure
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001846 * Description :
Linus Torvalds1da177e2005-04-16 15:20:36 -07001847 * New procedure to clear mac address reading problems on Alpha platforms
1848 *
1849 */
1850
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001851void fix_mac_address(nic_t * sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001852{
1853 XENA_dev_config_t __iomem *bar0 = sp->bar0;
1854 u64 val64;
1855 int i = 0;
1856
1857 while (fix_mac[i] != END_SIGN) {
1858 writeq(fix_mac[i++], &bar0->gpio_control);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001859 udelay(10);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001860 val64 = readq(&bar0->gpio_control);
1861 }
1862}
1863
1864/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001865 * start_nic - Turns the device on
Linus Torvalds1da177e2005-04-16 15:20:36 -07001866 * @nic : device private variable.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001867 * Description:
1868 * This function actually turns the device on. Before this function is
1869 * called,all Registers are configured from their reset states
1870 * and shared memory is allocated but the NIC is still quiescent. On
Linus Torvalds1da177e2005-04-16 15:20:36 -07001871 * calling this function, the device interrupts are cleared and the NIC is
1872 * literally switched on by writing into the adapter control register.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001873 * Return Value:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001874 * SUCCESS on success and -1 on failure.
1875 */
1876
1877static int start_nic(struct s2io_nic *nic)
1878{
1879 XENA_dev_config_t __iomem *bar0 = nic->bar0;
1880 struct net_device *dev = nic->dev;
1881 register u64 val64 = 0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001882 u16 interruptible;
1883 u16 subid, i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001884 mac_info_t *mac_control;
1885 struct config_param *config;
1886
1887 mac_control = &nic->mac_control;
1888 config = &nic->config;
1889
1890 /* PRC Initialization and configuration */
1891 for (i = 0; i < config->rx_ring_num; i++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001892 writeq((u64) mac_control->rings[i].rx_blocks[0].block_dma_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001893 &bar0->prc_rxd0_n[i]);
1894
1895 val64 = readq(&bar0->prc_ctrl_n[i]);
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07001896 if (nic->config.bimodal)
1897 val64 |= PRC_CTRL_BIMODAL_INTERRUPT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001898#ifndef CONFIG_2BUFF_MODE
1899 val64 |= PRC_CTRL_RC_ENABLED;
1900#else
1901 val64 |= PRC_CTRL_RC_ENABLED | PRC_CTRL_RING_MODE_3;
1902#endif
1903 writeq(val64, &bar0->prc_ctrl_n[i]);
1904 }
1905
1906#ifdef CONFIG_2BUFF_MODE
1907 /* Enabling 2 buffer mode by writing into Rx_pa_cfg reg. */
1908 val64 = readq(&bar0->rx_pa_cfg);
1909 val64 |= RX_PA_CFG_IGNORE_L2_ERR;
1910 writeq(val64, &bar0->rx_pa_cfg);
1911#endif
1912
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001913 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001914 * Enabling MC-RLDRAM. After enabling the device, we timeout
1915 * for around 100ms, which is approximately the time required
1916 * for the device to be ready for operation.
1917 */
1918 val64 = readq(&bar0->mc_rldram_mrs);
1919 val64 |= MC_RLDRAM_QUEUE_SIZE_ENABLE | MC_RLDRAM_MRS_ENABLE;
1920 SPECIAL_REG_WRITE(val64, &bar0->mc_rldram_mrs, UF);
1921 val64 = readq(&bar0->mc_rldram_mrs);
1922
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001923 msleep(100); /* Delay by around 100 ms. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924
1925 /* Enabling ECC Protection. */
1926 val64 = readq(&bar0->adapter_control);
1927 val64 &= ~ADAPTER_ECC_EN;
1928 writeq(val64, &bar0->adapter_control);
1929
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001930 /*
1931 * Clearing any possible Link state change interrupts that
Linus Torvalds1da177e2005-04-16 15:20:36 -07001932 * could have popped up just before Enabling the card.
1933 */
1934 val64 = readq(&bar0->mac_rmac_err_reg);
1935 if (val64)
1936 writeq(val64, &bar0->mac_rmac_err_reg);
1937
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001938 /*
1939 * Verify if the device is ready to be enabled, if so enable
Linus Torvalds1da177e2005-04-16 15:20:36 -07001940 * it.
1941 */
1942 val64 = readq(&bar0->adapter_status);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001943 if (!verify_xena_quiescence(nic, val64, nic->device_enabled_once)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001944 DBG_PRINT(ERR_DBG, "%s: device is not ready, ", dev->name);
1945 DBG_PRINT(ERR_DBG, "Adapter status reads: 0x%llx\n",
1946 (unsigned long long) val64);
1947 return FAILURE;
1948 }
1949
1950 /* Enable select interrupts */
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04001951 if (nic->intr_type != INTA)
1952 en_dis_able_nic_intrs(nic, ENA_ALL_INTRS, DISABLE_INTRS);
1953 else {
1954 interruptible = TX_TRAFFIC_INTR | RX_TRAFFIC_INTR;
1955 interruptible |= TX_PIC_INTR | RX_PIC_INTR;
1956 interruptible |= TX_MAC_INTR | RX_MAC_INTR;
1957 en_dis_able_nic_intrs(nic, interruptible, ENABLE_INTRS);
1958 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001959
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001960 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001961 * With some switches, link might be already up at this point.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001962 * Because of this weird behavior, when we enable laser,
1963 * we may not get link. We need to handle this. We cannot
1964 * figure out which switch is misbehaving. So we are forced to
1965 * make a global change.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001966 */
1967
1968 /* Enabling Laser. */
1969 val64 = readq(&bar0->adapter_control);
1970 val64 |= ADAPTER_EOI_TX_ON;
1971 writeq(val64, &bar0->adapter_control);
1972
1973 /* SXE-002: Initialize link and activity LED */
1974 subid = nic->pdev->subsystem_device;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07001975 if (((subid & 0xFF) >= 0x07) &&
1976 (nic->device_type == XFRAME_I_DEVICE)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001977 val64 = readq(&bar0->gpio_control);
1978 val64 |= 0x0000800000000000ULL;
1979 writeq(val64, &bar0->gpio_control);
1980 val64 = 0x0411040400000000ULL;
viro@ftp.linux.org.uk509a2672005-09-05 03:25:58 +01001981 writeq(val64, (void __iomem *)bar0 + 0x2700);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001982 }
1983
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001984 /*
1985 * Don't see link state interrupts on certain switches, so
Linus Torvalds1da177e2005-04-16 15:20:36 -07001986 * directly scheduling a link state task from here.
1987 */
1988 schedule_work(&nic->set_link_task);
1989
Linus Torvalds1da177e2005-04-16 15:20:36 -07001990 return SUCCESS;
1991}
1992
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001993/**
1994 * free_tx_buffers - Free all queued Tx buffers
Linus Torvalds1da177e2005-04-16 15:20:36 -07001995 * @nic : device private variable.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001996 * Description:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001997 * Free all queued Tx buffers.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07001998 * Return Value: void
Linus Torvalds1da177e2005-04-16 15:20:36 -07001999*/
2000
2001static void free_tx_buffers(struct s2io_nic *nic)
2002{
2003 struct net_device *dev = nic->dev;
2004 struct sk_buff *skb;
2005 TxD_t *txdp;
2006 int i, j;
2007 mac_info_t *mac_control;
2008 struct config_param *config;
raghavendra.koushik@neterion.com1ddc50d2005-08-03 12:30:43 -07002009 int cnt = 0, frg_cnt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002010
2011 mac_control = &nic->mac_control;
2012 config = &nic->config;
2013
2014 for (i = 0; i < config->tx_fifo_num; i++) {
2015 for (j = 0; j < config->tx_cfg[i].fifo_len - 1; j++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002016 txdp = (TxD_t *) mac_control->fifos[i].list_info[j].
Linus Torvalds1da177e2005-04-16 15:20:36 -07002017 list_virt_addr;
2018 skb =
2019 (struct sk_buff *) ((unsigned long) txdp->
2020 Host_Control);
2021 if (skb == NULL) {
raghavendra.koushik@neterion.com1ddc50d2005-08-03 12:30:43 -07002022 memset(txdp, 0, sizeof(TxD_t) *
2023 config->max_txds);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002024 continue;
2025 }
raghavendra.koushik@neterion.com1ddc50d2005-08-03 12:30:43 -07002026 frg_cnt = skb_shinfo(skb)->nr_frags;
2027 pci_unmap_single(nic->pdev, (dma_addr_t)
2028 txdp->Buffer_Pointer,
2029 skb->len - skb->data_len,
2030 PCI_DMA_TODEVICE);
2031 if (frg_cnt) {
2032 TxD_t *temp;
2033 temp = txdp;
2034 txdp++;
2035 for (j = 0; j < frg_cnt; j++, txdp++) {
2036 skb_frag_t *frag =
2037 &skb_shinfo(skb)->frags[j];
2038 pci_unmap_page(nic->pdev,
2039 (dma_addr_t)
2040 txdp->
2041 Buffer_Pointer,
2042 frag->size,
2043 PCI_DMA_TODEVICE);
2044 }
2045 txdp = temp;
2046 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002047 dev_kfree_skb(skb);
raghavendra.koushik@neterion.com1ddc50d2005-08-03 12:30:43 -07002048 memset(txdp, 0, sizeof(TxD_t) * config->max_txds);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049 cnt++;
2050 }
2051 DBG_PRINT(INTR_DBG,
2052 "%s:forcibly freeing %d skbs on FIFO%d\n",
2053 dev->name, cnt, i);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002054 mac_control->fifos[i].tx_curr_get_info.offset = 0;
2055 mac_control->fifos[i].tx_curr_put_info.offset = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002056 }
2057}
2058
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002059/**
2060 * stop_nic - To stop the nic
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061 * @nic ; device private variable.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002062 * Description:
2063 * This function does exactly the opposite of what the start_nic()
Linus Torvalds1da177e2005-04-16 15:20:36 -07002064 * function does. This function is called to stop the device.
2065 * Return Value:
2066 * void.
2067 */
2068
2069static void stop_nic(struct s2io_nic *nic)
2070{
2071 XENA_dev_config_t __iomem *bar0 = nic->bar0;
2072 register u64 val64 = 0;
2073 u16 interruptible, i;
2074 mac_info_t *mac_control;
2075 struct config_param *config;
2076
2077 mac_control = &nic->mac_control;
2078 config = &nic->config;
2079
2080 /* Disable all interrupts */
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -07002081 interruptible = TX_TRAFFIC_INTR | RX_TRAFFIC_INTR;
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07002082 interruptible |= TX_PIC_INTR | RX_PIC_INTR;
2083 interruptible |= TX_MAC_INTR | RX_MAC_INTR;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002084 en_dis_able_nic_intrs(nic, interruptible, DISABLE_INTRS);
2085
2086 /* Disable PRCs */
2087 for (i = 0; i < config->rx_ring_num; i++) {
2088 val64 = readq(&bar0->prc_ctrl_n[i]);
2089 val64 &= ~((u64) PRC_CTRL_RC_ENABLED);
2090 writeq(val64, &bar0->prc_ctrl_n[i]);
2091 }
2092}
2093
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002094/**
2095 * fill_rx_buffers - Allocates the Rx side skbs
Linus Torvalds1da177e2005-04-16 15:20:36 -07002096 * @nic: device private variable
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002097 * @ring_no: ring number
2098 * Description:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002099 * The function allocates Rx side skbs and puts the physical
2100 * address of these buffers into the RxD buffer pointers, so that the NIC
2101 * can DMA the received frame into these locations.
2102 * The NIC supports 3 receive modes, viz
2103 * 1. single buffer,
2104 * 2. three buffer and
2105 * 3. Five buffer modes.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002106 * Each mode defines how many fragments the received frame will be split
2107 * up into by the NIC. The frame is split into L3 header, L4 Header,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002108 * L4 payload in three buffer mode and in 5 buffer mode, L4 payload itself
2109 * is split into 3 fragments. As of now only single buffer mode is
2110 * supported.
2111 * Return Value:
2112 * SUCCESS on success or an appropriate -ve value on failure.
2113 */
2114
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002115int fill_rx_buffers(struct s2io_nic *nic, int ring_no)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116{
2117 struct net_device *dev = nic->dev;
2118 struct sk_buff *skb;
2119 RxD_t *rxdp;
2120 int off, off1, size, block_no, block_no1;
2121 int offset, offset1;
2122 u32 alloc_tab = 0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002123 u32 alloc_cnt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002124 mac_info_t *mac_control;
2125 struct config_param *config;
2126#ifdef CONFIG_2BUFF_MODE
2127 RxD_t *rxdpnext;
2128 int nextblk;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002129 u64 tmp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002130 buffAdd_t *ba;
2131 dma_addr_t rxdpphys;
2132#endif
2133#ifndef CONFIG_S2IO_NAPI
2134 unsigned long flags;
2135#endif
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002136 RxD_t *first_rxdp = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002137
2138 mac_control = &nic->mac_control;
2139 config = &nic->config;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002140 alloc_cnt = mac_control->rings[ring_no].pkt_cnt -
2141 atomic_read(&nic->rx_bufs_left[ring_no]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002142 size = dev->mtu + HEADER_ETHERNET_II_802_3_SIZE +
2143 HEADER_802_2_SIZE + HEADER_SNAP_SIZE;
2144
2145 while (alloc_tab < alloc_cnt) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002146 block_no = mac_control->rings[ring_no].rx_curr_put_info.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002147 block_index;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002148 block_no1 = mac_control->rings[ring_no].rx_curr_get_info.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002149 block_index;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002150 off = mac_control->rings[ring_no].rx_curr_put_info.offset;
2151 off1 = mac_control->rings[ring_no].rx_curr_get_info.offset;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002152#ifndef CONFIG_2BUFF_MODE
2153 offset = block_no * (MAX_RXDS_PER_BLOCK + 1) + off;
2154 offset1 = block_no1 * (MAX_RXDS_PER_BLOCK + 1) + off1;
2155#else
2156 offset = block_no * (MAX_RXDS_PER_BLOCK) + off;
2157 offset1 = block_no1 * (MAX_RXDS_PER_BLOCK) + off1;
2158#endif
2159
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002160 rxdp = mac_control->rings[ring_no].rx_blocks[block_no].
Linus Torvalds1da177e2005-04-16 15:20:36 -07002161 block_virt_addr + off;
2162 if ((offset == offset1) && (rxdp->Host_Control)) {
2163 DBG_PRINT(INTR_DBG, "%s: Get and Put", dev->name);
2164 DBG_PRINT(INTR_DBG, " info equated\n");
2165 goto end;
2166 }
2167#ifndef CONFIG_2BUFF_MODE
2168 if (rxdp->Control_1 == END_OF_BLOCK) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002169 mac_control->rings[ring_no].rx_curr_put_info.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002170 block_index++;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002171 mac_control->rings[ring_no].rx_curr_put_info.
2172 block_index %= mac_control->rings[ring_no].block_count;
2173 block_no = mac_control->rings[ring_no].rx_curr_put_info.
2174 block_index;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002175 off++;
2176 off %= (MAX_RXDS_PER_BLOCK + 1);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002177 mac_control->rings[ring_no].rx_curr_put_info.offset =
Linus Torvalds1da177e2005-04-16 15:20:36 -07002178 off;
2179 rxdp = (RxD_t *) ((unsigned long) rxdp->Control_2);
2180 DBG_PRINT(INTR_DBG, "%s: Next block at: %p\n",
2181 dev->name, rxdp);
2182 }
2183#ifndef CONFIG_S2IO_NAPI
2184 spin_lock_irqsave(&nic->put_lock, flags);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002185 mac_control->rings[ring_no].put_pos =
Linus Torvalds1da177e2005-04-16 15:20:36 -07002186 (block_no * (MAX_RXDS_PER_BLOCK + 1)) + off;
2187 spin_unlock_irqrestore(&nic->put_lock, flags);
2188#endif
2189#else
2190 if (rxdp->Host_Control == END_OF_BLOCK) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002191 mac_control->rings[ring_no].rx_curr_put_info.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002192 block_index++;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002193 mac_control->rings[ring_no].rx_curr_put_info.block_index
2194 %= mac_control->rings[ring_no].block_count;
2195 block_no = mac_control->rings[ring_no].rx_curr_put_info
2196 .block_index;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002197 off = 0;
2198 DBG_PRINT(INTR_DBG, "%s: block%d at: 0x%llx\n",
2199 dev->name, block_no,
2200 (unsigned long long) rxdp->Control_1);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002201 mac_control->rings[ring_no].rx_curr_put_info.offset =
Linus Torvalds1da177e2005-04-16 15:20:36 -07002202 off;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002203 rxdp = mac_control->rings[ring_no].rx_blocks[block_no].
Linus Torvalds1da177e2005-04-16 15:20:36 -07002204 block_virt_addr;
2205 }
2206#ifndef CONFIG_S2IO_NAPI
2207 spin_lock_irqsave(&nic->put_lock, flags);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002208 mac_control->rings[ring_no].put_pos = (block_no *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002209 (MAX_RXDS_PER_BLOCK + 1)) + off;
2210 spin_unlock_irqrestore(&nic->put_lock, flags);
2211#endif
2212#endif
2213
2214#ifndef CONFIG_2BUFF_MODE
2215 if (rxdp->Control_1 & RXD_OWN_XENA)
2216#else
2217 if (rxdp->Control_2 & BIT(0))
2218#endif
2219 {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002220 mac_control->rings[ring_no].rx_curr_put_info.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002221 offset = off;
2222 goto end;
2223 }
2224#ifdef CONFIG_2BUFF_MODE
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002225 /*
2226 * RxDs Spanning cache lines will be replenished only
2227 * if the succeeding RxD is also owned by Host. It
2228 * will always be the ((8*i)+3) and ((8*i)+6)
2229 * descriptors for the 48 byte descriptor. The offending
Linus Torvalds1da177e2005-04-16 15:20:36 -07002230 * decsriptor is of-course the 3rd descriptor.
2231 */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002232 rxdpphys = mac_control->rings[ring_no].rx_blocks[block_no].
Linus Torvalds1da177e2005-04-16 15:20:36 -07002233 block_dma_addr + (off * sizeof(RxD_t));
2234 if (((u64) (rxdpphys)) % 128 > 80) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002235 rxdpnext = mac_control->rings[ring_no].rx_blocks[block_no].
Linus Torvalds1da177e2005-04-16 15:20:36 -07002236 block_virt_addr + (off + 1);
2237 if (rxdpnext->Host_Control == END_OF_BLOCK) {
2238 nextblk = (block_no + 1) %
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002239 (mac_control->rings[ring_no].block_count);
2240 rxdpnext = mac_control->rings[ring_no].rx_blocks
Linus Torvalds1da177e2005-04-16 15:20:36 -07002241 [nextblk].block_virt_addr;
2242 }
2243 if (rxdpnext->Control_2 & BIT(0))
2244 goto end;
2245 }
2246#endif
2247
2248#ifndef CONFIG_2BUFF_MODE
2249 skb = dev_alloc_skb(size + NET_IP_ALIGN);
2250#else
2251 skb = dev_alloc_skb(dev->mtu + ALIGN_SIZE + BUF0_LEN + 4);
2252#endif
2253 if (!skb) {
2254 DBG_PRINT(ERR_DBG, "%s: Out of ", dev->name);
2255 DBG_PRINT(ERR_DBG, "memory to allocate SKBs\n");
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002256 if (first_rxdp) {
2257 wmb();
2258 first_rxdp->Control_1 |= RXD_OWN_XENA;
2259 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002260 return -ENOMEM;
2261 }
2262#ifndef CONFIG_2BUFF_MODE
2263 skb_reserve(skb, NET_IP_ALIGN);
2264 memset(rxdp, 0, sizeof(RxD_t));
2265 rxdp->Buffer0_ptr = pci_map_single
2266 (nic->pdev, skb->data, size, PCI_DMA_FROMDEVICE);
2267 rxdp->Control_2 &= (~MASK_BUFFER0_SIZE);
2268 rxdp->Control_2 |= SET_BUFFER0_SIZE(size);
2269 rxdp->Host_Control = (unsigned long) (skb);
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002270 if (alloc_tab & ((1 << rxsync_frequency) - 1))
2271 rxdp->Control_1 |= RXD_OWN_XENA;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002272 off++;
2273 off %= (MAX_RXDS_PER_BLOCK + 1);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002274 mac_control->rings[ring_no].rx_curr_put_info.offset = off;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002275#else
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002276 ba = &mac_control->rings[ring_no].ba[block_no][off];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002277 skb_reserve(skb, BUF0_LEN);
David S. Miller689be432005-06-28 15:25:31 -07002278 tmp = ((unsigned long) skb->data & ALIGN_SIZE);
2279 if (tmp)
2280 skb_reserve(skb, (ALIGN_SIZE + 1) - tmp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002281
2282 memset(rxdp, 0, sizeof(RxD_t));
2283 rxdp->Buffer2_ptr = pci_map_single
2284 (nic->pdev, skb->data, dev->mtu + BUF0_LEN + 4,
2285 PCI_DMA_FROMDEVICE);
2286 rxdp->Buffer0_ptr =
2287 pci_map_single(nic->pdev, ba->ba_0, BUF0_LEN,
2288 PCI_DMA_FROMDEVICE);
2289 rxdp->Buffer1_ptr =
2290 pci_map_single(nic->pdev, ba->ba_1, BUF1_LEN,
2291 PCI_DMA_FROMDEVICE);
2292
2293 rxdp->Control_2 = SET_BUFFER2_SIZE(dev->mtu + 4);
2294 rxdp->Control_2 |= SET_BUFFER0_SIZE(BUF0_LEN);
2295 rxdp->Control_2 |= SET_BUFFER1_SIZE(1); /* dummy. */
2296 rxdp->Control_2 |= BIT(0); /* Set Buffer_Empty bit. */
2297 rxdp->Host_Control = (u64) ((unsigned long) (skb));
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002298 if (alloc_tab & ((1 << rxsync_frequency) - 1))
2299 rxdp->Control_1 |= RXD_OWN_XENA;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002300 off++;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002301 mac_control->rings[ring_no].rx_curr_put_info.offset = off;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002302#endif
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002303 rxdp->Control_2 |= SET_RXD_MARKER;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002304
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002305 if (!(alloc_tab & ((1 << rxsync_frequency) - 1))) {
2306 if (first_rxdp) {
2307 wmb();
2308 first_rxdp->Control_1 |= RXD_OWN_XENA;
2309 }
2310 first_rxdp = rxdp;
2311 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002312 atomic_inc(&nic->rx_bufs_left[ring_no]);
2313 alloc_tab++;
2314 }
2315
2316 end:
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002317 /* Transfer ownership of first descriptor to adapter just before
2318 * exiting. Before that, use memory barrier so that ownership
2319 * and other fields are seen by adapter correctly.
2320 */
2321 if (first_rxdp) {
2322 wmb();
2323 first_rxdp->Control_1 |= RXD_OWN_XENA;
2324 }
2325
Linus Torvalds1da177e2005-04-16 15:20:36 -07002326 return SUCCESS;
2327}
2328
2329/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002330 * free_rx_buffers - Frees all Rx buffers
Linus Torvalds1da177e2005-04-16 15:20:36 -07002331 * @sp: device private variable.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002332 * Description:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002333 * This function will free all Rx buffers allocated by host.
2334 * Return Value:
2335 * NONE.
2336 */
2337
2338static void free_rx_buffers(struct s2io_nic *sp)
2339{
2340 struct net_device *dev = sp->dev;
2341 int i, j, blk = 0, off, buf_cnt = 0;
2342 RxD_t *rxdp;
2343 struct sk_buff *skb;
2344 mac_info_t *mac_control;
2345 struct config_param *config;
2346#ifdef CONFIG_2BUFF_MODE
2347 buffAdd_t *ba;
2348#endif
2349
2350 mac_control = &sp->mac_control;
2351 config = &sp->config;
2352
2353 for (i = 0; i < config->rx_ring_num; i++) {
2354 for (j = 0, blk = 0; j < config->rx_cfg[i].num_rxd; j++) {
2355 off = j % (MAX_RXDS_PER_BLOCK + 1);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002356 rxdp = mac_control->rings[i].rx_blocks[blk].
2357 block_virt_addr + off;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002358
2359#ifndef CONFIG_2BUFF_MODE
2360 if (rxdp->Control_1 == END_OF_BLOCK) {
2361 rxdp =
2362 (RxD_t *) ((unsigned long) rxdp->
2363 Control_2);
2364 j++;
2365 blk++;
2366 }
2367#else
2368 if (rxdp->Host_Control == END_OF_BLOCK) {
2369 blk++;
2370 continue;
2371 }
2372#endif
2373
2374 if (!(rxdp->Control_1 & RXD_OWN_XENA)) {
2375 memset(rxdp, 0, sizeof(RxD_t));
2376 continue;
2377 }
2378
2379 skb =
2380 (struct sk_buff *) ((unsigned long) rxdp->
2381 Host_Control);
2382 if (skb) {
2383#ifndef CONFIG_2BUFF_MODE
2384 pci_unmap_single(sp->pdev, (dma_addr_t)
2385 rxdp->Buffer0_ptr,
2386 dev->mtu +
2387 HEADER_ETHERNET_II_802_3_SIZE
2388 + HEADER_802_2_SIZE +
2389 HEADER_SNAP_SIZE,
2390 PCI_DMA_FROMDEVICE);
2391#else
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002392 ba = &mac_control->rings[i].ba[blk][off];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002393 pci_unmap_single(sp->pdev, (dma_addr_t)
2394 rxdp->Buffer0_ptr,
2395 BUF0_LEN,
2396 PCI_DMA_FROMDEVICE);
2397 pci_unmap_single(sp->pdev, (dma_addr_t)
2398 rxdp->Buffer1_ptr,
2399 BUF1_LEN,
2400 PCI_DMA_FROMDEVICE);
2401 pci_unmap_single(sp->pdev, (dma_addr_t)
2402 rxdp->Buffer2_ptr,
2403 dev->mtu + BUF0_LEN + 4,
2404 PCI_DMA_FROMDEVICE);
2405#endif
2406 dev_kfree_skb(skb);
2407 atomic_dec(&sp->rx_bufs_left[i]);
2408 buf_cnt++;
2409 }
2410 memset(rxdp, 0, sizeof(RxD_t));
2411 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002412 mac_control->rings[i].rx_curr_put_info.block_index = 0;
2413 mac_control->rings[i].rx_curr_get_info.block_index = 0;
2414 mac_control->rings[i].rx_curr_put_info.offset = 0;
2415 mac_control->rings[i].rx_curr_get_info.offset = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002416 atomic_set(&sp->rx_bufs_left[i], 0);
2417 DBG_PRINT(INIT_DBG, "%s:Freed 0x%x Rx Buffers on ring%d\n",
2418 dev->name, buf_cnt, i);
2419 }
2420}
2421
2422/**
2423 * s2io_poll - Rx interrupt handler for NAPI support
2424 * @dev : pointer to the device structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002425 * @budget : The number of packets that were budgeted to be processed
Linus Torvalds1da177e2005-04-16 15:20:36 -07002426 * during one pass through the 'Poll" function.
2427 * Description:
2428 * Comes into picture only if NAPI support has been incorporated. It does
2429 * the same thing that rx_intr_handler does, but not in a interrupt context
2430 * also It will process only a given number of packets.
2431 * Return value:
2432 * 0 on success and 1 if there are No Rx packets to be processed.
2433 */
2434
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002435#if defined(CONFIG_S2IO_NAPI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002436static int s2io_poll(struct net_device *dev, int *budget)
2437{
2438 nic_t *nic = dev->priv;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002439 int pkt_cnt = 0, org_pkts_to_process;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002440 mac_info_t *mac_control;
2441 struct config_param *config;
viro@ftp.linux.org.uk509a2672005-09-05 03:25:58 +01002442 XENA_dev_config_t __iomem *bar0 = nic->bar0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002443 u64 val64;
2444 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002445
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002446 atomic_inc(&nic->isr_cnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002447 mac_control = &nic->mac_control;
2448 config = &nic->config;
2449
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002450 nic->pkts_to_process = *budget;
2451 if (nic->pkts_to_process > dev->quota)
2452 nic->pkts_to_process = dev->quota;
2453 org_pkts_to_process = nic->pkts_to_process;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002454
2455 val64 = readq(&bar0->rx_traffic_int);
2456 writeq(val64, &bar0->rx_traffic_int);
2457
2458 for (i = 0; i < config->rx_ring_num; i++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002459 rx_intr_handler(&mac_control->rings[i]);
2460 pkt_cnt = org_pkts_to_process - nic->pkts_to_process;
2461 if (!nic->pkts_to_process) {
2462 /* Quota for the current iteration has been met */
2463 goto no_rx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002464 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002465 }
2466 if (!pkt_cnt)
2467 pkt_cnt = 1;
2468
2469 dev->quota -= pkt_cnt;
2470 *budget -= pkt_cnt;
2471 netif_rx_complete(dev);
2472
2473 for (i = 0; i < config->rx_ring_num; i++) {
2474 if (fill_rx_buffers(nic, i) == -ENOMEM) {
2475 DBG_PRINT(ERR_DBG, "%s:Out of memory", dev->name);
2476 DBG_PRINT(ERR_DBG, " in Rx Poll!!\n");
2477 break;
2478 }
2479 }
2480 /* Re enable the Rx interrupts. */
2481 en_dis_able_nic_intrs(nic, RX_TRAFFIC_INTR, ENABLE_INTRS);
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002482 atomic_dec(&nic->isr_cnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002483 return 0;
2484
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002485no_rx:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002486 dev->quota -= pkt_cnt;
2487 *budget -= pkt_cnt;
2488
2489 for (i = 0; i < config->rx_ring_num; i++) {
2490 if (fill_rx_buffers(nic, i) == -ENOMEM) {
2491 DBG_PRINT(ERR_DBG, "%s:Out of memory", dev->name);
2492 DBG_PRINT(ERR_DBG, " in Rx Poll!!\n");
2493 break;
2494 }
2495 }
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002496 atomic_dec(&nic->isr_cnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002497 return 1;
2498}
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002499#endif
2500
2501/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002502 * rx_intr_handler - Rx interrupt handler
2503 * @nic: device private variable.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002504 * Description:
2505 * If the interrupt is because of a received frame or if the
Linus Torvalds1da177e2005-04-16 15:20:36 -07002506 * receive ring contains fresh as yet un-processed frames,this function is
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002507 * called. It picks out the RxD at which place the last Rx processing had
2508 * stopped and sends the skb to the OSM's Rx handler and then increments
Linus Torvalds1da177e2005-04-16 15:20:36 -07002509 * the offset.
2510 * Return Value:
2511 * NONE.
2512 */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002513static void rx_intr_handler(ring_info_t *ring_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002514{
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002515 nic_t *nic = ring_data->nic;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002516 struct net_device *dev = (struct net_device *) nic->dev;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002517 int get_block, get_offset, put_block, put_offset, ring_bufs;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002518 rx_curr_get_info_t get_info, put_info;
2519 RxD_t *rxdp;
2520 struct sk_buff *skb;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002521#ifndef CONFIG_S2IO_NAPI
2522 int pkt_cnt = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002523#endif
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002524 spin_lock(&nic->rx_lock);
2525 if (atomic_read(&nic->card_state) == CARD_DOWN) {
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002526 DBG_PRINT(INTR_DBG, "%s: %s going down for reset\n",
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002527 __FUNCTION__, dev->name);
2528 spin_unlock(&nic->rx_lock);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002529 return;
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002530 }
2531
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002532 get_info = ring_data->rx_curr_get_info;
2533 get_block = get_info.block_index;
2534 put_info = ring_data->rx_curr_put_info;
2535 put_block = put_info.block_index;
2536 ring_bufs = get_info.ring_len+1;
2537 rxdp = ring_data->rx_blocks[get_block].block_virt_addr +
Linus Torvalds1da177e2005-04-16 15:20:36 -07002538 get_info.offset;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002539 get_offset = (get_block * (MAX_RXDS_PER_BLOCK + 1)) +
2540 get_info.offset;
2541#ifndef CONFIG_S2IO_NAPI
2542 spin_lock(&nic->put_lock);
2543 put_offset = ring_data->put_pos;
2544 spin_unlock(&nic->put_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002545#else
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002546 put_offset = (put_block * (MAX_RXDS_PER_BLOCK + 1)) +
2547 put_info.offset;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002548#endif
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002549 while (RXD_IS_UP2DT(rxdp) &&
2550 (((get_offset + 1) % ring_bufs) != put_offset)) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002551 skb = (struct sk_buff *) ((unsigned long)rxdp->Host_Control);
2552 if (skb == NULL) {
2553 DBG_PRINT(ERR_DBG, "%s: The skb is ",
2554 dev->name);
2555 DBG_PRINT(ERR_DBG, "Null in Rx Intr\n");
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002556 spin_unlock(&nic->rx_lock);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002557 return;
2558 }
2559#ifndef CONFIG_2BUFF_MODE
2560 pci_unmap_single(nic->pdev, (dma_addr_t)
2561 rxdp->Buffer0_ptr,
2562 dev->mtu +
2563 HEADER_ETHERNET_II_802_3_SIZE +
2564 HEADER_802_2_SIZE +
2565 HEADER_SNAP_SIZE,
2566 PCI_DMA_FROMDEVICE);
2567#else
2568 pci_unmap_single(nic->pdev, (dma_addr_t)
2569 rxdp->Buffer0_ptr,
2570 BUF0_LEN, PCI_DMA_FROMDEVICE);
2571 pci_unmap_single(nic->pdev, (dma_addr_t)
2572 rxdp->Buffer1_ptr,
2573 BUF1_LEN, PCI_DMA_FROMDEVICE);
2574 pci_unmap_single(nic->pdev, (dma_addr_t)
2575 rxdp->Buffer2_ptr,
2576 dev->mtu + BUF0_LEN + 4,
2577 PCI_DMA_FROMDEVICE);
2578#endif
2579 rx_osm_handler(ring_data, rxdp);
2580 get_info.offset++;
2581 ring_data->rx_curr_get_info.offset =
2582 get_info.offset;
2583 rxdp = ring_data->rx_blocks[get_block].block_virt_addr +
2584 get_info.offset;
2585 if (get_info.offset &&
2586 (!(get_info.offset % MAX_RXDS_PER_BLOCK))) {
2587 get_info.offset = 0;
2588 ring_data->rx_curr_get_info.offset
2589 = get_info.offset;
2590 get_block++;
2591 get_block %= ring_data->block_count;
2592 ring_data->rx_curr_get_info.block_index
2593 = get_block;
2594 rxdp = ring_data->rx_blocks[get_block].block_virt_addr;
2595 }
2596
2597 get_offset = (get_block * (MAX_RXDS_PER_BLOCK + 1)) +
2598 get_info.offset;
2599#ifdef CONFIG_S2IO_NAPI
2600 nic->pkts_to_process -= 1;
2601 if (!nic->pkts_to_process)
2602 break;
2603#else
2604 pkt_cnt++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002605 if ((indicate_max_pkts) && (pkt_cnt > indicate_max_pkts))
2606 break;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002607#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002608 }
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002609 spin_unlock(&nic->rx_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002610}
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002611
2612/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002613 * tx_intr_handler - Transmit interrupt handler
2614 * @nic : device private variable
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002615 * Description:
2616 * If an interrupt was raised to indicate DMA complete of the
2617 * Tx packet, this function is called. It identifies the last TxD
2618 * whose buffer was freed and frees all skbs whose data have already
Linus Torvalds1da177e2005-04-16 15:20:36 -07002619 * DMA'ed into the NICs internal memory.
2620 * Return Value:
2621 * NONE
2622 */
2623
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002624static void tx_intr_handler(fifo_info_t *fifo_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002625{
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002626 nic_t *nic = fifo_data->nic;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002627 struct net_device *dev = (struct net_device *) nic->dev;
2628 tx_curr_get_info_t get_info, put_info;
2629 struct sk_buff *skb;
2630 TxD_t *txdlp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002631 u16 j, frg_cnt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002632
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002633 get_info = fifo_data->tx_curr_get_info;
2634 put_info = fifo_data->tx_curr_put_info;
2635 txdlp = (TxD_t *) fifo_data->list_info[get_info.offset].
2636 list_virt_addr;
2637 while ((!(txdlp->Control_1 & TXD_LIST_OWN_XENA)) &&
2638 (get_info.offset != put_info.offset) &&
2639 (txdlp->Host_Control)) {
2640 /* Check for TxD errors */
2641 if (txdlp->Control_1 & TXD_T_CODE) {
2642 unsigned long long err;
2643 err = txdlp->Control_1 & TXD_T_CODE;
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002644 if ((err >> 48) == 0xA) {
2645 DBG_PRINT(TX_DBG, "TxD returned due \
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04002646to loss of link\n");
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002647 }
2648 else {
2649 DBG_PRINT(ERR_DBG, "***TxD error \
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04002650%llx\n", err);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002651 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002652 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002653
2654 skb = (struct sk_buff *) ((unsigned long)
2655 txdlp->Host_Control);
2656 if (skb == NULL) {
2657 DBG_PRINT(ERR_DBG, "%s: Null skb ",
2658 __FUNCTION__);
2659 DBG_PRINT(ERR_DBG, "in Tx Free Intr\n");
2660 return;
2661 }
2662
2663 frg_cnt = skb_shinfo(skb)->nr_frags;
2664 nic->tx_pkt_count++;
2665
2666 pci_unmap_single(nic->pdev, (dma_addr_t)
2667 txdlp->Buffer_Pointer,
2668 skb->len - skb->data_len,
2669 PCI_DMA_TODEVICE);
2670 if (frg_cnt) {
2671 TxD_t *temp;
2672 temp = txdlp;
2673 txdlp++;
2674 for (j = 0; j < frg_cnt; j++, txdlp++) {
2675 skb_frag_t *frag =
2676 &skb_shinfo(skb)->frags[j];
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07002677 if (!txdlp->Buffer_Pointer)
2678 break;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002679 pci_unmap_page(nic->pdev,
2680 (dma_addr_t)
2681 txdlp->
2682 Buffer_Pointer,
2683 frag->size,
2684 PCI_DMA_TODEVICE);
2685 }
2686 txdlp = temp;
2687 }
2688 memset(txdlp, 0,
2689 (sizeof(TxD_t) * fifo_data->max_txds));
2690
2691 /* Updating the statistics block */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002692 nic->stats.tx_bytes += skb->len;
2693 dev_kfree_skb_irq(skb);
2694
2695 get_info.offset++;
2696 get_info.offset %= get_info.fifo_len + 1;
2697 txdlp = (TxD_t *) fifo_data->list_info
2698 [get_info.offset].list_virt_addr;
2699 fifo_data->tx_curr_get_info.offset =
2700 get_info.offset;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002701 }
2702
2703 spin_lock(&nic->tx_lock);
2704 if (netif_queue_stopped(dev))
2705 netif_wake_queue(dev);
2706 spin_unlock(&nic->tx_lock);
2707}
2708
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002709/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002710 * alarm_intr_handler - Alarm Interrrupt handler
2711 * @nic: device private variable
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002712 * Description: If the interrupt was neither because of Rx packet or Tx
Linus Torvalds1da177e2005-04-16 15:20:36 -07002713 * complete, this function is called. If the interrupt was to indicate
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002714 * a loss of link, the OSM link status handler is invoked for any other
2715 * alarm interrupt the block that raised the interrupt is displayed
Linus Torvalds1da177e2005-04-16 15:20:36 -07002716 * and a H/W reset is issued.
2717 * Return Value:
2718 * NONE
2719*/
2720
2721static void alarm_intr_handler(struct s2io_nic *nic)
2722{
2723 struct net_device *dev = (struct net_device *) nic->dev;
2724 XENA_dev_config_t __iomem *bar0 = nic->bar0;
2725 register u64 val64 = 0, err_reg = 0;
2726
2727 /* Handling link status change error Intr */
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07002728 if (s2io_link_fault_indication(nic) == MAC_RMAC_ERR_TIMER) {
2729 err_reg = readq(&bar0->mac_rmac_err_reg);
2730 writeq(err_reg, &bar0->mac_rmac_err_reg);
2731 if (err_reg & RMAC_LINK_STATE_CHANGE_INT) {
2732 schedule_work(&nic->set_link_task);
2733 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002734 }
2735
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002736 /* Handling Ecc errors */
2737 val64 = readq(&bar0->mc_err_reg);
2738 writeq(val64, &bar0->mc_err_reg);
2739 if (val64 & (MC_ERR_REG_ECC_ALL_SNG | MC_ERR_REG_ECC_ALL_DBL)) {
2740 if (val64 & MC_ERR_REG_ECC_ALL_DBL) {
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002741 nic->mac_control.stats_info->sw_stat.
2742 double_ecc_errs++;
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002743 DBG_PRINT(INIT_DBG, "%s: Device indicates ",
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002744 dev->name);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002745 DBG_PRINT(INIT_DBG, "double ECC error!!\n");
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -07002746 if (nic->device_type != XFRAME_II_DEVICE) {
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002747 /* Reset XframeI only if critical error */
2748 if (val64 & (MC_ERR_REG_MIRI_ECC_DB_ERR_0 |
2749 MC_ERR_REG_MIRI_ECC_DB_ERR_1)) {
2750 netif_stop_queue(dev);
2751 schedule_work(&nic->rst_timer_task);
2752 }
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -07002753 }
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002754 } else {
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07002755 nic->mac_control.stats_info->sw_stat.
2756 single_ecc_errs++;
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002757 }
2758 }
2759
Linus Torvalds1da177e2005-04-16 15:20:36 -07002760 /* In case of a serious error, the device will be Reset. */
2761 val64 = readq(&bar0->serr_source);
2762 if (val64 & SERR_SOURCE_ANY) {
2763 DBG_PRINT(ERR_DBG, "%s: Device indicates ", dev->name);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07002764 DBG_PRINT(ERR_DBG, "serious error %llx!!\n",
2765 (unsigned long long)val64);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002766 netif_stop_queue(dev);
2767 schedule_work(&nic->rst_timer_task);
2768 }
2769
2770 /*
2771 * Also as mentioned in the latest Errata sheets if the PCC_FB_ECC
2772 * Error occurs, the adapter will be recycled by disabling the
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002773 * adapter enable bit and enabling it again after the device
Linus Torvalds1da177e2005-04-16 15:20:36 -07002774 * becomes Quiescent.
2775 */
2776 val64 = readq(&bar0->pcc_err_reg);
2777 writeq(val64, &bar0->pcc_err_reg);
2778 if (val64 & PCC_FB_ECC_DB_ERR) {
2779 u64 ac = readq(&bar0->adapter_control);
2780 ac &= ~(ADAPTER_CNTL_EN);
2781 writeq(ac, &bar0->adapter_control);
2782 ac = readq(&bar0->adapter_control);
2783 schedule_work(&nic->set_link_task);
2784 }
2785
2786 /* Other type of interrupts are not being handled now, TODO */
2787}
2788
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002789/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002790 * wait_for_cmd_complete - waits for a command to complete.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002791 * @sp : private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07002792 * s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002793 * Description: Function that waits for a command to Write into RMAC
2794 * ADDR DATA registers to be completed and returns either success or
2795 * error depending on whether the command was complete or not.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002796 * Return value:
2797 * SUCCESS on success and FAILURE on failure.
2798 */
2799
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002800int wait_for_cmd_complete(nic_t * sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002801{
2802 XENA_dev_config_t __iomem *bar0 = sp->bar0;
2803 int ret = FAILURE, cnt = 0;
2804 u64 val64;
2805
2806 while (TRUE) {
2807 val64 = readq(&bar0->rmac_addr_cmd_mem);
2808 if (!(val64 & RMAC_ADDR_CMD_MEM_STROBE_CMD_EXECUTING)) {
2809 ret = SUCCESS;
2810 break;
2811 }
2812 msleep(50);
2813 if (cnt++ > 10)
2814 break;
2815 }
2816
2817 return ret;
2818}
2819
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002820/**
2821 * s2io_reset - Resets the card.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002822 * @sp : private member of the device structure.
2823 * Description: Function to Reset the card. This function then also
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002824 * restores the previously saved PCI configuration space registers as
Linus Torvalds1da177e2005-04-16 15:20:36 -07002825 * the card reset also resets the configuration space.
2826 * Return value:
2827 * void.
2828 */
2829
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002830void s2io_reset(nic_t * sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002831{
2832 XENA_dev_config_t __iomem *bar0 = sp->bar0;
2833 u64 val64;
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002834 u16 subid, pci_cmd;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002835
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07002836 /* Back up the PCI-X CMD reg, dont want to lose MMRBC, OST settings */
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -07002837 pci_read_config_word(sp->pdev, PCIX_COMMAND_REGISTER, &(pci_cmd));
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07002838
Linus Torvalds1da177e2005-04-16 15:20:36 -07002839 val64 = SW_RESET_ALL;
2840 writeq(val64, &bar0->sw_reset);
2841
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002842 /*
2843 * At this stage, if the PCI write is indeed completed, the
2844 * card is reset and so is the PCI Config space of the device.
2845 * So a read cannot be issued at this stage on any of the
Linus Torvalds1da177e2005-04-16 15:20:36 -07002846 * registers to ensure the write into "sw_reset" register
2847 * has gone through.
2848 * Question: Is there any system call that will explicitly force
2849 * all the write commands still pending on the bus to be pushed
2850 * through?
2851 * As of now I'am just giving a 250ms delay and hoping that the
2852 * PCI write to sw_reset register is done by this time.
2853 */
2854 msleep(250);
2855
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -07002856 /* Restore the PCI state saved during initialization. */
2857 pci_restore_state(sp->pdev);
2858 pci_write_config_word(sp->pdev, PCIX_COMMAND_REGISTER,
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07002859 pci_cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002860 s2io_init_pci(sp);
2861
2862 msleep(250);
2863
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002864 /* Set swapper to enable I/O register access */
2865 s2io_set_swapper(sp);
2866
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04002867 /* Restore the MSIX table entries from local variables */
2868 restore_xmsi_data(sp);
2869
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002870 /* Clear certain PCI/PCI-X fields after reset */
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002871 if (sp->device_type == XFRAME_II_DEVICE) {
2872 /* Clear parity err detect bit */
2873 pci_write_config_word(sp->pdev, PCI_STATUS, 0x8000);
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002874
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002875 /* Clearing PCIX Ecc status register */
2876 pci_write_config_dword(sp->pdev, 0x68, 0x7C);
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002877
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07002878 /* Clearing PCI_STATUS error reflected here */
2879 writeq(BIT(62), &bar0->txpic_int_reg);
2880 }
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07002881
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002882 /* Reset device statistics maintained by OS */
2883 memset(&sp->stats, 0, sizeof (struct net_device_stats));
2884
Linus Torvalds1da177e2005-04-16 15:20:36 -07002885 /* SXE-002: Configure link and activity LED to turn it off */
2886 subid = sp->pdev->subsystem_device;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07002887 if (((subid & 0xFF) >= 0x07) &&
2888 (sp->device_type == XFRAME_I_DEVICE)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002889 val64 = readq(&bar0->gpio_control);
2890 val64 |= 0x0000800000000000ULL;
2891 writeq(val64, &bar0->gpio_control);
2892 val64 = 0x0411040400000000ULL;
viro@ftp.linux.org.uk509a2672005-09-05 03:25:58 +01002893 writeq(val64, (void __iomem *)bar0 + 0x2700);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002894 }
2895
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07002896 /*
2897 * Clear spurious ECC interrupts that would have occured on
2898 * XFRAME II cards after reset.
2899 */
2900 if (sp->device_type == XFRAME_II_DEVICE) {
2901 val64 = readq(&bar0->pcc_err_reg);
2902 writeq(val64, &bar0->pcc_err_reg);
2903 }
2904
Linus Torvalds1da177e2005-04-16 15:20:36 -07002905 sp->device_enabled_once = FALSE;
2906}
2907
2908/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002909 * s2io_set_swapper - to set the swapper controle on the card
2910 * @sp : private member of the device structure,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002911 * pointer to the s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002912 * Description: Function to set the swapper control on the card
Linus Torvalds1da177e2005-04-16 15:20:36 -07002913 * correctly depending on the 'endianness' of the system.
2914 * Return value:
2915 * SUCCESS on success and FAILURE on failure.
2916 */
2917
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002918int s2io_set_swapper(nic_t * sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002919{
2920 struct net_device *dev = sp->dev;
2921 XENA_dev_config_t __iomem *bar0 = sp->bar0;
2922 u64 val64, valt, valr;
2923
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002924 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002925 * Set proper endian settings and verify the same by reading
2926 * the PIF Feed-back register.
2927 */
2928
2929 val64 = readq(&bar0->pif_rd_swapper_fb);
2930 if (val64 != 0x0123456789ABCDEFULL) {
2931 int i = 0;
2932 u64 value[] = { 0xC30000C3C30000C3ULL, /* FE=1, SE=1 */
2933 0x8100008181000081ULL, /* FE=1, SE=0 */
2934 0x4200004242000042ULL, /* FE=0, SE=1 */
2935 0}; /* FE=0, SE=0 */
2936
2937 while(i<4) {
2938 writeq(value[i], &bar0->swapper_ctrl);
2939 val64 = readq(&bar0->pif_rd_swapper_fb);
2940 if (val64 == 0x0123456789ABCDEFULL)
2941 break;
2942 i++;
2943 }
2944 if (i == 4) {
2945 DBG_PRINT(ERR_DBG, "%s: Endian settings are wrong, ",
2946 dev->name);
2947 DBG_PRINT(ERR_DBG, "feedback read %llx\n",
2948 (unsigned long long) val64);
2949 return FAILURE;
2950 }
2951 valr = value[i];
2952 } else {
2953 valr = readq(&bar0->swapper_ctrl);
2954 }
2955
2956 valt = 0x0123456789ABCDEFULL;
2957 writeq(valt, &bar0->xmsi_address);
2958 val64 = readq(&bar0->xmsi_address);
2959
2960 if(val64 != valt) {
2961 int i = 0;
2962 u64 value[] = { 0x00C3C30000C3C300ULL, /* FE=1, SE=1 */
2963 0x0081810000818100ULL, /* FE=1, SE=0 */
2964 0x0042420000424200ULL, /* FE=0, SE=1 */
2965 0}; /* FE=0, SE=0 */
2966
2967 while(i<4) {
2968 writeq((value[i] | valr), &bar0->swapper_ctrl);
2969 writeq(valt, &bar0->xmsi_address);
2970 val64 = readq(&bar0->xmsi_address);
2971 if(val64 == valt)
2972 break;
2973 i++;
2974 }
2975 if(i == 4) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002976 unsigned long long x = val64;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002977 DBG_PRINT(ERR_DBG, "Write failed, Xmsi_addr ");
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002978 DBG_PRINT(ERR_DBG, "reads:0x%llx\n", x);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002979 return FAILURE;
2980 }
2981 }
2982 val64 = readq(&bar0->swapper_ctrl);
2983 val64 &= 0xFFFF000000000000ULL;
2984
2985#ifdef __BIG_ENDIAN
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07002986 /*
2987 * The device by default set to a big endian format, so a
Linus Torvalds1da177e2005-04-16 15:20:36 -07002988 * big endian driver need not set anything.
2989 */
2990 val64 |= (SWAPPER_CTRL_TXP_FE |
2991 SWAPPER_CTRL_TXP_SE |
2992 SWAPPER_CTRL_TXD_R_FE |
2993 SWAPPER_CTRL_TXD_W_FE |
2994 SWAPPER_CTRL_TXF_R_FE |
2995 SWAPPER_CTRL_RXD_R_FE |
2996 SWAPPER_CTRL_RXD_W_FE |
2997 SWAPPER_CTRL_RXF_W_FE |
2998 SWAPPER_CTRL_XMSI_FE |
Linus Torvalds1da177e2005-04-16 15:20:36 -07002999 SWAPPER_CTRL_STATS_FE | SWAPPER_CTRL_STATS_SE);
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003000 if (nic->intr_type == INTA)
3001 val64 |= SWAPPER_CTRL_XMSI_SE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003002 writeq(val64, &bar0->swapper_ctrl);
3003#else
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003004 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07003005 * Initially we enable all bits to make it accessible by the
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003006 * driver, then we selectively enable only those bits that
Linus Torvalds1da177e2005-04-16 15:20:36 -07003007 * we want to set.
3008 */
3009 val64 |= (SWAPPER_CTRL_TXP_FE |
3010 SWAPPER_CTRL_TXP_SE |
3011 SWAPPER_CTRL_TXD_R_FE |
3012 SWAPPER_CTRL_TXD_R_SE |
3013 SWAPPER_CTRL_TXD_W_FE |
3014 SWAPPER_CTRL_TXD_W_SE |
3015 SWAPPER_CTRL_TXF_R_FE |
3016 SWAPPER_CTRL_RXD_R_FE |
3017 SWAPPER_CTRL_RXD_R_SE |
3018 SWAPPER_CTRL_RXD_W_FE |
3019 SWAPPER_CTRL_RXD_W_SE |
3020 SWAPPER_CTRL_RXF_W_FE |
3021 SWAPPER_CTRL_XMSI_FE |
Linus Torvalds1da177e2005-04-16 15:20:36 -07003022 SWAPPER_CTRL_STATS_FE | SWAPPER_CTRL_STATS_SE);
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003023 if (sp->intr_type == INTA)
3024 val64 |= SWAPPER_CTRL_XMSI_SE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003025 writeq(val64, &bar0->swapper_ctrl);
3026#endif
3027 val64 = readq(&bar0->swapper_ctrl);
3028
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003029 /*
3030 * Verifying if endian settings are accurate by reading a
Linus Torvalds1da177e2005-04-16 15:20:36 -07003031 * feedback register.
3032 */
3033 val64 = readq(&bar0->pif_rd_swapper_fb);
3034 if (val64 != 0x0123456789ABCDEFULL) {
3035 /* Endian settings are incorrect, calls for another dekko. */
3036 DBG_PRINT(ERR_DBG, "%s: Endian settings are wrong, ",
3037 dev->name);
3038 DBG_PRINT(ERR_DBG, "feedback read %llx\n",
3039 (unsigned long long) val64);
3040 return FAILURE;
3041 }
3042
3043 return SUCCESS;
3044}
3045
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003046int wait_for_msix_trans(nic_t *nic, int i)
3047{
3048 XENA_dev_config_t *bar0 = (XENA_dev_config_t *) nic->bar0;
3049 u64 val64;
3050 int ret = 0, cnt = 0;
3051
3052 do {
3053 val64 = readq(&bar0->xmsi_access);
3054 if (!(val64 & BIT(15)))
3055 break;
3056 mdelay(1);
3057 cnt++;
3058 } while(cnt < 5);
3059 if (cnt == 5) {
3060 DBG_PRINT(ERR_DBG, "XMSI # %d Access failed\n", i);
3061 ret = 1;
3062 }
3063
3064 return ret;
3065}
3066
3067void restore_xmsi_data(nic_t *nic)
3068{
3069 XENA_dev_config_t *bar0 = (XENA_dev_config_t *) nic->bar0;
3070 u64 val64;
3071 int i;
3072
3073 for (i=0; i< MAX_REQUESTED_MSI_X; i++) {
3074 writeq(nic->msix_info[i].addr, &bar0->xmsi_address);
3075 writeq(nic->msix_info[i].data, &bar0->xmsi_data);
3076 val64 = (BIT(7) | BIT(15) | vBIT(i, 26, 6));
3077 writeq(val64, &bar0->xmsi_access);
3078 if (wait_for_msix_trans(nic, i)) {
3079 DBG_PRINT(ERR_DBG, "failed in %s\n", __FUNCTION__);
3080 continue;
3081 }
3082 }
3083}
3084
3085void store_xmsi_data(nic_t *nic)
3086{
3087 XENA_dev_config_t *bar0 = (XENA_dev_config_t *) nic->bar0;
3088 u64 val64, addr, data;
3089 int i;
3090
3091 /* Store and display */
3092 for (i=0; i< MAX_REQUESTED_MSI_X; i++) {
3093 val64 = (BIT(15) | vBIT(i, 26, 6));
3094 writeq(val64, &bar0->xmsi_access);
3095 if (wait_for_msix_trans(nic, i)) {
3096 DBG_PRINT(ERR_DBG, "failed in %s\n", __FUNCTION__);
3097 continue;
3098 }
3099 addr = readq(&bar0->xmsi_address);
3100 data = readq(&bar0->xmsi_data);
3101 if (addr && data) {
3102 nic->msix_info[i].addr = addr;
3103 nic->msix_info[i].data = data;
3104 }
3105 }
3106}
3107
3108int s2io_enable_msi(nic_t *nic)
3109{
3110 XENA_dev_config_t *bar0 = (XENA_dev_config_t *) nic->bar0;
3111 u16 msi_ctrl, msg_val;
3112 struct config_param *config = &nic->config;
3113 struct net_device *dev = nic->dev;
3114 u64 val64, tx_mat, rx_mat;
3115 int i, err;
3116
3117 val64 = readq(&bar0->pic_control);
3118 val64 &= ~BIT(1);
3119 writeq(val64, &bar0->pic_control);
3120
3121 err = pci_enable_msi(nic->pdev);
3122 if (err) {
3123 DBG_PRINT(ERR_DBG, "%s: enabling MSI failed\n",
3124 nic->dev->name);
3125 return err;
3126 }
3127
3128 /*
3129 * Enable MSI and use MSI-1 in stead of the standard MSI-0
3130 * for interrupt handling.
3131 */
3132 pci_read_config_word(nic->pdev, 0x4c, &msg_val);
3133 msg_val ^= 0x1;
3134 pci_write_config_word(nic->pdev, 0x4c, msg_val);
3135 pci_read_config_word(nic->pdev, 0x4c, &msg_val);
3136
3137 pci_read_config_word(nic->pdev, 0x42, &msi_ctrl);
3138 msi_ctrl |= 0x10;
3139 pci_write_config_word(nic->pdev, 0x42, msi_ctrl);
3140
3141 /* program MSI-1 into all usable Tx_Mat and Rx_Mat fields */
3142 tx_mat = readq(&bar0->tx_mat0_n[0]);
3143 for (i=0; i<config->tx_fifo_num; i++) {
3144 tx_mat |= TX_MAT_SET(i, 1);
3145 }
3146 writeq(tx_mat, &bar0->tx_mat0_n[0]);
3147
3148 rx_mat = readq(&bar0->rx_mat);
3149 for (i=0; i<config->rx_ring_num; i++) {
3150 rx_mat |= RX_MAT_SET(i, 1);
3151 }
3152 writeq(rx_mat, &bar0->rx_mat);
3153
3154 dev->irq = nic->pdev->irq;
3155 return 0;
3156}
3157
3158int s2io_enable_msi_x(nic_t *nic)
3159{
3160 XENA_dev_config_t *bar0 = (XENA_dev_config_t *) nic->bar0;
3161 u64 tx_mat, rx_mat;
3162 u16 msi_control; /* Temp variable */
3163 int ret, i, j, msix_indx = 1;
3164
3165 nic->entries = kmalloc(MAX_REQUESTED_MSI_X * sizeof(struct msix_entry),
3166 GFP_KERNEL);
3167 if (nic->entries == NULL) {
3168 DBG_PRINT(ERR_DBG, "%s: Memory allocation failed\n", __FUNCTION__);
3169 return -ENOMEM;
3170 }
3171 memset(nic->entries, 0, MAX_REQUESTED_MSI_X * sizeof(struct msix_entry));
3172
3173 nic->s2io_entries =
3174 kmalloc(MAX_REQUESTED_MSI_X * sizeof(struct s2io_msix_entry),
3175 GFP_KERNEL);
3176 if (nic->s2io_entries == NULL) {
3177 DBG_PRINT(ERR_DBG, "%s: Memory allocation failed\n", __FUNCTION__);
3178 kfree(nic->entries);
3179 return -ENOMEM;
3180 }
3181 memset(nic->s2io_entries, 0,
3182 MAX_REQUESTED_MSI_X * sizeof(struct s2io_msix_entry));
3183
3184 for (i=0; i< MAX_REQUESTED_MSI_X; i++) {
3185 nic->entries[i].entry = i;
3186 nic->s2io_entries[i].entry = i;
3187 nic->s2io_entries[i].arg = NULL;
3188 nic->s2io_entries[i].in_use = 0;
3189 }
3190
3191 tx_mat = readq(&bar0->tx_mat0_n[0]);
3192 for (i=0; i<nic->config.tx_fifo_num; i++, msix_indx++) {
3193 tx_mat |= TX_MAT_SET(i, msix_indx);
3194 nic->s2io_entries[msix_indx].arg = &nic->mac_control.fifos[i];
3195 nic->s2io_entries[msix_indx].type = MSIX_FIFO_TYPE;
3196 nic->s2io_entries[msix_indx].in_use = MSIX_FLG;
3197 }
3198 writeq(tx_mat, &bar0->tx_mat0_n[0]);
3199
3200 if (!nic->config.bimodal) {
3201 rx_mat = readq(&bar0->rx_mat);
3202 for (j=0; j<nic->config.rx_ring_num; j++, msix_indx++) {
3203 rx_mat |= RX_MAT_SET(j, msix_indx);
3204 nic->s2io_entries[msix_indx].arg = &nic->mac_control.rings[j];
3205 nic->s2io_entries[msix_indx].type = MSIX_RING_TYPE;
3206 nic->s2io_entries[msix_indx].in_use = MSIX_FLG;
3207 }
3208 writeq(rx_mat, &bar0->rx_mat);
3209 } else {
3210 tx_mat = readq(&bar0->tx_mat0_n[7]);
3211 for (j=0; j<nic->config.rx_ring_num; j++, msix_indx++) {
3212 tx_mat |= TX_MAT_SET(i, msix_indx);
3213 nic->s2io_entries[msix_indx].arg = &nic->mac_control.rings[j];
3214 nic->s2io_entries[msix_indx].type = MSIX_RING_TYPE;
3215 nic->s2io_entries[msix_indx].in_use = MSIX_FLG;
3216 }
3217 writeq(tx_mat, &bar0->tx_mat0_n[7]);
3218 }
3219
3220 ret = pci_enable_msix(nic->pdev, nic->entries, MAX_REQUESTED_MSI_X);
3221 if (ret) {
3222 DBG_PRINT(ERR_DBG, "%s: Enabling MSIX failed\n", nic->dev->name);
3223 kfree(nic->entries);
3224 kfree(nic->s2io_entries);
3225 nic->entries = NULL;
3226 nic->s2io_entries = NULL;
3227 return -ENOMEM;
3228 }
3229
3230 /*
3231 * To enable MSI-X, MSI also needs to be enabled, due to a bug
3232 * in the herc NIC. (Temp change, needs to be removed later)
3233 */
3234 pci_read_config_word(nic->pdev, 0x42, &msi_control);
3235 msi_control |= 0x1; /* Enable MSI */
3236 pci_write_config_word(nic->pdev, 0x42, msi_control);
3237
3238 return 0;
3239}
3240
Linus Torvalds1da177e2005-04-16 15:20:36 -07003241/* ********************************************************* *
3242 * Functions defined below concern the OS part of the driver *
3243 * ********************************************************* */
3244
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003245/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07003246 * s2io_open - open entry point of the driver
3247 * @dev : pointer to the device structure.
3248 * Description:
3249 * This function is the open entry point of the driver. It mainly calls a
3250 * function to allocate Rx buffers and inserts them into the buffer
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003251 * descriptors and then enables the Rx part of the NIC.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003252 * Return value:
3253 * 0 on success and an appropriate (-)ve integer as defined in errno.h
3254 * file on failure.
3255 */
3256
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003257int s2io_open(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003258{
3259 nic_t *sp = dev->priv;
3260 int err = 0;
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003261 int i;
3262 u16 msi_control; /* Temp variable */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003263
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003264 /*
3265 * Make sure you have link off by default every time
Linus Torvalds1da177e2005-04-16 15:20:36 -07003266 * Nic is initialized
3267 */
3268 netif_carrier_off(dev);
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07003269 sp->last_link_state = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003270
3271 /* Initialize H/W and enable interrupts */
3272 if (s2io_card_up(sp)) {
3273 DBG_PRINT(ERR_DBG, "%s: H/W initialization failed\n",
3274 dev->name);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003275 err = -ENODEV;
3276 goto hw_init_failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003277 }
3278
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003279 /* Store the values of the MSIX table in the nic_t structure */
3280 store_xmsi_data(sp);
3281
Linus Torvalds1da177e2005-04-16 15:20:36 -07003282 /* After proper initialization of H/W, register ISR */
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003283 if (sp->intr_type == MSI) {
3284 err = request_irq((int) sp->pdev->irq, s2io_msi_handle,
3285 SA_SHIRQ, sp->name, dev);
3286 if (err) {
3287 DBG_PRINT(ERR_DBG, "%s: MSI registration \
3288failed\n", dev->name);
3289 goto isr_registration_failed;
3290 }
3291 }
3292 if (sp->intr_type == MSI_X) {
3293 for (i=1; (sp->s2io_entries[i].in_use == MSIX_FLG); i++) {
3294 if (sp->s2io_entries[i].type == MSIX_FIFO_TYPE) {
3295 sprintf(sp->desc1, "%s:MSI-X-%d-TX",
3296 dev->name, i);
3297 err = request_irq(sp->entries[i].vector,
3298 s2io_msix_fifo_handle, 0, sp->desc1,
3299 sp->s2io_entries[i].arg);
3300 DBG_PRINT(ERR_DBG, "%s @ 0x%llx\n", sp->desc1,
3301 sp->msix_info[i].addr);
3302 } else {
3303 sprintf(sp->desc2, "%s:MSI-X-%d-RX",
3304 dev->name, i);
3305 err = request_irq(sp->entries[i].vector,
3306 s2io_msix_ring_handle, 0, sp->desc2,
3307 sp->s2io_entries[i].arg);
3308 DBG_PRINT(ERR_DBG, "%s @ 0x%llx\n", sp->desc2,
3309 sp->msix_info[i].addr);
3310 }
3311 if (err) {
3312 DBG_PRINT(ERR_DBG, "%s: MSI-X-%d registration \
3313failed\n", dev->name, i);
3314 DBG_PRINT(ERR_DBG, "Returned: %d\n", err);
3315 goto isr_registration_failed;
3316 }
3317 sp->s2io_entries[i].in_use = MSIX_REGISTERED_SUCCESS;
3318 }
3319 }
3320 if (sp->intr_type == INTA) {
3321 err = request_irq((int) sp->pdev->irq, s2io_isr, SA_SHIRQ,
3322 sp->name, dev);
3323 if (err) {
3324 DBG_PRINT(ERR_DBG, "%s: ISR registration failed\n",
3325 dev->name);
3326 goto isr_registration_failed;
3327 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003328 }
3329
3330 if (s2io_set_mac_addr(dev, dev->dev_addr) == FAILURE) {
3331 DBG_PRINT(ERR_DBG, "Set Mac Address Failed\n");
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003332 err = -ENODEV;
3333 goto setting_mac_address_failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003334 }
3335
3336 netif_start_queue(dev);
3337 return 0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003338
3339setting_mac_address_failed:
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003340 if (sp->intr_type != MSI_X)
3341 free_irq(sp->pdev->irq, dev);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003342isr_registration_failed:
raghavendra.koushik@neterion.com25fff882005-08-03 12:34:11 -07003343 del_timer_sync(&sp->alarm_timer);
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003344 if (sp->intr_type == MSI_X) {
3345 if (sp->device_type == XFRAME_II_DEVICE) {
3346 for (i=1; (sp->s2io_entries[i].in_use ==
3347 MSIX_REGISTERED_SUCCESS); i++) {
3348 int vector = sp->entries[i].vector;
3349 void *arg = sp->s2io_entries[i].arg;
3350
3351 free_irq(vector, arg);
3352 }
3353 pci_disable_msix(sp->pdev);
3354
3355 /* Temp */
3356 pci_read_config_word(sp->pdev, 0x42, &msi_control);
3357 msi_control &= 0xFFFE; /* Disable MSI */
3358 pci_write_config_word(sp->pdev, 0x42, msi_control);
3359 }
3360 }
3361 else if (sp->intr_type == MSI)
3362 pci_disable_msi(sp->pdev);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003363 s2io_reset(sp);
3364hw_init_failed:
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003365 if (sp->intr_type == MSI_X) {
3366 if (sp->entries)
3367 kfree(sp->entries);
3368 if (sp->s2io_entries)
3369 kfree(sp->s2io_entries);
3370 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003371 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003372}
3373
3374/**
3375 * s2io_close -close entry point of the driver
3376 * @dev : device pointer.
3377 * Description:
3378 * This is the stop entry point of the driver. It needs to undo exactly
3379 * whatever was done by the open entry point,thus it's usually referred to
3380 * as the close function.Among other things this function mainly stops the
3381 * Rx side of the NIC and frees all the Rx buffers in the Rx rings.
3382 * Return value:
3383 * 0 on success and an appropriate (-)ve integer as defined in errno.h
3384 * file on failure.
3385 */
3386
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003387int s2io_close(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003388{
3389 nic_t *sp = dev->priv;
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003390 int i;
3391 u16 msi_control;
3392
Linus Torvalds1da177e2005-04-16 15:20:36 -07003393 flush_scheduled_work();
3394 netif_stop_queue(dev);
3395 /* Reset card, kill tasklet and free Tx and Rx buffers. */
3396 s2io_card_down(sp);
3397
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003398 if (sp->intr_type == MSI_X) {
3399 if (sp->device_type == XFRAME_II_DEVICE) {
3400 for (i=1; (sp->s2io_entries[i].in_use ==
3401 MSIX_REGISTERED_SUCCESS); i++) {
3402 int vector = sp->entries[i].vector;
3403 void *arg = sp->s2io_entries[i].arg;
3404
3405 free_irq(vector, arg);
3406 }
3407 pci_read_config_word(sp->pdev, 0x42, &msi_control);
3408 msi_control &= 0xFFFE; /* Disable MSI */
3409 pci_write_config_word(sp->pdev, 0x42, msi_control);
3410
3411 pci_disable_msix(sp->pdev);
3412 }
3413 }
3414 else {
3415 free_irq(sp->pdev->irq, dev);
3416 if (sp->intr_type == MSI)
3417 pci_disable_msi(sp->pdev);
3418 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003419 sp->device_close_flag = TRUE; /* Device is shut down. */
3420 return 0;
3421}
3422
3423/**
3424 * s2io_xmit - Tx entry point of te driver
3425 * @skb : the socket buffer containing the Tx data.
3426 * @dev : device pointer.
3427 * Description :
3428 * This function is the Tx entry point of the driver. S2IO NIC supports
3429 * certain protocol assist features on Tx side, namely CSO, S/G, LSO.
3430 * NOTE: when device cant queue the pkt,just the trans_start variable will
3431 * not be upadted.
3432 * Return value:
3433 * 0 on success & 1 on failure.
3434 */
3435
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003436int s2io_xmit(struct sk_buff *skb, struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003437{
3438 nic_t *sp = dev->priv;
3439 u16 frg_cnt, frg_len, i, queue, queue_len, put_off, get_off;
3440 register u64 val64;
3441 TxD_t *txdp;
3442 TxFIFO_element_t __iomem *tx_fifo;
3443 unsigned long flags;
3444#ifdef NETIF_F_TSO
3445 int mss;
3446#endif
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -07003447 u16 vlan_tag = 0;
3448 int vlan_priority = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003449 mac_info_t *mac_control;
3450 struct config_param *config;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003451
3452 mac_control = &sp->mac_control;
3453 config = &sp->config;
3454
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003455 DBG_PRINT(TX_DBG, "%s: In Neterion Tx routine\n", dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003456 spin_lock_irqsave(&sp->tx_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003457 if (atomic_read(&sp->card_state) == CARD_DOWN) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003458 DBG_PRINT(TX_DBG, "%s: Card going down for reset\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003459 dev->name);
3460 spin_unlock_irqrestore(&sp->tx_lock, flags);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003461 dev_kfree_skb(skb);
3462 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003463 }
3464
3465 queue = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003466
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -07003467 /* Get Fifo number to Transmit based on vlan priority */
3468 if (sp->vlgrp && vlan_tx_tag_present(skb)) {
3469 vlan_tag = vlan_tx_tag_get(skb);
3470 vlan_priority = vlan_tag >> 13;
3471 queue = config->fifo_mapping[vlan_priority];
3472 }
3473
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003474 put_off = (u16) mac_control->fifos[queue].tx_curr_put_info.offset;
3475 get_off = (u16) mac_control->fifos[queue].tx_curr_get_info.offset;
3476 txdp = (TxD_t *) mac_control->fifos[queue].list_info[put_off].
3477 list_virt_addr;
3478
3479 queue_len = mac_control->fifos[queue].tx_curr_put_info.fifo_len + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003480 /* Avoid "put" pointer going beyond "get" pointer */
3481 if (txdp->Host_Control || (((put_off + 1) % queue_len) == get_off)) {
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07003482 DBG_PRINT(TX_DBG, "Error in xmit, No free TXDs.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003483 netif_stop_queue(dev);
3484 dev_kfree_skb(skb);
3485 spin_unlock_irqrestore(&sp->tx_lock, flags);
3486 return 0;
3487 }
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07003488
3489 /* A buffer with no data will be dropped */
3490 if (!skb->len) {
3491 DBG_PRINT(TX_DBG, "%s:Buffer has no data..\n", dev->name);
3492 dev_kfree_skb(skb);
3493 spin_unlock_irqrestore(&sp->tx_lock, flags);
3494 return 0;
3495 }
3496
Linus Torvalds1da177e2005-04-16 15:20:36 -07003497#ifdef NETIF_F_TSO
3498 mss = skb_shinfo(skb)->tso_size;
3499 if (mss) {
3500 txdp->Control_1 |= TXD_TCP_LSO_EN;
3501 txdp->Control_1 |= TXD_TCP_LSO_MSS(mss);
3502 }
3503#endif
3504
3505 frg_cnt = skb_shinfo(skb)->nr_frags;
3506 frg_len = skb->len - skb->data_len;
3507
Linus Torvalds1da177e2005-04-16 15:20:36 -07003508 txdp->Buffer_Pointer = pci_map_single
3509 (sp->pdev, skb->data, frg_len, PCI_DMA_TODEVICE);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003510 txdp->Host_Control = (unsigned long) skb;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003511 if (skb->ip_summed == CHECKSUM_HW) {
3512 txdp->Control_2 |=
3513 (TXD_TX_CKO_IPV4_EN | TXD_TX_CKO_TCP_EN |
3514 TXD_TX_CKO_UDP_EN);
3515 }
3516
3517 txdp->Control_2 |= config->tx_intr_type;
raghavendra.koushik@neterion.comd8892c62005-08-03 12:33:12 -07003518
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -07003519 if (sp->vlgrp && vlan_tx_tag_present(skb)) {
3520 txdp->Control_2 |= TXD_VLAN_ENABLE;
3521 txdp->Control_2 |= TXD_VLAN_TAG(vlan_tag);
3522 }
3523
Linus Torvalds1da177e2005-04-16 15:20:36 -07003524 txdp->Control_1 |= (TXD_BUFFER0_SIZE(frg_len) |
3525 TXD_GATHER_CODE_FIRST);
3526 txdp->Control_1 |= TXD_LIST_OWN_XENA;
3527
3528 /* For fragmented SKB. */
3529 for (i = 0; i < frg_cnt; i++) {
3530 skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07003531 /* A '0' length fragment will be ignored */
3532 if (!frag->size)
3533 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003534 txdp++;
3535 txdp->Buffer_Pointer = (u64) pci_map_page
3536 (sp->pdev, frag->page, frag->page_offset,
3537 frag->size, PCI_DMA_TODEVICE);
3538 txdp->Control_1 |= TXD_BUFFER0_SIZE(frag->size);
3539 }
3540 txdp->Control_1 |= TXD_GATHER_CODE_LAST;
3541
3542 tx_fifo = mac_control->tx_FIFO_start[queue];
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003543 val64 = mac_control->fifos[queue].list_info[put_off].list_phy_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003544 writeq(val64, &tx_fifo->TxDL_Pointer);
3545
3546 val64 = (TX_FIFO_LAST_TXD_NUM(frg_cnt) | TX_FIFO_FIRST_LIST |
3547 TX_FIFO_LAST_LIST);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003548
Linus Torvalds1da177e2005-04-16 15:20:36 -07003549#ifdef NETIF_F_TSO
3550 if (mss)
3551 val64 |= TX_FIFO_SPECIAL_FUNC;
3552#endif
3553 writeq(val64, &tx_fifo->List_Control);
3554
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07003555 mmiowb();
3556
Linus Torvalds1da177e2005-04-16 15:20:36 -07003557 put_off++;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003558 put_off %= mac_control->fifos[queue].tx_curr_put_info.fifo_len + 1;
3559 mac_control->fifos[queue].tx_curr_put_info.offset = put_off;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003560
3561 /* Avoid "put" pointer going beyond "get" pointer */
3562 if (((put_off + 1) % queue_len) == get_off) {
3563 DBG_PRINT(TX_DBG,
3564 "No free TxDs for xmit, Put: 0x%x Get:0x%x\n",
3565 put_off, get_off);
3566 netif_stop_queue(dev);
3567 }
3568
3569 dev->trans_start = jiffies;
3570 spin_unlock_irqrestore(&sp->tx_lock, flags);
3571
3572 return 0;
3573}
3574
raghavendra.koushik@neterion.com25fff882005-08-03 12:34:11 -07003575static void
3576s2io_alarm_handle(unsigned long data)
3577{
3578 nic_t *sp = (nic_t *)data;
3579
3580 alarm_intr_handler(sp);
3581 mod_timer(&sp->alarm_timer, jiffies + HZ / 2);
3582}
3583
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04003584static irqreturn_t
3585s2io_msi_handle(int irq, void *dev_id, struct pt_regs *regs)
3586{
3587 struct net_device *dev = (struct net_device *) dev_id;
3588 nic_t *sp = dev->priv;
3589 int i;
3590 int ret;
3591 mac_info_t *mac_control;
3592 struct config_param *config;
3593
3594 atomic_inc(&sp->isr_cnt);
3595 mac_control = &sp->mac_control;
3596 config = &sp->config;
3597 DBG_PRINT(INTR_DBG, "%s: MSI handler\n", __FUNCTION__);
3598
3599 /* If Intr is because of Rx Traffic */
3600 for (i = 0; i < config->rx_ring_num; i++)
3601 rx_intr_handler(&mac_control->rings[i]);
3602
3603 /* If Intr is because of Tx Traffic */
3604 for (i = 0; i < config->tx_fifo_num; i++)
3605 tx_intr_handler(&mac_control->fifos[i]);
3606
3607 /*
3608 * If the Rx buffer count is below the panic threshold then
3609 * reallocate the buffers from the interrupt handler itself,
3610 * else schedule a tasklet to reallocate the buffers.
3611 */
3612 for (i = 0; i < config->rx_ring_num; i++) {
3613 int rxb_size = atomic_read(&sp->rx_bufs_left[i]);
3614 int level = rx_buffer_level(sp, rxb_size, i);
3615
3616 if ((level == PANIC) && (!TASKLET_IN_USE)) {
3617 DBG_PRINT(INTR_DBG, "%s: Rx BD hit ", dev->name);
3618 DBG_PRINT(INTR_DBG, "PANIC levels\n");
3619 if ((ret = fill_rx_buffers(sp, i)) == -ENOMEM) {
3620 DBG_PRINT(ERR_DBG, "%s:Out of memory",
3621 dev->name);
3622 DBG_PRINT(ERR_DBG, " in ISR!!\n");
3623 clear_bit(0, (&sp->tasklet_status));
3624 atomic_dec(&sp->isr_cnt);
3625 return IRQ_HANDLED;
3626 }
3627 clear_bit(0, (&sp->tasklet_status));
3628 } else if (level == LOW) {
3629 tasklet_schedule(&sp->task);
3630 }
3631 }
3632
3633 atomic_dec(&sp->isr_cnt);
3634 return IRQ_HANDLED;
3635}
3636
3637static irqreturn_t
3638s2io_msix_ring_handle(int irq, void *dev_id, struct pt_regs *regs)
3639{
3640 ring_info_t *ring = (ring_info_t *)dev_id;
3641 nic_t *sp = ring->nic;
3642 int rxb_size, level, rng_n;
3643
3644 atomic_inc(&sp->isr_cnt);
3645 rx_intr_handler(ring);
3646
3647 rng_n = ring->ring_no;
3648 rxb_size = atomic_read(&sp->rx_bufs_left[rng_n]);
3649 level = rx_buffer_level(sp, rxb_size, rng_n);
3650
3651 if ((level == PANIC) && (!TASKLET_IN_USE)) {
3652 int ret;
3653 DBG_PRINT(INTR_DBG, "%s: Rx BD hit ", __FUNCTION__);
3654 DBG_PRINT(INTR_DBG, "PANIC levels\n");
3655 if ((ret = fill_rx_buffers(sp, rng_n)) == -ENOMEM) {
3656 DBG_PRINT(ERR_DBG, "Out of memory in %s",
3657 __FUNCTION__);
3658 clear_bit(0, (&sp->tasklet_status));
3659 return IRQ_HANDLED;
3660 }
3661 clear_bit(0, (&sp->tasklet_status));
3662 } else if (level == LOW) {
3663 tasklet_schedule(&sp->task);
3664 }
3665 atomic_dec(&sp->isr_cnt);
3666
3667 return IRQ_HANDLED;
3668}
3669
3670static irqreturn_t
3671s2io_msix_fifo_handle(int irq, void *dev_id, struct pt_regs *regs)
3672{
3673 fifo_info_t *fifo = (fifo_info_t *)dev_id;
3674 nic_t *sp = fifo->nic;
3675
3676 atomic_inc(&sp->isr_cnt);
3677 tx_intr_handler(fifo);
3678 atomic_dec(&sp->isr_cnt);
3679 return IRQ_HANDLED;
3680}
3681
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07003682static void s2io_txpic_intr_handle(nic_t *sp)
3683{
viro@ftp.linux.org.uk509a2672005-09-05 03:25:58 +01003684 XENA_dev_config_t __iomem *bar0 = sp->bar0;
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07003685 u64 val64;
3686
3687 val64 = readq(&bar0->pic_int_status);
3688 if (val64 & PIC_INT_GPIO) {
3689 val64 = readq(&bar0->gpio_int_reg);
3690 if ((val64 & GPIO_INT_REG_LINK_DOWN) &&
3691 (val64 & GPIO_INT_REG_LINK_UP)) {
3692 val64 |= GPIO_INT_REG_LINK_DOWN;
3693 val64 |= GPIO_INT_REG_LINK_UP;
3694 writeq(val64, &bar0->gpio_int_reg);
3695 goto masking;
3696 }
3697
3698 if (((sp->last_link_state == LINK_UP) &&
3699 (val64 & GPIO_INT_REG_LINK_DOWN)) ||
3700 ((sp->last_link_state == LINK_DOWN) &&
3701 (val64 & GPIO_INT_REG_LINK_UP))) {
3702 val64 = readq(&bar0->gpio_int_mask);
3703 val64 |= GPIO_INT_MASK_LINK_DOWN;
3704 val64 |= GPIO_INT_MASK_LINK_UP;
3705 writeq(val64, &bar0->gpio_int_mask);
3706 s2io_set_link((unsigned long)sp);
3707 }
3708masking:
3709 if (sp->last_link_state == LINK_UP) {
3710 /*enable down interrupt */
3711 val64 = readq(&bar0->gpio_int_mask);
3712 /* unmasks link down intr */
3713 val64 &= ~GPIO_INT_MASK_LINK_DOWN;
3714 /* masks link up intr */
3715 val64 |= GPIO_INT_MASK_LINK_UP;
3716 writeq(val64, &bar0->gpio_int_mask);
3717 } else {
3718 /*enable UP Interrupt */
3719 val64 = readq(&bar0->gpio_int_mask);
3720 /* unmasks link up interrupt */
3721 val64 &= ~GPIO_INT_MASK_LINK_UP;
3722 /* masks link down interrupt */
3723 val64 |= GPIO_INT_MASK_LINK_DOWN;
3724 writeq(val64, &bar0->gpio_int_mask);
3725 }
3726 }
3727}
3728
Linus Torvalds1da177e2005-04-16 15:20:36 -07003729/**
3730 * s2io_isr - ISR handler of the device .
3731 * @irq: the irq of the device.
3732 * @dev_id: a void pointer to the dev structure of the NIC.
3733 * @pt_regs: pointer to the registers pushed on the stack.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003734 * Description: This function is the ISR handler of the device. It
3735 * identifies the reason for the interrupt and calls the relevant
3736 * service routines. As a contongency measure, this ISR allocates the
Linus Torvalds1da177e2005-04-16 15:20:36 -07003737 * recv buffers, if their numbers are below the panic value which is
3738 * presently set to 25% of the original number of rcv buffers allocated.
3739 * Return value:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003740 * IRQ_HANDLED: will be returned if IRQ was handled by this routine
Linus Torvalds1da177e2005-04-16 15:20:36 -07003741 * IRQ_NONE: will be returned if interrupt is not from our device
3742 */
3743static irqreturn_t s2io_isr(int irq, void *dev_id, struct pt_regs *regs)
3744{
3745 struct net_device *dev = (struct net_device *) dev_id;
3746 nic_t *sp = dev->priv;
3747 XENA_dev_config_t __iomem *bar0 = sp->bar0;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003748 int i;
raghavendra.koushik@neterion.comfe113632005-08-03 12:32:00 -07003749 u64 reason = 0, val64;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003750 mac_info_t *mac_control;
3751 struct config_param *config;
3752
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07003753 atomic_inc(&sp->isr_cnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003754 mac_control = &sp->mac_control;
3755 config = &sp->config;
3756
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003757 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07003758 * Identify the cause for interrupt and call the appropriate
3759 * interrupt handler. Causes for the interrupt could be;
3760 * 1. Rx of packet.
3761 * 2. Tx complete.
3762 * 3. Link down.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003763 * 4. Error in any functional blocks of the NIC.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003764 */
3765 reason = readq(&bar0->general_int_status);
3766
3767 if (!reason) {
3768 /* The interrupt was not raised by Xena. */
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07003769 atomic_dec(&sp->isr_cnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003770 return IRQ_NONE;
3771 }
3772
Linus Torvalds1da177e2005-04-16 15:20:36 -07003773#ifdef CONFIG_S2IO_NAPI
3774 if (reason & GEN_INTR_RXTRAFFIC) {
3775 if (netif_rx_schedule_prep(dev)) {
3776 en_dis_able_nic_intrs(sp, RX_TRAFFIC_INTR,
3777 DISABLE_INTRS);
3778 __netif_rx_schedule(dev);
3779 }
3780 }
3781#else
3782 /* If Intr is because of Rx Traffic */
3783 if (reason & GEN_INTR_RXTRAFFIC) {
raghavendra.koushik@neterion.comfe113632005-08-03 12:32:00 -07003784 /*
3785 * rx_traffic_int reg is an R1 register, writing all 1's
3786 * will ensure that the actual interrupt causing bit get's
3787 * cleared and hence a read can be avoided.
3788 */
3789 val64 = 0xFFFFFFFFFFFFFFFFULL;
3790 writeq(val64, &bar0->rx_traffic_int);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003791 for (i = 0; i < config->rx_ring_num; i++) {
3792 rx_intr_handler(&mac_control->rings[i]);
3793 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003794 }
3795#endif
3796
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003797 /* If Intr is because of Tx Traffic */
3798 if (reason & GEN_INTR_TXTRAFFIC) {
raghavendra.koushik@neterion.comfe113632005-08-03 12:32:00 -07003799 /*
3800 * tx_traffic_int reg is an R1 register, writing all 1's
3801 * will ensure that the actual interrupt causing bit get's
3802 * cleared and hence a read can be avoided.
3803 */
3804 val64 = 0xFFFFFFFFFFFFFFFFULL;
3805 writeq(val64, &bar0->tx_traffic_int);
3806
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003807 for (i = 0; i < config->tx_fifo_num; i++)
3808 tx_intr_handler(&mac_control->fifos[i]);
3809 }
3810
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07003811 if (reason & GEN_INTR_TXPIC)
3812 s2io_txpic_intr_handle(sp);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003813 /*
3814 * If the Rx buffer count is below the panic threshold then
3815 * reallocate the buffers from the interrupt handler itself,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003816 * else schedule a tasklet to reallocate the buffers.
3817 */
3818#ifndef CONFIG_S2IO_NAPI
3819 for (i = 0; i < config->rx_ring_num; i++) {
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003820 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003821 int rxb_size = atomic_read(&sp->rx_bufs_left[i]);
3822 int level = rx_buffer_level(sp, rxb_size, i);
3823
3824 if ((level == PANIC) && (!TASKLET_IN_USE)) {
3825 DBG_PRINT(INTR_DBG, "%s: Rx BD hit ", dev->name);
3826 DBG_PRINT(INTR_DBG, "PANIC levels\n");
3827 if ((ret = fill_rx_buffers(sp, i)) == -ENOMEM) {
3828 DBG_PRINT(ERR_DBG, "%s:Out of memory",
3829 dev->name);
3830 DBG_PRINT(ERR_DBG, " in ISR!!\n");
3831 clear_bit(0, (&sp->tasklet_status));
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07003832 atomic_dec(&sp->isr_cnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003833 return IRQ_HANDLED;
3834 }
3835 clear_bit(0, (&sp->tasklet_status));
3836 } else if (level == LOW) {
3837 tasklet_schedule(&sp->task);
3838 }
3839 }
3840#endif
3841
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07003842 atomic_dec(&sp->isr_cnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003843 return IRQ_HANDLED;
3844}
3845
3846/**
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07003847 * s2io_updt_stats -
3848 */
3849static void s2io_updt_stats(nic_t *sp)
3850{
3851 XENA_dev_config_t __iomem *bar0 = sp->bar0;
3852 u64 val64;
3853 int cnt = 0;
3854
3855 if (atomic_read(&sp->card_state) == CARD_UP) {
3856 /* Apprx 30us on a 133 MHz bus */
3857 val64 = SET_UPDT_CLICKS(10) |
3858 STAT_CFG_ONE_SHOT_EN | STAT_CFG_STAT_EN;
3859 writeq(val64, &bar0->stat_cfg);
3860 do {
3861 udelay(100);
3862 val64 = readq(&bar0->stat_cfg);
3863 if (!(val64 & BIT(0)))
3864 break;
3865 cnt++;
3866 if (cnt == 5)
3867 break; /* Updt failed */
3868 } while(1);
3869 }
3870}
3871
3872/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003873 * s2io_get_stats - Updates the device statistics structure.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003874 * @dev : pointer to the device structure.
3875 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003876 * This function updates the device statistics structure in the s2io_nic
Linus Torvalds1da177e2005-04-16 15:20:36 -07003877 * structure and returns a pointer to the same.
3878 * Return value:
3879 * pointer to the updated net_device_stats structure.
3880 */
3881
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003882struct net_device_stats *s2io_get_stats(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003883{
3884 nic_t *sp = dev->priv;
3885 mac_info_t *mac_control;
3886 struct config_param *config;
3887
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003888
Linus Torvalds1da177e2005-04-16 15:20:36 -07003889 mac_control = &sp->mac_control;
3890 config = &sp->config;
3891
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07003892 /* Configure Stats for immediate updt */
3893 s2io_updt_stats(sp);
3894
3895 sp->stats.tx_packets =
3896 le32_to_cpu(mac_control->stats_info->tmac_frms);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003897 sp->stats.tx_errors =
3898 le32_to_cpu(mac_control->stats_info->tmac_any_err_frms);
3899 sp->stats.rx_errors =
3900 le32_to_cpu(mac_control->stats_info->rmac_drop_frms);
3901 sp->stats.multicast =
3902 le32_to_cpu(mac_control->stats_info->rmac_vld_mcst_frms);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003903 sp->stats.rx_length_errors =
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003904 le32_to_cpu(mac_control->stats_info->rmac_long_frms);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003905
3906 return (&sp->stats);
3907}
3908
3909/**
3910 * s2io_set_multicast - entry point for multicast address enable/disable.
3911 * @dev : pointer to the device structure
3912 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07003913 * This function is a driver entry point which gets called by the kernel
3914 * whenever multicast addresses must be enabled/disabled. This also gets
Linus Torvalds1da177e2005-04-16 15:20:36 -07003915 * called to set/reset promiscuous mode. Depending on the deivce flag, we
3916 * determine, if multicast address must be enabled or if promiscuous mode
3917 * is to be disabled etc.
3918 * Return value:
3919 * void.
3920 */
3921
3922static void s2io_set_multicast(struct net_device *dev)
3923{
3924 int i, j, prev_cnt;
3925 struct dev_mc_list *mclist;
3926 nic_t *sp = dev->priv;
3927 XENA_dev_config_t __iomem *bar0 = sp->bar0;
3928 u64 val64 = 0, multi_mac = 0x010203040506ULL, mask =
3929 0xfeffffffffffULL;
3930 u64 dis_addr = 0xffffffffffffULL, mac_addr = 0;
3931 void __iomem *add;
3932
3933 if ((dev->flags & IFF_ALLMULTI) && (!sp->m_cast_flg)) {
3934 /* Enable all Multicast addresses */
3935 writeq(RMAC_ADDR_DATA0_MEM_ADDR(multi_mac),
3936 &bar0->rmac_addr_data0_mem);
3937 writeq(RMAC_ADDR_DATA1_MEM_MASK(mask),
3938 &bar0->rmac_addr_data1_mem);
3939 val64 = RMAC_ADDR_CMD_MEM_WE |
3940 RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
3941 RMAC_ADDR_CMD_MEM_OFFSET(MAC_MC_ALL_MC_ADDR_OFFSET);
3942 writeq(val64, &bar0->rmac_addr_cmd_mem);
3943 /* Wait till command completes */
3944 wait_for_cmd_complete(sp);
3945
3946 sp->m_cast_flg = 1;
3947 sp->all_multi_pos = MAC_MC_ALL_MC_ADDR_OFFSET;
3948 } else if ((dev->flags & IFF_ALLMULTI) && (sp->m_cast_flg)) {
3949 /* Disable all Multicast addresses */
3950 writeq(RMAC_ADDR_DATA0_MEM_ADDR(dis_addr),
3951 &bar0->rmac_addr_data0_mem);
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07003952 writeq(RMAC_ADDR_DATA1_MEM_MASK(0x0),
3953 &bar0->rmac_addr_data1_mem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003954 val64 = RMAC_ADDR_CMD_MEM_WE |
3955 RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
3956 RMAC_ADDR_CMD_MEM_OFFSET(sp->all_multi_pos);
3957 writeq(val64, &bar0->rmac_addr_cmd_mem);
3958 /* Wait till command completes */
3959 wait_for_cmd_complete(sp);
3960
3961 sp->m_cast_flg = 0;
3962 sp->all_multi_pos = 0;
3963 }
3964
3965 if ((dev->flags & IFF_PROMISC) && (!sp->promisc_flg)) {
3966 /* Put the NIC into promiscuous mode */
3967 add = &bar0->mac_cfg;
3968 val64 = readq(&bar0->mac_cfg);
3969 val64 |= MAC_CFG_RMAC_PROM_ENABLE;
3970
3971 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
3972 writel((u32) val64, add);
3973 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
3974 writel((u32) (val64 >> 32), (add + 4));
3975
3976 val64 = readq(&bar0->mac_cfg);
3977 sp->promisc_flg = 1;
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07003978 DBG_PRINT(INFO_DBG, "%s: entered promiscuous mode\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003979 dev->name);
3980 } else if (!(dev->flags & IFF_PROMISC) && (sp->promisc_flg)) {
3981 /* Remove the NIC from promiscuous mode */
3982 add = &bar0->mac_cfg;
3983 val64 = readq(&bar0->mac_cfg);
3984 val64 &= ~MAC_CFG_RMAC_PROM_ENABLE;
3985
3986 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
3987 writel((u32) val64, add);
3988 writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
3989 writel((u32) (val64 >> 32), (add + 4));
3990
3991 val64 = readq(&bar0->mac_cfg);
3992 sp->promisc_flg = 0;
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07003993 DBG_PRINT(INFO_DBG, "%s: left promiscuous mode\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003994 dev->name);
3995 }
3996
3997 /* Update individual M_CAST address list */
3998 if ((!sp->m_cast_flg) && dev->mc_count) {
3999 if (dev->mc_count >
4000 (MAX_ADDRS_SUPPORTED - MAC_MC_ADDR_START_OFFSET - 1)) {
4001 DBG_PRINT(ERR_DBG, "%s: No more Rx filters ",
4002 dev->name);
4003 DBG_PRINT(ERR_DBG, "can be added, please enable ");
4004 DBG_PRINT(ERR_DBG, "ALL_MULTI instead\n");
4005 return;
4006 }
4007
4008 prev_cnt = sp->mc_addr_count;
4009 sp->mc_addr_count = dev->mc_count;
4010
4011 /* Clear out the previous list of Mc in the H/W. */
4012 for (i = 0; i < prev_cnt; i++) {
4013 writeq(RMAC_ADDR_DATA0_MEM_ADDR(dis_addr),
4014 &bar0->rmac_addr_data0_mem);
4015 writeq(RMAC_ADDR_DATA1_MEM_MASK(0ULL),
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004016 &bar0->rmac_addr_data1_mem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004017 val64 = RMAC_ADDR_CMD_MEM_WE |
4018 RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
4019 RMAC_ADDR_CMD_MEM_OFFSET
4020 (MAC_MC_ADDR_START_OFFSET + i);
4021 writeq(val64, &bar0->rmac_addr_cmd_mem);
4022
4023 /* Wait for command completes */
4024 if (wait_for_cmd_complete(sp)) {
4025 DBG_PRINT(ERR_DBG, "%s: Adding ",
4026 dev->name);
4027 DBG_PRINT(ERR_DBG, "Multicasts failed\n");
4028 return;
4029 }
4030 }
4031
4032 /* Create the new Rx filter list and update the same in H/W. */
4033 for (i = 0, mclist = dev->mc_list; i < dev->mc_count;
4034 i++, mclist = mclist->next) {
4035 memcpy(sp->usr_addrs[i].addr, mclist->dmi_addr,
4036 ETH_ALEN);
4037 for (j = 0; j < ETH_ALEN; j++) {
4038 mac_addr |= mclist->dmi_addr[j];
4039 mac_addr <<= 8;
4040 }
4041 mac_addr >>= 8;
4042 writeq(RMAC_ADDR_DATA0_MEM_ADDR(mac_addr),
4043 &bar0->rmac_addr_data0_mem);
4044 writeq(RMAC_ADDR_DATA1_MEM_MASK(0ULL),
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004045 &bar0->rmac_addr_data1_mem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004046 val64 = RMAC_ADDR_CMD_MEM_WE |
4047 RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
4048 RMAC_ADDR_CMD_MEM_OFFSET
4049 (i + MAC_MC_ADDR_START_OFFSET);
4050 writeq(val64, &bar0->rmac_addr_cmd_mem);
4051
4052 /* Wait for command completes */
4053 if (wait_for_cmd_complete(sp)) {
4054 DBG_PRINT(ERR_DBG, "%s: Adding ",
4055 dev->name);
4056 DBG_PRINT(ERR_DBG, "Multicasts failed\n");
4057 return;
4058 }
4059 }
4060 }
4061}
4062
4063/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004064 * s2io_set_mac_addr - Programs the Xframe mac address
Linus Torvalds1da177e2005-04-16 15:20:36 -07004065 * @dev : pointer to the device structure.
4066 * @addr: a uchar pointer to the new mac address which is to be set.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004067 * Description : This procedure will program the Xframe to receive
Linus Torvalds1da177e2005-04-16 15:20:36 -07004068 * frames with new Mac Address
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004069 * Return value: SUCCESS on success and an appropriate (-)ve integer
Linus Torvalds1da177e2005-04-16 15:20:36 -07004070 * as defined in errno.h file on failure.
4071 */
4072
4073int s2io_set_mac_addr(struct net_device *dev, u8 * addr)
4074{
4075 nic_t *sp = dev->priv;
4076 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4077 register u64 val64, mac_addr = 0;
4078 int i;
4079
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004080 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07004081 * Set the new MAC address as the new unicast filter and reflect this
4082 * change on the device address registered with the OS. It will be
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004083 * at offset 0.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004084 */
4085 for (i = 0; i < ETH_ALEN; i++) {
4086 mac_addr <<= 8;
4087 mac_addr |= addr[i];
4088 }
4089
4090 writeq(RMAC_ADDR_DATA0_MEM_ADDR(mac_addr),
4091 &bar0->rmac_addr_data0_mem);
4092
4093 val64 =
4094 RMAC_ADDR_CMD_MEM_WE | RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
4095 RMAC_ADDR_CMD_MEM_OFFSET(0);
4096 writeq(val64, &bar0->rmac_addr_cmd_mem);
4097 /* Wait till command completes */
4098 if (wait_for_cmd_complete(sp)) {
4099 DBG_PRINT(ERR_DBG, "%s: set_mac_addr failed\n", dev->name);
4100 return FAILURE;
4101 }
4102
4103 return SUCCESS;
4104}
4105
4106/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004107 * s2io_ethtool_sset - Sets different link parameters.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004108 * @sp : private member of the device structure, which is a pointer to the * s2io_nic structure.
4109 * @info: pointer to the structure with parameters given by ethtool to set
4110 * link information.
4111 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004112 * The function sets different link parameters provided by the user onto
Linus Torvalds1da177e2005-04-16 15:20:36 -07004113 * the NIC.
4114 * Return value:
4115 * 0 on success.
4116*/
4117
4118static int s2io_ethtool_sset(struct net_device *dev,
4119 struct ethtool_cmd *info)
4120{
4121 nic_t *sp = dev->priv;
4122 if ((info->autoneg == AUTONEG_ENABLE) ||
4123 (info->speed != SPEED_10000) || (info->duplex != DUPLEX_FULL))
4124 return -EINVAL;
4125 else {
4126 s2io_close(sp->dev);
4127 s2io_open(sp->dev);
4128 }
4129
4130 return 0;
4131}
4132
4133/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004134 * s2io_ethtol_gset - Return link specific information.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004135 * @sp : private member of the device structure, pointer to the
4136 * s2io_nic structure.
4137 * @info : pointer to the structure with parameters given by ethtool
4138 * to return link information.
4139 * Description:
4140 * Returns link specific information like speed, duplex etc.. to ethtool.
4141 * Return value :
4142 * return 0 on success.
4143 */
4144
4145static int s2io_ethtool_gset(struct net_device *dev, struct ethtool_cmd *info)
4146{
4147 nic_t *sp = dev->priv;
4148 info->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE);
4149 info->advertising = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE);
4150 info->port = PORT_FIBRE;
4151 /* info->transceiver?? TODO */
4152
4153 if (netif_carrier_ok(sp->dev)) {
4154 info->speed = 10000;
4155 info->duplex = DUPLEX_FULL;
4156 } else {
4157 info->speed = -1;
4158 info->duplex = -1;
4159 }
4160
4161 info->autoneg = AUTONEG_DISABLE;
4162 return 0;
4163}
4164
4165/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004166 * s2io_ethtool_gdrvinfo - Returns driver specific information.
4167 * @sp : private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004168 * s2io_nic structure.
4169 * @info : pointer to the structure with parameters given by ethtool to
4170 * return driver information.
4171 * Description:
4172 * Returns driver specefic information like name, version etc.. to ethtool.
4173 * Return value:
4174 * void
4175 */
4176
4177static void s2io_ethtool_gdrvinfo(struct net_device *dev,
4178 struct ethtool_drvinfo *info)
4179{
4180 nic_t *sp = dev->priv;
4181
John W. Linvilledbc23092005-09-28 17:50:51 -04004182 strncpy(info->driver, s2io_driver_name, sizeof(info->driver));
4183 strncpy(info->version, s2io_driver_version, sizeof(info->version));
4184 strncpy(info->fw_version, "", sizeof(info->fw_version));
4185 strncpy(info->bus_info, pci_name(sp->pdev), sizeof(info->bus_info));
Linus Torvalds1da177e2005-04-16 15:20:36 -07004186 info->regdump_len = XENA_REG_SPACE;
4187 info->eedump_len = XENA_EEPROM_SPACE;
4188 info->testinfo_len = S2IO_TEST_LEN;
4189 info->n_stats = S2IO_STAT_LEN;
4190}
4191
4192/**
4193 * s2io_ethtool_gregs - dumps the entire space of Xfame into the buffer.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004194 * @sp: private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004195 * s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004196 * @regs : pointer to the structure with parameters given by ethtool for
Linus Torvalds1da177e2005-04-16 15:20:36 -07004197 * dumping the registers.
4198 * @reg_space: The input argumnet into which all the registers are dumped.
4199 * Description:
4200 * Dumps the entire register space of xFrame NIC into the user given
4201 * buffer area.
4202 * Return value :
4203 * void .
4204*/
4205
4206static void s2io_ethtool_gregs(struct net_device *dev,
4207 struct ethtool_regs *regs, void *space)
4208{
4209 int i;
4210 u64 reg;
4211 u8 *reg_space = (u8 *) space;
4212 nic_t *sp = dev->priv;
4213
4214 regs->len = XENA_REG_SPACE;
4215 regs->version = sp->pdev->subsystem_device;
4216
4217 for (i = 0; i < regs->len; i += 8) {
4218 reg = readq(sp->bar0 + i);
4219 memcpy((reg_space + i), &reg, 8);
4220 }
4221}
4222
4223/**
4224 * s2io_phy_id - timer function that alternates adapter LED.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004225 * @data : address of the private member of the device structure, which
Linus Torvalds1da177e2005-04-16 15:20:36 -07004226 * is a pointer to the s2io_nic structure, provided as an u32.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004227 * Description: This is actually the timer function that alternates the
4228 * adapter LED bit of the adapter control bit to set/reset every time on
4229 * invocation. The timer is set for 1/2 a second, hence tha NIC blinks
Linus Torvalds1da177e2005-04-16 15:20:36 -07004230 * once every second.
4231*/
4232static void s2io_phy_id(unsigned long data)
4233{
4234 nic_t *sp = (nic_t *) data;
4235 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4236 u64 val64 = 0;
4237 u16 subid;
4238
4239 subid = sp->pdev->subsystem_device;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07004240 if ((sp->device_type == XFRAME_II_DEVICE) ||
4241 ((subid & 0xFF) >= 0x07)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004242 val64 = readq(&bar0->gpio_control);
4243 val64 ^= GPIO_CTRL_GPIO_0;
4244 writeq(val64, &bar0->gpio_control);
4245 } else {
4246 val64 = readq(&bar0->adapter_control);
4247 val64 ^= ADAPTER_LED_ON;
4248 writeq(val64, &bar0->adapter_control);
4249 }
4250
4251 mod_timer(&sp->id_timer, jiffies + HZ / 2);
4252}
4253
4254/**
4255 * s2io_ethtool_idnic - To physically identify the nic on the system.
4256 * @sp : private member of the device structure, which is a pointer to the
4257 * s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004258 * @id : pointer to the structure with identification parameters given by
Linus Torvalds1da177e2005-04-16 15:20:36 -07004259 * ethtool.
4260 * Description: Used to physically identify the NIC on the system.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004261 * The Link LED will blink for a time specified by the user for
Linus Torvalds1da177e2005-04-16 15:20:36 -07004262 * identification.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004263 * NOTE: The Link has to be Up to be able to blink the LED. Hence
Linus Torvalds1da177e2005-04-16 15:20:36 -07004264 * identification is possible only if it's link is up.
4265 * Return value:
4266 * int , returns 0 on success
4267 */
4268
4269static int s2io_ethtool_idnic(struct net_device *dev, u32 data)
4270{
4271 u64 val64 = 0, last_gpio_ctrl_val;
4272 nic_t *sp = dev->priv;
4273 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4274 u16 subid;
4275
4276 subid = sp->pdev->subsystem_device;
4277 last_gpio_ctrl_val = readq(&bar0->gpio_control);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07004278 if ((sp->device_type == XFRAME_I_DEVICE) &&
4279 ((subid & 0xFF) < 0x07)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004280 val64 = readq(&bar0->adapter_control);
4281 if (!(val64 & ADAPTER_CNTL_EN)) {
4282 printk(KERN_ERR
4283 "Adapter Link down, cannot blink LED\n");
4284 return -EFAULT;
4285 }
4286 }
4287 if (sp->id_timer.function == NULL) {
4288 init_timer(&sp->id_timer);
4289 sp->id_timer.function = s2io_phy_id;
4290 sp->id_timer.data = (unsigned long) sp;
4291 }
4292 mod_timer(&sp->id_timer, jiffies);
4293 if (data)
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004294 msleep_interruptible(data * HZ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004295 else
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004296 msleep_interruptible(MAX_FLICKER_TIME);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004297 del_timer_sync(&sp->id_timer);
4298
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07004299 if (CARDS_WITH_FAULTY_LINK_INDICATORS(sp->device_type, subid)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004300 writeq(last_gpio_ctrl_val, &bar0->gpio_control);
4301 last_gpio_ctrl_val = readq(&bar0->gpio_control);
4302 }
4303
4304 return 0;
4305}
4306
4307/**
4308 * s2io_ethtool_getpause_data -Pause frame frame generation and reception.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004309 * @sp : private member of the device structure, which is a pointer to the
4310 * s2io_nic structure.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004311 * @ep : pointer to the structure with pause parameters given by ethtool.
4312 * Description:
4313 * Returns the Pause frame generation and reception capability of the NIC.
4314 * Return value:
4315 * void
4316 */
4317static void s2io_ethtool_getpause_data(struct net_device *dev,
4318 struct ethtool_pauseparam *ep)
4319{
4320 u64 val64;
4321 nic_t *sp = dev->priv;
4322 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4323
4324 val64 = readq(&bar0->rmac_pause_cfg);
4325 if (val64 & RMAC_PAUSE_GEN_ENABLE)
4326 ep->tx_pause = TRUE;
4327 if (val64 & RMAC_PAUSE_RX_ENABLE)
4328 ep->rx_pause = TRUE;
4329 ep->autoneg = FALSE;
4330}
4331
4332/**
4333 * s2io_ethtool_setpause_data - set/reset pause frame generation.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004334 * @sp : private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004335 * s2io_nic structure.
4336 * @ep : pointer to the structure with pause parameters given by ethtool.
4337 * Description:
4338 * It can be used to set or reset Pause frame generation or reception
4339 * support of the NIC.
4340 * Return value:
4341 * int, returns 0 on Success
4342 */
4343
4344static int s2io_ethtool_setpause_data(struct net_device *dev,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004345 struct ethtool_pauseparam *ep)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004346{
4347 u64 val64;
4348 nic_t *sp = dev->priv;
4349 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4350
4351 val64 = readq(&bar0->rmac_pause_cfg);
4352 if (ep->tx_pause)
4353 val64 |= RMAC_PAUSE_GEN_ENABLE;
4354 else
4355 val64 &= ~RMAC_PAUSE_GEN_ENABLE;
4356 if (ep->rx_pause)
4357 val64 |= RMAC_PAUSE_RX_ENABLE;
4358 else
4359 val64 &= ~RMAC_PAUSE_RX_ENABLE;
4360 writeq(val64, &bar0->rmac_pause_cfg);
4361 return 0;
4362}
4363
4364/**
4365 * read_eeprom - reads 4 bytes of data from user given offset.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004366 * @sp : private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004367 * s2io_nic structure.
4368 * @off : offset at which the data must be written
4369 * @data : Its an output parameter where the data read at the given
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004370 * offset is stored.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004371 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004372 * Will read 4 bytes of data from the user given offset and return the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004373 * read data.
4374 * NOTE: Will allow to read only part of the EEPROM visible through the
4375 * I2C bus.
4376 * Return value:
4377 * -1 on failure and 0 on success.
4378 */
4379
4380#define S2IO_DEV_ID 5
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004381static int read_eeprom(nic_t * sp, int off, u64 * data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004382{
4383 int ret = -1;
4384 u32 exit_cnt = 0;
4385 u64 val64;
4386 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4387
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004388 if (sp->device_type == XFRAME_I_DEVICE) {
4389 val64 = I2C_CONTROL_DEV_ID(S2IO_DEV_ID) | I2C_CONTROL_ADDR(off) |
4390 I2C_CONTROL_BYTE_CNT(0x3) | I2C_CONTROL_READ |
4391 I2C_CONTROL_CNTL_START;
4392 SPECIAL_REG_WRITE(val64, &bar0->i2c_control, LF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004393
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004394 while (exit_cnt < 5) {
4395 val64 = readq(&bar0->i2c_control);
4396 if (I2C_CONTROL_CNTL_END(val64)) {
4397 *data = I2C_CONTROL_GET_DATA(val64);
4398 ret = 0;
4399 break;
4400 }
4401 msleep(50);
4402 exit_cnt++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004403 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004404 }
4405
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004406 if (sp->device_type == XFRAME_II_DEVICE) {
4407 val64 = SPI_CONTROL_KEY(0x9) | SPI_CONTROL_SEL1 |
4408 SPI_CONTROL_BYTECNT(0x3) |
4409 SPI_CONTROL_CMD(0x3) | SPI_CONTROL_ADDR(off);
4410 SPECIAL_REG_WRITE(val64, &bar0->spi_control, LF);
4411 val64 |= SPI_CONTROL_REQ;
4412 SPECIAL_REG_WRITE(val64, &bar0->spi_control, LF);
4413 while (exit_cnt < 5) {
4414 val64 = readq(&bar0->spi_control);
4415 if (val64 & SPI_CONTROL_NACK) {
4416 ret = 1;
4417 break;
4418 } else if (val64 & SPI_CONTROL_DONE) {
4419 *data = readq(&bar0->spi_data);
4420 *data &= 0xffffff;
4421 ret = 0;
4422 break;
4423 }
4424 msleep(50);
4425 exit_cnt++;
4426 }
4427 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004428 return ret;
4429}
4430
4431/**
4432 * write_eeprom - actually writes the relevant part of the data value.
4433 * @sp : private member of the device structure, which is a pointer to the
4434 * s2io_nic structure.
4435 * @off : offset at which the data must be written
4436 * @data : The data that is to be written
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004437 * @cnt : Number of bytes of the data that are actually to be written into
Linus Torvalds1da177e2005-04-16 15:20:36 -07004438 * the Eeprom. (max of 3)
4439 * Description:
4440 * Actually writes the relevant part of the data value into the Eeprom
4441 * through the I2C bus.
4442 * Return value:
4443 * 0 on success, -1 on failure.
4444 */
4445
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004446static int write_eeprom(nic_t * sp, int off, u64 data, int cnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004447{
4448 int exit_cnt = 0, ret = -1;
4449 u64 val64;
4450 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4451
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004452 if (sp->device_type == XFRAME_I_DEVICE) {
4453 val64 = I2C_CONTROL_DEV_ID(S2IO_DEV_ID) | I2C_CONTROL_ADDR(off) |
4454 I2C_CONTROL_BYTE_CNT(cnt) | I2C_CONTROL_SET_DATA((u32)data) |
4455 I2C_CONTROL_CNTL_START;
4456 SPECIAL_REG_WRITE(val64, &bar0->i2c_control, LF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004457
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004458 while (exit_cnt < 5) {
4459 val64 = readq(&bar0->i2c_control);
4460 if (I2C_CONTROL_CNTL_END(val64)) {
4461 if (!(val64 & I2C_CONTROL_NACK))
4462 ret = 0;
4463 break;
4464 }
4465 msleep(50);
4466 exit_cnt++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004467 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004468 }
4469
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004470 if (sp->device_type == XFRAME_II_DEVICE) {
4471 int write_cnt = (cnt == 8) ? 0 : cnt;
4472 writeq(SPI_DATA_WRITE(data,(cnt<<3)), &bar0->spi_data);
4473
4474 val64 = SPI_CONTROL_KEY(0x9) | SPI_CONTROL_SEL1 |
4475 SPI_CONTROL_BYTECNT(write_cnt) |
4476 SPI_CONTROL_CMD(0x2) | SPI_CONTROL_ADDR(off);
4477 SPECIAL_REG_WRITE(val64, &bar0->spi_control, LF);
4478 val64 |= SPI_CONTROL_REQ;
4479 SPECIAL_REG_WRITE(val64, &bar0->spi_control, LF);
4480 while (exit_cnt < 5) {
4481 val64 = readq(&bar0->spi_control);
4482 if (val64 & SPI_CONTROL_NACK) {
4483 ret = 1;
4484 break;
4485 } else if (val64 & SPI_CONTROL_DONE) {
4486 ret = 0;
4487 break;
4488 }
4489 msleep(50);
4490 exit_cnt++;
4491 }
4492 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004493 return ret;
4494}
4495
4496/**
4497 * s2io_ethtool_geeprom - reads the value stored in the Eeprom.
4498 * @sp : private member of the device structure, which is a pointer to the * s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004499 * @eeprom : pointer to the user level structure provided by ethtool,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004500 * containing all relevant information.
4501 * @data_buf : user defined value to be written into Eeprom.
4502 * Description: Reads the values stored in the Eeprom at given offset
4503 * for a given length. Stores these values int the input argument data
4504 * buffer 'data_buf' and returns these to the caller (ethtool.)
4505 * Return value:
4506 * int 0 on success
4507 */
4508
4509static int s2io_ethtool_geeprom(struct net_device *dev,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004510 struct ethtool_eeprom *eeprom, u8 * data_buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004511{
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004512 u32 i, valid;
4513 u64 data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004514 nic_t *sp = dev->priv;
4515
4516 eeprom->magic = sp->pdev->vendor | (sp->pdev->device << 16);
4517
4518 if ((eeprom->offset + eeprom->len) > (XENA_EEPROM_SPACE))
4519 eeprom->len = XENA_EEPROM_SPACE - eeprom->offset;
4520
4521 for (i = 0; i < eeprom->len; i += 4) {
4522 if (read_eeprom(sp, (eeprom->offset + i), &data)) {
4523 DBG_PRINT(ERR_DBG, "Read of EEPROM failed\n");
4524 return -EFAULT;
4525 }
4526 valid = INV(data);
4527 memcpy((data_buf + i), &valid, 4);
4528 }
4529 return 0;
4530}
4531
4532/**
4533 * s2io_ethtool_seeprom - tries to write the user provided value in Eeprom
4534 * @sp : private member of the device structure, which is a pointer to the
4535 * s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004536 * @eeprom : pointer to the user level structure provided by ethtool,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004537 * containing all relevant information.
4538 * @data_buf ; user defined value to be written into Eeprom.
4539 * Description:
4540 * Tries to write the user provided value in the Eeprom, at the offset
4541 * given by the user.
4542 * Return value:
4543 * 0 on success, -EFAULT on failure.
4544 */
4545
4546static int s2io_ethtool_seeprom(struct net_device *dev,
4547 struct ethtool_eeprom *eeprom,
4548 u8 * data_buf)
4549{
4550 int len = eeprom->len, cnt = 0;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004551 u64 valid = 0, data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004552 nic_t *sp = dev->priv;
4553
4554 if (eeprom->magic != (sp->pdev->vendor | (sp->pdev->device << 16))) {
4555 DBG_PRINT(ERR_DBG,
4556 "ETHTOOL_WRITE_EEPROM Err: Magic value ");
4557 DBG_PRINT(ERR_DBG, "is wrong, Its not 0x%x\n",
4558 eeprom->magic);
4559 return -EFAULT;
4560 }
4561
4562 while (len) {
4563 data = (u32) data_buf[cnt] & 0x000000FF;
4564 if (data) {
4565 valid = (u32) (data << 24);
4566 } else
4567 valid = data;
4568
4569 if (write_eeprom(sp, (eeprom->offset + cnt), valid, 0)) {
4570 DBG_PRINT(ERR_DBG,
4571 "ETHTOOL_WRITE_EEPROM Err: Cannot ");
4572 DBG_PRINT(ERR_DBG,
4573 "write into the specified offset\n");
4574 return -EFAULT;
4575 }
4576 cnt++;
4577 len--;
4578 }
4579
4580 return 0;
4581}
4582
4583/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004584 * s2io_register_test - reads and writes into all clock domains.
4585 * @sp : private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004586 * s2io_nic structure.
4587 * @data : variable that returns the result of each of the test conducted b
4588 * by the driver.
4589 * Description:
4590 * Read and write into all clock domains. The NIC has 3 clock domains,
4591 * see that registers in all the three regions are accessible.
4592 * Return value:
4593 * 0 on success.
4594 */
4595
4596static int s2io_register_test(nic_t * sp, uint64_t * data)
4597{
4598 XENA_dev_config_t __iomem *bar0 = sp->bar0;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004599 u64 val64 = 0, exp_val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004600 int fail = 0;
4601
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004602 val64 = readq(&bar0->pif_rd_swapper_fb);
4603 if (val64 != 0x123456789abcdefULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004604 fail = 1;
4605 DBG_PRINT(INFO_DBG, "Read Test level 1 fails\n");
4606 }
4607
4608 val64 = readq(&bar0->rmac_pause_cfg);
4609 if (val64 != 0xc000ffff00000000ULL) {
4610 fail = 1;
4611 DBG_PRINT(INFO_DBG, "Read Test level 2 fails\n");
4612 }
4613
4614 val64 = readq(&bar0->rx_queue_cfg);
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004615 if (sp->device_type == XFRAME_II_DEVICE)
4616 exp_val = 0x0404040404040404ULL;
4617 else
4618 exp_val = 0x0808080808080808ULL;
4619 if (val64 != exp_val) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004620 fail = 1;
4621 DBG_PRINT(INFO_DBG, "Read Test level 3 fails\n");
4622 }
4623
4624 val64 = readq(&bar0->xgxs_efifo_cfg);
4625 if (val64 != 0x000000001923141EULL) {
4626 fail = 1;
4627 DBG_PRINT(INFO_DBG, "Read Test level 4 fails\n");
4628 }
4629
4630 val64 = 0x5A5A5A5A5A5A5A5AULL;
4631 writeq(val64, &bar0->xmsi_data);
4632 val64 = readq(&bar0->xmsi_data);
4633 if (val64 != 0x5A5A5A5A5A5A5A5AULL) {
4634 fail = 1;
4635 DBG_PRINT(ERR_DBG, "Write Test level 1 fails\n");
4636 }
4637
4638 val64 = 0xA5A5A5A5A5A5A5A5ULL;
4639 writeq(val64, &bar0->xmsi_data);
4640 val64 = readq(&bar0->xmsi_data);
4641 if (val64 != 0xA5A5A5A5A5A5A5A5ULL) {
4642 fail = 1;
4643 DBG_PRINT(ERR_DBG, "Write Test level 2 fails\n");
4644 }
4645
4646 *data = fail;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004647 return fail;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004648}
4649
4650/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004651 * s2io_eeprom_test - to verify that EEprom in the xena can be programmed.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004652 * @sp : private member of the device structure, which is a pointer to the
4653 * s2io_nic structure.
4654 * @data:variable that returns the result of each of the test conducted by
4655 * the driver.
4656 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004657 * Verify that EEPROM in the xena can be programmed using I2C_CONTROL
Linus Torvalds1da177e2005-04-16 15:20:36 -07004658 * register.
4659 * Return value:
4660 * 0 on success.
4661 */
4662
4663static int s2io_eeprom_test(nic_t * sp, uint64_t * data)
4664{
4665 int fail = 0;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004666 u64 ret_data, org_4F0, org_7F0;
4667 u8 saved_4F0 = 0, saved_7F0 = 0;
4668 struct net_device *dev = sp->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004669
4670 /* Test Write Error at offset 0 */
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004671 /* Note that SPI interface allows write access to all areas
4672 * of EEPROM. Hence doing all negative testing only for Xframe I.
4673 */
4674 if (sp->device_type == XFRAME_I_DEVICE)
4675 if (!write_eeprom(sp, 0, 0, 3))
4676 fail = 1;
4677
4678 /* Save current values at offsets 0x4F0 and 0x7F0 */
4679 if (!read_eeprom(sp, 0x4F0, &org_4F0))
4680 saved_4F0 = 1;
4681 if (!read_eeprom(sp, 0x7F0, &org_7F0))
4682 saved_7F0 = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004683
4684 /* Test Write at offset 4f0 */
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004685 if (write_eeprom(sp, 0x4F0, 0x012345, 3))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004686 fail = 1;
4687 if (read_eeprom(sp, 0x4F0, &ret_data))
4688 fail = 1;
4689
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004690 if (ret_data != 0x012345) {
4691 DBG_PRINT(ERR_DBG, "%s: eeprom test error at offset 0x4F0. Data written %llx Data read %llx\n", dev->name, (u64)0x12345, ret_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004692 fail = 1;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004693 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004694
4695 /* Reset the EEPROM data go FFFF */
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004696 write_eeprom(sp, 0x4F0, 0xFFFFFF, 3);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004697
4698 /* Test Write Request Error at offset 0x7c */
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004699 if (sp->device_type == XFRAME_I_DEVICE)
4700 if (!write_eeprom(sp, 0x07C, 0, 3))
4701 fail = 1;
4702
4703 /* Test Write Request at offset 0x7f0 */
4704 if (write_eeprom(sp, 0x7F0, 0x012345, 3))
4705 fail = 1;
4706 if (read_eeprom(sp, 0x7F0, &ret_data))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004707 fail = 1;
4708
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004709 if (ret_data != 0x012345) {
4710 DBG_PRINT(ERR_DBG, "%s: eeprom test error at offset 0x7F0. Data written %llx Data read %llx\n", dev->name, (u64)0x12345, ret_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004711 fail = 1;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004712 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004713
4714 /* Reset the EEPROM data go FFFF */
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004715 write_eeprom(sp, 0x7F0, 0xFFFFFF, 3);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004716
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004717 if (sp->device_type == XFRAME_I_DEVICE) {
4718 /* Test Write Error at offset 0x80 */
4719 if (!write_eeprom(sp, 0x080, 0, 3))
4720 fail = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004721
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004722 /* Test Write Error at offset 0xfc */
4723 if (!write_eeprom(sp, 0x0FC, 0, 3))
4724 fail = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004725
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004726 /* Test Write Error at offset 0x100 */
4727 if (!write_eeprom(sp, 0x100, 0, 3))
4728 fail = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004729
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004730 /* Test Write Error at offset 4ec */
4731 if (!write_eeprom(sp, 0x4EC, 0, 3))
4732 fail = 1;
4733 }
4734
4735 /* Restore values at offsets 0x4F0 and 0x7F0 */
4736 if (saved_4F0)
4737 write_eeprom(sp, 0x4F0, org_4F0, 3);
4738 if (saved_7F0)
4739 write_eeprom(sp, 0x7F0, org_7F0, 3);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004740
4741 *data = fail;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004742 return fail;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004743}
4744
4745/**
4746 * s2io_bist_test - invokes the MemBist test of the card .
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004747 * @sp : private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004748 * s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004749 * @data:variable that returns the result of each of the test conducted by
Linus Torvalds1da177e2005-04-16 15:20:36 -07004750 * the driver.
4751 * Description:
4752 * This invokes the MemBist test of the card. We give around
4753 * 2 secs time for the Test to complete. If it's still not complete
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004754 * within this peiod, we consider that the test failed.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004755 * Return value:
4756 * 0 on success and -1 on failure.
4757 */
4758
4759static int s2io_bist_test(nic_t * sp, uint64_t * data)
4760{
4761 u8 bist = 0;
4762 int cnt = 0, ret = -1;
4763
4764 pci_read_config_byte(sp->pdev, PCI_BIST, &bist);
4765 bist |= PCI_BIST_START;
4766 pci_write_config_word(sp->pdev, PCI_BIST, bist);
4767
4768 while (cnt < 20) {
4769 pci_read_config_byte(sp->pdev, PCI_BIST, &bist);
4770 if (!(bist & PCI_BIST_START)) {
4771 *data = (bist & PCI_BIST_CODE_MASK);
4772 ret = 0;
4773 break;
4774 }
4775 msleep(100);
4776 cnt++;
4777 }
4778
4779 return ret;
4780}
4781
4782/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004783 * s2io-link_test - verifies the link state of the nic
4784 * @sp ; private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004785 * s2io_nic structure.
4786 * @data: variable that returns the result of each of the test conducted by
4787 * the driver.
4788 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004789 * The function verifies the link state of the NIC and updates the input
Linus Torvalds1da177e2005-04-16 15:20:36 -07004790 * argument 'data' appropriately.
4791 * Return value:
4792 * 0 on success.
4793 */
4794
4795static int s2io_link_test(nic_t * sp, uint64_t * data)
4796{
4797 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4798 u64 val64;
4799
4800 val64 = readq(&bar0->adapter_status);
4801 if (val64 & ADAPTER_STATUS_RMAC_LOCAL_FAULT)
4802 *data = 1;
4803
4804 return 0;
4805}
4806
4807/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004808 * s2io_rldram_test - offline test for access to the RldRam chip on the NIC
4809 * @sp - private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07004810 * s2io_nic structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004811 * @data - variable that returns the result of each of the test
Linus Torvalds1da177e2005-04-16 15:20:36 -07004812 * conducted by the driver.
4813 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004814 * This is one of the offline test that tests the read and write
Linus Torvalds1da177e2005-04-16 15:20:36 -07004815 * access to the RldRam chip on the NIC.
4816 * Return value:
4817 * 0 on success.
4818 */
4819
4820static int s2io_rldram_test(nic_t * sp, uint64_t * data)
4821{
4822 XENA_dev_config_t __iomem *bar0 = sp->bar0;
4823 u64 val64;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004824 int cnt, iteration = 0, test_fail = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004825
4826 val64 = readq(&bar0->adapter_control);
4827 val64 &= ~ADAPTER_ECC_EN;
4828 writeq(val64, &bar0->adapter_control);
4829
4830 val64 = readq(&bar0->mc_rldram_test_ctrl);
4831 val64 |= MC_RLDRAM_TEST_MODE;
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004832 SPECIAL_REG_WRITE(val64, &bar0->mc_rldram_test_ctrl, LF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004833
4834 val64 = readq(&bar0->mc_rldram_mrs);
4835 val64 |= MC_RLDRAM_QUEUE_SIZE_ENABLE;
4836 SPECIAL_REG_WRITE(val64, &bar0->mc_rldram_mrs, UF);
4837
4838 val64 |= MC_RLDRAM_MRS_ENABLE;
4839 SPECIAL_REG_WRITE(val64, &bar0->mc_rldram_mrs, UF);
4840
4841 while (iteration < 2) {
4842 val64 = 0x55555555aaaa0000ULL;
4843 if (iteration == 1) {
4844 val64 ^= 0xFFFFFFFFFFFF0000ULL;
4845 }
4846 writeq(val64, &bar0->mc_rldram_test_d0);
4847
4848 val64 = 0xaaaa5a5555550000ULL;
4849 if (iteration == 1) {
4850 val64 ^= 0xFFFFFFFFFFFF0000ULL;
4851 }
4852 writeq(val64, &bar0->mc_rldram_test_d1);
4853
4854 val64 = 0x55aaaaaaaa5a0000ULL;
4855 if (iteration == 1) {
4856 val64 ^= 0xFFFFFFFFFFFF0000ULL;
4857 }
4858 writeq(val64, &bar0->mc_rldram_test_d2);
4859
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004860 val64 = (u64) (0x0000003ffffe0100ULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004861 writeq(val64, &bar0->mc_rldram_test_add);
4862
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004863 val64 = MC_RLDRAM_TEST_MODE | MC_RLDRAM_TEST_WRITE |
4864 MC_RLDRAM_TEST_GO;
4865 SPECIAL_REG_WRITE(val64, &bar0->mc_rldram_test_ctrl, LF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004866
4867 for (cnt = 0; cnt < 5; cnt++) {
4868 val64 = readq(&bar0->mc_rldram_test_ctrl);
4869 if (val64 & MC_RLDRAM_TEST_DONE)
4870 break;
4871 msleep(200);
4872 }
4873
4874 if (cnt == 5)
4875 break;
4876
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004877 val64 = MC_RLDRAM_TEST_MODE | MC_RLDRAM_TEST_GO;
4878 SPECIAL_REG_WRITE(val64, &bar0->mc_rldram_test_ctrl, LF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004879
4880 for (cnt = 0; cnt < 5; cnt++) {
4881 val64 = readq(&bar0->mc_rldram_test_ctrl);
4882 if (val64 & MC_RLDRAM_TEST_DONE)
4883 break;
4884 msleep(500);
4885 }
4886
4887 if (cnt == 5)
4888 break;
4889
4890 val64 = readq(&bar0->mc_rldram_test_ctrl);
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004891 if (!(val64 & MC_RLDRAM_TEST_PASS))
4892 test_fail = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004893
4894 iteration++;
4895 }
4896
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004897 *data = test_fail;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004898
ravinandan.arakali@neterion.comad4ebed2005-10-17 18:26:20 -07004899 /* Bring the adapter out of test mode */
4900 SPECIAL_REG_WRITE(0, &bar0->mc_rldram_test_ctrl, LF);
4901
4902 return test_fail;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004903}
4904
4905/**
4906 * s2io_ethtool_test - conducts 6 tsets to determine the health of card.
4907 * @sp : private member of the device structure, which is a pointer to the
4908 * s2io_nic structure.
4909 * @ethtest : pointer to a ethtool command specific structure that will be
4910 * returned to the user.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004911 * @data : variable that returns the result of each of the test
Linus Torvalds1da177e2005-04-16 15:20:36 -07004912 * conducted by the driver.
4913 * Description:
4914 * This function conducts 6 tests ( 4 offline and 2 online) to determine
4915 * the health of the card.
4916 * Return value:
4917 * void
4918 */
4919
4920static void s2io_ethtool_test(struct net_device *dev,
4921 struct ethtool_test *ethtest,
4922 uint64_t * data)
4923{
4924 nic_t *sp = dev->priv;
4925 int orig_state = netif_running(sp->dev);
4926
4927 if (ethtest->flags == ETH_TEST_FL_OFFLINE) {
4928 /* Offline Tests. */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07004929 if (orig_state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004930 s2io_close(sp->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004931
4932 if (s2io_register_test(sp, &data[0]))
4933 ethtest->flags |= ETH_TEST_FL_FAILED;
4934
4935 s2io_reset(sp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004936
4937 if (s2io_rldram_test(sp, &data[3]))
4938 ethtest->flags |= ETH_TEST_FL_FAILED;
4939
4940 s2io_reset(sp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004941
4942 if (s2io_eeprom_test(sp, &data[1]))
4943 ethtest->flags |= ETH_TEST_FL_FAILED;
4944
4945 if (s2io_bist_test(sp, &data[4]))
4946 ethtest->flags |= ETH_TEST_FL_FAILED;
4947
4948 if (orig_state)
4949 s2io_open(sp->dev);
4950
4951 data[2] = 0;
4952 } else {
4953 /* Online Tests. */
4954 if (!orig_state) {
4955 DBG_PRINT(ERR_DBG,
4956 "%s: is not up, cannot run test\n",
4957 dev->name);
4958 data[0] = -1;
4959 data[1] = -1;
4960 data[2] = -1;
4961 data[3] = -1;
4962 data[4] = -1;
4963 }
4964
4965 if (s2io_link_test(sp, &data[2]))
4966 ethtest->flags |= ETH_TEST_FL_FAILED;
4967
4968 data[0] = 0;
4969 data[1] = 0;
4970 data[3] = 0;
4971 data[4] = 0;
4972 }
4973}
4974
4975static void s2io_get_ethtool_stats(struct net_device *dev,
4976 struct ethtool_stats *estats,
4977 u64 * tmp_stats)
4978{
4979 int i = 0;
4980 nic_t *sp = dev->priv;
4981 StatInfo_t *stat_info = sp->mac_control.stats_info;
4982
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07004983 s2io_updt_stats(sp);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07004984 tmp_stats[i++] =
4985 (u64)le32_to_cpu(stat_info->tmac_frms_oflow) << 32 |
4986 le32_to_cpu(stat_info->tmac_frms);
4987 tmp_stats[i++] =
4988 (u64)le32_to_cpu(stat_info->tmac_data_octets_oflow) << 32 |
4989 le32_to_cpu(stat_info->tmac_data_octets);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004990 tmp_stats[i++] = le64_to_cpu(stat_info->tmac_drop_frms);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07004991 tmp_stats[i++] =
4992 (u64)le32_to_cpu(stat_info->tmac_mcst_frms_oflow) << 32 |
4993 le32_to_cpu(stat_info->tmac_mcst_frms);
4994 tmp_stats[i++] =
4995 (u64)le32_to_cpu(stat_info->tmac_bcst_frms_oflow) << 32 |
4996 le32_to_cpu(stat_info->tmac_bcst_frms);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004997 tmp_stats[i++] = le64_to_cpu(stat_info->tmac_pause_ctrl_frms);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07004998 tmp_stats[i++] =
4999 (u64)le32_to_cpu(stat_info->tmac_any_err_frms_oflow) << 32 |
5000 le32_to_cpu(stat_info->tmac_any_err_frms);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005001 tmp_stats[i++] = le64_to_cpu(stat_info->tmac_vld_ip_octets);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005002 tmp_stats[i++] =
5003 (u64)le32_to_cpu(stat_info->tmac_vld_ip_oflow) << 32 |
5004 le32_to_cpu(stat_info->tmac_vld_ip);
5005 tmp_stats[i++] =
5006 (u64)le32_to_cpu(stat_info->tmac_drop_ip_oflow) << 32 |
5007 le32_to_cpu(stat_info->tmac_drop_ip);
5008 tmp_stats[i++] =
5009 (u64)le32_to_cpu(stat_info->tmac_icmp_oflow) << 32 |
5010 le32_to_cpu(stat_info->tmac_icmp);
5011 tmp_stats[i++] =
5012 (u64)le32_to_cpu(stat_info->tmac_rst_tcp_oflow) << 32 |
5013 le32_to_cpu(stat_info->tmac_rst_tcp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005014 tmp_stats[i++] = le64_to_cpu(stat_info->tmac_tcp);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005015 tmp_stats[i++] = (u64)le32_to_cpu(stat_info->tmac_udp_oflow) << 32 |
5016 le32_to_cpu(stat_info->tmac_udp);
5017 tmp_stats[i++] =
5018 (u64)le32_to_cpu(stat_info->rmac_vld_frms_oflow) << 32 |
5019 le32_to_cpu(stat_info->rmac_vld_frms);
5020 tmp_stats[i++] =
5021 (u64)le32_to_cpu(stat_info->rmac_data_octets_oflow) << 32 |
5022 le32_to_cpu(stat_info->rmac_data_octets);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005023 tmp_stats[i++] = le64_to_cpu(stat_info->rmac_fcs_err_frms);
5024 tmp_stats[i++] = le64_to_cpu(stat_info->rmac_drop_frms);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005025 tmp_stats[i++] =
5026 (u64)le32_to_cpu(stat_info->rmac_vld_mcst_frms_oflow) << 32 |
5027 le32_to_cpu(stat_info->rmac_vld_mcst_frms);
5028 tmp_stats[i++] =
5029 (u64)le32_to_cpu(stat_info->rmac_vld_bcst_frms_oflow) << 32 |
5030 le32_to_cpu(stat_info->rmac_vld_bcst_frms);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005031 tmp_stats[i++] = le32_to_cpu(stat_info->rmac_in_rng_len_err_frms);
5032 tmp_stats[i++] = le64_to_cpu(stat_info->rmac_long_frms);
5033 tmp_stats[i++] = le64_to_cpu(stat_info->rmac_pause_ctrl_frms);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005034 tmp_stats[i++] =
5035 (u64)le32_to_cpu(stat_info->rmac_discarded_frms_oflow) << 32 |
5036 le32_to_cpu(stat_info->rmac_discarded_frms);
5037 tmp_stats[i++] =
5038 (u64)le32_to_cpu(stat_info->rmac_usized_frms_oflow) << 32 |
5039 le32_to_cpu(stat_info->rmac_usized_frms);
5040 tmp_stats[i++] =
5041 (u64)le32_to_cpu(stat_info->rmac_osized_frms_oflow) << 32 |
5042 le32_to_cpu(stat_info->rmac_osized_frms);
5043 tmp_stats[i++] =
5044 (u64)le32_to_cpu(stat_info->rmac_frag_frms_oflow) << 32 |
5045 le32_to_cpu(stat_info->rmac_frag_frms);
5046 tmp_stats[i++] =
5047 (u64)le32_to_cpu(stat_info->rmac_jabber_frms_oflow) << 32 |
5048 le32_to_cpu(stat_info->rmac_jabber_frms);
5049 tmp_stats[i++] = (u64)le32_to_cpu(stat_info->rmac_ip_oflow) << 32 |
5050 le32_to_cpu(stat_info->rmac_ip);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005051 tmp_stats[i++] = le64_to_cpu(stat_info->rmac_ip_octets);
5052 tmp_stats[i++] = le32_to_cpu(stat_info->rmac_hdr_err_ip);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005053 tmp_stats[i++] = (u64)le32_to_cpu(stat_info->rmac_drop_ip_oflow) << 32 |
5054 le32_to_cpu(stat_info->rmac_drop_ip);
5055 tmp_stats[i++] = (u64)le32_to_cpu(stat_info->rmac_icmp_oflow) << 32 |
5056 le32_to_cpu(stat_info->rmac_icmp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005057 tmp_stats[i++] = le64_to_cpu(stat_info->rmac_tcp);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005058 tmp_stats[i++] = (u64)le32_to_cpu(stat_info->rmac_udp_oflow) << 32 |
5059 le32_to_cpu(stat_info->rmac_udp);
5060 tmp_stats[i++] =
5061 (u64)le32_to_cpu(stat_info->rmac_err_drp_udp_oflow) << 32 |
5062 le32_to_cpu(stat_info->rmac_err_drp_udp);
5063 tmp_stats[i++] =
5064 (u64)le32_to_cpu(stat_info->rmac_pause_cnt_oflow) << 32 |
5065 le32_to_cpu(stat_info->rmac_pause_cnt);
5066 tmp_stats[i++] =
5067 (u64)le32_to_cpu(stat_info->rmac_accepted_ip_oflow) << 32 |
5068 le32_to_cpu(stat_info->rmac_accepted_ip);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005069 tmp_stats[i++] = le32_to_cpu(stat_info->rmac_err_tcp);
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07005070 tmp_stats[i++] = 0;
5071 tmp_stats[i++] = stat_info->sw_stat.single_ecc_errs;
5072 tmp_stats[i++] = stat_info->sw_stat.double_ecc_errs;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005073}
5074
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005075int s2io_ethtool_get_regs_len(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005076{
5077 return (XENA_REG_SPACE);
5078}
5079
5080
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005081u32 s2io_ethtool_get_rx_csum(struct net_device * dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005082{
5083 nic_t *sp = dev->priv;
5084
5085 return (sp->rx_csum);
5086}
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005087int s2io_ethtool_set_rx_csum(struct net_device *dev, u32 data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005088{
5089 nic_t *sp = dev->priv;
5090
5091 if (data)
5092 sp->rx_csum = 1;
5093 else
5094 sp->rx_csum = 0;
5095
5096 return 0;
5097}
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005098int s2io_get_eeprom_len(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005099{
5100 return (XENA_EEPROM_SPACE);
5101}
5102
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005103int s2io_ethtool_self_test_count(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005104{
5105 return (S2IO_TEST_LEN);
5106}
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005107void s2io_ethtool_get_strings(struct net_device *dev,
5108 u32 stringset, u8 * data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005109{
5110 switch (stringset) {
5111 case ETH_SS_TEST:
5112 memcpy(data, s2io_gstrings, S2IO_STRINGS_LEN);
5113 break;
5114 case ETH_SS_STATS:
5115 memcpy(data, &ethtool_stats_keys,
5116 sizeof(ethtool_stats_keys));
5117 }
5118}
Linus Torvalds1da177e2005-04-16 15:20:36 -07005119static int s2io_ethtool_get_stats_count(struct net_device *dev)
5120{
5121 return (S2IO_STAT_LEN);
5122}
5123
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005124int s2io_ethtool_op_set_tx_csum(struct net_device *dev, u32 data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005125{
5126 if (data)
5127 dev->features |= NETIF_F_IP_CSUM;
5128 else
5129 dev->features &= ~NETIF_F_IP_CSUM;
5130
5131 return 0;
5132}
5133
5134
5135static struct ethtool_ops netdev_ethtool_ops = {
5136 .get_settings = s2io_ethtool_gset,
5137 .set_settings = s2io_ethtool_sset,
5138 .get_drvinfo = s2io_ethtool_gdrvinfo,
5139 .get_regs_len = s2io_ethtool_get_regs_len,
5140 .get_regs = s2io_ethtool_gregs,
5141 .get_link = ethtool_op_get_link,
5142 .get_eeprom_len = s2io_get_eeprom_len,
5143 .get_eeprom = s2io_ethtool_geeprom,
5144 .set_eeprom = s2io_ethtool_seeprom,
5145 .get_pauseparam = s2io_ethtool_getpause_data,
5146 .set_pauseparam = s2io_ethtool_setpause_data,
5147 .get_rx_csum = s2io_ethtool_get_rx_csum,
5148 .set_rx_csum = s2io_ethtool_set_rx_csum,
5149 .get_tx_csum = ethtool_op_get_tx_csum,
5150 .set_tx_csum = s2io_ethtool_op_set_tx_csum,
5151 .get_sg = ethtool_op_get_sg,
5152 .set_sg = ethtool_op_set_sg,
5153#ifdef NETIF_F_TSO
5154 .get_tso = ethtool_op_get_tso,
5155 .set_tso = ethtool_op_set_tso,
5156#endif
5157 .self_test_count = s2io_ethtool_self_test_count,
5158 .self_test = s2io_ethtool_test,
5159 .get_strings = s2io_ethtool_get_strings,
5160 .phys_id = s2io_ethtool_idnic,
5161 .get_stats_count = s2io_ethtool_get_stats_count,
5162 .get_ethtool_stats = s2io_get_ethtool_stats
5163};
5164
5165/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005166 * s2io_ioctl - Entry point for the Ioctl
Linus Torvalds1da177e2005-04-16 15:20:36 -07005167 * @dev : Device pointer.
5168 * @ifr : An IOCTL specefic structure, that can contain a pointer to
5169 * a proprietary structure used to pass information to the driver.
5170 * @cmd : This is used to distinguish between the different commands that
5171 * can be passed to the IOCTL functions.
5172 * Description:
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005173 * Currently there are no special functionality supported in IOCTL, hence
5174 * function always return EOPNOTSUPPORTED
Linus Torvalds1da177e2005-04-16 15:20:36 -07005175 */
5176
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005177int s2io_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005178{
5179 return -EOPNOTSUPP;
5180}
5181
5182/**
5183 * s2io_change_mtu - entry point to change MTU size for the device.
5184 * @dev : device pointer.
5185 * @new_mtu : the new MTU size for the device.
5186 * Description: A driver entry point to change MTU size for the device.
5187 * Before changing the MTU the device must be stopped.
5188 * Return value:
5189 * 0 on success and an appropriate (-)ve integer as defined in errno.h
5190 * file on failure.
5191 */
5192
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005193int s2io_change_mtu(struct net_device *dev, int new_mtu)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005194{
5195 nic_t *sp = dev->priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005196
5197 if ((new_mtu < MIN_MTU) || (new_mtu > S2IO_JUMBO_SIZE)) {
5198 DBG_PRINT(ERR_DBG, "%s: MTU size is invalid.\n",
5199 dev->name);
5200 return -EPERM;
5201 }
5202
Linus Torvalds1da177e2005-04-16 15:20:36 -07005203 dev->mtu = new_mtu;
raghavendra.koushik@neterion.comd8892c62005-08-03 12:33:12 -07005204 if (netif_running(dev)) {
5205 s2io_card_down(sp);
5206 netif_stop_queue(dev);
5207 if (s2io_card_up(sp)) {
5208 DBG_PRINT(ERR_DBG, "%s: Device bring up failed\n",
5209 __FUNCTION__);
5210 }
5211 if (netif_queue_stopped(dev))
5212 netif_wake_queue(dev);
5213 } else { /* Device is down */
5214 XENA_dev_config_t __iomem *bar0 = sp->bar0;
5215 u64 val64 = new_mtu;
5216
5217 writeq(vBIT(val64, 2, 14), &bar0->rmac_max_pyld_len);
5218 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005219
5220 return 0;
5221}
5222
5223/**
5224 * s2io_tasklet - Bottom half of the ISR.
5225 * @dev_adr : address of the device structure in dma_addr_t format.
5226 * Description:
5227 * This is the tasklet or the bottom half of the ISR. This is
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005228 * an extension of the ISR which is scheduled by the scheduler to be run
Linus Torvalds1da177e2005-04-16 15:20:36 -07005229 * when the load on the CPU is low. All low priority tasks of the ISR can
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005230 * be pushed into the tasklet. For now the tasklet is used only to
Linus Torvalds1da177e2005-04-16 15:20:36 -07005231 * replenish the Rx buffers in the Rx buffer descriptors.
5232 * Return value:
5233 * void.
5234 */
5235
5236static void s2io_tasklet(unsigned long dev_addr)
5237{
5238 struct net_device *dev = (struct net_device *) dev_addr;
5239 nic_t *sp = dev->priv;
5240 int i, ret;
5241 mac_info_t *mac_control;
5242 struct config_param *config;
5243
5244 mac_control = &sp->mac_control;
5245 config = &sp->config;
5246
5247 if (!TASKLET_IN_USE) {
5248 for (i = 0; i < config->rx_ring_num; i++) {
5249 ret = fill_rx_buffers(sp, i);
5250 if (ret == -ENOMEM) {
5251 DBG_PRINT(ERR_DBG, "%s: Out of ",
5252 dev->name);
5253 DBG_PRINT(ERR_DBG, "memory in tasklet\n");
5254 break;
5255 } else if (ret == -EFILL) {
5256 DBG_PRINT(ERR_DBG,
5257 "%s: Rx Ring %d is full\n",
5258 dev->name, i);
5259 break;
5260 }
5261 }
5262 clear_bit(0, (&sp->tasklet_status));
5263 }
5264}
5265
5266/**
5267 * s2io_set_link - Set the LInk status
5268 * @data: long pointer to device private structue
5269 * Description: Sets the link status for the adapter
5270 */
5271
5272static void s2io_set_link(unsigned long data)
5273{
5274 nic_t *nic = (nic_t *) data;
5275 struct net_device *dev = nic->dev;
5276 XENA_dev_config_t __iomem *bar0 = nic->bar0;
5277 register u64 val64;
5278 u16 subid;
5279
5280 if (test_and_set_bit(0, &(nic->link_state))) {
5281 /* The card is being reset, no point doing anything */
5282 return;
5283 }
5284
5285 subid = nic->pdev->subsystem_device;
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07005286 if (s2io_link_fault_indication(nic) == MAC_RMAC_ERR_TIMER) {
5287 /*
5288 * Allow a small delay for the NICs self initiated
5289 * cleanup to complete.
5290 */
5291 msleep(100);
5292 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005293
5294 val64 = readq(&bar0->adapter_status);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005295 if (verify_xena_quiescence(nic, val64, nic->device_enabled_once)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005296 if (LINK_IS_UP(val64)) {
5297 val64 = readq(&bar0->adapter_control);
5298 val64 |= ADAPTER_CNTL_EN;
5299 writeq(val64, &bar0->adapter_control);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005300 if (CARDS_WITH_FAULTY_LINK_INDICATORS(nic->device_type,
5301 subid)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005302 val64 = readq(&bar0->gpio_control);
5303 val64 |= GPIO_CTRL_GPIO_0;
5304 writeq(val64, &bar0->gpio_control);
5305 val64 = readq(&bar0->gpio_control);
5306 } else {
5307 val64 |= ADAPTER_LED_ON;
5308 writeq(val64, &bar0->adapter_control);
5309 }
raghavendra.koushik@neterion.coma371a072005-08-03 12:38:59 -07005310 if (s2io_link_fault_indication(nic) ==
5311 MAC_RMAC_ERR_TIMER) {
5312 val64 = readq(&bar0->adapter_status);
5313 if (!LINK_IS_UP(val64)) {
5314 DBG_PRINT(ERR_DBG, "%s:", dev->name);
5315 DBG_PRINT(ERR_DBG, " Link down");
5316 DBG_PRINT(ERR_DBG, "after ");
5317 DBG_PRINT(ERR_DBG, "enabling ");
5318 DBG_PRINT(ERR_DBG, "device \n");
5319 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005320 }
5321 if (nic->device_enabled_once == FALSE) {
5322 nic->device_enabled_once = TRUE;
5323 }
5324 s2io_link(nic, LINK_UP);
5325 } else {
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005326 if (CARDS_WITH_FAULTY_LINK_INDICATORS(nic->device_type,
5327 subid)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005328 val64 = readq(&bar0->gpio_control);
5329 val64 &= ~GPIO_CTRL_GPIO_0;
5330 writeq(val64, &bar0->gpio_control);
5331 val64 = readq(&bar0->gpio_control);
5332 }
5333 s2io_link(nic, LINK_DOWN);
5334 }
5335 } else { /* NIC is not Quiescent. */
5336 DBG_PRINT(ERR_DBG, "%s: Error: ", dev->name);
5337 DBG_PRINT(ERR_DBG, "device is not Quiescent\n");
5338 netif_stop_queue(dev);
5339 }
5340 clear_bit(0, &(nic->link_state));
5341}
5342
5343static void s2io_card_down(nic_t * sp)
5344{
5345 int cnt = 0;
5346 XENA_dev_config_t __iomem *bar0 = sp->bar0;
5347 unsigned long flags;
5348 register u64 val64 = 0;
5349
raghavendra.koushik@neterion.com25fff882005-08-03 12:34:11 -07005350 del_timer_sync(&sp->alarm_timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005351 /* If s2io_set_link task is executing, wait till it completes. */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005352 while (test_and_set_bit(0, &(sp->link_state))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005353 msleep(50);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005354 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005355 atomic_set(&sp->card_state, CARD_DOWN);
5356
5357 /* disable Tx and Rx traffic on the NIC */
5358 stop_nic(sp);
5359
5360 /* Kill tasklet. */
5361 tasklet_kill(&sp->task);
5362
5363 /* Check if the device is Quiescent and then Reset the NIC */
5364 do {
5365 val64 = readq(&bar0->adapter_status);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005366 if (verify_xena_quiescence(sp, val64, sp->device_enabled_once)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005367 break;
5368 }
5369
5370 msleep(50);
5371 cnt++;
5372 if (cnt == 10) {
5373 DBG_PRINT(ERR_DBG,
5374 "s2io_close:Device not Quiescent ");
5375 DBG_PRINT(ERR_DBG, "adaper status reads 0x%llx\n",
5376 (unsigned long long) val64);
5377 break;
5378 }
5379 } while (1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005380 s2io_reset(sp);
5381
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07005382 /* Waiting till all Interrupt handlers are complete */
5383 cnt = 0;
5384 do {
5385 msleep(10);
5386 if (!atomic_read(&sp->isr_cnt))
5387 break;
5388 cnt++;
5389 } while(cnt < 5);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005390
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07005391 spin_lock_irqsave(&sp->tx_lock, flags);
5392 /* Free all Tx buffers */
5393 free_tx_buffers(sp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005394 spin_unlock_irqrestore(&sp->tx_lock, flags);
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07005395
5396 /* Free all Rx buffers */
5397 spin_lock_irqsave(&sp->rx_lock, flags);
5398 free_rx_buffers(sp);
5399 spin_unlock_irqrestore(&sp->rx_lock, flags);
5400
Linus Torvalds1da177e2005-04-16 15:20:36 -07005401 clear_bit(0, &(sp->link_state));
5402}
5403
5404static int s2io_card_up(nic_t * sp)
5405{
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005406 int i, ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005407 mac_info_t *mac_control;
5408 struct config_param *config;
5409 struct net_device *dev = (struct net_device *) sp->dev;
5410
5411 /* Initialize the H/W I/O registers */
5412 if (init_nic(sp) != 0) {
5413 DBG_PRINT(ERR_DBG, "%s: H/W initialization failed\n",
5414 dev->name);
5415 return -ENODEV;
5416 }
5417
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005418 if (sp->intr_type == MSI)
5419 ret = s2io_enable_msi(sp);
5420 else if (sp->intr_type == MSI_X)
5421 ret = s2io_enable_msi_x(sp);
5422 if (ret) {
5423 DBG_PRINT(ERR_DBG, "%s: Defaulting to INTA\n", dev->name);
5424 sp->intr_type = INTA;
5425 }
5426
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005427 /*
5428 * Initializing the Rx buffers. For now we are considering only 1
Linus Torvalds1da177e2005-04-16 15:20:36 -07005429 * Rx ring and initializing buffers into 30 Rx blocks
5430 */
5431 mac_control = &sp->mac_control;
5432 config = &sp->config;
5433
5434 for (i = 0; i < config->rx_ring_num; i++) {
5435 if ((ret = fill_rx_buffers(sp, i))) {
5436 DBG_PRINT(ERR_DBG, "%s: Out of memory in Open\n",
5437 dev->name);
5438 s2io_reset(sp);
5439 free_rx_buffers(sp);
5440 return -ENOMEM;
5441 }
5442 DBG_PRINT(INFO_DBG, "Buf in ring:%d is %d:\n", i,
5443 atomic_read(&sp->rx_bufs_left[i]));
5444 }
5445
5446 /* Setting its receive mode */
5447 s2io_set_multicast(dev);
5448
5449 /* Enable tasklet for the device */
5450 tasklet_init(&sp->task, s2io_tasklet, (unsigned long) dev);
5451
5452 /* Enable Rx Traffic and interrupts on the NIC */
5453 if (start_nic(sp)) {
5454 DBG_PRINT(ERR_DBG, "%s: Starting NIC failed\n", dev->name);
5455 tasklet_kill(&sp->task);
5456 s2io_reset(sp);
5457 free_irq(dev->irq, dev);
5458 free_rx_buffers(sp);
5459 return -ENODEV;
5460 }
5461
raghavendra.koushik@neterion.com25fff882005-08-03 12:34:11 -07005462 S2IO_TIMER_CONF(sp->alarm_timer, s2io_alarm_handle, sp, (HZ/2));
5463
Linus Torvalds1da177e2005-04-16 15:20:36 -07005464 atomic_set(&sp->card_state, CARD_UP);
5465 return 0;
5466}
5467
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005468/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07005469 * s2io_restart_nic - Resets the NIC.
5470 * @data : long pointer to the device private structure
5471 * Description:
5472 * This function is scheduled to be run by the s2io_tx_watchdog
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005473 * function after 0.5 secs to reset the NIC. The idea is to reduce
Linus Torvalds1da177e2005-04-16 15:20:36 -07005474 * the run time of the watch dog routine which is run holding a
5475 * spin lock.
5476 */
5477
5478static void s2io_restart_nic(unsigned long data)
5479{
5480 struct net_device *dev = (struct net_device *) data;
5481 nic_t *sp = dev->priv;
5482
5483 s2io_card_down(sp);
5484 if (s2io_card_up(sp)) {
5485 DBG_PRINT(ERR_DBG, "%s: Device bring up failed\n",
5486 dev->name);
5487 }
5488 netif_wake_queue(dev);
5489 DBG_PRINT(ERR_DBG, "%s: was reset by Tx watchdog timer\n",
5490 dev->name);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005491
Linus Torvalds1da177e2005-04-16 15:20:36 -07005492}
5493
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005494/**
5495 * s2io_tx_watchdog - Watchdog for transmit side.
Linus Torvalds1da177e2005-04-16 15:20:36 -07005496 * @dev : Pointer to net device structure
5497 * Description:
5498 * This function is triggered if the Tx Queue is stopped
5499 * for a pre-defined amount of time when the Interface is still up.
5500 * If the Interface is jammed in such a situation, the hardware is
5501 * reset (by s2io_close) and restarted again (by s2io_open) to
5502 * overcome any problem that might have been caused in the hardware.
5503 * Return value:
5504 * void
5505 */
5506
5507static void s2io_tx_watchdog(struct net_device *dev)
5508{
5509 nic_t *sp = dev->priv;
5510
5511 if (netif_carrier_ok(dev)) {
5512 schedule_work(&sp->rst_timer_task);
5513 }
5514}
5515
5516/**
5517 * rx_osm_handler - To perform some OS related operations on SKB.
5518 * @sp: private member of the device structure,pointer to s2io_nic structure.
5519 * @skb : the socket buffer pointer.
5520 * @len : length of the packet
5521 * @cksum : FCS checksum of the frame.
5522 * @ring_no : the ring from which this RxD was extracted.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005523 * Description:
Linus Torvalds1da177e2005-04-16 15:20:36 -07005524 * This function is called by the Tx interrupt serivce routine to perform
5525 * some OS related operations on the SKB before passing it to the upper
5526 * layers. It mainly checks if the checksum is OK, if so adds it to the
5527 * SKBs cksum variable, increments the Rx packet count and passes the SKB
5528 * to the upper layer. If the checksum is wrong, it increments the Rx
5529 * packet error count, frees the SKB and returns error.
5530 * Return value:
5531 * SUCCESS on success and -1 on failure.
5532 */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005533static int rx_osm_handler(ring_info_t *ring_data, RxD_t * rxdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005534{
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005535 nic_t *sp = ring_data->nic;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005536 struct net_device *dev = (struct net_device *) sp->dev;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005537 struct sk_buff *skb = (struct sk_buff *)
5538 ((unsigned long) rxdp->Host_Control);
5539 int ring_no = ring_data->ring_no;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005540 u16 l3_csum, l4_csum;
5541#ifdef CONFIG_2BUFF_MODE
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005542 int buf0_len = RXD_GET_BUFFER0_SIZE(rxdp->Control_2);
5543 int buf2_len = RXD_GET_BUFFER2_SIZE(rxdp->Control_2);
5544 int get_block = ring_data->rx_curr_get_info.block_index;
5545 int get_off = ring_data->rx_curr_get_info.offset;
5546 buffAdd_t *ba = &ring_data->ba[get_block][get_off];
Linus Torvalds1da177e2005-04-16 15:20:36 -07005547 unsigned char *buff;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005548#else
5549 u16 len = (u16) ((RXD_GET_BUFFER0_SIZE(rxdp->Control_2)) >> 48);;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005550#endif
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005551 skb->dev = dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005552 if (rxdp->Control_1 & RXD_T_CODE) {
5553 unsigned long long err = rxdp->Control_1 & RXD_T_CODE;
5554 DBG_PRINT(ERR_DBG, "%s: Rx error Value: 0x%llx\n",
5555 dev->name, err);
raghavendra.koushik@neterion.com1ddc50d2005-08-03 12:30:43 -07005556 dev_kfree_skb(skb);
5557 sp->stats.rx_crc_errors++;
5558 atomic_dec(&sp->rx_bufs_left[ring_no]);
5559 rxdp->Host_Control = 0;
5560 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005561 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005562
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005563 /* Updating statistics */
5564 rxdp->Host_Control = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005565 sp->rx_pkt_count++;
5566 sp->stats.rx_packets++;
5567#ifndef CONFIG_2BUFF_MODE
5568 sp->stats.rx_bytes += len;
5569#else
5570 sp->stats.rx_bytes += buf0_len + buf2_len;
5571#endif
5572
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005573#ifndef CONFIG_2BUFF_MODE
5574 skb_put(skb, len);
5575#else
5576 buff = skb_push(skb, buf0_len);
5577 memcpy(buff, ba->ba_0, buf0_len);
5578 skb_put(skb, buf2_len);
5579#endif
5580
5581 if ((rxdp->Control_1 & TCP_OR_UDP_FRAME) &&
5582 (sp->rx_csum)) {
5583 l3_csum = RXD_GET_L3_CKSUM(rxdp->Control_1);
5584 l4_csum = RXD_GET_L4_CKSUM(rxdp->Control_1);
5585 if ((l3_csum == L3_CKSUM_OK) && (l4_csum == L4_CKSUM_OK)) {
5586 /*
5587 * NIC verifies if the Checksum of the received
5588 * frame is Ok or not and accordingly returns
5589 * a flag in the RxD.
5590 */
5591 skb->ip_summed = CHECKSUM_UNNECESSARY;
5592 } else {
5593 /*
5594 * Packet with erroneous checksum, let the
5595 * upper layers deal with it.
5596 */
5597 skb->ip_summed = CHECKSUM_NONE;
5598 }
5599 } else {
5600 skb->ip_summed = CHECKSUM_NONE;
5601 }
5602
5603 skb->protocol = eth_type_trans(skb, dev);
5604#ifdef CONFIG_S2IO_NAPI
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -07005605 if (sp->vlgrp && RXD_GET_VLAN_TAG(rxdp->Control_2)) {
5606 /* Queueing the vlan frame to the upper layer */
5607 vlan_hwaccel_receive_skb(skb, sp->vlgrp,
5608 RXD_GET_VLAN_TAG(rxdp->Control_2));
5609 } else {
5610 netif_receive_skb(skb);
5611 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005612#else
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -07005613 if (sp->vlgrp && RXD_GET_VLAN_TAG(rxdp->Control_2)) {
5614 /* Queueing the vlan frame to the upper layer */
5615 vlan_hwaccel_rx(skb, sp->vlgrp,
5616 RXD_GET_VLAN_TAG(rxdp->Control_2));
5617 } else {
5618 netif_rx(skb);
5619 }
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005620#endif
5621 dev->last_rx = jiffies;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005622 atomic_dec(&sp->rx_bufs_left[ring_no]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005623 return SUCCESS;
5624}
5625
5626/**
5627 * s2io_link - stops/starts the Tx queue.
5628 * @sp : private member of the device structure, which is a pointer to the
5629 * s2io_nic structure.
5630 * @link : inidicates whether link is UP/DOWN.
5631 * Description:
5632 * This function stops/starts the Tx queue depending on whether the link
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005633 * status of the NIC is is down or up. This is called by the Alarm
5634 * interrupt handler whenever a link change interrupt comes up.
Linus Torvalds1da177e2005-04-16 15:20:36 -07005635 * Return value:
5636 * void.
5637 */
5638
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005639void s2io_link(nic_t * sp, int link)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005640{
5641 struct net_device *dev = (struct net_device *) sp->dev;
5642
5643 if (link != sp->last_link_state) {
5644 if (link == LINK_DOWN) {
5645 DBG_PRINT(ERR_DBG, "%s: Link down\n", dev->name);
5646 netif_carrier_off(dev);
5647 } else {
5648 DBG_PRINT(ERR_DBG, "%s: Link Up\n", dev->name);
5649 netif_carrier_on(dev);
5650 }
5651 }
5652 sp->last_link_state = link;
5653}
5654
5655/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005656 * get_xena_rev_id - to identify revision ID of xena.
5657 * @pdev : PCI Dev structure
5658 * Description:
5659 * Function to identify the Revision ID of xena.
5660 * Return value:
5661 * returns the revision ID of the device.
5662 */
5663
5664int get_xena_rev_id(struct pci_dev *pdev)
5665{
5666 u8 id = 0;
5667 int ret;
5668 ret = pci_read_config_byte(pdev, PCI_REVISION_ID, (u8 *) & id);
5669 return id;
5670}
5671
5672/**
5673 * s2io_init_pci -Initialization of PCI and PCI-X configuration registers .
5674 * @sp : private member of the device structure, which is a pointer to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07005675 * s2io_nic structure.
5676 * Description:
5677 * This function initializes a few of the PCI and PCI-X configuration registers
5678 * with recommended values.
5679 * Return value:
5680 * void
5681 */
5682
5683static void s2io_init_pci(nic_t * sp)
5684{
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005685 u16 pci_cmd = 0, pcix_cmd = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005686
5687 /* Enable Data Parity Error Recovery in PCI-X command register. */
5688 pci_read_config_word(sp->pdev, PCIX_COMMAND_REGISTER,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005689 &(pcix_cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005690 pci_write_config_word(sp->pdev, PCIX_COMMAND_REGISTER,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005691 (pcix_cmd | 1));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005692 pci_read_config_word(sp->pdev, PCIX_COMMAND_REGISTER,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005693 &(pcix_cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005694
5695 /* Set the PErr Response bit in PCI command register. */
5696 pci_read_config_word(sp->pdev, PCI_COMMAND, &pci_cmd);
5697 pci_write_config_word(sp->pdev, PCI_COMMAND,
5698 (pci_cmd | PCI_COMMAND_PARITY));
5699 pci_read_config_word(sp->pdev, PCI_COMMAND, &pci_cmd);
5700
Linus Torvalds1da177e2005-04-16 15:20:36 -07005701 /* Forcibly disabling relaxed ordering capability of the card. */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005702 pcix_cmd &= 0xfffd;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005703 pci_write_config_word(sp->pdev, PCIX_COMMAND_REGISTER,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005704 pcix_cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005705 pci_read_config_word(sp->pdev, PCIX_COMMAND_REGISTER,
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005706 &(pcix_cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005707}
5708
5709MODULE_AUTHOR("Raghavendra Koushik <raghavendra.koushik@neterion.com>");
5710MODULE_LICENSE("GPL");
John Linville6c1792f2005-10-04 07:51:45 -04005711MODULE_VERSION(DRV_VERSION);
5712
Linus Torvalds1da177e2005-04-16 15:20:36 -07005713module_param(tx_fifo_num, int, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005714module_param(rx_ring_num, int, 0);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005715module_param_array(tx_fifo_len, uint, NULL, 0);
5716module_param_array(rx_ring_sz, uint, NULL, 0);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005717module_param_array(rts_frm_len, uint, NULL, 0);
raghavendra.koushik@neterion.com5e25b9d2005-08-03 12:27:09 -07005718module_param(use_continuous_tx_intrs, int, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005719module_param(rmac_pause_time, int, 0);
5720module_param(mc_pause_threshold_q0q3, int, 0);
5721module_param(mc_pause_threshold_q4q7, int, 0);
5722module_param(shared_splits, int, 0);
5723module_param(tmac_util_period, int, 0);
5724module_param(rmac_util_period, int, 0);
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07005725module_param(bimodal, bool, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005726#ifndef CONFIG_S2IO_NAPI
5727module_param(indicate_max_pkts, int, 0);
5728#endif
raghavendra.koushik@neterion.com303bcb42005-08-03 12:41:38 -07005729module_param(rxsync_frequency, int, 0);
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005730module_param(intr_type, int, 0);
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005731
Linus Torvalds1da177e2005-04-16 15:20:36 -07005732/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005733 * s2io_init_nic - Initialization of the adapter .
Linus Torvalds1da177e2005-04-16 15:20:36 -07005734 * @pdev : structure containing the PCI related information of the device.
5735 * @pre: List of PCI devices supported by the driver listed in s2io_tbl.
5736 * Description:
5737 * The function initializes an adapter identified by the pci_dec structure.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005738 * All OS related initialization including memory and device structure and
5739 * initlaization of the device private variable is done. Also the swapper
5740 * control register is initialized to enable read and write into the I/O
Linus Torvalds1da177e2005-04-16 15:20:36 -07005741 * registers of the device.
5742 * Return value:
5743 * returns 0 on success and negative on failure.
5744 */
5745
5746static int __devinit
5747s2io_init_nic(struct pci_dev *pdev, const struct pci_device_id *pre)
5748{
5749 nic_t *sp;
5750 struct net_device *dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005751 int i, j, ret;
5752 int dma_flag = FALSE;
5753 u32 mac_up, mac_down;
5754 u64 val64 = 0, tmp64 = 0;
5755 XENA_dev_config_t __iomem *bar0 = NULL;
5756 u16 subid;
5757 mac_info_t *mac_control;
5758 struct config_param *config;
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005759 int mode;
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005760 u8 dev_intr_type = intr_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005761
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005762#ifdef CONFIG_S2IO_NAPI
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005763 if (dev_intr_type != INTA) {
5764 DBG_PRINT(ERR_DBG, "NAPI cannot be enabled when MSI/MSI-X \
5765is enabled. Defaulting to INTA\n");
5766 dev_intr_type = INTA;
5767 }
5768 else
5769 DBG_PRINT(ERR_DBG, "NAPI support has been enabled\n");
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005770#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07005771
5772 if ((ret = pci_enable_device(pdev))) {
5773 DBG_PRINT(ERR_DBG,
5774 "s2io_init_nic: pci_enable_device failed\n");
5775 return ret;
5776 }
5777
Domen Puncer1e7f0bd2005-06-26 18:22:14 -04005778 if (!pci_set_dma_mask(pdev, DMA_64BIT_MASK)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005779 DBG_PRINT(INIT_DBG, "s2io_init_nic: Using 64bit DMA\n");
5780 dma_flag = TRUE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005781 if (pci_set_consistent_dma_mask
Domen Puncer1e7f0bd2005-06-26 18:22:14 -04005782 (pdev, DMA_64BIT_MASK)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005783 DBG_PRINT(ERR_DBG,
5784 "Unable to obtain 64bit DMA for \
5785 consistent allocations\n");
5786 pci_disable_device(pdev);
5787 return -ENOMEM;
5788 }
Domen Puncer1e7f0bd2005-06-26 18:22:14 -04005789 } else if (!pci_set_dma_mask(pdev, DMA_32BIT_MASK)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005790 DBG_PRINT(INIT_DBG, "s2io_init_nic: Using 32bit DMA\n");
5791 } else {
5792 pci_disable_device(pdev);
5793 return -ENOMEM;
5794 }
5795
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005796 if ((dev_intr_type == MSI_X) &&
5797 ((pdev->device != PCI_DEVICE_ID_HERC_WIN) &&
5798 (pdev->device != PCI_DEVICE_ID_HERC_UNI))) {
5799 DBG_PRINT(ERR_DBG, "Xframe I does not support MSI_X. \
5800Defaulting to INTA\n");
5801 dev_intr_type = INTA;
5802 }
5803 if (dev_intr_type != MSI_X) {
5804 if (pci_request_regions(pdev, s2io_driver_name)) {
5805 DBG_PRINT(ERR_DBG, "Request Regions failed\n"),
5806 pci_disable_device(pdev);
5807 return -ENODEV;
5808 }
5809 }
5810 else {
5811 if (!(request_mem_region(pci_resource_start(pdev, 0),
5812 pci_resource_len(pdev, 0), s2io_driver_name))) {
5813 DBG_PRINT(ERR_DBG, "bar0 Request Regions failed\n");
5814 pci_disable_device(pdev);
5815 return -ENODEV;
5816 }
5817 if (!(request_mem_region(pci_resource_start(pdev, 2),
5818 pci_resource_len(pdev, 2), s2io_driver_name))) {
5819 DBG_PRINT(ERR_DBG, "bar1 Request Regions failed\n");
5820 release_mem_region(pci_resource_start(pdev, 0),
5821 pci_resource_len(pdev, 0));
5822 pci_disable_device(pdev);
5823 return -ENODEV;
5824 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005825 }
5826
5827 dev = alloc_etherdev(sizeof(nic_t));
5828 if (dev == NULL) {
5829 DBG_PRINT(ERR_DBG, "Device allocation failed\n");
5830 pci_disable_device(pdev);
5831 pci_release_regions(pdev);
5832 return -ENODEV;
5833 }
5834
5835 pci_set_master(pdev);
5836 pci_set_drvdata(pdev, dev);
5837 SET_MODULE_OWNER(dev);
5838 SET_NETDEV_DEV(dev, &pdev->dev);
5839
5840 /* Private member variable initialized to s2io NIC structure */
5841 sp = dev->priv;
5842 memset(sp, 0, sizeof(nic_t));
5843 sp->dev = dev;
5844 sp->pdev = pdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005845 sp->high_dma_flag = dma_flag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005846 sp->device_enabled_once = FALSE;
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005847 sp->intr_type = dev_intr_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005848
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07005849 if ((pdev->device == PCI_DEVICE_ID_HERC_WIN) ||
5850 (pdev->device == PCI_DEVICE_ID_HERC_UNI))
5851 sp->device_type = XFRAME_II_DEVICE;
5852 else
5853 sp->device_type = XFRAME_I_DEVICE;
5854
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04005855
Linus Torvalds1da177e2005-04-16 15:20:36 -07005856 /* Initialize some PCI/PCI-X fields of the NIC. */
5857 s2io_init_pci(sp);
5858
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005859 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07005860 * Setting the device configuration parameters.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005861 * Most of these parameters can be specified by the user during
5862 * module insertion as they are module loadable parameters. If
5863 * these parameters are not not specified during load time, they
Linus Torvalds1da177e2005-04-16 15:20:36 -07005864 * are initialized with default values.
5865 */
5866 mac_control = &sp->mac_control;
5867 config = &sp->config;
5868
5869 /* Tx side parameters. */
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07005870 if (tx_fifo_len[0] == 0)
5871 tx_fifo_len[0] = DEFAULT_FIFO_LEN; /* Default value. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005872 config->tx_fifo_num = tx_fifo_num;
5873 for (i = 0; i < MAX_TX_FIFOS; i++) {
5874 config->tx_cfg[i].fifo_len = tx_fifo_len[i];
5875 config->tx_cfg[i].fifo_priority = i;
5876 }
5877
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005878 /* mapping the QoS priority to the configured fifos */
5879 for (i = 0; i < MAX_TX_FIFOS; i++)
5880 config->fifo_mapping[i] = fifo_map[config->tx_fifo_num][i];
5881
Linus Torvalds1da177e2005-04-16 15:20:36 -07005882 config->tx_intr_type = TXD_INT_TYPE_UTILZ;
5883 for (i = 0; i < config->tx_fifo_num; i++) {
5884 config->tx_cfg[i].f_no_snoop =
5885 (NO_SNOOP_TXD | NO_SNOOP_TXD_BUFFER);
5886 if (config->tx_cfg[i].fifo_len < 65) {
5887 config->tx_intr_type = TXD_INT_TYPE_PER_LIST;
5888 break;
5889 }
5890 }
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07005891 config->max_txds = MAX_SKB_FRAGS + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005892
5893 /* Rx side parameters. */
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07005894 if (rx_ring_sz[0] == 0)
5895 rx_ring_sz[0] = SMALL_BLK_CNT; /* Default value. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005896 config->rx_ring_num = rx_ring_num;
5897 for (i = 0; i < MAX_RX_RINGS; i++) {
5898 config->rx_cfg[i].num_rxd = rx_ring_sz[i] *
5899 (MAX_RXDS_PER_BLOCK + 1);
5900 config->rx_cfg[i].ring_priority = i;
5901 }
5902
5903 for (i = 0; i < rx_ring_num; i++) {
5904 config->rx_cfg[i].ring_org = RING_ORG_BUFF1;
5905 config->rx_cfg[i].f_no_snoop =
5906 (NO_SNOOP_RXD | NO_SNOOP_RXD_BUFFER);
5907 }
5908
5909 /* Setting Mac Control parameters */
5910 mac_control->rmac_pause_time = rmac_pause_time;
5911 mac_control->mc_pause_threshold_q0q3 = mc_pause_threshold_q0q3;
5912 mac_control->mc_pause_threshold_q4q7 = mc_pause_threshold_q4q7;
5913
5914
5915 /* Initialize Ring buffer parameters. */
5916 for (i = 0; i < config->rx_ring_num; i++)
5917 atomic_set(&sp->rx_bufs_left[i], 0);
5918
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07005919 /* Initialize the number of ISRs currently running */
5920 atomic_set(&sp->isr_cnt, 0);
5921
Linus Torvalds1da177e2005-04-16 15:20:36 -07005922 /* initialize the shared memory used by the NIC and the host */
5923 if (init_shared_mem(sp)) {
5924 DBG_PRINT(ERR_DBG, "%s: Memory allocation failed\n",
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07005925 __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005926 ret = -ENOMEM;
5927 goto mem_alloc_failed;
5928 }
5929
5930 sp->bar0 = ioremap(pci_resource_start(pdev, 0),
5931 pci_resource_len(pdev, 0));
5932 if (!sp->bar0) {
5933 DBG_PRINT(ERR_DBG, "%s: S2IO: cannot remap io mem1\n",
5934 dev->name);
5935 ret = -ENOMEM;
5936 goto bar0_remap_failed;
5937 }
5938
5939 sp->bar1 = ioremap(pci_resource_start(pdev, 2),
5940 pci_resource_len(pdev, 2));
5941 if (!sp->bar1) {
5942 DBG_PRINT(ERR_DBG, "%s: S2IO: cannot remap io mem2\n",
5943 dev->name);
5944 ret = -ENOMEM;
5945 goto bar1_remap_failed;
5946 }
5947
5948 dev->irq = pdev->irq;
5949 dev->base_addr = (unsigned long) sp->bar0;
5950
5951 /* Initializing the BAR1 address as the start of the FIFO pointer. */
5952 for (j = 0; j < MAX_TX_FIFOS; j++) {
5953 mac_control->tx_FIFO_start[j] = (TxFIFO_element_t __iomem *)
5954 (sp->bar1 + (j * 0x00020000));
5955 }
5956
5957 /* Driver entry points */
5958 dev->open = &s2io_open;
5959 dev->stop = &s2io_close;
5960 dev->hard_start_xmit = &s2io_xmit;
5961 dev->get_stats = &s2io_get_stats;
5962 dev->set_multicast_list = &s2io_set_multicast;
5963 dev->do_ioctl = &s2io_ioctl;
5964 dev->change_mtu = &s2io_change_mtu;
5965 SET_ETHTOOL_OPS(dev, &netdev_ethtool_ops);
raghavendra.koushik@neterion.combe3a6b02005-08-03 12:35:55 -07005966 dev->features |= NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX;
5967 dev->vlan_rx_register = s2io_vlan_rx_register;
5968 dev->vlan_rx_kill_vid = (void *)s2io_vlan_rx_kill_vid;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005969
Linus Torvalds1da177e2005-04-16 15:20:36 -07005970 /*
5971 * will use eth_mac_addr() for dev->set_mac_address
5972 * mac address will be set every time dev->open() is called
5973 */
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005974#if defined(CONFIG_S2IO_NAPI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005975 dev->poll = s2io_poll;
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07005976 dev->weight = 32;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005977#endif
5978
5979 dev->features |= NETIF_F_SG | NETIF_F_IP_CSUM;
5980 if (sp->high_dma_flag == TRUE)
5981 dev->features |= NETIF_F_HIGHDMA;
5982#ifdef NETIF_F_TSO
5983 dev->features |= NETIF_F_TSO;
5984#endif
5985
5986 dev->tx_timeout = &s2io_tx_watchdog;
5987 dev->watchdog_timeo = WATCH_DOG_TIMEOUT;
5988 INIT_WORK(&sp->rst_timer_task,
5989 (void (*)(void *)) s2io_restart_nic, dev);
5990 INIT_WORK(&sp->set_link_task,
5991 (void (*)(void *)) s2io_set_link, sp);
5992
ravinandan.arakali@neterion.come960fc52005-08-12 10:15:59 -07005993 pci_save_state(sp->pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005994
5995 /* Setting swapper control on the NIC, for proper reset operation */
5996 if (s2io_set_swapper(sp)) {
5997 DBG_PRINT(ERR_DBG, "%s:swapper settings are wrong\n",
5998 dev->name);
5999 ret = -EAGAIN;
6000 goto set_swap_failed;
6001 }
6002
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006003 /* Verify if the Herc works on the slot its placed into */
6004 if (sp->device_type & XFRAME_II_DEVICE) {
6005 mode = s2io_verify_pci_mode(sp);
6006 if (mode < 0) {
6007 DBG_PRINT(ERR_DBG, "%s: ", __FUNCTION__);
6008 DBG_PRINT(ERR_DBG, " Unsupported PCI bus mode\n");
6009 ret = -EBADSLT;
6010 goto set_swap_failed;
6011 }
6012 }
6013
6014 /* Not needed for Herc */
6015 if (sp->device_type & XFRAME_I_DEVICE) {
6016 /*
6017 * Fix for all "FFs" MAC address problems observed on
6018 * Alpha platforms
6019 */
6020 fix_mac_address(sp);
6021 s2io_reset(sp);
6022 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07006023
6024 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07006025 * MAC address initialization.
6026 * For now only one mac address will be read and used.
6027 */
6028 bar0 = sp->bar0;
6029 val64 = RMAC_ADDR_CMD_MEM_RD | RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
6030 RMAC_ADDR_CMD_MEM_OFFSET(0 + MAC_MAC_ADDR_START_OFFSET);
6031 writeq(val64, &bar0->rmac_addr_cmd_mem);
6032 wait_for_cmd_complete(sp);
6033
6034 tmp64 = readq(&bar0->rmac_addr_data0_mem);
6035 mac_down = (u32) tmp64;
6036 mac_up = (u32) (tmp64 >> 32);
6037
6038 memset(sp->def_mac_addr[0].mac_addr, 0, sizeof(ETH_ALEN));
6039
6040 sp->def_mac_addr[0].mac_addr[3] = (u8) (mac_up);
6041 sp->def_mac_addr[0].mac_addr[2] = (u8) (mac_up >> 8);
6042 sp->def_mac_addr[0].mac_addr[1] = (u8) (mac_up >> 16);
6043 sp->def_mac_addr[0].mac_addr[0] = (u8) (mac_up >> 24);
6044 sp->def_mac_addr[0].mac_addr[5] = (u8) (mac_down >> 16);
6045 sp->def_mac_addr[0].mac_addr[4] = (u8) (mac_down >> 24);
6046
Linus Torvalds1da177e2005-04-16 15:20:36 -07006047 /* Set the factory defined MAC address initially */
6048 dev->addr_len = ETH_ALEN;
6049 memcpy(dev->dev_addr, sp->def_mac_addr, ETH_ALEN);
6050
6051 /*
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006052 * Initialize the tasklet status and link state flags
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006053 * and the card state parameter
Linus Torvalds1da177e2005-04-16 15:20:36 -07006054 */
6055 atomic_set(&(sp->card_state), 0);
6056 sp->tasklet_status = 0;
6057 sp->link_state = 0;
6058
Linus Torvalds1da177e2005-04-16 15:20:36 -07006059 /* Initialize spinlocks */
6060 spin_lock_init(&sp->tx_lock);
6061#ifndef CONFIG_S2IO_NAPI
6062 spin_lock_init(&sp->put_lock);
6063#endif
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07006064 spin_lock_init(&sp->rx_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006065
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006066 /*
6067 * SXE-002: Configure link and activity LED to init state
6068 * on driver load.
Linus Torvalds1da177e2005-04-16 15:20:36 -07006069 */
6070 subid = sp->pdev->subsystem_device;
6071 if ((subid & 0xFF) >= 0x07) {
6072 val64 = readq(&bar0->gpio_control);
6073 val64 |= 0x0000800000000000ULL;
6074 writeq(val64, &bar0->gpio_control);
6075 val64 = 0x0411040400000000ULL;
6076 writeq(val64, (void __iomem *) bar0 + 0x2700);
6077 val64 = readq(&bar0->gpio_control);
6078 }
6079
6080 sp->rx_csum = 1; /* Rx chksum verify enabled by default */
6081
6082 if (register_netdev(dev)) {
6083 DBG_PRINT(ERR_DBG, "Device registration failed\n");
6084 ret = -ENODEV;
6085 goto register_failed;
6086 }
6087
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006088 if (sp->device_type & XFRAME_II_DEVICE) {
6089 DBG_PRINT(ERR_DBG, "%s: Neterion Xframe II 10GbE adapter ",
6090 dev->name);
John Linville6c1792f2005-10-04 07:51:45 -04006091 DBG_PRINT(ERR_DBG, "(rev %d), Version %s",
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006092 get_xena_rev_id(sp->pdev),
6093 s2io_driver_version);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07006094#ifdef CONFIG_2BUFF_MODE
6095 DBG_PRINT(ERR_DBG, ", Buffer mode %d",2);
6096#endif
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04006097 switch(sp->intr_type) {
6098 case INTA:
6099 DBG_PRINT(ERR_DBG, ", Intr type INTA");
6100 break;
6101 case MSI:
6102 DBG_PRINT(ERR_DBG, ", Intr type MSI");
6103 break;
6104 case MSI_X:
6105 DBG_PRINT(ERR_DBG, ", Intr type MSI-X");
6106 break;
6107 }
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07006108
6109 DBG_PRINT(ERR_DBG, "\nCopyright(c) 2002-2005 Neterion Inc.\n");
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006110 DBG_PRINT(ERR_DBG, "MAC ADDR: %02x:%02x:%02x:%02x:%02x:%02x\n",
6111 sp->def_mac_addr[0].mac_addr[0],
6112 sp->def_mac_addr[0].mac_addr[1],
6113 sp->def_mac_addr[0].mac_addr[2],
6114 sp->def_mac_addr[0].mac_addr[3],
6115 sp->def_mac_addr[0].mac_addr[4],
6116 sp->def_mac_addr[0].mac_addr[5]);
raghavendra.koushik@neterion.com0b1f7eb2005-08-03 12:39:56 -07006117 mode = s2io_print_pci_mode(sp);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006118 if (mode < 0) {
6119 DBG_PRINT(ERR_DBG, " Unsupported PCI bus mode ");
6120 ret = -EBADSLT;
6121 goto set_swap_failed;
6122 }
6123 } else {
6124 DBG_PRINT(ERR_DBG, "%s: Neterion Xframe I 10GbE adapter ",
6125 dev->name);
John Linville6c1792f2005-10-04 07:51:45 -04006126 DBG_PRINT(ERR_DBG, "(rev %d), Version %s",
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006127 get_xena_rev_id(sp->pdev),
6128 s2io_driver_version);
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07006129#ifdef CONFIG_2BUFF_MODE
6130 DBG_PRINT(ERR_DBG, ", Buffer mode %d",2);
6131#endif
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04006132 switch(sp->intr_type) {
6133 case INTA:
6134 DBG_PRINT(ERR_DBG, ", Intr type INTA");
6135 break;
6136 case MSI:
6137 DBG_PRINT(ERR_DBG, ", Intr type MSI");
6138 break;
6139 case MSI_X:
6140 DBG_PRINT(ERR_DBG, ", Intr type MSI-X");
6141 break;
6142 }
ravinandan.arakali@neterion.com776bd202005-09-06 21:36:56 -07006143 DBG_PRINT(ERR_DBG, "\nCopyright(c) 2002-2005 Neterion Inc.\n");
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006144 DBG_PRINT(ERR_DBG, "MAC ADDR: %02x:%02x:%02x:%02x:%02x:%02x\n",
6145 sp->def_mac_addr[0].mac_addr[0],
6146 sp->def_mac_addr[0].mac_addr[1],
6147 sp->def_mac_addr[0].mac_addr[2],
6148 sp->def_mac_addr[0].mac_addr[3],
6149 sp->def_mac_addr[0].mac_addr[4],
6150 sp->def_mac_addr[0].mac_addr[5]);
6151 }
6152
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07006153 /* Initialize device name */
6154 strcpy(sp->name, dev->name);
raghavendra.koushik@neterion.com541ae682005-08-03 12:36:55 -07006155 if (sp->device_type & XFRAME_II_DEVICE)
6156 strcat(sp->name, ": Neterion Xframe II 10GbE adapter");
6157 else
6158 strcat(sp->name, ": Neterion Xframe I 10GbE adapter");
raghavendra.koushik@neterion.com7ba013a2005-08-03 12:29:20 -07006159
raghavendra.koushik@neterion.comb6e3f982005-08-03 12:38:01 -07006160 /* Initialize bimodal Interrupts */
6161 sp->config.bimodal = bimodal;
6162 if (!(sp->device_type & XFRAME_II_DEVICE) && bimodal) {
6163 sp->config.bimodal = 0;
6164 DBG_PRINT(ERR_DBG,"%s:Bimodal intr not supported by Xframe I\n",
6165 dev->name);
6166 }
6167
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006168 /*
6169 * Make Link state as off at this point, when the Link change
6170 * interrupt comes the state will be automatically changed to
Linus Torvalds1da177e2005-04-16 15:20:36 -07006171 * the right state.
6172 */
6173 netif_carrier_off(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006174
6175 return 0;
6176
6177 register_failed:
6178 set_swap_failed:
6179 iounmap(sp->bar1);
6180 bar1_remap_failed:
6181 iounmap(sp->bar0);
6182 bar0_remap_failed:
6183 mem_alloc_failed:
6184 free_shared_mem(sp);
6185 pci_disable_device(pdev);
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04006186 if (dev_intr_type != MSI_X)
6187 pci_release_regions(pdev);
6188 else {
6189 release_mem_region(pci_resource_start(pdev, 0),
6190 pci_resource_len(pdev, 0));
6191 release_mem_region(pci_resource_start(pdev, 2),
6192 pci_resource_len(pdev, 2));
6193 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07006194 pci_set_drvdata(pdev, NULL);
6195 free_netdev(dev);
6196
6197 return ret;
6198}
6199
6200/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006201 * s2io_rem_nic - Free the PCI device
Linus Torvalds1da177e2005-04-16 15:20:36 -07006202 * @pdev: structure containing the PCI related information of the device.
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006203 * Description: This function is called by the Pci subsystem to release a
Linus Torvalds1da177e2005-04-16 15:20:36 -07006204 * PCI device and free up all resource held up by the device. This could
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006205 * be in response to a Hot plug event or when the driver is to be removed
Linus Torvalds1da177e2005-04-16 15:20:36 -07006206 * from memory.
6207 */
6208
6209static void __devexit s2io_rem_nic(struct pci_dev *pdev)
6210{
6211 struct net_device *dev =
6212 (struct net_device *) pci_get_drvdata(pdev);
6213 nic_t *sp;
6214
6215 if (dev == NULL) {
6216 DBG_PRINT(ERR_DBG, "Driver Data is NULL!!\n");
6217 return;
6218 }
6219
6220 sp = dev->priv;
6221 unregister_netdev(dev);
6222
6223 free_shared_mem(sp);
6224 iounmap(sp->bar0);
6225 iounmap(sp->bar1);
6226 pci_disable_device(pdev);
Ravinandan Arakalicc6e7c42005-10-04 06:41:24 -04006227 if (sp->intr_type != MSI_X)
6228 pci_release_regions(pdev);
6229 else {
6230 release_mem_region(pci_resource_start(pdev, 0),
6231 pci_resource_len(pdev, 0));
6232 release_mem_region(pci_resource_start(pdev, 2),
6233 pci_resource_len(pdev, 2));
6234 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07006235 pci_set_drvdata(pdev, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006236 free_netdev(dev);
6237}
6238
6239/**
6240 * s2io_starter - Entry point for the driver
6241 * Description: This function is the entry point for the driver. It verifies
6242 * the module loadable parameters and initializes PCI configuration space.
6243 */
6244
6245int __init s2io_starter(void)
6246{
6247 return pci_module_init(&s2io_driver);
6248}
6249
6250/**
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006251 * s2io_closer - Cleanup routine for the driver
Linus Torvalds1da177e2005-04-16 15:20:36 -07006252 * Description: This function is the cleanup routine for the driver. It unregist * ers the driver.
6253 */
6254
raghavendra.koushik@neterion.com20346722005-08-03 12:24:33 -07006255void s2io_closer(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07006256{
6257 pci_unregister_driver(&s2io_driver);
6258 DBG_PRINT(INIT_DBG, "cleanup done\n");
6259}
6260
6261module_init(s2io_starter);
6262module_exit(s2io_closer);