12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667 |
- /*
- * Microchip ENC28J60 ethernet driver (MAC + PHY)
- *
- * Copyright (C) 2007 Eurek srl
- * Author: Claudio Lanconelli <lanconelli.claudio@eptar.com>
- * based on enc28j60.c written by David Anders for 2.4 kernel version
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * $Id: enc28j60.c,v 1.22 2007/12/20 10:47:01 claudio Exp $
- */
- #include <linux/module.h>
- #include <linux/kernel.h>
- #include <linux/types.h>
- #include <linux/fcntl.h>
- #include <linux/interrupt.h>
- #include <linux/slab.h>
- #include <linux/string.h>
- #include <linux/errno.h>
- #include <linux/init.h>
- #include <linux/netdevice.h>
- #include <linux/etherdevice.h>
- #include <linux/ethtool.h>
- #include <linux/tcp.h>
- #include <linux/skbuff.h>
- #include <linux/delay.h>
- #include <linux/spi/spi.h>
- #include "enc28j60_hw.h"
- #define DRV_NAME "enc28j60"
- #define DRV_VERSION "1.01"
- #define SPI_OPLEN 1
- #define ENC28J60_MSG_DEFAULT \
- (NETIF_MSG_PROBE | NETIF_MSG_IFUP | NETIF_MSG_IFDOWN | NETIF_MSG_LINK)
- /* Buffer size required for the largest SPI transfer (i.e., reading a
- * frame). */
- #define SPI_TRANSFER_BUF_LEN (4 + MAX_FRAMELEN)
- #define TX_TIMEOUT (4 * HZ)
- /* Max TX retries in case of collision as suggested by errata datasheet */
- #define MAX_TX_RETRYCOUNT 16
- enum {
- RXFILTER_NORMAL,
- RXFILTER_MULTI,
- RXFILTER_PROMISC
- };
- /* Driver local data */
- struct enc28j60_net {
- struct net_device *netdev;
- struct spi_device *spi;
- struct mutex lock;
- struct sk_buff *tx_skb;
- struct work_struct tx_work;
- struct work_struct irq_work;
- struct work_struct setrx_work;
- struct work_struct restart_work;
- u8 bank; /* current register bank selected */
- u16 next_pk_ptr; /* next packet pointer within FIFO */
- u16 max_pk_counter; /* statistics: max packet counter */
- u16 tx_retry_count;
- bool hw_enable;
- bool full_duplex;
- int rxfilter;
- u32 msg_enable;
- u8 spi_transfer_buf[SPI_TRANSFER_BUF_LEN];
- };
- /* use ethtool to change the level for any given device */
- static struct {
- u32 msg_enable;
- } debug = { -1 };
- /*
- * SPI read buffer
- * wait for the SPI transfer and copy received data to destination
- */
- static int
- spi_read_buf(struct enc28j60_net *priv, int len, u8 *data)
- {
- u8 *rx_buf = priv->spi_transfer_buf + 4;
- u8 *tx_buf = priv->spi_transfer_buf;
- struct spi_transfer t = {
- .tx_buf = tx_buf,
- .rx_buf = rx_buf,
- .len = SPI_OPLEN + len,
- };
- struct spi_message msg;
- int ret;
- tx_buf[0] = ENC28J60_READ_BUF_MEM;
- tx_buf[1] = tx_buf[2] = tx_buf[3] = 0; /* don't care */
- spi_message_init(&msg);
- spi_message_add_tail(&t, &msg);
- ret = spi_sync(priv->spi, &msg);
- if (ret == 0) {
- memcpy(data, &rx_buf[SPI_OPLEN], len);
- ret = msg.status;
- }
- if (ret && netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() failed: ret = %d\n",
- __func__, ret);
- return ret;
- }
- /*
- * SPI write buffer
- */
- static int spi_write_buf(struct enc28j60_net *priv, int len,
- const u8 *data)
- {
- int ret;
- if (len > SPI_TRANSFER_BUF_LEN - 1 || len <= 0)
- ret = -EINVAL;
- else {
- priv->spi_transfer_buf[0] = ENC28J60_WRITE_BUF_MEM;
- memcpy(&priv->spi_transfer_buf[1], data, len);
- ret = spi_write(priv->spi, priv->spi_transfer_buf, len + 1);
- if (ret && netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() failed: ret = %d\n",
- __func__, ret);
- }
- return ret;
- }
- /*
- * basic SPI read operation
- */
- static u8 spi_read_op(struct enc28j60_net *priv, u8 op,
- u8 addr)
- {
- u8 tx_buf[2];
- u8 rx_buf[4];
- u8 val = 0;
- int ret;
- int slen = SPI_OPLEN;
- /* do dummy read if needed */
- if (addr & SPRD_MASK)
- slen++;
- tx_buf[0] = op | (addr & ADDR_MASK);
- ret = spi_write_then_read(priv->spi, tx_buf, 1, rx_buf, slen);
- if (ret)
- printk(KERN_DEBUG DRV_NAME ": %s() failed: ret = %d\n",
- __func__, ret);
- else
- val = rx_buf[slen - 1];
- return val;
- }
- /*
- * basic SPI write operation
- */
- static int spi_write_op(struct enc28j60_net *priv, u8 op,
- u8 addr, u8 val)
- {
- int ret;
- priv->spi_transfer_buf[0] = op | (addr & ADDR_MASK);
- priv->spi_transfer_buf[1] = val;
- ret = spi_write(priv->spi, priv->spi_transfer_buf, 2);
- if (ret && netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() failed: ret = %d\n",
- __func__, ret);
- return ret;
- }
- static void enc28j60_soft_reset(struct enc28j60_net *priv)
- {
- if (netif_msg_hw(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() enter\n", __func__);
- spi_write_op(priv, ENC28J60_SOFT_RESET, 0, ENC28J60_SOFT_RESET);
- /* Errata workaround #1, CLKRDY check is unreliable,
- * delay at least 1 mS instead */
- udelay(2000);
- }
- /*
- * select the current register bank if necessary
- */
- static void enc28j60_set_bank(struct enc28j60_net *priv, u8 addr)
- {
- u8 b = (addr & BANK_MASK) >> 5;
- /* These registers (EIE, EIR, ESTAT, ECON2, ECON1)
- * are present in all banks, no need to switch bank
- */
- if (addr >= EIE && addr <= ECON1)
- return;
- /* Clear or set each bank selection bit as needed */
- if ((b & ECON1_BSEL0) != (priv->bank & ECON1_BSEL0)) {
- if (b & ECON1_BSEL0)
- spi_write_op(priv, ENC28J60_BIT_FIELD_SET, ECON1,
- ECON1_BSEL0);
- else
- spi_write_op(priv, ENC28J60_BIT_FIELD_CLR, ECON1,
- ECON1_BSEL0);
- }
- if ((b & ECON1_BSEL1) != (priv->bank & ECON1_BSEL1)) {
- if (b & ECON1_BSEL1)
- spi_write_op(priv, ENC28J60_BIT_FIELD_SET, ECON1,
- ECON1_BSEL1);
- else
- spi_write_op(priv, ENC28J60_BIT_FIELD_CLR, ECON1,
- ECON1_BSEL1);
- }
- priv->bank = b;
- }
- /*
- * Register access routines through the SPI bus.
- * Every register access comes in two flavours:
- * - nolock_xxx: caller needs to invoke mutex_lock, usually to access
- * atomically more than one register
- * - locked_xxx: caller doesn't need to invoke mutex_lock, single access
- *
- * Some registers can be accessed through the bit field clear and
- * bit field set to avoid a read modify write cycle.
- */
- /*
- * Register bit field Set
- */
- static void nolock_reg_bfset(struct enc28j60_net *priv,
- u8 addr, u8 mask)
- {
- enc28j60_set_bank(priv, addr);
- spi_write_op(priv, ENC28J60_BIT_FIELD_SET, addr, mask);
- }
- static void locked_reg_bfset(struct enc28j60_net *priv,
- u8 addr, u8 mask)
- {
- mutex_lock(&priv->lock);
- nolock_reg_bfset(priv, addr, mask);
- mutex_unlock(&priv->lock);
- }
- /*
- * Register bit field Clear
- */
- static void nolock_reg_bfclr(struct enc28j60_net *priv,
- u8 addr, u8 mask)
- {
- enc28j60_set_bank(priv, addr);
- spi_write_op(priv, ENC28J60_BIT_FIELD_CLR, addr, mask);
- }
- static void locked_reg_bfclr(struct enc28j60_net *priv,
- u8 addr, u8 mask)
- {
- mutex_lock(&priv->lock);
- nolock_reg_bfclr(priv, addr, mask);
- mutex_unlock(&priv->lock);
- }
- /*
- * Register byte read
- */
- static int nolock_regb_read(struct enc28j60_net *priv,
- u8 address)
- {
- enc28j60_set_bank(priv, address);
- return spi_read_op(priv, ENC28J60_READ_CTRL_REG, address);
- }
- static int locked_regb_read(struct enc28j60_net *priv,
- u8 address)
- {
- int ret;
- mutex_lock(&priv->lock);
- ret = nolock_regb_read(priv, address);
- mutex_unlock(&priv->lock);
- return ret;
- }
- /*
- * Register word read
- */
- static int nolock_regw_read(struct enc28j60_net *priv,
- u8 address)
- {
- int rl, rh;
- enc28j60_set_bank(priv, address);
- rl = spi_read_op(priv, ENC28J60_READ_CTRL_REG, address);
- rh = spi_read_op(priv, ENC28J60_READ_CTRL_REG, address + 1);
- return (rh << 8) | rl;
- }
- static int locked_regw_read(struct enc28j60_net *priv,
- u8 address)
- {
- int ret;
- mutex_lock(&priv->lock);
- ret = nolock_regw_read(priv, address);
- mutex_unlock(&priv->lock);
- return ret;
- }
- /*
- * Register byte write
- */
- static void nolock_regb_write(struct enc28j60_net *priv,
- u8 address, u8 data)
- {
- enc28j60_set_bank(priv, address);
- spi_write_op(priv, ENC28J60_WRITE_CTRL_REG, address, data);
- }
- static void locked_regb_write(struct enc28j60_net *priv,
- u8 address, u8 data)
- {
- mutex_lock(&priv->lock);
- nolock_regb_write(priv, address, data);
- mutex_unlock(&priv->lock);
- }
- /*
- * Register word write
- */
- static void nolock_regw_write(struct enc28j60_net *priv,
- u8 address, u16 data)
- {
- enc28j60_set_bank(priv, address);
- spi_write_op(priv, ENC28J60_WRITE_CTRL_REG, address, (u8) data);
- spi_write_op(priv, ENC28J60_WRITE_CTRL_REG, address + 1,
- (u8) (data >> 8));
- }
- static void locked_regw_write(struct enc28j60_net *priv,
- u8 address, u16 data)
- {
- mutex_lock(&priv->lock);
- nolock_regw_write(priv, address, data);
- mutex_unlock(&priv->lock);
- }
- /*
- * Buffer memory read
- * Select the starting address and execute a SPI buffer read
- */
- static void enc28j60_mem_read(struct enc28j60_net *priv,
- u16 addr, int len, u8 *data)
- {
- mutex_lock(&priv->lock);
- nolock_regw_write(priv, ERDPTL, addr);
- #ifdef CONFIG_ENC28J60_WRITEVERIFY
- if (netif_msg_drv(priv)) {
- u16 reg;
- reg = nolock_regw_read(priv, ERDPTL);
- if (reg != addr)
- printk(KERN_DEBUG DRV_NAME ": %s() error writing ERDPT "
- "(0x%04x - 0x%04x)\n", __func__, reg, addr);
- }
- #endif
- spi_read_buf(priv, len, data);
- mutex_unlock(&priv->lock);
- }
- /*
- * Write packet to enc28j60 TX buffer memory
- */
- static void
- enc28j60_packet_write(struct enc28j60_net *priv, int len, const u8 *data)
- {
- mutex_lock(&priv->lock);
- /* Set the write pointer to start of transmit buffer area */
- nolock_regw_write(priv, EWRPTL, TXSTART_INIT);
- #ifdef CONFIG_ENC28J60_WRITEVERIFY
- if (netif_msg_drv(priv)) {
- u16 reg;
- reg = nolock_regw_read(priv, EWRPTL);
- if (reg != TXSTART_INIT)
- printk(KERN_DEBUG DRV_NAME
- ": %s() ERWPT:0x%04x != 0x%04x\n",
- __func__, reg, TXSTART_INIT);
- }
- #endif
- /* Set the TXND pointer to correspond to the packet size given */
- nolock_regw_write(priv, ETXNDL, TXSTART_INIT + len);
- /* write per-packet control byte */
- spi_write_op(priv, ENC28J60_WRITE_BUF_MEM, 0, 0x00);
- if (netif_msg_hw(priv))
- printk(KERN_DEBUG DRV_NAME
- ": %s() after control byte ERWPT:0x%04x\n",
- __func__, nolock_regw_read(priv, EWRPTL));
- /* copy the packet into the transmit buffer */
- spi_write_buf(priv, len, data);
- if (netif_msg_hw(priv))
- printk(KERN_DEBUG DRV_NAME
- ": %s() after write packet ERWPT:0x%04x, len=%d\n",
- __func__, nolock_regw_read(priv, EWRPTL), len);
- mutex_unlock(&priv->lock);
- }
- static unsigned long msec20_to_jiffies;
- static int poll_ready(struct enc28j60_net *priv, u8 reg, u8 mask, u8 val)
- {
- unsigned long timeout = jiffies + msec20_to_jiffies;
- /* 20 msec timeout read */
- while ((nolock_regb_read(priv, reg) & mask) != val) {
- if (time_after(jiffies, timeout)) {
- if (netif_msg_drv(priv))
- dev_dbg(&priv->spi->dev,
- "reg %02x ready timeout!\n", reg);
- return -ETIMEDOUT;
- }
- cpu_relax();
- }
- return 0;
- }
- /*
- * Wait until the PHY operation is complete.
- */
- static int wait_phy_ready(struct enc28j60_net *priv)
- {
- return poll_ready(priv, MISTAT, MISTAT_BUSY, 0) ? 0 : 1;
- }
- /*
- * PHY register read
- * PHY registers are not accessed directly, but through the MII
- */
- static u16 enc28j60_phy_read(struct enc28j60_net *priv, u8 address)
- {
- u16 ret;
- mutex_lock(&priv->lock);
- /* set the PHY register address */
- nolock_regb_write(priv, MIREGADR, address);
- /* start the register read operation */
- nolock_regb_write(priv, MICMD, MICMD_MIIRD);
- /* wait until the PHY read completes */
- wait_phy_ready(priv);
- /* quit reading */
- nolock_regb_write(priv, MICMD, 0x00);
- /* return the data */
- ret = nolock_regw_read(priv, MIRDL);
- mutex_unlock(&priv->lock);
- return ret;
- }
- static int enc28j60_phy_write(struct enc28j60_net *priv, u8 address, u16 data)
- {
- int ret;
- mutex_lock(&priv->lock);
- /* set the PHY register address */
- nolock_regb_write(priv, MIREGADR, address);
- /* write the PHY data */
- nolock_regw_write(priv, MIWRL, data);
- /* wait until the PHY write completes and return */
- ret = wait_phy_ready(priv);
- mutex_unlock(&priv->lock);
- return ret;
- }
- /*
- * Program the hardware MAC address from dev->dev_addr.
- */
- static int enc28j60_set_hw_macaddr(struct net_device *ndev)
- {
- int ret;
- struct enc28j60_net *priv = netdev_priv(ndev);
- mutex_lock(&priv->lock);
- if (!priv->hw_enable) {
- if (netif_msg_drv(priv))
- printk(KERN_INFO DRV_NAME
- ": %s: Setting MAC address to %pM\n",
- ndev->name, ndev->dev_addr);
- /* NOTE: MAC address in ENC28J60 is byte-backward */
- nolock_regb_write(priv, MAADR5, ndev->dev_addr[0]);
- nolock_regb_write(priv, MAADR4, ndev->dev_addr[1]);
- nolock_regb_write(priv, MAADR3, ndev->dev_addr[2]);
- nolock_regb_write(priv, MAADR2, ndev->dev_addr[3]);
- nolock_regb_write(priv, MAADR1, ndev->dev_addr[4]);
- nolock_regb_write(priv, MAADR0, ndev->dev_addr[5]);
- ret = 0;
- } else {
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME
- ": %s() Hardware must be disabled to set "
- "Mac address\n", __func__);
- ret = -EBUSY;
- }
- mutex_unlock(&priv->lock);
- return ret;
- }
- /*
- * Store the new hardware address in dev->dev_addr, and update the MAC.
- */
- static int enc28j60_set_mac_address(struct net_device *dev, void *addr)
- {
- struct sockaddr *address = addr;
- if (netif_running(dev))
- return -EBUSY;
- if (!is_valid_ether_addr(address->sa_data))
- return -EADDRNOTAVAIL;
- memcpy(dev->dev_addr, address->sa_data, dev->addr_len);
- return enc28j60_set_hw_macaddr(dev);
- }
- /*
- * Debug routine to dump useful register contents
- */
- static void enc28j60_dump_regs(struct enc28j60_net *priv, const char *msg)
- {
- mutex_lock(&priv->lock);
- printk(KERN_DEBUG DRV_NAME " %s\n"
- "HwRevID: 0x%02x\n"
- "Cntrl: ECON1 ECON2 ESTAT EIR EIE\n"
- " 0x%02x 0x%02x 0x%02x 0x%02x 0x%02x\n"
- "MAC : MACON1 MACON3 MACON4\n"
- " 0x%02x 0x%02x 0x%02x\n"
- "Rx : ERXST ERXND ERXWRPT ERXRDPT ERXFCON EPKTCNT MAMXFL\n"
- " 0x%04x 0x%04x 0x%04x 0x%04x "
- "0x%02x 0x%02x 0x%04x\n"
- "Tx : ETXST ETXND MACLCON1 MACLCON2 MAPHSUP\n"
- " 0x%04x 0x%04x 0x%02x 0x%02x 0x%02x\n",
- msg, nolock_regb_read(priv, EREVID),
- nolock_regb_read(priv, ECON1), nolock_regb_read(priv, ECON2),
- nolock_regb_read(priv, ESTAT), nolock_regb_read(priv, EIR),
- nolock_regb_read(priv, EIE), nolock_regb_read(priv, MACON1),
- nolock_regb_read(priv, MACON3), nolock_regb_read(priv, MACON4),
- nolock_regw_read(priv, ERXSTL), nolock_regw_read(priv, ERXNDL),
- nolock_regw_read(priv, ERXWRPTL),
- nolock_regw_read(priv, ERXRDPTL),
- nolock_regb_read(priv, ERXFCON),
- nolock_regb_read(priv, EPKTCNT),
- nolock_regw_read(priv, MAMXFLL), nolock_regw_read(priv, ETXSTL),
- nolock_regw_read(priv, ETXNDL),
- nolock_regb_read(priv, MACLCON1),
- nolock_regb_read(priv, MACLCON2),
- nolock_regb_read(priv, MAPHSUP));
- mutex_unlock(&priv->lock);
- }
- /*
- * ERXRDPT need to be set always at odd addresses, refer to errata datasheet
- */
- static u16 erxrdpt_workaround(u16 next_packet_ptr, u16 start, u16 end)
- {
- u16 erxrdpt;
- if ((next_packet_ptr - 1 < start) || (next_packet_ptr - 1 > end))
- erxrdpt = end;
- else
- erxrdpt = next_packet_ptr - 1;
- return erxrdpt;
- }
- /*
- * Calculate wrap around when reading beyond the end of the RX buffer
- */
- static u16 rx_packet_start(u16 ptr)
- {
- if (ptr + RSV_SIZE > RXEND_INIT)
- return (ptr + RSV_SIZE) - (RXEND_INIT - RXSTART_INIT + 1);
- else
- return ptr + RSV_SIZE;
- }
- static void nolock_rxfifo_init(struct enc28j60_net *priv, u16 start, u16 end)
- {
- u16 erxrdpt;
- if (start > 0x1FFF || end > 0x1FFF || start > end) {
- if (netif_msg_drv(priv))
- printk(KERN_ERR DRV_NAME ": %s(%d, %d) RXFIFO "
- "bad parameters!\n", __func__, start, end);
- return;
- }
- /* set receive buffer start + end */
- priv->next_pk_ptr = start;
- nolock_regw_write(priv, ERXSTL, start);
- erxrdpt = erxrdpt_workaround(priv->next_pk_ptr, start, end);
- nolock_regw_write(priv, ERXRDPTL, erxrdpt);
- nolock_regw_write(priv, ERXNDL, end);
- }
- static void nolock_txfifo_init(struct enc28j60_net *priv, u16 start, u16 end)
- {
- if (start > 0x1FFF || end > 0x1FFF || start > end) {
- if (netif_msg_drv(priv))
- printk(KERN_ERR DRV_NAME ": %s(%d, %d) TXFIFO "
- "bad parameters!\n", __func__, start, end);
- return;
- }
- /* set transmit buffer start + end */
- nolock_regw_write(priv, ETXSTL, start);
- nolock_regw_write(priv, ETXNDL, end);
- }
- /*
- * Low power mode shrinks power consumption about 100x, so we'd like
- * the chip to be in that mode whenever it's inactive. (However, we
- * can't stay in lowpower mode during suspend with WOL active.)
- */
- static void enc28j60_lowpower(struct enc28j60_net *priv, bool is_low)
- {
- if (netif_msg_drv(priv))
- dev_dbg(&priv->spi->dev, "%s power...\n",
- is_low ? "low" : "high");
- mutex_lock(&priv->lock);
- if (is_low) {
- nolock_reg_bfclr(priv, ECON1, ECON1_RXEN);
- poll_ready(priv, ESTAT, ESTAT_RXBUSY, 0);
- poll_ready(priv, ECON1, ECON1_TXRTS, 0);
- /* ECON2_VRPS was set during initialization */
- nolock_reg_bfset(priv, ECON2, ECON2_PWRSV);
- } else {
- nolock_reg_bfclr(priv, ECON2, ECON2_PWRSV);
- poll_ready(priv, ESTAT, ESTAT_CLKRDY, ESTAT_CLKRDY);
- /* caller sets ECON1_RXEN */
- }
- mutex_unlock(&priv->lock);
- }
- static int enc28j60_hw_init(struct enc28j60_net *priv)
- {
- u8 reg;
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() - %s\n", __func__,
- priv->full_duplex ? "FullDuplex" : "HalfDuplex");
- mutex_lock(&priv->lock);
- /* first reset the chip */
- enc28j60_soft_reset(priv);
- /* Clear ECON1 */
- spi_write_op(priv, ENC28J60_WRITE_CTRL_REG, ECON1, 0x00);
- priv->bank = 0;
- priv->hw_enable = false;
- priv->tx_retry_count = 0;
- priv->max_pk_counter = 0;
- priv->rxfilter = RXFILTER_NORMAL;
- /* enable address auto increment and voltage regulator powersave */
- nolock_regb_write(priv, ECON2, ECON2_AUTOINC | ECON2_VRPS);
- nolock_rxfifo_init(priv, RXSTART_INIT, RXEND_INIT);
- nolock_txfifo_init(priv, TXSTART_INIT, TXEND_INIT);
- mutex_unlock(&priv->lock);
- /*
- * Check the RevID.
- * If it's 0x00 or 0xFF probably the enc28j60 is not mounted or
- * damaged
- */
- reg = locked_regb_read(priv, EREVID);
- if (netif_msg_drv(priv))
- printk(KERN_INFO DRV_NAME ": chip RevID: 0x%02x\n", reg);
- if (reg == 0x00 || reg == 0xff) {
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() Invalid RevId %d\n",
- __func__, reg);
- return 0;
- }
- /* default filter mode: (unicast OR broadcast) AND crc valid */
- locked_regb_write(priv, ERXFCON,
- ERXFCON_UCEN | ERXFCON_CRCEN | ERXFCON_BCEN);
- /* enable MAC receive */
- locked_regb_write(priv, MACON1,
- MACON1_MARXEN | MACON1_TXPAUS | MACON1_RXPAUS);
- /* enable automatic padding and CRC operations */
- if (priv->full_duplex) {
- locked_regb_write(priv, MACON3,
- MACON3_PADCFG0 | MACON3_TXCRCEN |
- MACON3_FRMLNEN | MACON3_FULDPX);
- /* set inter-frame gap (non-back-to-back) */
- locked_regb_write(priv, MAIPGL, 0x12);
- /* set inter-frame gap (back-to-back) */
- locked_regb_write(priv, MABBIPG, 0x15);
- } else {
- locked_regb_write(priv, MACON3,
- MACON3_PADCFG0 | MACON3_TXCRCEN |
- MACON3_FRMLNEN);
- locked_regb_write(priv, MACON4, 1 << 6); /* DEFER bit */
- /* set inter-frame gap (non-back-to-back) */
- locked_regw_write(priv, MAIPGL, 0x0C12);
- /* set inter-frame gap (back-to-back) */
- locked_regb_write(priv, MABBIPG, 0x12);
- }
- /*
- * MACLCON1 (default)
- * MACLCON2 (default)
- * Set the maximum packet size which the controller will accept
- */
- locked_regw_write(priv, MAMXFLL, MAX_FRAMELEN);
- /* Configure LEDs */
- if (!enc28j60_phy_write(priv, PHLCON, ENC28J60_LAMPS_MODE))
- return 0;
- if (priv->full_duplex) {
- if (!enc28j60_phy_write(priv, PHCON1, PHCON1_PDPXMD))
- return 0;
- if (!enc28j60_phy_write(priv, PHCON2, 0x00))
- return 0;
- } else {
- if (!enc28j60_phy_write(priv, PHCON1, 0x00))
- return 0;
- if (!enc28j60_phy_write(priv, PHCON2, PHCON2_HDLDIS))
- return 0;
- }
- if (netif_msg_hw(priv))
- enc28j60_dump_regs(priv, "Hw initialized.");
- return 1;
- }
- static void enc28j60_hw_enable(struct enc28j60_net *priv)
- {
- /* enable interrupts */
- if (netif_msg_hw(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() enabling interrupts.\n",
- __func__);
- enc28j60_phy_write(priv, PHIE, PHIE_PGEIE | PHIE_PLNKIE);
- mutex_lock(&priv->lock);
- nolock_reg_bfclr(priv, EIR, EIR_DMAIF | EIR_LINKIF |
- EIR_TXIF | EIR_TXERIF | EIR_RXERIF | EIR_PKTIF);
- nolock_regb_write(priv, EIE, EIE_INTIE | EIE_PKTIE | EIE_LINKIE |
- EIE_TXIE | EIE_TXERIE | EIE_RXERIE);
- /* enable receive logic */
- nolock_reg_bfset(priv, ECON1, ECON1_RXEN);
- priv->hw_enable = true;
- mutex_unlock(&priv->lock);
- }
- static void enc28j60_hw_disable(struct enc28j60_net *priv)
- {
- mutex_lock(&priv->lock);
- /* disable interrutps and packet reception */
- nolock_regb_write(priv, EIE, 0x00);
- nolock_reg_bfclr(priv, ECON1, ECON1_RXEN);
- priv->hw_enable = false;
- mutex_unlock(&priv->lock);
- }
- static int
- enc28j60_setlink(struct net_device *ndev, u8 autoneg, u16 speed, u8 duplex)
- {
- struct enc28j60_net *priv = netdev_priv(ndev);
- int ret = 0;
- if (!priv->hw_enable) {
- /* link is in low power mode now; duplex setting
- * will take effect on next enc28j60_hw_init().
- */
- if (autoneg == AUTONEG_DISABLE && speed == SPEED_10)
- priv->full_duplex = (duplex == DUPLEX_FULL);
- else {
- if (netif_msg_link(priv))
- dev_warn(&ndev->dev,
- "unsupported link setting\n");
- ret = -EOPNOTSUPP;
- }
- } else {
- if (netif_msg_link(priv))
- dev_warn(&ndev->dev, "Warning: hw must be disabled "
- "to set link mode\n");
- ret = -EBUSY;
- }
- return ret;
- }
- /*
- * Read the Transmit Status Vector
- */
- static void enc28j60_read_tsv(struct enc28j60_net *priv, u8 tsv[TSV_SIZE])
- {
- int endptr;
- endptr = locked_regw_read(priv, ETXNDL);
- if (netif_msg_hw(priv))
- printk(KERN_DEBUG DRV_NAME ": reading TSV at addr:0x%04x\n",
- endptr + 1);
- enc28j60_mem_read(priv, endptr + 1, sizeof(tsv), tsv);
- }
- static void enc28j60_dump_tsv(struct enc28j60_net *priv, const char *msg,
- u8 tsv[TSV_SIZE])
- {
- u16 tmp1, tmp2;
- printk(KERN_DEBUG DRV_NAME ": %s - TSV:\n", msg);
- tmp1 = tsv[1];
- tmp1 <<= 8;
- tmp1 |= tsv[0];
- tmp2 = tsv[5];
- tmp2 <<= 8;
- tmp2 |= tsv[4];
- printk(KERN_DEBUG DRV_NAME ": ByteCount: %d, CollisionCount: %d,"
- " TotByteOnWire: %d\n", tmp1, tsv[2] & 0x0f, tmp2);
- printk(KERN_DEBUG DRV_NAME ": TxDone: %d, CRCErr:%d, LenChkErr: %d,"
- " LenOutOfRange: %d\n", TSV_GETBIT(tsv, TSV_TXDONE),
- TSV_GETBIT(tsv, TSV_TXCRCERROR),
- TSV_GETBIT(tsv, TSV_TXLENCHKERROR),
- TSV_GETBIT(tsv, TSV_TXLENOUTOFRANGE));
- printk(KERN_DEBUG DRV_NAME ": Multicast: %d, Broadcast: %d, "
- "PacketDefer: %d, ExDefer: %d\n",
- TSV_GETBIT(tsv, TSV_TXMULTICAST),
- TSV_GETBIT(tsv, TSV_TXBROADCAST),
- TSV_GETBIT(tsv, TSV_TXPACKETDEFER),
- TSV_GETBIT(tsv, TSV_TXEXDEFER));
- printk(KERN_DEBUG DRV_NAME ": ExCollision: %d, LateCollision: %d, "
- "Giant: %d, Underrun: %d\n",
- TSV_GETBIT(tsv, TSV_TXEXCOLLISION),
- TSV_GETBIT(tsv, TSV_TXLATECOLLISION),
- TSV_GETBIT(tsv, TSV_TXGIANT), TSV_GETBIT(tsv, TSV_TXUNDERRUN));
- printk(KERN_DEBUG DRV_NAME ": ControlFrame: %d, PauseFrame: %d, "
- "BackPressApp: %d, VLanTagFrame: %d\n",
- TSV_GETBIT(tsv, TSV_TXCONTROLFRAME),
- TSV_GETBIT(tsv, TSV_TXPAUSEFRAME),
- TSV_GETBIT(tsv, TSV_BACKPRESSUREAPP),
- TSV_GETBIT(tsv, TSV_TXVLANTAGFRAME));
- }
- /*
- * Receive Status vector
- */
- static void enc28j60_dump_rsv(struct enc28j60_net *priv, const char *msg,
- u16 pk_ptr, int len, u16 sts)
- {
- printk(KERN_DEBUG DRV_NAME ": %s - NextPk: 0x%04x - RSV:\n",
- msg, pk_ptr);
- printk(KERN_DEBUG DRV_NAME ": ByteCount: %d, DribbleNibble: %d\n", len,
- RSV_GETBIT(sts, RSV_DRIBBLENIBBLE));
- printk(KERN_DEBUG DRV_NAME ": RxOK: %d, CRCErr:%d, LenChkErr: %d,"
- " LenOutOfRange: %d\n", RSV_GETBIT(sts, RSV_RXOK),
- RSV_GETBIT(sts, RSV_CRCERROR),
- RSV_GETBIT(sts, RSV_LENCHECKERR),
- RSV_GETBIT(sts, RSV_LENOUTOFRANGE));
- printk(KERN_DEBUG DRV_NAME ": Multicast: %d, Broadcast: %d, "
- "LongDropEvent: %d, CarrierEvent: %d\n",
- RSV_GETBIT(sts, RSV_RXMULTICAST),
- RSV_GETBIT(sts, RSV_RXBROADCAST),
- RSV_GETBIT(sts, RSV_RXLONGEVDROPEV),
- RSV_GETBIT(sts, RSV_CARRIEREV));
- printk(KERN_DEBUG DRV_NAME ": ControlFrame: %d, PauseFrame: %d,"
- " UnknownOp: %d, VLanTagFrame: %d\n",
- RSV_GETBIT(sts, RSV_RXCONTROLFRAME),
- RSV_GETBIT(sts, RSV_RXPAUSEFRAME),
- RSV_GETBIT(sts, RSV_RXUNKNOWNOPCODE),
- RSV_GETBIT(sts, RSV_RXTYPEVLAN));
- }
- static void dump_packet(const char *msg, int len, const char *data)
- {
- printk(KERN_DEBUG DRV_NAME ": %s - packet len:%d\n", msg, len);
- print_hex_dump(KERN_DEBUG, "pk data: ", DUMP_PREFIX_OFFSET, 16, 1,
- data, len, true);
- }
- /*
- * Hardware receive function.
- * Read the buffer memory, update the FIFO pointer to free the buffer,
- * check the status vector and decrement the packet counter.
- */
- static void enc28j60_hw_rx(struct net_device *ndev)
- {
- struct enc28j60_net *priv = netdev_priv(ndev);
- struct sk_buff *skb = NULL;
- u16 erxrdpt, next_packet, rxstat;
- u8 rsv[RSV_SIZE];
- int len;
- if (netif_msg_rx_status(priv))
- printk(KERN_DEBUG DRV_NAME ": RX pk_addr:0x%04x\n",
- priv->next_pk_ptr);
- if (unlikely(priv->next_pk_ptr > RXEND_INIT)) {
- if (netif_msg_rx_err(priv))
- dev_err(&ndev->dev,
- "%s() Invalid packet address!! 0x%04x\n",
- __func__, priv->next_pk_ptr);
- /* packet address corrupted: reset RX logic */
- mutex_lock(&priv->lock);
- nolock_reg_bfclr(priv, ECON1, ECON1_RXEN);
- nolock_reg_bfset(priv, ECON1, ECON1_RXRST);
- nolock_reg_bfclr(priv, ECON1, ECON1_RXRST);
- nolock_rxfifo_init(priv, RXSTART_INIT, RXEND_INIT);
- nolock_reg_bfclr(priv, EIR, EIR_RXERIF);
- nolock_reg_bfset(priv, ECON1, ECON1_RXEN);
- mutex_unlock(&priv->lock);
- ndev->stats.rx_errors++;
- return;
- }
- /* Read next packet pointer and rx status vector */
- enc28j60_mem_read(priv, priv->next_pk_ptr, sizeof(rsv), rsv);
- next_packet = rsv[1];
- next_packet <<= 8;
- next_packet |= rsv[0];
- len = rsv[3];
- len <<= 8;
- len |= rsv[2];
- rxstat = rsv[5];
- rxstat <<= 8;
- rxstat |= rsv[4];
- if (netif_msg_rx_status(priv))
- enc28j60_dump_rsv(priv, __func__, next_packet, len, rxstat);
- if (!RSV_GETBIT(rxstat, RSV_RXOK) || len > MAX_FRAMELEN) {
- if (netif_msg_rx_err(priv))
- dev_err(&ndev->dev, "Rx Error (%04x)\n", rxstat);
- ndev->stats.rx_errors++;
- if (RSV_GETBIT(rxstat, RSV_CRCERROR))
- ndev->stats.rx_crc_errors++;
- if (RSV_GETBIT(rxstat, RSV_LENCHECKERR))
- ndev->stats.rx_frame_errors++;
- if (len > MAX_FRAMELEN)
- ndev->stats.rx_over_errors++;
- } else {
- skb = dev_alloc_skb(len + NET_IP_ALIGN);
- if (!skb) {
- if (netif_msg_rx_err(priv))
- dev_err(&ndev->dev,
- "out of memory for Rx'd frame\n");
- ndev->stats.rx_dropped++;
- } else {
- skb->dev = ndev;
- skb_reserve(skb, NET_IP_ALIGN);
- /* copy the packet from the receive buffer */
- enc28j60_mem_read(priv,
- rx_packet_start(priv->next_pk_ptr),
- len, skb_put(skb, len));
- if (netif_msg_pktdata(priv))
- dump_packet(__func__, skb->len, skb->data);
- skb->protocol = eth_type_trans(skb, ndev);
- /* update statistics */
- ndev->stats.rx_packets++;
- ndev->stats.rx_bytes += len;
- netif_rx_ni(skb);
- }
- }
- /*
- * Move the RX read pointer to the start of the next
- * received packet.
- * This frees the memory we just read out
- */
- erxrdpt = erxrdpt_workaround(next_packet, RXSTART_INIT, RXEND_INIT);
- if (netif_msg_hw(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() ERXRDPT:0x%04x\n",
- __func__, erxrdpt);
- mutex_lock(&priv->lock);
- nolock_regw_write(priv, ERXRDPTL, erxrdpt);
- #ifdef CONFIG_ENC28J60_WRITEVERIFY
- if (netif_msg_drv(priv)) {
- u16 reg;
- reg = nolock_regw_read(priv, ERXRDPTL);
- if (reg != erxrdpt)
- printk(KERN_DEBUG DRV_NAME ": %s() ERXRDPT verify "
- "error (0x%04x - 0x%04x)\n", __func__,
- reg, erxrdpt);
- }
- #endif
- priv->next_pk_ptr = next_packet;
- /* we are done with this packet, decrement the packet counter */
- nolock_reg_bfset(priv, ECON2, ECON2_PKTDEC);
- mutex_unlock(&priv->lock);
- }
- /*
- * Calculate free space in RxFIFO
- */
- static int enc28j60_get_free_rxfifo(struct enc28j60_net *priv)
- {
- int epkcnt, erxst, erxnd, erxwr, erxrd;
- int free_space;
- mutex_lock(&priv->lock);
- epkcnt = nolock_regb_read(priv, EPKTCNT);
- if (epkcnt >= 255)
- free_space = -1;
- else {
- erxst = nolock_regw_read(priv, ERXSTL);
- erxnd = nolock_regw_read(priv, ERXNDL);
- erxwr = nolock_regw_read(priv, ERXWRPTL);
- erxrd = nolock_regw_read(priv, ERXRDPTL);
- if (erxwr > erxrd)
- free_space = (erxnd - erxst) - (erxwr - erxrd);
- else if (erxwr == erxrd)
- free_space = (erxnd - erxst);
- else
- free_space = erxrd - erxwr - 1;
- }
- mutex_unlock(&priv->lock);
- if (netif_msg_rx_status(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() free_space = %d\n",
- __func__, free_space);
- return free_space;
- }
- /*
- * Access the PHY to determine link status
- */
- static void enc28j60_check_link_status(struct net_device *ndev)
- {
- struct enc28j60_net *priv = netdev_priv(ndev);
- u16 reg;
- int duplex;
- reg = enc28j60_phy_read(priv, PHSTAT2);
- if (netif_msg_hw(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() PHSTAT1: %04x, "
- "PHSTAT2: %04x\n", __func__,
- enc28j60_phy_read(priv, PHSTAT1), reg);
- duplex = reg & PHSTAT2_DPXSTAT;
- if (reg & PHSTAT2_LSTAT) {
- netif_carrier_on(ndev);
- if (netif_msg_ifup(priv))
- dev_info(&ndev->dev, "link up - %s\n",
- duplex ? "Full duplex" : "Half duplex");
- } else {
- if (netif_msg_ifdown(priv))
- dev_info(&ndev->dev, "link down\n");
- netif_carrier_off(ndev);
- }
- }
- static void enc28j60_tx_clear(struct net_device *ndev, bool err)
- {
- struct enc28j60_net *priv = netdev_priv(ndev);
- if (err)
- ndev->stats.tx_errors++;
- else
- ndev->stats.tx_packets++;
- if (priv->tx_skb) {
- if (!err)
- ndev->stats.tx_bytes += priv->tx_skb->len;
- dev_kfree_skb(priv->tx_skb);
- priv->tx_skb = NULL;
- }
- locked_reg_bfclr(priv, ECON1, ECON1_TXRTS);
- netif_wake_queue(ndev);
- }
- /*
- * RX handler
- * ignore PKTIF because is unreliable! (look at the errata datasheet)
- * check EPKTCNT is the suggested workaround.
- * We don't need to clear interrupt flag, automatically done when
- * enc28j60_hw_rx() decrements the packet counter.
- * Returns how many packet processed.
- */
- static int enc28j60_rx_interrupt(struct net_device *ndev)
- {
- struct enc28j60_net *priv = netdev_priv(ndev);
- int pk_counter, ret;
- pk_counter = locked_regb_read(priv, EPKTCNT);
- if (pk_counter && netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME ": intRX, pk_cnt: %d\n", pk_counter);
- if (pk_counter > priv->max_pk_counter) {
- /* update statistics */
- priv->max_pk_counter = pk_counter;
- if (netif_msg_rx_status(priv) && priv->max_pk_counter > 1)
- printk(KERN_DEBUG DRV_NAME ": RX max_pk_cnt: %d\n",
- priv->max_pk_counter);
- }
- ret = pk_counter;
- while (pk_counter-- > 0)
- enc28j60_hw_rx(ndev);
- return ret;
- }
- static void enc28j60_irq_work_handler(struct work_struct *work)
- {
- struct enc28j60_net *priv =
- container_of(work, struct enc28j60_net, irq_work);
- struct net_device *ndev = priv->netdev;
- int intflags, loop;
- if (netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() enter\n", __func__);
- /* disable further interrupts */
- locked_reg_bfclr(priv, EIE, EIE_INTIE);
- do {
- loop = 0;
- intflags = locked_regb_read(priv, EIR);
- /* DMA interrupt handler (not currently used) */
- if ((intflags & EIR_DMAIF) != 0) {
- loop++;
- if (netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME
- ": intDMA(%d)\n", loop);
- locked_reg_bfclr(priv, EIR, EIR_DMAIF);
- }
- /* LINK changed handler */
- if ((intflags & EIR_LINKIF) != 0) {
- loop++;
- if (netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME
- ": intLINK(%d)\n", loop);
- enc28j60_check_link_status(ndev);
- /* read PHIR to clear the flag */
- enc28j60_phy_read(priv, PHIR);
- }
- /* TX complete handler */
- if ((intflags & EIR_TXIF) != 0) {
- bool err = false;
- loop++;
- if (netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME
- ": intTX(%d)\n", loop);
- priv->tx_retry_count = 0;
- if (locked_regb_read(priv, ESTAT) & ESTAT_TXABRT) {
- if (netif_msg_tx_err(priv))
- dev_err(&ndev->dev,
- "Tx Error (aborted)\n");
- err = true;
- }
- if (netif_msg_tx_done(priv)) {
- u8 tsv[TSV_SIZE];
- enc28j60_read_tsv(priv, tsv);
- enc28j60_dump_tsv(priv, "Tx Done", tsv);
- }
- enc28j60_tx_clear(ndev, err);
- locked_reg_bfclr(priv, EIR, EIR_TXIF);
- }
- /* TX Error handler */
- if ((intflags & EIR_TXERIF) != 0) {
- u8 tsv[TSV_SIZE];
- loop++;
- if (netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME
- ": intTXErr(%d)\n", loop);
- locked_reg_bfclr(priv, ECON1, ECON1_TXRTS);
- enc28j60_read_tsv(priv, tsv);
- if (netif_msg_tx_err(priv))
- enc28j60_dump_tsv(priv, "Tx Error", tsv);
- /* Reset TX logic */
- mutex_lock(&priv->lock);
- nolock_reg_bfset(priv, ECON1, ECON1_TXRST);
- nolock_reg_bfclr(priv, ECON1, ECON1_TXRST);
- nolock_txfifo_init(priv, TXSTART_INIT, TXEND_INIT);
- mutex_unlock(&priv->lock);
- /* Transmit Late collision check for retransmit */
- if (TSV_GETBIT(tsv, TSV_TXLATECOLLISION)) {
- if (netif_msg_tx_err(priv))
- printk(KERN_DEBUG DRV_NAME
- ": LateCollision TXErr (%d)\n",
- priv->tx_retry_count);
- if (priv->tx_retry_count++ < MAX_TX_RETRYCOUNT)
- locked_reg_bfset(priv, ECON1,
- ECON1_TXRTS);
- else
- enc28j60_tx_clear(ndev, true);
- } else
- enc28j60_tx_clear(ndev, true);
- locked_reg_bfclr(priv, EIR, EIR_TXERIF);
- }
- /* RX Error handler */
- if ((intflags & EIR_RXERIF) != 0) {
- loop++;
- if (netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME
- ": intRXErr(%d)\n", loop);
- /* Check free FIFO space to flag RX overrun */
- if (enc28j60_get_free_rxfifo(priv) <= 0) {
- if (netif_msg_rx_err(priv))
- printk(KERN_DEBUG DRV_NAME
- ": RX Overrun\n");
- ndev->stats.rx_dropped++;
- }
- locked_reg_bfclr(priv, EIR, EIR_RXERIF);
- }
- /* RX handler */
- if (enc28j60_rx_interrupt(ndev))
- loop++;
- } while (loop);
- /* re-enable interrupts */
- locked_reg_bfset(priv, EIE, EIE_INTIE);
- if (netif_msg_intr(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() exit\n", __func__);
- }
- /*
- * Hardware transmit function.
- * Fill the buffer memory and send the contents of the transmit buffer
- * onto the network
- */
- static void enc28j60_hw_tx(struct enc28j60_net *priv)
- {
- if (netif_msg_tx_queued(priv))
- printk(KERN_DEBUG DRV_NAME
- ": Tx Packet Len:%d\n", priv->tx_skb->len);
- if (netif_msg_pktdata(priv))
- dump_packet(__func__,
- priv->tx_skb->len, priv->tx_skb->data);
- enc28j60_packet_write(priv, priv->tx_skb->len, priv->tx_skb->data);
- #ifdef CONFIG_ENC28J60_WRITEVERIFY
- /* readback and verify written data */
- if (netif_msg_drv(priv)) {
- int test_len, k;
- u8 test_buf[64]; /* limit the test to the first 64 bytes */
- int okflag;
- test_len = priv->tx_skb->len;
- if (test_len > sizeof(test_buf))
- test_len = sizeof(test_buf);
- /* + 1 to skip control byte */
- enc28j60_mem_read(priv, TXSTART_INIT + 1, test_len, test_buf);
- okflag = 1;
- for (k = 0; k < test_len; k++) {
- if (priv->tx_skb->data[k] != test_buf[k]) {
- printk(KERN_DEBUG DRV_NAME
- ": Error, %d location differ: "
- "0x%02x-0x%02x\n", k,
- priv->tx_skb->data[k], test_buf[k]);
- okflag = 0;
- }
- }
- if (!okflag)
- printk(KERN_DEBUG DRV_NAME ": Tx write buffer, "
- "verify ERROR!\n");
- }
- #endif
- /* set TX request flag */
- locked_reg_bfset(priv, ECON1, ECON1_TXRTS);
- }
- static int enc28j60_send_packet(struct sk_buff *skb, struct net_device *dev)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- if (netif_msg_tx_queued(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() enter\n", __func__);
- /* If some error occurs while trying to transmit this
- * packet, you should return '1' from this function.
- * In such a case you _may not_ do anything to the
- * SKB, it is still owned by the network queueing
- * layer when an error is returned. This means you
- * may not modify any SKB fields, you may not free
- * the SKB, etc.
- */
- netif_stop_queue(dev);
- /* save the timestamp */
- priv->netdev->trans_start = jiffies;
- /* Remember the skb for deferred processing */
- priv->tx_skb = skb;
- schedule_work(&priv->tx_work);
- return 0;
- }
- static void enc28j60_tx_work_handler(struct work_struct *work)
- {
- struct enc28j60_net *priv =
- container_of(work, struct enc28j60_net, tx_work);
- /* actual delivery of data */
- enc28j60_hw_tx(priv);
- }
- static irqreturn_t enc28j60_irq(int irq, void *dev_id)
- {
- struct enc28j60_net *priv = dev_id;
- /*
- * Can't do anything in interrupt context because we need to
- * block (spi_sync() is blocking) so fire of the interrupt
- * handling workqueue.
- * Remember that we access enc28j60 registers through SPI bus
- * via spi_sync() call.
- */
- schedule_work(&priv->irq_work);
- return IRQ_HANDLED;
- }
- static void enc28j60_tx_timeout(struct net_device *ndev)
- {
- struct enc28j60_net *priv = netdev_priv(ndev);
- if (netif_msg_timer(priv))
- dev_err(&ndev->dev, DRV_NAME " tx timeout\n");
- ndev->stats.tx_errors++;
- /* can't restart safely under softirq */
- schedule_work(&priv->restart_work);
- }
- /*
- * Open/initialize the board. This is called (in the current kernel)
- * sometime after booting when the 'ifconfig' program is run.
- *
- * This routine should set everything up anew at each open, even
- * registers that "should" only need to be set once at boot, so that
- * there is non-reboot way to recover if something goes wrong.
- */
- static int enc28j60_net_open(struct net_device *dev)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() enter\n", __func__);
- if (!is_valid_ether_addr(dev->dev_addr)) {
- if (netif_msg_ifup(priv))
- dev_err(&dev->dev, "invalid MAC address %pM\n",
- dev->dev_addr);
- return -EADDRNOTAVAIL;
- }
- /* Reset the hardware here (and take it out of low power mode) */
- enc28j60_lowpower(priv, false);
- enc28j60_hw_disable(priv);
- if (!enc28j60_hw_init(priv)) {
- if (netif_msg_ifup(priv))
- dev_err(&dev->dev, "hw_reset() failed\n");
- return -EINVAL;
- }
- /* Update the MAC address (in case user has changed it) */
- enc28j60_set_hw_macaddr(dev);
- /* Enable interrupts */
- enc28j60_hw_enable(priv);
- /* check link status */
- enc28j60_check_link_status(dev);
- /* We are now ready to accept transmit requests from
- * the queueing layer of the networking.
- */
- netif_start_queue(dev);
- return 0;
- }
- /* The inverse routine to net_open(). */
- static int enc28j60_net_close(struct net_device *dev)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": %s() enter\n", __func__);
- enc28j60_hw_disable(priv);
- enc28j60_lowpower(priv, true);
- netif_stop_queue(dev);
- return 0;
- }
- /*
- * Set or clear the multicast filter for this adapter
- * num_addrs == -1 Promiscuous mode, receive all packets
- * num_addrs == 0 Normal mode, filter out multicast packets
- * num_addrs > 0 Multicast mode, receive normal and MC packets
- */
- static void enc28j60_set_multicast_list(struct net_device *dev)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- int oldfilter = priv->rxfilter;
- if (dev->flags & IFF_PROMISC) {
- if (netif_msg_link(priv))
- dev_info(&dev->dev, "promiscuous mode\n");
- priv->rxfilter = RXFILTER_PROMISC;
- } else if ((dev->flags & IFF_ALLMULTI) || dev->mc_count) {
- if (netif_msg_link(priv))
- dev_info(&dev->dev, "%smulticast mode\n",
- (dev->flags & IFF_ALLMULTI) ? "all-" : "");
- priv->rxfilter = RXFILTER_MULTI;
- } else {
- if (netif_msg_link(priv))
- dev_info(&dev->dev, "normal mode\n");
- priv->rxfilter = RXFILTER_NORMAL;
- }
- if (oldfilter != priv->rxfilter)
- schedule_work(&priv->setrx_work);
- }
- static void enc28j60_setrx_work_handler(struct work_struct *work)
- {
- struct enc28j60_net *priv =
- container_of(work, struct enc28j60_net, setrx_work);
- if (priv->rxfilter == RXFILTER_PROMISC) {
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": promiscuous mode\n");
- locked_regb_write(priv, ERXFCON, 0x00);
- } else if (priv->rxfilter == RXFILTER_MULTI) {
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": multicast mode\n");
- locked_regb_write(priv, ERXFCON,
- ERXFCON_UCEN | ERXFCON_CRCEN |
- ERXFCON_BCEN | ERXFCON_MCEN);
- } else {
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": normal mode\n");
- locked_regb_write(priv, ERXFCON,
- ERXFCON_UCEN | ERXFCON_CRCEN |
- ERXFCON_BCEN);
- }
- }
- static void enc28j60_restart_work_handler(struct work_struct *work)
- {
- struct enc28j60_net *priv =
- container_of(work, struct enc28j60_net, restart_work);
- struct net_device *ndev = priv->netdev;
- int ret;
- rtnl_lock();
- if (netif_running(ndev)) {
- enc28j60_net_close(ndev);
- ret = enc28j60_net_open(ndev);
- if (unlikely(ret)) {
- dev_info(&ndev->dev, " could not restart %d\n", ret);
- dev_close(ndev);
- }
- }
- rtnl_unlock();
- }
- /* ......................... ETHTOOL SUPPORT ........................... */
- static void
- enc28j60_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
- {
- strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
- strlcpy(info->version, DRV_VERSION, sizeof(info->version));
- strlcpy(info->bus_info,
- dev_name(dev->dev.parent), sizeof(info->bus_info));
- }
- static int
- enc28j60_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- cmd->transceiver = XCVR_INTERNAL;
- cmd->supported = SUPPORTED_10baseT_Half
- | SUPPORTED_10baseT_Full
- | SUPPORTED_TP;
- cmd->speed = SPEED_10;
- cmd->duplex = priv->full_duplex ? DUPLEX_FULL : DUPLEX_HALF;
- cmd->port = PORT_TP;
- cmd->autoneg = AUTONEG_DISABLE;
- return 0;
- }
- static int
- enc28j60_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
- {
- return enc28j60_setlink(dev, cmd->autoneg, cmd->speed, cmd->duplex);
- }
- static u32 enc28j60_get_msglevel(struct net_device *dev)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- return priv->msg_enable;
- }
- static void enc28j60_set_msglevel(struct net_device *dev, u32 val)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- priv->msg_enable = val;
- }
- static const struct ethtool_ops enc28j60_ethtool_ops = {
- .get_settings = enc28j60_get_settings,
- .set_settings = enc28j60_set_settings,
- .get_drvinfo = enc28j60_get_drvinfo,
- .get_msglevel = enc28j60_get_msglevel,
- .set_msglevel = enc28j60_set_msglevel,
- };
- static int enc28j60_chipset_init(struct net_device *dev)
- {
- struct enc28j60_net *priv = netdev_priv(dev);
- return enc28j60_hw_init(priv);
- }
- static const struct net_device_ops enc28j60_netdev_ops = {
- .ndo_open = enc28j60_net_open,
- .ndo_stop = enc28j60_net_close,
- .ndo_start_xmit = enc28j60_send_packet,
- .ndo_set_multicast_list = enc28j60_set_multicast_list,
- .ndo_set_mac_address = enc28j60_set_mac_address,
- .ndo_tx_timeout = enc28j60_tx_timeout,
- .ndo_change_mtu = eth_change_mtu,
- .ndo_validate_addr = eth_validate_addr,
- };
- static int __devinit enc28j60_probe(struct spi_device *spi)
- {
- struct net_device *dev;
- struct enc28j60_net *priv;
- int ret = 0;
- if (netif_msg_drv(&debug))
- dev_info(&spi->dev, DRV_NAME " Ethernet driver %s loaded\n",
- DRV_VERSION);
- dev = alloc_etherdev(sizeof(struct enc28j60_net));
- if (!dev) {
- if (netif_msg_drv(&debug))
- dev_err(&spi->dev, DRV_NAME
- ": unable to alloc new ethernet\n");
- ret = -ENOMEM;
- goto error_alloc;
- }
- priv = netdev_priv(dev);
- priv->netdev = dev; /* priv to netdev reference */
- priv->spi = spi; /* priv to spi reference */
- priv->msg_enable = netif_msg_init(debug.msg_enable,
- ENC28J60_MSG_DEFAULT);
- mutex_init(&priv->lock);
- INIT_WORK(&priv->tx_work, enc28j60_tx_work_handler);
- INIT_WORK(&priv->setrx_work, enc28j60_setrx_work_handler);
- INIT_WORK(&priv->irq_work, enc28j60_irq_work_handler);
- INIT_WORK(&priv->restart_work, enc28j60_restart_work_handler);
- dev_set_drvdata(&spi->dev, priv); /* spi to priv reference */
- SET_NETDEV_DEV(dev, &spi->dev);
- if (!enc28j60_chipset_init(dev)) {
- if (netif_msg_probe(priv))
- dev_info(&spi->dev, DRV_NAME " chip not found\n");
- ret = -EIO;
- goto error_irq;
- }
- random_ether_addr(dev->dev_addr);
- enc28j60_set_hw_macaddr(dev);
- /* Board setup must set the relevant edge trigger type;
- * level triggers won't currently work.
- */
- ret = request_irq(spi->irq, enc28j60_irq, 0, DRV_NAME, priv);
- if (ret < 0) {
- if (netif_msg_probe(priv))
- dev_err(&spi->dev, DRV_NAME ": request irq %d failed "
- "(ret = %d)\n", spi->irq, ret);
- goto error_irq;
- }
- dev->if_port = IF_PORT_10BASET;
- dev->irq = spi->irq;
- dev->netdev_ops = &enc28j60_netdev_ops;
- dev->watchdog_timeo = TX_TIMEOUT;
- SET_ETHTOOL_OPS(dev, &enc28j60_ethtool_ops);
- enc28j60_lowpower(priv, true);
- ret = register_netdev(dev);
- if (ret) {
- if (netif_msg_probe(priv))
- dev_err(&spi->dev, "register netdev " DRV_NAME
- " failed (ret = %d)\n", ret);
- goto error_register;
- }
- dev_info(&dev->dev, DRV_NAME " driver registered\n");
- return 0;
- error_register:
- free_irq(spi->irq, priv);
- error_irq:
- free_netdev(dev);
- error_alloc:
- return ret;
- }
- static int __devexit enc28j60_remove(struct spi_device *spi)
- {
- struct enc28j60_net *priv = dev_get_drvdata(&spi->dev);
- if (netif_msg_drv(priv))
- printk(KERN_DEBUG DRV_NAME ": remove\n");
- unregister_netdev(priv->netdev);
- free_irq(spi->irq, priv);
- free_netdev(priv->netdev);
- return 0;
- }
- static struct spi_driver enc28j60_driver = {
- .driver = {
- .name = DRV_NAME,
- .owner = THIS_MODULE,
- },
- .probe = enc28j60_probe,
- .remove = __devexit_p(enc28j60_remove),
- };
- static int __init enc28j60_init(void)
- {
- msec20_to_jiffies = msecs_to_jiffies(20);
- return spi_register_driver(&enc28j60_driver);
- }
- module_init(enc28j60_init);
- static void __exit enc28j60_exit(void)
- {
- spi_unregister_driver(&enc28j60_driver);
- }
- module_exit(enc28j60_exit);
- MODULE_DESCRIPTION(DRV_NAME " ethernet driver");
- MODULE_AUTHOR("Claudio Lanconelli <lanconelli.claudio@eptar.com>");
- MODULE_LICENSE("GPL");
- module_param_named(debug, debug.msg_enable, int, 0);
- MODULE_PARM_DESC(debug, "Debug verbosity level (0=none, ..., ffff=all)");
|