cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

dmfe.c (59108B)


      1// SPDX-License-Identifier: GPL-2.0-or-later
      2/*
      3    A Davicom DM9102/DM9102A/DM9102A+DM9801/DM9102A+DM9802 NIC fast
      4    ethernet driver for Linux.
      5    Copyright (C) 1997  Sten Wang
      6
      7
      8    DAVICOM Web-Site: www.davicom.com.tw
      9
     10    Author: Sten Wang, 886-3-5798797-8517, E-mail: sten_wang@davicom.com.tw
     11    Maintainer: Tobias Ringstrom <tori@unhappy.mine.nu>
     12
     13    (C)Copyright 1997-1998 DAVICOM Semiconductor,Inc. All Rights Reserved.
     14
     15    Marcelo Tosatti <marcelo@conectiva.com.br> :
     16    Made it compile in 2.3 (device to net_device)
     17
     18    Alan Cox <alan@lxorguk.ukuu.org.uk> :
     19    Cleaned up for kernel merge.
     20    Removed the back compatibility support
     21    Reformatted, fixing spelling etc as I went
     22    Removed IRQ 0-15 assumption
     23
     24    Jeff Garzik <jgarzik@pobox.com> :
     25    Updated to use new PCI driver API.
     26    Resource usage cleanups.
     27    Report driver version to user.
     28
     29    Tobias Ringstrom <tori@unhappy.mine.nu> :
     30    Cleaned up and added SMP safety.  Thanks go to Jeff Garzik,
     31    Andrew Morton and Frank Davis for the SMP safety fixes.
     32
     33    Vojtech Pavlik <vojtech@suse.cz> :
     34    Cleaned up pointer arithmetics.
     35    Fixed a lot of 64bit issues.
     36    Cleaned up printk()s a bit.
     37    Fixed some obvious big endian problems.
     38
     39    Tobias Ringstrom <tori@unhappy.mine.nu> :
     40    Use time_after for jiffies calculation.  Added ethtool
     41    support.  Updated PCI resource allocation.  Do not
     42    forget to unmap PCI mapped skbs.
     43
     44    Alan Cox <alan@lxorguk.ukuu.org.uk>
     45    Added new PCI identifiers provided by Clear Zhang at ALi
     46    for their 1563 ethernet device.
     47
     48    TODO
     49
     50    Check on 64 bit boxes.
     51    Check and fix on big endian boxes.
     52
     53    Test and make sure PCI latency is now correct for all cases.
     54*/
     55
     56#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
     57
     58#define DRV_NAME	"dmfe"
     59
     60#include <linux/module.h>
     61#include <linux/kernel.h>
     62#include <linux/string.h>
     63#include <linux/timer.h>
     64#include <linux/ptrace.h>
     65#include <linux/errno.h>
     66#include <linux/ioport.h>
     67#include <linux/interrupt.h>
     68#include <linux/pci.h>
     69#include <linux/dma-mapping.h>
     70#include <linux/init.h>
     71#include <linux/netdevice.h>
     72#include <linux/etherdevice.h>
     73#include <linux/ethtool.h>
     74#include <linux/skbuff.h>
     75#include <linux/delay.h>
     76#include <linux/spinlock.h>
     77#include <linux/crc32.h>
     78#include <linux/bitops.h>
     79
     80#include <asm/processor.h>
     81#include <asm/io.h>
     82#include <asm/dma.h>
     83#include <linux/uaccess.h>
     84#include <asm/irq.h>
     85
     86#ifdef CONFIG_TULIP_DM910X
     87#include <linux/of.h>
     88#endif
     89
     90
     91/* Board/System/Debug information/definition ---------------- */
     92#define PCI_DM9132_ID   0x91321282      /* Davicom DM9132 ID */
     93#define PCI_DM9102_ID   0x91021282      /* Davicom DM9102 ID */
     94#define PCI_DM9100_ID   0x91001282      /* Davicom DM9100 ID */
     95#define PCI_DM9009_ID   0x90091282      /* Davicom DM9009 ID */
     96
     97#define DM9102_IO_SIZE  0x80
     98#define DM9102A_IO_SIZE 0x100
     99#define TX_MAX_SEND_CNT 0x1             /* Maximum tx packet per time */
    100#define TX_DESC_CNT     0x10            /* Allocated Tx descriptors */
    101#define RX_DESC_CNT     0x20            /* Allocated Rx descriptors */
    102#define TX_FREE_DESC_CNT (TX_DESC_CNT - 2)	/* Max TX packet count */
    103#define TX_WAKE_DESC_CNT (TX_DESC_CNT - 3)	/* TX wakeup count */
    104#define DESC_ALL_CNT    (TX_DESC_CNT + RX_DESC_CNT)
    105#define TX_BUF_ALLOC    0x600
    106#define RX_ALLOC_SIZE   0x620
    107#define DM910X_RESET    1
    108#define CR0_DEFAULT     0x00E00000      /* TX & RX burst mode */
    109#define CR6_DEFAULT     0x00080000      /* HD */
    110#define CR7_DEFAULT     0x180c1
    111#define CR15_DEFAULT    0x06            /* TxJabber RxWatchdog */
    112#define TDES0_ERR_MASK  0x4302          /* TXJT, LC, EC, FUE */
    113#define MAX_PACKET_SIZE 1514
    114#define DMFE_MAX_MULTICAST 14
    115#define RX_COPY_SIZE	100
    116#define MAX_CHECK_PACKET 0x8000
    117#define DM9801_NOISE_FLOOR 8
    118#define DM9802_NOISE_FLOOR 5
    119
    120#define DMFE_WOL_LINKCHANGE	0x20000000
    121#define DMFE_WOL_SAMPLEPACKET	0x10000000
    122#define DMFE_WOL_MAGICPACKET	0x08000000
    123
    124
    125#define DMFE_10MHF      0
    126#define DMFE_100MHF     1
    127#define DMFE_10MFD      4
    128#define DMFE_100MFD     5
    129#define DMFE_AUTO       8
    130#define DMFE_1M_HPNA    0x10
    131
    132#define DMFE_TXTH_72	0x400000	/* TX TH 72 byte */
    133#define DMFE_TXTH_96	0x404000	/* TX TH 96 byte */
    134#define DMFE_TXTH_128	0x0000		/* TX TH 128 byte */
    135#define DMFE_TXTH_256	0x4000		/* TX TH 256 byte */
    136#define DMFE_TXTH_512	0x8000		/* TX TH 512 byte */
    137#define DMFE_TXTH_1K	0xC000		/* TX TH 1K  byte */
    138
    139#define DMFE_TIMER_WUT  (jiffies + HZ * 1)/* timer wakeup time : 1 second */
    140#define DMFE_TX_TIMEOUT ((3*HZ)/2)	/* tx packet time-out time 1.5 s" */
    141#define DMFE_TX_KICK 	(HZ/2)	/* tx packet Kick-out time 0.5 s" */
    142
    143#define dw32(reg, val)	iowrite32(val, ioaddr + (reg))
    144#define dw16(reg, val)	iowrite16(val, ioaddr + (reg))
    145#define dr32(reg)	ioread32(ioaddr + (reg))
    146#define dr16(reg)	ioread16(ioaddr + (reg))
    147#define dr8(reg)	ioread8(ioaddr + (reg))
    148
    149#define DMFE_DBUG(dbug_now, msg, value)			\
    150	do {						\
    151		if (dmfe_debug || (dbug_now))		\
    152			pr_err("%s %lx\n",		\
    153			       (msg), (long) (value));	\
    154	} while (0)
    155
    156#define SHOW_MEDIA_TYPE(mode)				\
    157	pr_info("Change Speed to %sMhz %s duplex\n" ,	\
    158		(mode & 1) ? "100":"10",		\
    159		(mode & 4) ? "full":"half");
    160
    161
    162/* CR9 definition: SROM/MII */
    163#define CR9_SROM_READ   0x4800
    164#define CR9_SRCS        0x1
    165#define CR9_SRCLK       0x2
    166#define CR9_CRDOUT      0x8
    167#define SROM_DATA_0     0x0
    168#define SROM_DATA_1     0x4
    169#define PHY_DATA_1      0x20000
    170#define PHY_DATA_0      0x00000
    171#define MDCLKH          0x10000
    172
    173#define PHY_POWER_DOWN	0x800
    174
    175#define SROM_V41_CODE   0x14
    176
    177#define __CHK_IO_SIZE(pci_id, dev_rev) \
    178 (( ((pci_id)==PCI_DM9132_ID) || ((dev_rev) >= 0x30) ) ? \
    179	DM9102A_IO_SIZE: DM9102_IO_SIZE)
    180
    181#define CHK_IO_SIZE(pci_dev) \
    182	(__CHK_IO_SIZE(((pci_dev)->device << 16) | (pci_dev)->vendor, \
    183	(pci_dev)->revision))
    184
    185/* Structure/enum declaration ------------------------------- */
    186struct tx_desc {
    187        __le32 tdes0, tdes1, tdes2, tdes3; /* Data for the card */
    188        char *tx_buf_ptr;               /* Data for us */
    189        struct tx_desc *next_tx_desc;
    190} __attribute__(( aligned(32) ));
    191
    192struct rx_desc {
    193	__le32 rdes0, rdes1, rdes2, rdes3; /* Data for the card */
    194	struct sk_buff *rx_skb_ptr;	/* Data for us */
    195	struct rx_desc *next_rx_desc;
    196} __attribute__(( aligned(32) ));
    197
    198struct dmfe_board_info {
    199	u32 chip_id;			/* Chip vendor/Device ID */
    200	u8 chip_revision;		/* Chip revision */
    201	struct net_device *next_dev;	/* next device */
    202	struct pci_dev *pdev;		/* PCI device */
    203	spinlock_t lock;
    204
    205	void __iomem *ioaddr;		/* I/O base address */
    206	u32 cr0_data;
    207	u32 cr5_data;
    208	u32 cr6_data;
    209	u32 cr7_data;
    210	u32 cr15_data;
    211
    212	/* pointer for memory physical address */
    213	dma_addr_t buf_pool_dma_ptr;	/* Tx buffer pool memory */
    214	dma_addr_t buf_pool_dma_start;	/* Tx buffer pool align dword */
    215	dma_addr_t desc_pool_dma_ptr;	/* descriptor pool memory */
    216	dma_addr_t first_tx_desc_dma;
    217	dma_addr_t first_rx_desc_dma;
    218
    219	/* descriptor pointer */
    220	unsigned char *buf_pool_ptr;	/* Tx buffer pool memory */
    221	unsigned char *buf_pool_start;	/* Tx buffer pool align dword */
    222	unsigned char *desc_pool_ptr;	/* descriptor pool memory */
    223	struct tx_desc *first_tx_desc;
    224	struct tx_desc *tx_insert_ptr;
    225	struct tx_desc *tx_remove_ptr;
    226	struct rx_desc *first_rx_desc;
    227	struct rx_desc *rx_insert_ptr;
    228	struct rx_desc *rx_ready_ptr;	/* packet come pointer */
    229	unsigned long tx_packet_cnt;	/* transmitted packet count */
    230	unsigned long tx_queue_cnt;	/* wait to send packet count */
    231	unsigned long rx_avail_cnt;	/* available rx descriptor count */
    232	unsigned long interval_rx_cnt;	/* rx packet count a callback time */
    233
    234	u16 HPNA_command;		/* For HPNA register 16 */
    235	u16 HPNA_timer;			/* For HPNA remote device check */
    236	u16 dbug_cnt;
    237	u16 NIC_capability;		/* NIC media capability */
    238	u16 PHY_reg4;			/* Saved Phyxcer register 4 value */
    239
    240	u8 HPNA_present;		/* 0:none, 1:DM9801, 2:DM9802 */
    241	u8 chip_type;			/* Keep DM9102A chip type */
    242	u8 media_mode;			/* user specify media mode */
    243	u8 op_mode;			/* real work media mode */
    244	u8 phy_addr;
    245	u8 wait_reset;			/* Hardware failed, need to reset */
    246	u8 dm910x_chk_mode;		/* Operating mode check */
    247	u8 first_in_callback;		/* Flag to record state */
    248	u8 wol_mode;			/* user WOL settings */
    249	struct timer_list timer;
    250
    251	/* Driver defined statistic counter */
    252	unsigned long tx_fifo_underrun;
    253	unsigned long tx_loss_carrier;
    254	unsigned long tx_no_carrier;
    255	unsigned long tx_late_collision;
    256	unsigned long tx_excessive_collision;
    257	unsigned long tx_jabber_timeout;
    258	unsigned long reset_count;
    259	unsigned long reset_cr8;
    260	unsigned long reset_fatal;
    261	unsigned long reset_TXtimeout;
    262
    263	/* NIC SROM data */
    264	unsigned char srom[128];
    265};
    266
    267enum dmfe_offsets {
    268	DCR0 = 0x00, DCR1 = 0x08, DCR2 = 0x10, DCR3 = 0x18, DCR4 = 0x20,
    269	DCR5 = 0x28, DCR6 = 0x30, DCR7 = 0x38, DCR8 = 0x40, DCR9 = 0x48,
    270	DCR10 = 0x50, DCR11 = 0x58, DCR12 = 0x60, DCR13 = 0x68, DCR14 = 0x70,
    271	DCR15 = 0x78
    272};
    273
    274enum dmfe_CR6_bits {
    275	CR6_RXSC = 0x2, CR6_PBF = 0x8, CR6_PM = 0x40, CR6_PAM = 0x80,
    276	CR6_FDM = 0x200, CR6_TXSC = 0x2000, CR6_STI = 0x100000,
    277	CR6_SFT = 0x200000, CR6_RXA = 0x40000000, CR6_NO_PURGE = 0x20000000
    278};
    279
    280/* Global variable declaration ----------------------------- */
    281static int dmfe_debug;
    282static unsigned char dmfe_media_mode = DMFE_AUTO;
    283static u32 dmfe_cr6_user_set;
    284
    285/* For module input parameter */
    286static int debug;
    287static u32 cr6set;
    288static unsigned char mode = 8;
    289static u8 chkmode = 1;
    290static u8 HPNA_mode;		/* Default: Low Power/High Speed */
    291static u8 HPNA_rx_cmd;		/* Default: Disable Rx remote command */
    292static u8 HPNA_tx_cmd;		/* Default: Don't issue remote command */
    293static u8 HPNA_NoiseFloor;	/* Default: HPNA NoiseFloor */
    294static u8 SF_mode;		/* Special Function: 1:VLAN, 2:RX Flow Control
    295				   4: TX pause packet */
    296
    297
    298/* function declaration ------------------------------------- */
    299static int dmfe_open(struct net_device *);
    300static netdev_tx_t dmfe_start_xmit(struct sk_buff *, struct net_device *);
    301static int dmfe_stop(struct net_device *);
    302static void dmfe_set_filter_mode(struct net_device *);
    303static const struct ethtool_ops netdev_ethtool_ops;
    304static u16 read_srom_word(void __iomem *, int);
    305static irqreturn_t dmfe_interrupt(int , void *);
    306#ifdef CONFIG_NET_POLL_CONTROLLER
    307static void poll_dmfe (struct net_device *dev);
    308#endif
    309static void dmfe_descriptor_init(struct net_device *);
    310static void allocate_rx_buffer(struct net_device *);
    311static void update_cr6(u32, void __iomem *);
    312static void send_filter_frame(struct net_device *);
    313static void dm9132_id_table(struct net_device *);
    314static u16 dmfe_phy_read(void __iomem *, u8, u8, u32);
    315static void dmfe_phy_write(void __iomem *, u8, u8, u16, u32);
    316static void dmfe_phy_write_1bit(void __iomem *, u32);
    317static u16 dmfe_phy_read_1bit(void __iomem *);
    318static u8 dmfe_sense_speed(struct dmfe_board_info *);
    319static void dmfe_process_mode(struct dmfe_board_info *);
    320static void dmfe_timer(struct timer_list *);
    321static inline u32 cal_CRC(unsigned char *, unsigned int, u8);
    322static void dmfe_rx_packet(struct net_device *, struct dmfe_board_info *);
    323static void dmfe_free_tx_pkt(struct net_device *, struct dmfe_board_info *);
    324static void dmfe_reuse_skb(struct dmfe_board_info *, struct sk_buff *);
    325static void dmfe_dynamic_reset(struct net_device *);
    326static void dmfe_free_rxbuffer(struct dmfe_board_info *);
    327static void dmfe_init_dm910x(struct net_device *);
    328static void dmfe_parse_srom(struct dmfe_board_info *);
    329static void dmfe_program_DM9801(struct dmfe_board_info *, int);
    330static void dmfe_program_DM9802(struct dmfe_board_info *);
    331static void dmfe_HPNA_remote_cmd_chk(struct dmfe_board_info * );
    332static void dmfe_set_phyxcer(struct dmfe_board_info *);
    333
    334/* DM910X network board routine ---------------------------- */
    335
    336static const struct net_device_ops netdev_ops = {
    337	.ndo_open 		= dmfe_open,
    338	.ndo_stop		= dmfe_stop,
    339	.ndo_start_xmit		= dmfe_start_xmit,
    340	.ndo_set_rx_mode	= dmfe_set_filter_mode,
    341	.ndo_set_mac_address	= eth_mac_addr,
    342	.ndo_validate_addr	= eth_validate_addr,
    343#ifdef CONFIG_NET_POLL_CONTROLLER
    344	.ndo_poll_controller	= poll_dmfe,
    345#endif
    346};
    347
    348/*
    349 *	Search DM910X board ,allocate space and register it
    350 */
    351
    352static int dmfe_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
    353{
    354	struct dmfe_board_info *db;	/* board information structure */
    355	struct net_device *dev;
    356	u32 pci_pmr;
    357	int i, err;
    358
    359	DMFE_DBUG(0, "dmfe_init_one()", 0);
    360
    361	/*
    362	 *	SPARC on-board DM910x chips should be handled by the main
    363	 *	tulip driver, except for early DM9100s.
    364	 */
    365#ifdef CONFIG_TULIP_DM910X
    366	if ((ent->driver_data == PCI_DM9100_ID && pdev->revision >= 0x30) ||
    367	    ent->driver_data == PCI_DM9102_ID) {
    368		struct device_node *dp = pci_device_to_OF_node(pdev);
    369
    370		if (dp && of_get_property(dp, "local-mac-address", NULL)) {
    371			pr_info("skipping on-board DM910x (use tulip)\n");
    372			return -ENODEV;
    373		}
    374	}
    375#endif
    376
    377	/* Init network device */
    378	dev = alloc_etherdev(sizeof(*db));
    379	if (dev == NULL)
    380		return -ENOMEM;
    381	SET_NETDEV_DEV(dev, &pdev->dev);
    382
    383	if (dma_set_mask(&pdev->dev, DMA_BIT_MASK(32))) {
    384		pr_warn("32-bit PCI DMA not available\n");
    385		err = -ENODEV;
    386		goto err_out_free;
    387	}
    388
    389	/* Enable Master/IO access, Disable memory access */
    390	err = pci_enable_device(pdev);
    391	if (err)
    392		goto err_out_free;
    393
    394	if (!pci_resource_start(pdev, 0)) {
    395		pr_err("I/O base is zero\n");
    396		err = -ENODEV;
    397		goto err_out_disable;
    398	}
    399
    400	if (pci_resource_len(pdev, 0) < (CHK_IO_SIZE(pdev)) ) {
    401		pr_err("Allocated I/O size too small\n");
    402		err = -ENODEV;
    403		goto err_out_disable;
    404	}
    405
    406#if 0	/* pci_{enable_device,set_master} sets minimum latency for us now */
    407
    408	/* Set Latency Timer 80h */
    409	/* FIXME: setting values > 32 breaks some SiS 559x stuff.
    410	   Need a PCI quirk.. */
    411
    412	pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x80);
    413#endif
    414
    415	if (pci_request_regions(pdev, DRV_NAME)) {
    416		pr_err("Failed to request PCI regions\n");
    417		err = -ENODEV;
    418		goto err_out_disable;
    419	}
    420
    421	/* Init system & device */
    422	db = netdev_priv(dev);
    423
    424	/* Allocate Tx/Rx descriptor memory */
    425	db->desc_pool_ptr = dma_alloc_coherent(&pdev->dev,
    426					       sizeof(struct tx_desc) * DESC_ALL_CNT + 0x20,
    427					       &db->desc_pool_dma_ptr, GFP_KERNEL);
    428	if (!db->desc_pool_ptr) {
    429		err = -ENOMEM;
    430		goto err_out_res;
    431	}
    432
    433	db->buf_pool_ptr = dma_alloc_coherent(&pdev->dev,
    434					      TX_BUF_ALLOC * TX_DESC_CNT + 4,
    435					      &db->buf_pool_dma_ptr, GFP_KERNEL);
    436	if (!db->buf_pool_ptr) {
    437		err = -ENOMEM;
    438		goto err_out_free_desc;
    439	}
    440
    441	db->first_tx_desc = (struct tx_desc *) db->desc_pool_ptr;
    442	db->first_tx_desc_dma = db->desc_pool_dma_ptr;
    443	db->buf_pool_start = db->buf_pool_ptr;
    444	db->buf_pool_dma_start = db->buf_pool_dma_ptr;
    445
    446	db->chip_id = ent->driver_data;
    447	/* IO type range. */
    448	db->ioaddr = pci_iomap(pdev, 0, 0);
    449	if (!db->ioaddr) {
    450		err = -ENOMEM;
    451		goto err_out_free_buf;
    452	}
    453
    454	db->chip_revision = pdev->revision;
    455	db->wol_mode = 0;
    456
    457	db->pdev = pdev;
    458
    459	pci_set_drvdata(pdev, dev);
    460	dev->netdev_ops = &netdev_ops;
    461	dev->ethtool_ops = &netdev_ethtool_ops;
    462	netif_carrier_off(dev);
    463	spin_lock_init(&db->lock);
    464
    465	pci_read_config_dword(pdev, 0x50, &pci_pmr);
    466	pci_pmr &= 0x70000;
    467	if ( (pci_pmr == 0x10000) && (db->chip_revision == 0x31) )
    468		db->chip_type = 1;	/* DM9102A E3 */
    469	else
    470		db->chip_type = 0;
    471
    472	/* read 64 word srom data */
    473	for (i = 0; i < 64; i++) {
    474		((__le16 *) db->srom)[i] =
    475			cpu_to_le16(read_srom_word(db->ioaddr, i));
    476	}
    477
    478	/* Set Node address */
    479	eth_hw_addr_set(dev, &db->srom[20]);
    480
    481	err = register_netdev (dev);
    482	if (err)
    483		goto err_out_unmap;
    484
    485	dev_info(&dev->dev, "Davicom DM%04lx at pci%s, %pM, irq %d\n",
    486		 ent->driver_data >> 16,
    487		 pci_name(pdev), dev->dev_addr, pdev->irq);
    488
    489	pci_set_master(pdev);
    490
    491	return 0;
    492
    493err_out_unmap:
    494	pci_iounmap(pdev, db->ioaddr);
    495err_out_free_buf:
    496	dma_free_coherent(&pdev->dev, TX_BUF_ALLOC * TX_DESC_CNT + 4,
    497			  db->buf_pool_ptr, db->buf_pool_dma_ptr);
    498err_out_free_desc:
    499	dma_free_coherent(&pdev->dev,
    500			  sizeof(struct tx_desc) * DESC_ALL_CNT + 0x20,
    501			  db->desc_pool_ptr, db->desc_pool_dma_ptr);
    502err_out_res:
    503	pci_release_regions(pdev);
    504err_out_disable:
    505	pci_disable_device(pdev);
    506err_out_free:
    507	free_netdev(dev);
    508
    509	return err;
    510}
    511
    512
    513static void dmfe_remove_one(struct pci_dev *pdev)
    514{
    515	struct net_device *dev = pci_get_drvdata(pdev);
    516	struct dmfe_board_info *db = netdev_priv(dev);
    517
    518	DMFE_DBUG(0, "dmfe_remove_one()", 0);
    519
    520	if (dev) {
    521
    522		unregister_netdev(dev);
    523		pci_iounmap(db->pdev, db->ioaddr);
    524		dma_free_coherent(&db->pdev->dev,
    525				  sizeof(struct tx_desc) * DESC_ALL_CNT + 0x20,
    526				  db->desc_pool_ptr, db->desc_pool_dma_ptr);
    527		dma_free_coherent(&db->pdev->dev,
    528				  TX_BUF_ALLOC * TX_DESC_CNT + 4,
    529				  db->buf_pool_ptr, db->buf_pool_dma_ptr);
    530		pci_release_regions(pdev);
    531		free_netdev(dev);	/* free board information */
    532	}
    533
    534	DMFE_DBUG(0, "dmfe_remove_one() exit", 0);
    535}
    536
    537
    538/*
    539 *	Open the interface.
    540 *	The interface is opened whenever "ifconfig" actives it.
    541 */
    542
    543static int dmfe_open(struct net_device *dev)
    544{
    545	struct dmfe_board_info *db = netdev_priv(dev);
    546	const int irq = db->pdev->irq;
    547	int ret;
    548
    549	DMFE_DBUG(0, "dmfe_open", 0);
    550
    551	ret = request_irq(irq, dmfe_interrupt, IRQF_SHARED, dev->name, dev);
    552	if (ret)
    553		return ret;
    554
    555	/* system variable init */
    556	db->cr6_data = CR6_DEFAULT | dmfe_cr6_user_set;
    557	db->tx_packet_cnt = 0;
    558	db->tx_queue_cnt = 0;
    559	db->rx_avail_cnt = 0;
    560	db->wait_reset = 0;
    561
    562	db->first_in_callback = 0;
    563	db->NIC_capability = 0xf;	/* All capability*/
    564	db->PHY_reg4 = 0x1e0;
    565
    566	/* CR6 operation mode decision */
    567	if ( !chkmode || (db->chip_id == PCI_DM9132_ID) ||
    568		(db->chip_revision >= 0x30) ) {
    569		db->cr6_data |= DMFE_TXTH_256;
    570		db->cr0_data = CR0_DEFAULT;
    571		db->dm910x_chk_mode=4;		/* Enter the normal mode */
    572	} else {
    573		db->cr6_data |= CR6_SFT;	/* Store & Forward mode */
    574		db->cr0_data = 0;
    575		db->dm910x_chk_mode = 1;	/* Enter the check mode */
    576	}
    577
    578	/* Initialize DM910X board */
    579	dmfe_init_dm910x(dev);
    580
    581	/* Active System Interface */
    582	netif_wake_queue(dev);
    583
    584	/* set and active a timer process */
    585	timer_setup(&db->timer, dmfe_timer, 0);
    586	db->timer.expires = DMFE_TIMER_WUT + HZ * 2;
    587	add_timer(&db->timer);
    588
    589	return 0;
    590}
    591
    592
    593/*	Initialize DM910X board
    594 *	Reset DM910X board
    595 *	Initialize TX/Rx descriptor chain structure
    596 *	Send the set-up frame
    597 *	Enable Tx/Rx machine
    598 */
    599
    600static void dmfe_init_dm910x(struct net_device *dev)
    601{
    602	struct dmfe_board_info *db = netdev_priv(dev);
    603	void __iomem *ioaddr = db->ioaddr;
    604
    605	DMFE_DBUG(0, "dmfe_init_dm910x()", 0);
    606
    607	/* Reset DM910x MAC controller */
    608	dw32(DCR0, DM910X_RESET);	/* RESET MAC */
    609	udelay(100);
    610	dw32(DCR0, db->cr0_data);
    611	udelay(5);
    612
    613	/* Phy addr : DM910(A)2/DM9132/9801, phy address = 1 */
    614	db->phy_addr = 1;
    615
    616	/* Parser SROM and media mode */
    617	dmfe_parse_srom(db);
    618	db->media_mode = dmfe_media_mode;
    619
    620	/* RESET Phyxcer Chip by GPR port bit 7 */
    621	dw32(DCR12, 0x180);		/* Let bit 7 output port */
    622	if (db->chip_id == PCI_DM9009_ID) {
    623		dw32(DCR12, 0x80);	/* Issue RESET signal */
    624		mdelay(300);			/* Delay 300 ms */
    625	}
    626	dw32(DCR12, 0x0);	/* Clear RESET signal */
    627
    628	/* Process Phyxcer Media Mode */
    629	if ( !(db->media_mode & 0x10) )	/* Force 1M mode */
    630		dmfe_set_phyxcer(db);
    631
    632	/* Media Mode Process */
    633	if ( !(db->media_mode & DMFE_AUTO) )
    634		db->op_mode = db->media_mode; 	/* Force Mode */
    635
    636	/* Initialize Transmit/Receive descriptor and CR3/4 */
    637	dmfe_descriptor_init(dev);
    638
    639	/* Init CR6 to program DM910x operation */
    640	update_cr6(db->cr6_data, ioaddr);
    641
    642	/* Send setup frame */
    643	if (db->chip_id == PCI_DM9132_ID)
    644		dm9132_id_table(dev);	/* DM9132 */
    645	else
    646		send_filter_frame(dev);	/* DM9102/DM9102A */
    647
    648	/* Init CR7, interrupt active bit */
    649	db->cr7_data = CR7_DEFAULT;
    650	dw32(DCR7, db->cr7_data);
    651
    652	/* Init CR15, Tx jabber and Rx watchdog timer */
    653	dw32(DCR15, db->cr15_data);
    654
    655	/* Enable DM910X Tx/Rx function */
    656	db->cr6_data |= CR6_RXSC | CR6_TXSC | 0x40000;
    657	update_cr6(db->cr6_data, ioaddr);
    658}
    659
    660
    661/*
    662 *	Hardware start transmission.
    663 *	Send a packet to media from the upper layer.
    664 */
    665
    666static netdev_tx_t dmfe_start_xmit(struct sk_buff *skb,
    667					 struct net_device *dev)
    668{
    669	struct dmfe_board_info *db = netdev_priv(dev);
    670	void __iomem *ioaddr = db->ioaddr;
    671	struct tx_desc *txptr;
    672	unsigned long flags;
    673
    674	DMFE_DBUG(0, "dmfe_start_xmit", 0);
    675
    676	/* Too large packet check */
    677	if (skb->len > MAX_PACKET_SIZE) {
    678		pr_err("big packet = %d\n", (u16)skb->len);
    679		dev_kfree_skb_any(skb);
    680		return NETDEV_TX_OK;
    681	}
    682
    683	/* Resource flag check */
    684	netif_stop_queue(dev);
    685
    686	spin_lock_irqsave(&db->lock, flags);
    687
    688	/* No Tx resource check, it never happen nromally */
    689	if (db->tx_queue_cnt >= TX_FREE_DESC_CNT) {
    690		spin_unlock_irqrestore(&db->lock, flags);
    691		pr_err("No Tx resource %ld\n", db->tx_queue_cnt);
    692		return NETDEV_TX_BUSY;
    693	}
    694
    695	/* Disable NIC interrupt */
    696	dw32(DCR7, 0);
    697
    698	/* transmit this packet */
    699	txptr = db->tx_insert_ptr;
    700	skb_copy_from_linear_data(skb, txptr->tx_buf_ptr, skb->len);
    701	txptr->tdes1 = cpu_to_le32(0xe1000000 | skb->len);
    702
    703	/* Point to next transmit free descriptor */
    704	db->tx_insert_ptr = txptr->next_tx_desc;
    705
    706	/* Transmit Packet Process */
    707	if ( (!db->tx_queue_cnt) && (db->tx_packet_cnt < TX_MAX_SEND_CNT) ) {
    708		txptr->tdes0 = cpu_to_le32(0x80000000);	/* Set owner bit */
    709		db->tx_packet_cnt++;			/* Ready to send */
    710		dw32(DCR1, 0x1);			/* Issue Tx polling */
    711		netif_trans_update(dev);		/* saved time stamp */
    712	} else {
    713		db->tx_queue_cnt++;			/* queue TX packet */
    714		dw32(DCR1, 0x1);			/* Issue Tx polling */
    715	}
    716
    717	/* Tx resource check */
    718	if ( db->tx_queue_cnt < TX_FREE_DESC_CNT )
    719		netif_wake_queue(dev);
    720
    721	/* Restore CR7 to enable interrupt */
    722	spin_unlock_irqrestore(&db->lock, flags);
    723	dw32(DCR7, db->cr7_data);
    724
    725	/* free this SKB */
    726	dev_consume_skb_any(skb);
    727
    728	return NETDEV_TX_OK;
    729}
    730
    731
    732/*
    733 *	Stop the interface.
    734 *	The interface is stopped when it is brought.
    735 */
    736
    737static int dmfe_stop(struct net_device *dev)
    738{
    739	struct dmfe_board_info *db = netdev_priv(dev);
    740	void __iomem *ioaddr = db->ioaddr;
    741
    742	DMFE_DBUG(0, "dmfe_stop", 0);
    743
    744	/* disable system */
    745	netif_stop_queue(dev);
    746
    747	/* deleted timer */
    748	del_timer_sync(&db->timer);
    749
    750	/* Reset & stop DM910X board */
    751	dw32(DCR0, DM910X_RESET);
    752	udelay(100);
    753	dmfe_phy_write(ioaddr, db->phy_addr, 0, 0x8000, db->chip_id);
    754
    755	/* free interrupt */
    756	free_irq(db->pdev->irq, dev);
    757
    758	/* free allocated rx buffer */
    759	dmfe_free_rxbuffer(db);
    760
    761#if 0
    762	/* show statistic counter */
    763	printk("FU:%lx EC:%lx LC:%lx NC:%lx LOC:%lx TXJT:%lx RESET:%lx RCR8:%lx FAL:%lx TT:%lx\n",
    764	       db->tx_fifo_underrun, db->tx_excessive_collision,
    765	       db->tx_late_collision, db->tx_no_carrier, db->tx_loss_carrier,
    766	       db->tx_jabber_timeout, db->reset_count, db->reset_cr8,
    767	       db->reset_fatal, db->reset_TXtimeout);
    768#endif
    769
    770	return 0;
    771}
    772
    773
    774/*
    775 *	DM9102 insterrupt handler
    776 *	receive the packet to upper layer, free the transmitted packet
    777 */
    778
    779static irqreturn_t dmfe_interrupt(int irq, void *dev_id)
    780{
    781	struct net_device *dev = dev_id;
    782	struct dmfe_board_info *db = netdev_priv(dev);
    783	void __iomem *ioaddr = db->ioaddr;
    784	unsigned long flags;
    785
    786	DMFE_DBUG(0, "dmfe_interrupt()", 0);
    787
    788	spin_lock_irqsave(&db->lock, flags);
    789
    790	/* Got DM910X status */
    791	db->cr5_data = dr32(DCR5);
    792	dw32(DCR5, db->cr5_data);
    793	if ( !(db->cr5_data & 0xc1) ) {
    794		spin_unlock_irqrestore(&db->lock, flags);
    795		return IRQ_HANDLED;
    796	}
    797
    798	/* Disable all interrupt in CR7 to solve the interrupt edge problem */
    799	dw32(DCR7, 0);
    800
    801	/* Check system status */
    802	if (db->cr5_data & 0x2000) {
    803		/* system bus error happen */
    804		DMFE_DBUG(1, "System bus error happen. CR5=", db->cr5_data);
    805		db->reset_fatal++;
    806		db->wait_reset = 1;	/* Need to RESET */
    807		spin_unlock_irqrestore(&db->lock, flags);
    808		return IRQ_HANDLED;
    809	}
    810
    811	 /* Received the coming packet */
    812	if ( (db->cr5_data & 0x40) && db->rx_avail_cnt )
    813		dmfe_rx_packet(dev, db);
    814
    815	/* reallocate rx descriptor buffer */
    816	if (db->rx_avail_cnt<RX_DESC_CNT)
    817		allocate_rx_buffer(dev);
    818
    819	/* Free the transmitted descriptor */
    820	if ( db->cr5_data & 0x01)
    821		dmfe_free_tx_pkt(dev, db);
    822
    823	/* Mode Check */
    824	if (db->dm910x_chk_mode & 0x2) {
    825		db->dm910x_chk_mode = 0x4;
    826		db->cr6_data |= 0x100;
    827		update_cr6(db->cr6_data, ioaddr);
    828	}
    829
    830	/* Restore CR7 to enable interrupt mask */
    831	dw32(DCR7, db->cr7_data);
    832
    833	spin_unlock_irqrestore(&db->lock, flags);
    834	return IRQ_HANDLED;
    835}
    836
    837
    838#ifdef CONFIG_NET_POLL_CONTROLLER
    839/*
    840 * Polling 'interrupt' - used by things like netconsole to send skbs
    841 * without having to re-enable interrupts. It's not called while
    842 * the interrupt routine is executing.
    843 */
    844
    845static void poll_dmfe (struct net_device *dev)
    846{
    847	struct dmfe_board_info *db = netdev_priv(dev);
    848	const int irq = db->pdev->irq;
    849
    850	/* disable_irq here is not very nice, but with the lockless
    851	   interrupt handler we have no other choice. */
    852	disable_irq(irq);
    853	dmfe_interrupt (irq, dev);
    854	enable_irq(irq);
    855}
    856#endif
    857
    858/*
    859 *	Free TX resource after TX complete
    860 */
    861
    862static void dmfe_free_tx_pkt(struct net_device *dev, struct dmfe_board_info *db)
    863{
    864	struct tx_desc *txptr;
    865	void __iomem *ioaddr = db->ioaddr;
    866	u32 tdes0;
    867
    868	txptr = db->tx_remove_ptr;
    869	while(db->tx_packet_cnt) {
    870		tdes0 = le32_to_cpu(txptr->tdes0);
    871		if (tdes0 & 0x80000000)
    872			break;
    873
    874		/* A packet sent completed */
    875		db->tx_packet_cnt--;
    876		dev->stats.tx_packets++;
    877
    878		/* Transmit statistic counter */
    879		if ( tdes0 != 0x7fffffff ) {
    880			dev->stats.collisions += (tdes0 >> 3) & 0xf;
    881			dev->stats.tx_bytes += le32_to_cpu(txptr->tdes1) & 0x7ff;
    882			if (tdes0 & TDES0_ERR_MASK) {
    883				dev->stats.tx_errors++;
    884
    885				if (tdes0 & 0x0002) {	/* UnderRun */
    886					db->tx_fifo_underrun++;
    887					if ( !(db->cr6_data & CR6_SFT) ) {
    888						db->cr6_data = db->cr6_data | CR6_SFT;
    889						update_cr6(db->cr6_data, ioaddr);
    890					}
    891				}
    892				if (tdes0 & 0x0100)
    893					db->tx_excessive_collision++;
    894				if (tdes0 & 0x0200)
    895					db->tx_late_collision++;
    896				if (tdes0 & 0x0400)
    897					db->tx_no_carrier++;
    898				if (tdes0 & 0x0800)
    899					db->tx_loss_carrier++;
    900				if (tdes0 & 0x4000)
    901					db->tx_jabber_timeout++;
    902			}
    903		}
    904
    905		txptr = txptr->next_tx_desc;
    906	}/* End of while */
    907
    908	/* Update TX remove pointer to next */
    909	db->tx_remove_ptr = txptr;
    910
    911	/* Send the Tx packet in queue */
    912	if ( (db->tx_packet_cnt < TX_MAX_SEND_CNT) && db->tx_queue_cnt ) {
    913		txptr->tdes0 = cpu_to_le32(0x80000000);	/* Set owner bit */
    914		db->tx_packet_cnt++;			/* Ready to send */
    915		db->tx_queue_cnt--;
    916		dw32(DCR1, 0x1);			/* Issue Tx polling */
    917		netif_trans_update(dev);		/* saved time stamp */
    918	}
    919
    920	/* Resource available check */
    921	if ( db->tx_queue_cnt < TX_WAKE_DESC_CNT )
    922		netif_wake_queue(dev);	/* Active upper layer, send again */
    923}
    924
    925
    926/*
    927 *	Calculate the CRC valude of the Rx packet
    928 *	flag = 	1 : return the reverse CRC (for the received packet CRC)
    929 *		0 : return the normal CRC (for Hash Table index)
    930 */
    931
    932static inline u32 cal_CRC(unsigned char * Data, unsigned int Len, u8 flag)
    933{
    934	u32 crc = crc32(~0, Data, Len);
    935	if (flag) crc = ~crc;
    936	return crc;
    937}
    938
    939
    940/*
    941 *	Receive the come packet and pass to upper layer
    942 */
    943
    944static void dmfe_rx_packet(struct net_device *dev, struct dmfe_board_info *db)
    945{
    946	struct rx_desc *rxptr;
    947	struct sk_buff *skb, *newskb;
    948	int rxlen;
    949	u32 rdes0;
    950
    951	rxptr = db->rx_ready_ptr;
    952
    953	while(db->rx_avail_cnt) {
    954		rdes0 = le32_to_cpu(rxptr->rdes0);
    955		if (rdes0 & 0x80000000)	/* packet owner check */
    956			break;
    957
    958		db->rx_avail_cnt--;
    959		db->interval_rx_cnt++;
    960
    961		dma_unmap_single(&db->pdev->dev, le32_to_cpu(rxptr->rdes2),
    962				 RX_ALLOC_SIZE, DMA_FROM_DEVICE);
    963
    964		if ( (rdes0 & 0x300) != 0x300) {
    965			/* A packet without First/Last flag */
    966			/* reuse this SKB */
    967			DMFE_DBUG(0, "Reuse SK buffer, rdes0", rdes0);
    968			dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
    969		} else {
    970			/* A packet with First/Last flag */
    971			rxlen = ( (rdes0 >> 16) & 0x3fff) - 4;
    972
    973			/* error summary bit check */
    974			if (rdes0 & 0x8000) {
    975				/* This is a error packet */
    976				dev->stats.rx_errors++;
    977				if (rdes0 & 1)
    978					dev->stats.rx_fifo_errors++;
    979				if (rdes0 & 2)
    980					dev->stats.rx_crc_errors++;
    981				if (rdes0 & 0x80)
    982					dev->stats.rx_length_errors++;
    983			}
    984
    985			if ( !(rdes0 & 0x8000) ||
    986				((db->cr6_data & CR6_PM) && (rxlen>6)) ) {
    987				skb = rxptr->rx_skb_ptr;
    988
    989				/* Received Packet CRC check need or not */
    990				if ( (db->dm910x_chk_mode & 1) &&
    991					(cal_CRC(skb->data, rxlen, 1) !=
    992					(*(u32 *) (skb->data+rxlen) ))) { /* FIXME (?) */
    993					/* Found a error received packet */
    994					dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
    995					db->dm910x_chk_mode = 3;
    996				} else {
    997					/* Good packet, send to upper layer */
    998					/* Shorst packet used new SKB */
    999					if ((rxlen < RX_COPY_SIZE) &&
   1000						((newskb = netdev_alloc_skb(dev, rxlen + 2))
   1001						!= NULL)) {
   1002
   1003						skb = newskb;
   1004						/* size less than COPY_SIZE, allocate a rxlen SKB */
   1005						skb_reserve(skb, 2); /* 16byte align */
   1006						skb_copy_from_linear_data(rxptr->rx_skb_ptr,
   1007							  skb_put(skb, rxlen),
   1008									  rxlen);
   1009						dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
   1010					} else
   1011						skb_put(skb, rxlen);
   1012
   1013					skb->protocol = eth_type_trans(skb, dev);
   1014					netif_rx(skb);
   1015					dev->stats.rx_packets++;
   1016					dev->stats.rx_bytes += rxlen;
   1017				}
   1018			} else {
   1019				/* Reuse SKB buffer when the packet is error */
   1020				DMFE_DBUG(0, "Reuse SK buffer, rdes0", rdes0);
   1021				dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
   1022			}
   1023		}
   1024
   1025		rxptr = rxptr->next_rx_desc;
   1026	}
   1027
   1028	db->rx_ready_ptr = rxptr;
   1029}
   1030
   1031/*
   1032 * Set DM910X multicast address
   1033 */
   1034
   1035static void dmfe_set_filter_mode(struct net_device *dev)
   1036{
   1037	struct dmfe_board_info *db = netdev_priv(dev);
   1038	unsigned long flags;
   1039	int mc_count = netdev_mc_count(dev);
   1040
   1041	DMFE_DBUG(0, "dmfe_set_filter_mode()", 0);
   1042	spin_lock_irqsave(&db->lock, flags);
   1043
   1044	if (dev->flags & IFF_PROMISC) {
   1045		DMFE_DBUG(0, "Enable PROM Mode", 0);
   1046		db->cr6_data |= CR6_PM | CR6_PBF;
   1047		update_cr6(db->cr6_data, db->ioaddr);
   1048		spin_unlock_irqrestore(&db->lock, flags);
   1049		return;
   1050	}
   1051
   1052	if (dev->flags & IFF_ALLMULTI || mc_count > DMFE_MAX_MULTICAST) {
   1053		DMFE_DBUG(0, "Pass all multicast address", mc_count);
   1054		db->cr6_data &= ~(CR6_PM | CR6_PBF);
   1055		db->cr6_data |= CR6_PAM;
   1056		spin_unlock_irqrestore(&db->lock, flags);
   1057		return;
   1058	}
   1059
   1060	DMFE_DBUG(0, "Set multicast address", mc_count);
   1061	if (db->chip_id == PCI_DM9132_ID)
   1062		dm9132_id_table(dev);	/* DM9132 */
   1063	else
   1064		send_filter_frame(dev);	/* DM9102/DM9102A */
   1065	spin_unlock_irqrestore(&db->lock, flags);
   1066}
   1067
   1068/*
   1069 * 	Ethtool interace
   1070 */
   1071
   1072static void dmfe_ethtool_get_drvinfo(struct net_device *dev,
   1073			       struct ethtool_drvinfo *info)
   1074{
   1075	struct dmfe_board_info *np = netdev_priv(dev);
   1076
   1077	strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
   1078	strlcpy(info->bus_info, pci_name(np->pdev), sizeof(info->bus_info));
   1079}
   1080
   1081static int dmfe_ethtool_set_wol(struct net_device *dev,
   1082				struct ethtool_wolinfo *wolinfo)
   1083{
   1084	struct dmfe_board_info *db = netdev_priv(dev);
   1085
   1086	if (wolinfo->wolopts & (WAKE_UCAST | WAKE_MCAST | WAKE_BCAST |
   1087		   		WAKE_ARP | WAKE_MAGICSECURE))
   1088		   return -EOPNOTSUPP;
   1089
   1090	db->wol_mode = wolinfo->wolopts;
   1091	return 0;
   1092}
   1093
   1094static void dmfe_ethtool_get_wol(struct net_device *dev,
   1095				 struct ethtool_wolinfo *wolinfo)
   1096{
   1097	struct dmfe_board_info *db = netdev_priv(dev);
   1098
   1099	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
   1100	wolinfo->wolopts = db->wol_mode;
   1101}
   1102
   1103
   1104static const struct ethtool_ops netdev_ethtool_ops = {
   1105	.get_drvinfo		= dmfe_ethtool_get_drvinfo,
   1106	.get_link               = ethtool_op_get_link,
   1107	.set_wol		= dmfe_ethtool_set_wol,
   1108	.get_wol		= dmfe_ethtool_get_wol,
   1109};
   1110
   1111/*
   1112 *	A periodic timer routine
   1113 *	Dynamic media sense, allocate Rx buffer...
   1114 */
   1115
   1116static void dmfe_timer(struct timer_list *t)
   1117{
   1118	struct dmfe_board_info *db = from_timer(db, t, timer);
   1119	struct net_device *dev = pci_get_drvdata(db->pdev);
   1120	void __iomem *ioaddr = db->ioaddr;
   1121	u32 tmp_cr8;
   1122	unsigned char tmp_cr12;
   1123	unsigned long flags;
   1124
   1125	int link_ok, link_ok_phy;
   1126
   1127	DMFE_DBUG(0, "dmfe_timer()", 0);
   1128	spin_lock_irqsave(&db->lock, flags);
   1129
   1130	/* Media mode process when Link OK before enter this route */
   1131	if (db->first_in_callback == 0) {
   1132		db->first_in_callback = 1;
   1133		if (db->chip_type && (db->chip_id==PCI_DM9102_ID)) {
   1134			db->cr6_data &= ~0x40000;
   1135			update_cr6(db->cr6_data, ioaddr);
   1136			dmfe_phy_write(ioaddr, db->phy_addr, 0, 0x1000, db->chip_id);
   1137			db->cr6_data |= 0x40000;
   1138			update_cr6(db->cr6_data, ioaddr);
   1139			db->timer.expires = DMFE_TIMER_WUT + HZ * 2;
   1140			add_timer(&db->timer);
   1141			spin_unlock_irqrestore(&db->lock, flags);
   1142			return;
   1143		}
   1144	}
   1145
   1146
   1147	/* Operating Mode Check */
   1148	if ( (db->dm910x_chk_mode & 0x1) &&
   1149		(dev->stats.rx_packets > MAX_CHECK_PACKET) )
   1150		db->dm910x_chk_mode = 0x4;
   1151
   1152	/* Dynamic reset DM910X : system error or transmit time-out */
   1153	tmp_cr8 = dr32(DCR8);
   1154	if ( (db->interval_rx_cnt==0) && (tmp_cr8) ) {
   1155		db->reset_cr8++;
   1156		db->wait_reset = 1;
   1157	}
   1158	db->interval_rx_cnt = 0;
   1159
   1160	/* TX polling kick monitor */
   1161	if ( db->tx_packet_cnt &&
   1162	     time_after(jiffies, dev_trans_start(dev) + DMFE_TX_KICK) ) {
   1163		dw32(DCR1, 0x1);   /* Tx polling again */
   1164
   1165		/* TX Timeout */
   1166		if (time_after(jiffies, dev_trans_start(dev) + DMFE_TX_TIMEOUT) ) {
   1167			db->reset_TXtimeout++;
   1168			db->wait_reset = 1;
   1169			dev_warn(&dev->dev, "Tx timeout - resetting\n");
   1170		}
   1171	}
   1172
   1173	if (db->wait_reset) {
   1174		DMFE_DBUG(0, "Dynamic Reset device", db->tx_packet_cnt);
   1175		db->reset_count++;
   1176		dmfe_dynamic_reset(dev);
   1177		db->first_in_callback = 0;
   1178		db->timer.expires = DMFE_TIMER_WUT;
   1179		add_timer(&db->timer);
   1180		spin_unlock_irqrestore(&db->lock, flags);
   1181		return;
   1182	}
   1183
   1184	/* Link status check, Dynamic media type change */
   1185	if (db->chip_id == PCI_DM9132_ID)
   1186		tmp_cr12 = dr8(DCR9 + 3);	/* DM9132 */
   1187	else
   1188		tmp_cr12 = dr8(DCR12);		/* DM9102/DM9102A */
   1189
   1190	if ( ((db->chip_id == PCI_DM9102_ID) &&
   1191		(db->chip_revision == 0x30)) ||
   1192		((db->chip_id == PCI_DM9132_ID) &&
   1193		(db->chip_revision == 0x10)) ) {
   1194		/* DM9102A Chip */
   1195		if (tmp_cr12 & 2)
   1196			link_ok = 0;
   1197		else
   1198			link_ok = 1;
   1199	}
   1200	else
   1201		/*0x43 is used instead of 0x3 because bit 6 should represent
   1202			link status of external PHY */
   1203		link_ok = (tmp_cr12 & 0x43) ? 1 : 0;
   1204
   1205
   1206	/* If chip reports that link is failed it could be because external
   1207		PHY link status pin is not connected correctly to chip
   1208		To be sure ask PHY too.
   1209	*/
   1210
   1211	/* need a dummy read because of PHY's register latch*/
   1212	dmfe_phy_read (db->ioaddr, db->phy_addr, 1, db->chip_id);
   1213	link_ok_phy = (dmfe_phy_read (db->ioaddr,
   1214				      db->phy_addr, 1, db->chip_id) & 0x4) ? 1 : 0;
   1215
   1216	if (link_ok_phy != link_ok) {
   1217		DMFE_DBUG (0, "PHY and chip report different link status", 0);
   1218		link_ok = link_ok | link_ok_phy;
   1219	}
   1220
   1221	if ( !link_ok && netif_carrier_ok(dev)) {
   1222		/* Link Failed */
   1223		DMFE_DBUG(0, "Link Failed", tmp_cr12);
   1224		netif_carrier_off(dev);
   1225
   1226		/* For Force 10/100M Half/Full mode: Enable Auto-Nego mode */
   1227		/* AUTO or force 1M Homerun/Longrun don't need */
   1228		if ( !(db->media_mode & 0x38) )
   1229			dmfe_phy_write(db->ioaddr, db->phy_addr,
   1230				       0, 0x1000, db->chip_id);
   1231
   1232		/* AUTO mode, if INT phyxcer link failed, select EXT device */
   1233		if (db->media_mode & DMFE_AUTO) {
   1234			/* 10/100M link failed, used 1M Home-Net */
   1235			db->cr6_data|=0x00040000;	/* bit18=1, MII */
   1236			db->cr6_data&=~0x00000200;	/* bit9=0, HD mode */
   1237			update_cr6(db->cr6_data, ioaddr);
   1238		}
   1239	} else if (!netif_carrier_ok(dev)) {
   1240
   1241		DMFE_DBUG(0, "Link link OK", tmp_cr12);
   1242
   1243		/* Auto Sense Speed */
   1244		if ( !(db->media_mode & DMFE_AUTO) || !dmfe_sense_speed(db)) {
   1245			netif_carrier_on(dev);
   1246			SHOW_MEDIA_TYPE(db->op_mode);
   1247		}
   1248
   1249		dmfe_process_mode(db);
   1250	}
   1251
   1252	/* HPNA remote command check */
   1253	if (db->HPNA_command & 0xf00) {
   1254		db->HPNA_timer--;
   1255		if (!db->HPNA_timer)
   1256			dmfe_HPNA_remote_cmd_chk(db);
   1257	}
   1258
   1259	/* Timer active again */
   1260	db->timer.expires = DMFE_TIMER_WUT;
   1261	add_timer(&db->timer);
   1262	spin_unlock_irqrestore(&db->lock, flags);
   1263}
   1264
   1265
   1266/*
   1267 *	Dynamic reset the DM910X board
   1268 *	Stop DM910X board
   1269 *	Free Tx/Rx allocated memory
   1270 *	Reset DM910X board
   1271 *	Re-initialize DM910X board
   1272 */
   1273
   1274static void dmfe_dynamic_reset(struct net_device *dev)
   1275{
   1276	struct dmfe_board_info *db = netdev_priv(dev);
   1277	void __iomem *ioaddr = db->ioaddr;
   1278
   1279	DMFE_DBUG(0, "dmfe_dynamic_reset()", 0);
   1280
   1281	/* Sopt MAC controller */
   1282	db->cr6_data &= ~(CR6_RXSC | CR6_TXSC);	/* Disable Tx/Rx */
   1283	update_cr6(db->cr6_data, ioaddr);
   1284	dw32(DCR7, 0);				/* Disable Interrupt */
   1285	dw32(DCR5, dr32(DCR5));
   1286
   1287	/* Disable upper layer interface */
   1288	netif_stop_queue(dev);
   1289
   1290	/* Free Rx Allocate buffer */
   1291	dmfe_free_rxbuffer(db);
   1292
   1293	/* system variable init */
   1294	db->tx_packet_cnt = 0;
   1295	db->tx_queue_cnt = 0;
   1296	db->rx_avail_cnt = 0;
   1297	netif_carrier_off(dev);
   1298	db->wait_reset = 0;
   1299
   1300	/* Re-initialize DM910X board */
   1301	dmfe_init_dm910x(dev);
   1302
   1303	/* Restart upper layer interface */
   1304	netif_wake_queue(dev);
   1305}
   1306
   1307
   1308/*
   1309 *	free all allocated rx buffer
   1310 */
   1311
   1312static void dmfe_free_rxbuffer(struct dmfe_board_info * db)
   1313{
   1314	DMFE_DBUG(0, "dmfe_free_rxbuffer()", 0);
   1315
   1316	/* free allocated rx buffer */
   1317	while (db->rx_avail_cnt) {
   1318		dev_kfree_skb(db->rx_ready_ptr->rx_skb_ptr);
   1319		db->rx_ready_ptr = db->rx_ready_ptr->next_rx_desc;
   1320		db->rx_avail_cnt--;
   1321	}
   1322}
   1323
   1324
   1325/*
   1326 *	Reuse the SK buffer
   1327 */
   1328
   1329static void dmfe_reuse_skb(struct dmfe_board_info *db, struct sk_buff * skb)
   1330{
   1331	struct rx_desc *rxptr = db->rx_insert_ptr;
   1332
   1333	if (!(rxptr->rdes0 & cpu_to_le32(0x80000000))) {
   1334		rxptr->rx_skb_ptr = skb;
   1335		rxptr->rdes2 = cpu_to_le32(dma_map_single(&db->pdev->dev, skb->data,
   1336							  RX_ALLOC_SIZE, DMA_FROM_DEVICE));
   1337		wmb();
   1338		rxptr->rdes0 = cpu_to_le32(0x80000000);
   1339		db->rx_avail_cnt++;
   1340		db->rx_insert_ptr = rxptr->next_rx_desc;
   1341	} else
   1342		DMFE_DBUG(0, "SK Buffer reuse method error", db->rx_avail_cnt);
   1343}
   1344
   1345
   1346/*
   1347 *	Initialize transmit/Receive descriptor
   1348 *	Using Chain structure, and allocate Tx/Rx buffer
   1349 */
   1350
   1351static void dmfe_descriptor_init(struct net_device *dev)
   1352{
   1353	struct dmfe_board_info *db = netdev_priv(dev);
   1354	void __iomem *ioaddr = db->ioaddr;
   1355	struct tx_desc *tmp_tx;
   1356	struct rx_desc *tmp_rx;
   1357	unsigned char *tmp_buf;
   1358	dma_addr_t tmp_tx_dma, tmp_rx_dma;
   1359	dma_addr_t tmp_buf_dma;
   1360	int i;
   1361
   1362	DMFE_DBUG(0, "dmfe_descriptor_init()", 0);
   1363
   1364	/* tx descriptor start pointer */
   1365	db->tx_insert_ptr = db->first_tx_desc;
   1366	db->tx_remove_ptr = db->first_tx_desc;
   1367	dw32(DCR4, db->first_tx_desc_dma);     /* TX DESC address */
   1368
   1369	/* rx descriptor start pointer */
   1370	db->first_rx_desc = (void *)db->first_tx_desc +
   1371			sizeof(struct tx_desc) * TX_DESC_CNT;
   1372
   1373	db->first_rx_desc_dma =  db->first_tx_desc_dma +
   1374			sizeof(struct tx_desc) * TX_DESC_CNT;
   1375	db->rx_insert_ptr = db->first_rx_desc;
   1376	db->rx_ready_ptr = db->first_rx_desc;
   1377	dw32(DCR3, db->first_rx_desc_dma);		/* RX DESC address */
   1378
   1379	/* Init Transmit chain */
   1380	tmp_buf = db->buf_pool_start;
   1381	tmp_buf_dma = db->buf_pool_dma_start;
   1382	tmp_tx_dma = db->first_tx_desc_dma;
   1383	for (tmp_tx = db->first_tx_desc, i = 0; i < TX_DESC_CNT; i++, tmp_tx++) {
   1384		tmp_tx->tx_buf_ptr = tmp_buf;
   1385		tmp_tx->tdes0 = cpu_to_le32(0);
   1386		tmp_tx->tdes1 = cpu_to_le32(0x81000000);	/* IC, chain */
   1387		tmp_tx->tdes2 = cpu_to_le32(tmp_buf_dma);
   1388		tmp_tx_dma += sizeof(struct tx_desc);
   1389		tmp_tx->tdes3 = cpu_to_le32(tmp_tx_dma);
   1390		tmp_tx->next_tx_desc = tmp_tx + 1;
   1391		tmp_buf = tmp_buf + TX_BUF_ALLOC;
   1392		tmp_buf_dma = tmp_buf_dma + TX_BUF_ALLOC;
   1393	}
   1394	(--tmp_tx)->tdes3 = cpu_to_le32(db->first_tx_desc_dma);
   1395	tmp_tx->next_tx_desc = db->first_tx_desc;
   1396
   1397	 /* Init Receive descriptor chain */
   1398	tmp_rx_dma=db->first_rx_desc_dma;
   1399	for (tmp_rx = db->first_rx_desc, i = 0; i < RX_DESC_CNT; i++, tmp_rx++) {
   1400		tmp_rx->rdes0 = cpu_to_le32(0);
   1401		tmp_rx->rdes1 = cpu_to_le32(0x01000600);
   1402		tmp_rx_dma += sizeof(struct rx_desc);
   1403		tmp_rx->rdes3 = cpu_to_le32(tmp_rx_dma);
   1404		tmp_rx->next_rx_desc = tmp_rx + 1;
   1405	}
   1406	(--tmp_rx)->rdes3 = cpu_to_le32(db->first_rx_desc_dma);
   1407	tmp_rx->next_rx_desc = db->first_rx_desc;
   1408
   1409	/* pre-allocate Rx buffer */
   1410	allocate_rx_buffer(dev);
   1411}
   1412
   1413
   1414/*
   1415 *	Update CR6 value
   1416 *	Firstly stop DM910X , then written value and start
   1417 */
   1418
   1419static void update_cr6(u32 cr6_data, void __iomem *ioaddr)
   1420{
   1421	u32 cr6_tmp;
   1422
   1423	cr6_tmp = cr6_data & ~0x2002;           /* stop Tx/Rx */
   1424	dw32(DCR6, cr6_tmp);
   1425	udelay(5);
   1426	dw32(DCR6, cr6_data);
   1427	udelay(5);
   1428}
   1429
   1430
   1431/*
   1432 *	Send a setup frame for DM9132
   1433 *	This setup frame initialize DM910X address filter mode
   1434*/
   1435
   1436static void dm9132_id_table(struct net_device *dev)
   1437{
   1438	const u16 *addrptr = (const u16 *)dev->dev_addr;
   1439	struct dmfe_board_info *db = netdev_priv(dev);
   1440	void __iomem *ioaddr = db->ioaddr + 0xc0;
   1441	struct netdev_hw_addr *ha;
   1442	u16 i, hash_table[4];
   1443
   1444	/* Node address */
   1445	for (i = 0; i < 3; i++) {
   1446		dw16(0, addrptr[i]);
   1447		ioaddr += 4;
   1448	}
   1449
   1450	/* Clear Hash Table */
   1451	memset(hash_table, 0, sizeof(hash_table));
   1452
   1453	/* broadcast address */
   1454	hash_table[3] = 0x8000;
   1455
   1456	/* the multicast address in Hash Table : 64 bits */
   1457	netdev_for_each_mc_addr(ha, dev) {
   1458		u32 hash_val = cal_CRC((char *)ha->addr, 6, 0) & 0x3f;
   1459
   1460		hash_table[hash_val / 16] |= (u16) 1 << (hash_val % 16);
   1461	}
   1462
   1463	/* Write the hash table to MAC MD table */
   1464	for (i = 0; i < 4; i++, ioaddr += 4)
   1465		dw16(0, hash_table[i]);
   1466}
   1467
   1468
   1469/*
   1470 *	Send a setup frame for DM9102/DM9102A
   1471 *	This setup frame initialize DM910X address filter mode
   1472 */
   1473
   1474static void send_filter_frame(struct net_device *dev)
   1475{
   1476	struct dmfe_board_info *db = netdev_priv(dev);
   1477	struct netdev_hw_addr *ha;
   1478	struct tx_desc *txptr;
   1479	const u16 * addrptr;
   1480	u32 * suptr;
   1481	int i;
   1482
   1483	DMFE_DBUG(0, "send_filter_frame()", 0);
   1484
   1485	txptr = db->tx_insert_ptr;
   1486	suptr = (u32 *) txptr->tx_buf_ptr;
   1487
   1488	/* Node address */
   1489	addrptr = (const u16 *) dev->dev_addr;
   1490	*suptr++ = addrptr[0];
   1491	*suptr++ = addrptr[1];
   1492	*suptr++ = addrptr[2];
   1493
   1494	/* broadcast address */
   1495	*suptr++ = 0xffff;
   1496	*suptr++ = 0xffff;
   1497	*suptr++ = 0xffff;
   1498
   1499	/* fit the multicast address */
   1500	netdev_for_each_mc_addr(ha, dev) {
   1501		addrptr = (u16 *) ha->addr;
   1502		*suptr++ = addrptr[0];
   1503		*suptr++ = addrptr[1];
   1504		*suptr++ = addrptr[2];
   1505	}
   1506
   1507	for (i = netdev_mc_count(dev); i < 14; i++) {
   1508		*suptr++ = 0xffff;
   1509		*suptr++ = 0xffff;
   1510		*suptr++ = 0xffff;
   1511	}
   1512
   1513	/* prepare the setup frame */
   1514	db->tx_insert_ptr = txptr->next_tx_desc;
   1515	txptr->tdes1 = cpu_to_le32(0x890000c0);
   1516
   1517	/* Resource Check and Send the setup packet */
   1518	if (!db->tx_packet_cnt) {
   1519		void __iomem *ioaddr = db->ioaddr;
   1520
   1521		/* Resource Empty */
   1522		db->tx_packet_cnt++;
   1523		txptr->tdes0 = cpu_to_le32(0x80000000);
   1524		update_cr6(db->cr6_data | 0x2000, ioaddr);
   1525		dw32(DCR1, 0x1);	/* Issue Tx polling */
   1526		update_cr6(db->cr6_data, ioaddr);
   1527		netif_trans_update(dev);
   1528	} else
   1529		db->tx_queue_cnt++;	/* Put in TX queue */
   1530}
   1531
   1532
   1533/*
   1534 *	Allocate rx buffer,
   1535 *	As possible as allocate maxiumn Rx buffer
   1536 */
   1537
   1538static void allocate_rx_buffer(struct net_device *dev)
   1539{
   1540	struct dmfe_board_info *db = netdev_priv(dev);
   1541	struct rx_desc *rxptr;
   1542	struct sk_buff *skb;
   1543
   1544	rxptr = db->rx_insert_ptr;
   1545
   1546	while(db->rx_avail_cnt < RX_DESC_CNT) {
   1547		if ( ( skb = netdev_alloc_skb(dev, RX_ALLOC_SIZE) ) == NULL )
   1548			break;
   1549		rxptr->rx_skb_ptr = skb; /* FIXME (?) */
   1550		rxptr->rdes2 = cpu_to_le32(dma_map_single(&db->pdev->dev, skb->data,
   1551							  RX_ALLOC_SIZE, DMA_FROM_DEVICE));
   1552		wmb();
   1553		rxptr->rdes0 = cpu_to_le32(0x80000000);
   1554		rxptr = rxptr->next_rx_desc;
   1555		db->rx_avail_cnt++;
   1556	}
   1557
   1558	db->rx_insert_ptr = rxptr;
   1559}
   1560
   1561static void srom_clk_write(void __iomem *ioaddr, u32 data)
   1562{
   1563	static const u32 cmd[] = {
   1564		CR9_SROM_READ | CR9_SRCS,
   1565		CR9_SROM_READ | CR9_SRCS | CR9_SRCLK,
   1566		CR9_SROM_READ | CR9_SRCS
   1567	};
   1568	int i;
   1569
   1570	for (i = 0; i < ARRAY_SIZE(cmd); i++) {
   1571		dw32(DCR9, data | cmd[i]);
   1572		udelay(5);
   1573	}
   1574}
   1575
   1576/*
   1577 *	Read one word data from the serial ROM
   1578 */
   1579static u16 read_srom_word(void __iomem *ioaddr, int offset)
   1580{
   1581	u16 srom_data;
   1582	int i;
   1583
   1584	dw32(DCR9, CR9_SROM_READ);
   1585	udelay(5);
   1586	dw32(DCR9, CR9_SROM_READ | CR9_SRCS);
   1587	udelay(5);
   1588
   1589	/* Send the Read Command 110b */
   1590	srom_clk_write(ioaddr, SROM_DATA_1);
   1591	srom_clk_write(ioaddr, SROM_DATA_1);
   1592	srom_clk_write(ioaddr, SROM_DATA_0);
   1593
   1594	/* Send the offset */
   1595	for (i = 5; i >= 0; i--) {
   1596		srom_data = (offset & (1 << i)) ? SROM_DATA_1 : SROM_DATA_0;
   1597		srom_clk_write(ioaddr, srom_data);
   1598	}
   1599
   1600	dw32(DCR9, CR9_SROM_READ | CR9_SRCS);
   1601	udelay(5);
   1602
   1603	for (i = 16; i > 0; i--) {
   1604		dw32(DCR9, CR9_SROM_READ | CR9_SRCS | CR9_SRCLK);
   1605		udelay(5);
   1606		srom_data = (srom_data << 1) |
   1607				((dr32(DCR9) & CR9_CRDOUT) ? 1 : 0);
   1608		dw32(DCR9, CR9_SROM_READ | CR9_SRCS);
   1609		udelay(5);
   1610	}
   1611
   1612	dw32(DCR9, CR9_SROM_READ);
   1613	udelay(5);
   1614	return srom_data;
   1615}
   1616
   1617
   1618/*
   1619 *	Auto sense the media mode
   1620 */
   1621
   1622static u8 dmfe_sense_speed(struct dmfe_board_info *db)
   1623{
   1624	void __iomem *ioaddr = db->ioaddr;
   1625	u8 ErrFlag = 0;
   1626	u16 phy_mode;
   1627
   1628	/* CR6 bit18=0, select 10/100M */
   1629	update_cr6(db->cr6_data & ~0x40000, ioaddr);
   1630
   1631	phy_mode = dmfe_phy_read(db->ioaddr, db->phy_addr, 1, db->chip_id);
   1632	phy_mode = dmfe_phy_read(db->ioaddr, db->phy_addr, 1, db->chip_id);
   1633
   1634	if ( (phy_mode & 0x24) == 0x24 ) {
   1635		if (db->chip_id == PCI_DM9132_ID)	/* DM9132 */
   1636			phy_mode = dmfe_phy_read(db->ioaddr,
   1637						 db->phy_addr, 7, db->chip_id) & 0xf000;
   1638		else 				/* DM9102/DM9102A */
   1639			phy_mode = dmfe_phy_read(db->ioaddr,
   1640						 db->phy_addr, 17, db->chip_id) & 0xf000;
   1641		switch (phy_mode) {
   1642		case 0x1000: db->op_mode = DMFE_10MHF; break;
   1643		case 0x2000: db->op_mode = DMFE_10MFD; break;
   1644		case 0x4000: db->op_mode = DMFE_100MHF; break;
   1645		case 0x8000: db->op_mode = DMFE_100MFD; break;
   1646		default: db->op_mode = DMFE_10MHF;
   1647			ErrFlag = 1;
   1648			break;
   1649		}
   1650	} else {
   1651		db->op_mode = DMFE_10MHF;
   1652		DMFE_DBUG(0, "Link Failed :", phy_mode);
   1653		ErrFlag = 1;
   1654	}
   1655
   1656	return ErrFlag;
   1657}
   1658
   1659
   1660/*
   1661 *	Set 10/100 phyxcer capability
   1662 *	AUTO mode : phyxcer register4 is NIC capability
   1663 *	Force mode: phyxcer register4 is the force media
   1664 */
   1665
   1666static void dmfe_set_phyxcer(struct dmfe_board_info *db)
   1667{
   1668	void __iomem *ioaddr = db->ioaddr;
   1669	u16 phy_reg;
   1670
   1671	/* Select 10/100M phyxcer */
   1672	db->cr6_data &= ~0x40000;
   1673	update_cr6(db->cr6_data, ioaddr);
   1674
   1675	/* DM9009 Chip: Phyxcer reg18 bit12=0 */
   1676	if (db->chip_id == PCI_DM9009_ID) {
   1677		phy_reg = dmfe_phy_read(db->ioaddr,
   1678					db->phy_addr, 18, db->chip_id) & ~0x1000;
   1679
   1680		dmfe_phy_write(db->ioaddr,
   1681			       db->phy_addr, 18, phy_reg, db->chip_id);
   1682	}
   1683
   1684	/* Phyxcer capability setting */
   1685	phy_reg = dmfe_phy_read(db->ioaddr, db->phy_addr, 4, db->chip_id) & ~0x01e0;
   1686
   1687	if (db->media_mode & DMFE_AUTO) {
   1688		/* AUTO Mode */
   1689		phy_reg |= db->PHY_reg4;
   1690	} else {
   1691		/* Force Mode */
   1692		switch(db->media_mode) {
   1693		case DMFE_10MHF: phy_reg |= 0x20; break;
   1694		case DMFE_10MFD: phy_reg |= 0x40; break;
   1695		case DMFE_100MHF: phy_reg |= 0x80; break;
   1696		case DMFE_100MFD: phy_reg |= 0x100; break;
   1697		}
   1698		if (db->chip_id == PCI_DM9009_ID) phy_reg &= 0x61;
   1699	}
   1700
   1701	/* Write new capability to Phyxcer Reg4 */
   1702	if ( !(phy_reg & 0x01e0)) {
   1703		phy_reg|=db->PHY_reg4;
   1704		db->media_mode|=DMFE_AUTO;
   1705	}
   1706	dmfe_phy_write(db->ioaddr, db->phy_addr, 4, phy_reg, db->chip_id);
   1707
   1708	/* Restart Auto-Negotiation */
   1709	if ( db->chip_type && (db->chip_id == PCI_DM9102_ID) )
   1710		dmfe_phy_write(db->ioaddr, db->phy_addr, 0, 0x1800, db->chip_id);
   1711	if ( !db->chip_type )
   1712		dmfe_phy_write(db->ioaddr, db->phy_addr, 0, 0x1200, db->chip_id);
   1713}
   1714
   1715
   1716/*
   1717 *	Process op-mode
   1718 *	AUTO mode : PHY controller in Auto-negotiation Mode
   1719 *	Force mode: PHY controller in force mode with HUB
   1720 *			N-way force capability with SWITCH
   1721 */
   1722
   1723static void dmfe_process_mode(struct dmfe_board_info *db)
   1724{
   1725	u16 phy_reg;
   1726
   1727	/* Full Duplex Mode Check */
   1728	if (db->op_mode & 0x4)
   1729		db->cr6_data |= CR6_FDM;	/* Set Full Duplex Bit */
   1730	else
   1731		db->cr6_data &= ~CR6_FDM;	/* Clear Full Duplex Bit */
   1732
   1733	/* Transciver Selection */
   1734	if (db->op_mode & 0x10)		/* 1M HomePNA */
   1735		db->cr6_data |= 0x40000;/* External MII select */
   1736	else
   1737		db->cr6_data &= ~0x40000;/* Internal 10/100 transciver */
   1738
   1739	update_cr6(db->cr6_data, db->ioaddr);
   1740
   1741	/* 10/100M phyxcer force mode need */
   1742	if ( !(db->media_mode & 0x18)) {
   1743		/* Forece Mode */
   1744		phy_reg = dmfe_phy_read(db->ioaddr, db->phy_addr, 6, db->chip_id);
   1745		if ( !(phy_reg & 0x1) ) {
   1746			/* parter without N-Way capability */
   1747			phy_reg = 0x0;
   1748			switch(db->op_mode) {
   1749			case DMFE_10MHF: phy_reg = 0x0; break;
   1750			case DMFE_10MFD: phy_reg = 0x100; break;
   1751			case DMFE_100MHF: phy_reg = 0x2000; break;
   1752			case DMFE_100MFD: phy_reg = 0x2100; break;
   1753			}
   1754			dmfe_phy_write(db->ioaddr,
   1755				       db->phy_addr, 0, phy_reg, db->chip_id);
   1756			if ( db->chip_type && (db->chip_id == PCI_DM9102_ID) )
   1757				mdelay(20);
   1758			dmfe_phy_write(db->ioaddr,
   1759				       db->phy_addr, 0, phy_reg, db->chip_id);
   1760		}
   1761	}
   1762}
   1763
   1764
   1765/*
   1766 *	Write a word to Phy register
   1767 */
   1768
   1769static void dmfe_phy_write(void __iomem *ioaddr, u8 phy_addr, u8 offset,
   1770			   u16 phy_data, u32 chip_id)
   1771{
   1772	u16 i;
   1773
   1774	if (chip_id == PCI_DM9132_ID) {
   1775		dw16(0x80 + offset * 4, phy_data);
   1776	} else {
   1777		/* DM9102/DM9102A Chip */
   1778
   1779		/* Send 33 synchronization clock to Phy controller */
   1780		for (i = 0; i < 35; i++)
   1781			dmfe_phy_write_1bit(ioaddr, PHY_DATA_1);
   1782
   1783		/* Send start command(01) to Phy */
   1784		dmfe_phy_write_1bit(ioaddr, PHY_DATA_0);
   1785		dmfe_phy_write_1bit(ioaddr, PHY_DATA_1);
   1786
   1787		/* Send write command(01) to Phy */
   1788		dmfe_phy_write_1bit(ioaddr, PHY_DATA_0);
   1789		dmfe_phy_write_1bit(ioaddr, PHY_DATA_1);
   1790
   1791		/* Send Phy address */
   1792		for (i = 0x10; i > 0; i = i >> 1)
   1793			dmfe_phy_write_1bit(ioaddr,
   1794					    phy_addr & i ? PHY_DATA_1 : PHY_DATA_0);
   1795
   1796		/* Send register address */
   1797		for (i = 0x10; i > 0; i = i >> 1)
   1798			dmfe_phy_write_1bit(ioaddr,
   1799					    offset & i ? PHY_DATA_1 : PHY_DATA_0);
   1800
   1801		/* written trasnition */
   1802		dmfe_phy_write_1bit(ioaddr, PHY_DATA_1);
   1803		dmfe_phy_write_1bit(ioaddr, PHY_DATA_0);
   1804
   1805		/* Write a word data to PHY controller */
   1806		for ( i = 0x8000; i > 0; i >>= 1)
   1807			dmfe_phy_write_1bit(ioaddr,
   1808					    phy_data & i ? PHY_DATA_1 : PHY_DATA_0);
   1809	}
   1810}
   1811
   1812
   1813/*
   1814 *	Read a word data from phy register
   1815 */
   1816
   1817static u16 dmfe_phy_read(void __iomem *ioaddr, u8 phy_addr, u8 offset, u32 chip_id)
   1818{
   1819	int i;
   1820	u16 phy_data;
   1821
   1822	if (chip_id == PCI_DM9132_ID) {
   1823		/* DM9132 Chip */
   1824		phy_data = dr16(0x80 + offset * 4);
   1825	} else {
   1826		/* DM9102/DM9102A Chip */
   1827
   1828		/* Send 33 synchronization clock to Phy controller */
   1829		for (i = 0; i < 35; i++)
   1830			dmfe_phy_write_1bit(ioaddr, PHY_DATA_1);
   1831
   1832		/* Send start command(01) to Phy */
   1833		dmfe_phy_write_1bit(ioaddr, PHY_DATA_0);
   1834		dmfe_phy_write_1bit(ioaddr, PHY_DATA_1);
   1835
   1836		/* Send read command(10) to Phy */
   1837		dmfe_phy_write_1bit(ioaddr, PHY_DATA_1);
   1838		dmfe_phy_write_1bit(ioaddr, PHY_DATA_0);
   1839
   1840		/* Send Phy address */
   1841		for (i = 0x10; i > 0; i = i >> 1)
   1842			dmfe_phy_write_1bit(ioaddr,
   1843					    phy_addr & i ? PHY_DATA_1 : PHY_DATA_0);
   1844
   1845		/* Send register address */
   1846		for (i = 0x10; i > 0; i = i >> 1)
   1847			dmfe_phy_write_1bit(ioaddr,
   1848					    offset & i ? PHY_DATA_1 : PHY_DATA_0);
   1849
   1850		/* Skip transition state */
   1851		dmfe_phy_read_1bit(ioaddr);
   1852
   1853		/* read 16bit data */
   1854		for (phy_data = 0, i = 0; i < 16; i++) {
   1855			phy_data <<= 1;
   1856			phy_data |= dmfe_phy_read_1bit(ioaddr);
   1857		}
   1858	}
   1859
   1860	return phy_data;
   1861}
   1862
   1863
   1864/*
   1865 *	Write one bit data to Phy Controller
   1866 */
   1867
   1868static void dmfe_phy_write_1bit(void __iomem *ioaddr, u32 phy_data)
   1869{
   1870	dw32(DCR9, phy_data);		/* MII Clock Low */
   1871	udelay(1);
   1872	dw32(DCR9, phy_data | MDCLKH);	/* MII Clock High */
   1873	udelay(1);
   1874	dw32(DCR9, phy_data);		/* MII Clock Low */
   1875	udelay(1);
   1876}
   1877
   1878
   1879/*
   1880 *	Read one bit phy data from PHY controller
   1881 */
   1882
   1883static u16 dmfe_phy_read_1bit(void __iomem *ioaddr)
   1884{
   1885	u16 phy_data;
   1886
   1887	dw32(DCR9, 0x50000);
   1888	udelay(1);
   1889	phy_data = (dr32(DCR9) >> 19) & 0x1;
   1890	dw32(DCR9, 0x40000);
   1891	udelay(1);
   1892
   1893	return phy_data;
   1894}
   1895
   1896
   1897/*
   1898 *	Parser SROM and media mode
   1899 */
   1900
   1901static void dmfe_parse_srom(struct dmfe_board_info * db)
   1902{
   1903	char * srom = db->srom;
   1904	int dmfe_mode, tmp_reg;
   1905
   1906	DMFE_DBUG(0, "dmfe_parse_srom() ", 0);
   1907
   1908	/* Init CR15 */
   1909	db->cr15_data = CR15_DEFAULT;
   1910
   1911	/* Check SROM Version */
   1912	if ( ( (int) srom[18] & 0xff) == SROM_V41_CODE) {
   1913		/* SROM V4.01 */
   1914		/* Get NIC support media mode */
   1915		db->NIC_capability = le16_to_cpup((__le16 *) (srom + 34));
   1916		db->PHY_reg4 = 0;
   1917		for (tmp_reg = 1; tmp_reg < 0x10; tmp_reg <<= 1) {
   1918			switch( db->NIC_capability & tmp_reg ) {
   1919			case 0x1: db->PHY_reg4 |= 0x0020; break;
   1920			case 0x2: db->PHY_reg4 |= 0x0040; break;
   1921			case 0x4: db->PHY_reg4 |= 0x0080; break;
   1922			case 0x8: db->PHY_reg4 |= 0x0100; break;
   1923			}
   1924		}
   1925
   1926		/* Media Mode Force or not check */
   1927		dmfe_mode = (le32_to_cpup((__le32 *) (srom + 34)) &
   1928			     le32_to_cpup((__le32 *) (srom + 36)));
   1929		switch(dmfe_mode) {
   1930		case 0x4: dmfe_media_mode = DMFE_100MHF; break;	/* 100MHF */
   1931		case 0x2: dmfe_media_mode = DMFE_10MFD; break;	/* 10MFD */
   1932		case 0x8: dmfe_media_mode = DMFE_100MFD; break;	/* 100MFD */
   1933		case 0x100:
   1934		case 0x200: dmfe_media_mode = DMFE_1M_HPNA; break;/* HomePNA */
   1935		}
   1936
   1937		/* Special Function setting */
   1938		/* VLAN function */
   1939		if ( (SF_mode & 0x1) || (srom[43] & 0x80) )
   1940			db->cr15_data |= 0x40;
   1941
   1942		/* Flow Control */
   1943		if ( (SF_mode & 0x2) || (srom[40] & 0x1) )
   1944			db->cr15_data |= 0x400;
   1945
   1946		/* TX pause packet */
   1947		if ( (SF_mode & 0x4) || (srom[40] & 0xe) )
   1948			db->cr15_data |= 0x9800;
   1949	}
   1950
   1951	/* Parse HPNA parameter */
   1952	db->HPNA_command = 1;
   1953
   1954	/* Accept remote command or not */
   1955	if (HPNA_rx_cmd == 0)
   1956		db->HPNA_command |= 0x8000;
   1957
   1958	 /* Issue remote command & operation mode */
   1959	if (HPNA_tx_cmd == 1)
   1960		switch(HPNA_mode) {	/* Issue Remote Command */
   1961		case 0: db->HPNA_command |= 0x0904; break;
   1962		case 1: db->HPNA_command |= 0x0a00; break;
   1963		case 2: db->HPNA_command |= 0x0506; break;
   1964		case 3: db->HPNA_command |= 0x0602; break;
   1965		}
   1966	else
   1967		switch(HPNA_mode) {	/* Don't Issue */
   1968		case 0: db->HPNA_command |= 0x0004; break;
   1969		case 1: db->HPNA_command |= 0x0000; break;
   1970		case 2: db->HPNA_command |= 0x0006; break;
   1971		case 3: db->HPNA_command |= 0x0002; break;
   1972		}
   1973
   1974	/* Check DM9801 or DM9802 present or not */
   1975	db->HPNA_present = 0;
   1976	update_cr6(db->cr6_data | 0x40000, db->ioaddr);
   1977	tmp_reg = dmfe_phy_read(db->ioaddr, db->phy_addr, 3, db->chip_id);
   1978	if ( ( tmp_reg & 0xfff0 ) == 0xb900 ) {
   1979		/* DM9801 or DM9802 present */
   1980		db->HPNA_timer = 8;
   1981		if ( dmfe_phy_read(db->ioaddr, db->phy_addr, 31, db->chip_id) == 0x4404) {
   1982			/* DM9801 HomeRun */
   1983			db->HPNA_present = 1;
   1984			dmfe_program_DM9801(db, tmp_reg);
   1985		} else {
   1986			/* DM9802 LongRun */
   1987			db->HPNA_present = 2;
   1988			dmfe_program_DM9802(db);
   1989		}
   1990	}
   1991
   1992}
   1993
   1994
   1995/*
   1996 *	Init HomeRun DM9801
   1997 */
   1998
   1999static void dmfe_program_DM9801(struct dmfe_board_info * db, int HPNA_rev)
   2000{
   2001	uint reg17, reg25;
   2002
   2003	if ( !HPNA_NoiseFloor ) HPNA_NoiseFloor = DM9801_NOISE_FLOOR;
   2004	switch(HPNA_rev) {
   2005	case 0xb900: /* DM9801 E3 */
   2006		db->HPNA_command |= 0x1000;
   2007		reg25 = dmfe_phy_read(db->ioaddr, db->phy_addr, 24, db->chip_id);
   2008		reg25 = ( (reg25 + HPNA_NoiseFloor) & 0xff) | 0xf000;
   2009		reg17 = dmfe_phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id);
   2010		break;
   2011	case 0xb901: /* DM9801 E4 */
   2012		reg25 = dmfe_phy_read(db->ioaddr, db->phy_addr, 25, db->chip_id);
   2013		reg25 = (reg25 & 0xff00) + HPNA_NoiseFloor;
   2014		reg17 = dmfe_phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id);
   2015		reg17 = (reg17 & 0xfff0) + HPNA_NoiseFloor + 3;
   2016		break;
   2017	case 0xb902: /* DM9801 E5 */
   2018	case 0xb903: /* DM9801 E6 */
   2019	default:
   2020		db->HPNA_command |= 0x1000;
   2021		reg25 = dmfe_phy_read(db->ioaddr, db->phy_addr, 25, db->chip_id);
   2022		reg25 = (reg25 & 0xff00) + HPNA_NoiseFloor - 5;
   2023		reg17 = dmfe_phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id);
   2024		reg17 = (reg17 & 0xfff0) + HPNA_NoiseFloor;
   2025		break;
   2026	}
   2027	dmfe_phy_write(db->ioaddr, db->phy_addr, 16, db->HPNA_command, db->chip_id);
   2028	dmfe_phy_write(db->ioaddr, db->phy_addr, 17, reg17, db->chip_id);
   2029	dmfe_phy_write(db->ioaddr, db->phy_addr, 25, reg25, db->chip_id);
   2030}
   2031
   2032
   2033/*
   2034 *	Init HomeRun DM9802
   2035 */
   2036
   2037static void dmfe_program_DM9802(struct dmfe_board_info * db)
   2038{
   2039	uint phy_reg;
   2040
   2041	if ( !HPNA_NoiseFloor ) HPNA_NoiseFloor = DM9802_NOISE_FLOOR;
   2042	dmfe_phy_write(db->ioaddr, db->phy_addr, 16, db->HPNA_command, db->chip_id);
   2043	phy_reg = dmfe_phy_read(db->ioaddr, db->phy_addr, 25, db->chip_id);
   2044	phy_reg = ( phy_reg & 0xff00) + HPNA_NoiseFloor;
   2045	dmfe_phy_write(db->ioaddr, db->phy_addr, 25, phy_reg, db->chip_id);
   2046}
   2047
   2048
   2049/*
   2050 *	Check remote HPNA power and speed status. If not correct,
   2051 *	issue command again.
   2052*/
   2053
   2054static void dmfe_HPNA_remote_cmd_chk(struct dmfe_board_info * db)
   2055{
   2056	uint phy_reg;
   2057
   2058	/* Got remote device status */
   2059	phy_reg = dmfe_phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id) & 0x60;
   2060	switch(phy_reg) {
   2061	case 0x00: phy_reg = 0x0a00;break; /* LP/LS */
   2062	case 0x20: phy_reg = 0x0900;break; /* LP/HS */
   2063	case 0x40: phy_reg = 0x0600;break; /* HP/LS */
   2064	case 0x60: phy_reg = 0x0500;break; /* HP/HS */
   2065	}
   2066
   2067	/* Check remote device status match our setting ot not */
   2068	if ( phy_reg != (db->HPNA_command & 0x0f00) ) {
   2069		dmfe_phy_write(db->ioaddr, db->phy_addr, 16, db->HPNA_command,
   2070			       db->chip_id);
   2071		db->HPNA_timer=8;
   2072	} else
   2073		db->HPNA_timer=600;	/* Match, every 10 minutes, check */
   2074}
   2075
   2076
   2077
   2078static const struct pci_device_id dmfe_pci_tbl[] = {
   2079	{ 0x1282, 0x9132, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9132_ID },
   2080	{ 0x1282, 0x9102, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9102_ID },
   2081	{ 0x1282, 0x9100, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9100_ID },
   2082	{ 0x1282, 0x9009, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9009_ID },
   2083	{ 0, }
   2084};
   2085MODULE_DEVICE_TABLE(pci, dmfe_pci_tbl);
   2086
   2087static int __maybe_unused dmfe_suspend(struct device *dev_d)
   2088{
   2089	struct net_device *dev = dev_get_drvdata(dev_d);
   2090	struct dmfe_board_info *db = netdev_priv(dev);
   2091	void __iomem *ioaddr = db->ioaddr;
   2092
   2093	/* Disable upper layer interface */
   2094	netif_device_detach(dev);
   2095
   2096	/* Disable Tx/Rx */
   2097	db->cr6_data &= ~(CR6_RXSC | CR6_TXSC);
   2098	update_cr6(db->cr6_data, ioaddr);
   2099
   2100	/* Disable Interrupt */
   2101	dw32(DCR7, 0);
   2102	dw32(DCR5, dr32(DCR5));
   2103
   2104	/* Fre RX buffers */
   2105	dmfe_free_rxbuffer(db);
   2106
   2107	/* Enable WOL */
   2108	device_wakeup_enable(dev_d);
   2109
   2110	return 0;
   2111}
   2112
   2113static int __maybe_unused dmfe_resume(struct device *dev_d)
   2114{
   2115	struct net_device *dev = dev_get_drvdata(dev_d);
   2116
   2117	/* Re-initialize DM910X board */
   2118	dmfe_init_dm910x(dev);
   2119
   2120	/* Disable WOL */
   2121	device_wakeup_disable(dev_d);
   2122
   2123	/* Restart upper layer interface */
   2124	netif_device_attach(dev);
   2125
   2126	return 0;
   2127}
   2128
   2129static SIMPLE_DEV_PM_OPS(dmfe_pm_ops, dmfe_suspend, dmfe_resume);
   2130
   2131static struct pci_driver dmfe_driver = {
   2132	.name		= "dmfe",
   2133	.id_table	= dmfe_pci_tbl,
   2134	.probe		= dmfe_init_one,
   2135	.remove		= dmfe_remove_one,
   2136	.driver.pm	= &dmfe_pm_ops,
   2137};
   2138
   2139MODULE_AUTHOR("Sten Wang, sten_wang@davicom.com.tw");
   2140MODULE_DESCRIPTION("Davicom DM910X fast ethernet driver");
   2141MODULE_LICENSE("GPL");
   2142
   2143module_param(debug, int, 0);
   2144module_param(mode, byte, 0);
   2145module_param(cr6set, int, 0);
   2146module_param(chkmode, byte, 0);
   2147module_param(HPNA_mode, byte, 0);
   2148module_param(HPNA_rx_cmd, byte, 0);
   2149module_param(HPNA_tx_cmd, byte, 0);
   2150module_param(HPNA_NoiseFloor, byte, 0);
   2151module_param(SF_mode, byte, 0);
   2152MODULE_PARM_DESC(debug, "Davicom DM9xxx enable debugging (0-1)");
   2153MODULE_PARM_DESC(mode, "Davicom DM9xxx: "
   2154		"Bit 0: 10/100Mbps, bit 2: duplex, bit 8: HomePNA");
   2155
   2156MODULE_PARM_DESC(SF_mode, "Davicom DM9xxx special function "
   2157		"(bit 0: VLAN, bit 1 Flow Control, bit 2: TX pause packet)");
   2158
   2159/*	Description:
   2160 *	when user used insmod to add module, system invoked init_module()
   2161 *	to initialize and register.
   2162 */
   2163
   2164static int __init dmfe_init_module(void)
   2165{
   2166	int rc;
   2167
   2168	DMFE_DBUG(0, "init_module() ", debug);
   2169
   2170	if (debug)
   2171		dmfe_debug = debug;	/* set debug flag */
   2172	if (cr6set)
   2173		dmfe_cr6_user_set = cr6set;
   2174
   2175	switch (mode) {
   2176	case DMFE_10MHF:
   2177	case DMFE_100MHF:
   2178	case DMFE_10MFD:
   2179	case DMFE_100MFD:
   2180	case DMFE_1M_HPNA:
   2181		dmfe_media_mode = mode;
   2182		break;
   2183	default:
   2184		dmfe_media_mode = DMFE_AUTO;
   2185		break;
   2186	}
   2187
   2188	if (HPNA_mode > 4)
   2189		HPNA_mode = 0;		/* Default: LP/HS */
   2190	if (HPNA_rx_cmd > 1)
   2191		HPNA_rx_cmd = 0;	/* Default: Ignored remote cmd */
   2192	if (HPNA_tx_cmd > 1)
   2193		HPNA_tx_cmd = 0;	/* Default: Don't issue remote cmd */
   2194	if (HPNA_NoiseFloor > 15)
   2195		HPNA_NoiseFloor = 0;
   2196
   2197	rc = pci_register_driver(&dmfe_driver);
   2198	if (rc < 0)
   2199		return rc;
   2200
   2201	return 0;
   2202}
   2203
   2204
   2205/*
   2206 *	Description:
   2207 *	when user used rmmod to delete module, system invoked clean_module()
   2208 *	to un-register all registered services.
   2209 */
   2210
   2211static void __exit dmfe_cleanup_module(void)
   2212{
   2213	DMFE_DBUG(0, "dmfe_cleanup_module() ", debug);
   2214	pci_unregister_driver(&dmfe_driver);
   2215}
   2216
   2217module_init(dmfe_init_module);
   2218module_exit(dmfe_cleanup_module);