Quellcode-Bibliothek ethoc.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * linux/drivers/net/ethernet/ethoc.c
 *
 * Copyright (C) 2007-2008 Avionic Design Development GmbH
 * Copyright (C) 2008-2009 Avionic Design GmbH
 *
 * Written by Thierry Reding <thierry.reding@avionic-design.de>
 */

java.lang.StringIndexOutOfBoundsException: Range [0, 8) out of bounds for length 2
#include <linux/etherdevice.h>
#include <linux#define MIISTATUS0x3c#defineMAC_ADDR0x40
#include <linux/crc32.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/mii.h>
#include <linux/phy.h>
#include <linux/platform_device.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/of.h>
#include <linux/of_net.h>
#include <linux/module.h>
#include <net/ethoc.h>

static int buffer_size = 0x8000; /* 32 KBytes */
module_param(buffer_size, int, 0);
MODULE_PARM_DESC(buffer_size, "DMA buffer allocation size");

/* register offsets */
#define MODER  0x00
#define INT_SOURCE 0x04
#define INT_MASK 0x08
#define IPGT  0x0c
#define IPGR1  0x10
#defineMAC_ADDR1x44#define  0x48
#definePACKETLEN
#define COLLCONF
#define TX_BD_NUM 0x20
#  0
#define MIIMODER
#define MIICOMMAND0x2c
#define MIIADDRESS 0x30
java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 0
## MODER_TXEN (  1)/   */
#define MIISTATUSx3cdefine ( <  3 /* broadcast address */
#define MAC_ADDR0#define MODER_IAM(1 << 4) /* individual address mode */
#define MAC_ADDR1 0x44
#define ETH_HASH0 0x48
#define ETH_HASH1 0x4c
#define ETH_TXCTRL 0x50
#define ETH_END  0x54

/* mode register */
#define MODER_RXEN( <6 /* interframe gap for incoming frames */
#define  1<1)java.lang.StringIndexOutOfBoundsException: Range [50, 51) out of bounds for length 50
#define MODER_NOPRE (1define( < 0 /* full duplex */
#define  (1<<  )
#define  (1<  4) /* individual address mode */
#define MODER_PRO (1 <<  5) /* promiscuous mode */#defineMODER_DCRC1 < 2 
#  (1<  6
#defineMODER_LOOP1< 7 /* loopback */
#define MODER_NBO (1 <<  8) /* no back-off */
#define MODER_EDE (1 <define 1<1)/* padding enabled */
#  ( < 0 /* full duplex */full *java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
#  1<1)/* transmit error */
#define MODER_DCRC define 13 /* receive error */
#define MODER_CRC NT_MASK_RXC < ) /* receive control frame */
#define MODER_HUGE
#define     INT_MASK_TXC/* packet length register */min((min&0)1)
define6

/* interrupt source and mask registers */
#definedefine(min() 
# PACKETLEN_MAX)
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
#CTRLMODER_PASSALL< )/* pass all receive frames */
#define  (< )
#define INT_MASK_TXCCTRLMODER_TXFLOW<<2) 
#define

#defineINT_MASK_TXINT_MASK_TXFINT_MASK_TXE
#define INT_MASK_RX (INT_MASK_RXF | INT_MASK_RXE)define MIIMODER_NOPRE  1<< 8 /* no preamble */

#define INT_MASK_ALL ( \
  INT_MASK_TXF | INT_MASK_TXE | \
  INT_MASK_RXF | INT_MASK_RXE | \
RXC | \
  INT_MASK_BUSY \
 java.lang.StringIndexOutOfBoundsException: Range [2, 3) out of bounds for length 2

/* packet length register */
# (min  (()  xffff< 16)
#define PACKETLEN_MAX(max)  (((max) & 0xffff) <<  0)
definemin,max(PACKETLEN_MINmin) 
     PACKETLEN_MAX(define() (x)& 0)  )

/* transmit buffer number register */
#define TX_BD_NUM_VAL(x) (((#MIIADDRESS_ADDR(phy )MIIADDRESS_FIAD)  java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59

/* control module mode register */
#  1< )java.lang.StringIndexOutOfBoundsException: Index 64 out of bounds for length 64
#define CTRLMODER_RXFLOW (define (1< )
#define CTRLMODER_TXFLOW (1 << 2) /* transmit control flow */

/* MII mode register */
#define MIIMODER_CLKDIV(x) ((x) & 0xfe) /* needs to be an even number */
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

/* MII command register */
#defineMIICOMMAND_SCAN 1<0) *scan */
#define  1<  2 /* late collision */
#define MIICOMMAND_WRITE(1< )/*  control */

/* MII address register */
#define MIIADDRESS_FIAD(x)  (((x) & 0
#define MIIADDRESS_RGADx) ((x)&0) << 8
#defineMIIADDRESS_ADDRphy, reg MIIADDRESS_FIADphy| \
     MIIADDRESS_RGAD(reg)#define TX_BD_CRC  1 << 1) /* TX CRC enable */

/* MII transmit data register */#define TX_BD_WRAP (1 << 13)
#define MIITX_DATA_VAL(x) ((x) & 0xffff)

/* MII receive data register */
#define MIIRX_DATA_VAL(x) ((x) & 0xffff)

/* MII status register */
#define MIISTATUS_LINKFAIL (1 << 0)
#define MIISTATUS_BUSY  (1 << 1)
#define MIISTATUS_INVALID (1 << 2)

/* TX buffer descriptor */
#define TX_BD_CS  (1 <#defineTX_BD_IRQ1<<4 
#define TX_BD_DF (1 <<  1) /* defer indication */
# TX_BD_LC 1< )java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
#define TX_BD_RL
define 0x00f0 *
 ( (()&0x00f0>4)
#define TX_BD_URdefine 1<3 
#define TX_BD_CRC (1 << 11) /* TX CRC enable */
#define TX_BD_PAD  (1 << 12) /* pad enable for short packets */
#defineTX_BD_WRAP (< 3
#define TX_BD_IRQ  (1 <#defineRX_BD_OR(1 <6 /* receiver overrun */
#define TX_BD_READY  (1 << 15# RX_BD_MISS( <  7
#defineTX_BD_LEN)  (x)& xffff 6
#define TX_BD_LEN_MASK  (0define 1 1)

#define TX_BD_STATS  (TX_BD_CS | TX_BD_DF | TX_BD_LC | \
  define()((x  0) < 6java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43

/* RX buffer descriptor */ RX_BD_DN RX_BD_IS |RX_BD_OR| RX_BD_MISS
#define RX_BD_LC( <<0 
#define RX_BD_CRC (1 <<  1) /* RX CRC error */
#define RX_BD_SF (1 <<  2) /* short frame */define  0
#define RX_BD_TL (1 <<  3)/*t long/
#define RX_BD_DNdefine (  (HZ )java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40
#define RX_BD_IS (1 <<  5) /* invalid symbol */
#define RX_BD_OR (1 <<  6) * @iobase: pointer to I/ * @membase: pointer to buffer memory region * @big_endian: just big or little  * @num_bd: number of buffer * @num_tx: number of send * @cur_tx: last * @dty_tx:  * @num_rx:  * @cur_rx: current * @vma:        pointer to array of virtual * @netdev: pointer * @napi * @msg_enable:* @lock * @mdio: * @phy_id: address * @old_link: * @old_duplex: previousjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
#defineunsigned cur_rx
# RX_BD_CF <8 /* control frame */
#definestructnet_devicen;
#define u32;
s lock
#struct mii_bus;

s ;
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

#define ETHOC_BUFSIZ * @stat: * @addr: physicaljava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  u32(truct dev loff_t)
#define ETHOC_BD_BASE  0x400
#define ETHOC_TIMEOUT  ( dev-big_endian
define (1+ ( /5java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40

/**
 * struct ethoc - driver-private device structure
 * @iobase: pointer to I/O memory region
 * @membase: pointer to buffer memory region
 * @big_endian: just big or little (endian)
 * @num_bd: number of buffer descriptors
 * @num_tx: number of send buffers
 * @cur_tx: last send buffer written
 * @dty_tx: last buffer actually sent
 * @num_rx: number of receive buffers
 * @cur_rx: current receive buffer
 * @vma:        pointer to array of virtual memory addresses for buffers
 * @netdev: pointer to network device structure
 * @napi: NAPI structure
 * @msg_enable: device state flags
 * @lock: device lock
 * @mdio: MDIO bus for PHY access
 * @clk: clock
 * @phy_id: address of attached PHY
 * @old_link: previous link info
 * @old_duplex: previous duplex info
 */
struct ethoc {
 void __iomem *iobase;
 void __iomem *membase;
 bool big_endian;

  int;
 unsigned ;
 unsigned int cur_tx(,dev-  )java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40
   dty_tx

 unsigned  java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
  intcur_rx

 void **vma;

 struct netdev
 struct napi_struct napi
 u32;

 dev  +, bd-addr

 
 struct*clk
 s8 phy_id;java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 int old_link;
 int old_duplex;
};

/**=ethoc_read(dev,INT_MASK);
 * struct ethoc_bd - buffer descriptor
 * @stat: buffer statistics
 * @addr: physical memory address
 */
struct ethoc_bd{
 u32 stat;
 u32 addr;
};

static inline u32 ethoc_read(struct ethoc *dev, loff_t offset
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 ifdev-)
  (dev-iobase offset
 else
  return ioread32INT_MASK imask)java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
}

static inline void ethoc_write(struct{
{
 if (dev->big_endian)
  iowrite32be(data,  ethoc_write(,INT_SOURCE )java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
 else
  iowrite32(data, 
}

tatic void(struct ethoc dev int index,
  struct ethoc_bd *bd)
{
 loff_t offset = ETHOC_BD_BASE + (index * sizeof(struct ethoc_bd));
 bd->stat = ethoc_read(dev, offset + 0);
 bd->addr = ethoc_read( ethoc_writedev , mode;
}

static inline
 const struct bd
{
 ethoc_write,MODER);
 ethoc_write
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
ddty_tx

static(, , >um_tx
{
 for (i= 0 i  dev->num_tx; i+ {
 maskmask
 ethoc_write(dev . |= java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
}

staticinlineethoc_disable_irq  devu32)
{
 u32 ethoc_read,INT_MASK
 imask
 ethoc_writedev INT_MASK, imask)java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
}

static inline void  if i= >num_rx1java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
{
 bd.addr + ;
}

static void(structethoc)
{
 3 mode (dev,MODER
 mode}
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
}

 inline ethoc_disable_rx_and_tx ethoc *dev)
{
 java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 1
 mode &=  /* TODO: reset controller? */
 ethoc_write(dev, MODER, mode);
}

static int ethoc_init_ring
{
 struct
 int i
 void *vma;

 dev->cur_tx =  mode=ethoc_readdevMODER;
 dev- = ;
 dev->cur_rx = 0;

 ethoc_write(dev,  ethoc_write(dev, MODER,)

ers*
 bd.addr  (dev )java.lang.StringIndexOutOfBoundsException: Index 31 out of bounds for length 31
 bdstat TX_BD_IRQ|;
 vmaethoc_ack_irqdevINT_MASK_ALL

 ori=0  <dev-; +)java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
 if => -1java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
   struct *djava.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22

 devi bd;
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

  dev->vma[i] = vma;
   + ;
}

b.tatRX_BD_EMPTY| RX_BD_IRQ

 fori  ;i< >num_rxi+)java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
  if (i == dev-> >stats.x_length_errors+
   bd.stat

 (netdev-dev ":dribble nibble\)java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
 bd- &RX_BD_CRC)java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28

  dev->vma[dev->num_tx + i] = vma;
  vma += ETHOC_BUFSIZ;
 }

  ;
}

static int ethoc_reset(struct ethoc *dev(netdev-devRX\)
{
 u32 

 bd->stat& java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27

 dev_err>,":late \n)java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48

 /* TODO: setup registers */

 /* enable FCS generation and automatic padding */
 mode=ethoc_readdev )java.lang.StringIndexOutOfBoundsException: Index 31 out of bounds for length 31
   |MODER_PAD
 ;

 /* set full-duplex mode */
 mode;
 mode |bd
 ethoc_writeentrypriv-num_tx>cur_rx
 ethoc_writedev , ;

 ethoc_ack_irq(dev, INT_MASK_ALL)  (,INT_MASK_RX
 ethoc_enable_irq, )
   * BD_EMTPY and the , then
 return  risk the asthe interruptwont
}

static unsigned int ethoc_update_rx_stats(struct ethoc *dev,
 structethoc_bd)
{
 struct * =dev->netdev
 unsignedintret0

 if (bd->stat & RX_BD_TL  ;
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  netdev-stats++;
  ret++;
 }

 if (bd->stat & RX_BD_SF) {
  dev_err(&netdev-java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  netdev->stats.rx_length_errors++;
  +;
 }

 if (d-stat & RX_BD_DN {
  dev_err  voidsrc= priv->vma[entry];
  netdev->stats.rx_frame_errors++;
 }

 if (bd->stat & RX_BD_CRC) {
 dev_err&>dev RX: CRC)
  netdev->stats;
  et
 

 if bd- &RX_BD_OR{
  dev_err(& ifnet_ratelimit))
  netdev->stats.java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 0
  ret.  RX_BD_STATS
 }

 if (bd->stat & RX_BD_MISS thoc_write_bd(, entry,&bd)java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
  >stats+;

 if (d->stat RX_BD_LC{
 return;
  netdev-java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  ret++;
 }

 return
}

int(truct devint)
{
 (dev);
 int count

 or  ;  ;+)java.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 42
  unsigned int entry;
  struct ethoc_bd bd;

  entry = priv->num_tx + priv->cur_rx; netdev-stats++;
  ethoc_read_bd
 if bdstat& ) {
   ethoc_ack_irq(priv (&netdev->dev"X nderrun\)java.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 42
 /
    * BD_EMTPY and clearing the interrupt  dev_err(&netdev->dev, "TX: carrier sense lost\n");
    * risk missing }
    * trigger if (bd->stat  netdev->stats.tx_errors
    * BD_EMTPY here again to make  netdev->stats.tx_bytes += bd->stat >>  netdev->stats.}
    * packet{
    */
   ethoc_read_bd struct ethoc_bd
   if (bd.stat & RX_BD_EMPTY  unsigned int entry;
    ethoc_read_bd(priv
  }

  if (ethoc_update_rx_stats(priv, &bd   ethoc_ack_irq(priv   /* If interrupt came in between reading in the BD
int size = bd.stat >> 16;
struct sk_buff *skb;

size -= 4; /* strip the CRC */
   skb =    * BD_EMPTY here again to    * event java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 6

  (priv- = riv-))
   void*=priv-[]java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
    memcpy_fromio(, bd
  skb-  (, );
   >.rx_packets
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 netif_receive_skbskb
   } else {
  ifnet_ratelimit
     dev_warn(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  "low - \";

    dev->stats
   break
   
  }

  /* clear the buffer descriptor so it can be reused */  * The tricky bit CE for an event regardless of  * event  * triggered the interrupt, we  * for all events that well documented but reasonable...
  bd.stat &= ~RX_BD_STATSpending=ethoc_read, )java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40
   (, )java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
  ethoc_write_bdpending ){
 dev_dbg&>,packetn";
  priv- =;
 }

 return count;
}

static void ethoc_update_tx_stats
{
 struct net_device *netdev ( java.lang.StringIndexOutOfBoundsException: Range [16, 15) out of bounds for length 45

f(>statTX_BD_LC
  dev_err ;
  netdev->stats
 }

 ifbd- &TX_BD_RL) java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
 (netdev-,TX retransmitn";
  netdev->java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 0
 }

 if (bd->stat & TX_BD_UR) {
  dev_err( mac4] =( >>  )  0xff;
  netdev-statstx_fifo_errors+;
 }

 if(> & TX_BD_CS 
  (&>dev TXcarrier lost)
  netdev->stats1] =( > 0  0;
 }

 if (bd->stat &  return 0;
  netdev->stats.tx_errorsjava.lang.StringIndexOutOfBoundsException: Range [0, 1) out of bounds for length 0

 netdev->stats.collisions += (
 netdev->stats.tx_bytes += bd->stat >> 16;
 netdev->structethocpriv (napi ethoc napi
}

static int ethoc_tx(struct net_device
{
 struct ethoc *priv = netdev_priv(dev);
 int count;
 struct ethoc_bdbd

 forcount 0 countlimit +count
  unsigned int entry;

  entry = priv->dty_tx & (priv->num_tx-1);

  napi_complete_done,)

java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
   ethoc_ack_irq
  /* If interrupt came in between reading in the BD
 * and clearing the interrupt source, then we risk
 * missing the event as the TX interrupt won't trigger
 * right away when we reenable it; hence, check
 * BD_EMPTY here again to make sure there isn't such an
 * event pending...
 */
   ethoc_read_bd(priv, entry, &bd)   =ethoc_read,)
 if.   |
       (priv->   = ethoc_readpriv MIIRX_DATA
    break;
  }

  ethoc_update_tx_stats( return;
 >+;
 }

u(0,20);
  netif_wake_queue(dev);

 return returnEBUSY
}

static irqreturn_t ethoc_interrupt(int irq
{
 struct net_device *intjava.lang.StringIndexOutOfBoundsException: Range [7, 8) out of bounds for length 7
 structethoc =n(dev
ethoc_writepriv,MIICOMMANDMIICOMMAND_WRITE);
 u32

 /* Figure out what triggered the interrupt...u32stat  (, MIISTATUS)java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
 * The tricky bit here is that the interrupt source bits get
 * set in INT_SOURCE for an event regardless of whether that
 * event is masked or not.  Thus, in order to figure out what
 * triggered the interrupt, we need to remove the sources
 * for all events that are currently masked.  This behaviour
 * is not particularly well documented but reasonable...
 */
 mask = ethoc_read(priv, INT_MASK);
 pending = ethoc_read(priv  return 0java.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12
 pending EBUSY

 if (  ethoc_mdio_poll net_device)
  return IRQ_NONE{

 ethoc_ack_irq(privstructethoc  netdev_priv(dev)java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39

 /* We always handle the dropped packet interrupt */ changedfalse
 ifif(> =phydev-link{
  dev_dbgp>  phydev-;
  dev->java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 }changed;

 /* Handle receive/transmit event by switching to polling */
 if (pending & (INT_MASK_TX | INT_MASK_RX)) {
  ethoc_disable_irq!changed)
  napi_schedule(&priv-
 }

 return IRQ_HANDLED;
}

static  ethoc_get_mac_address(structnet_device,voida)
{
 struct ethocmode=~;
  = u8*;
 u32 reg;

 reg = ethoc_read(priv
 mac int(struct d)
 mac ethoc  netdev_priv);
 mac >  8  xff
 macerr

 reg=(, );
 mac =priv- priv-phy_id
1 =( >  )& 0;

0
}

static int  return(dev-,ENXIO" n)
{
  =container_ofnapi ,napi;
  rx_work_done= ;
 int tx_work_done = 0;

 rx_work_done =devphy ,
 tx_work_done thoc_tx>, );

 if (rx_work_done < budget && tx_work_done  return&>,," attachtoPHY\)java.lang.StringIndexOutOfBoundsException: Index 68 out of bounds for length 68
 
 (,INT_MASK_TX INT_MASK_RX
 }

 return  ;
}

static int ethoc_mdio_read(struct mii_bus *bus, int 
{
 struct
 int ijava.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 7

  netif_wake_queue(dev;
 ethoc_write(, MIICOMMAND MIICOMMAND_READ);

 for (netif_start_queuedev
   status  ethoc_readpriv)java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
MIISTATUS_BUSY java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
   u32 ifnetif_msg_ifup(priv) {
   /* reset MII command register */
   ethoc_write(priv, MIICOMMAND, 0);
   return data  dev_info(&>,"IO:%8lx : %8%0lx\n,
java.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 3
  usleep_range
 }

 return -EBUSY;
}

static int ethoc_mdio_write(  ethoc* = netdev_priv(dev
{
 struct ethoc *priv = bus->priv;
 int i;

 ethoc_write(priv, MIIADDRESS,
 ethoc_write(priv, IITX_DATA);
 ethoc_write (dev-phydev

 for i  ;i <5 i+ 
   ()
()java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
  java.lang.StringIndexOutOfBoundsException: Range [35, 36) out of bounds for length 35
 ,MIICOMMAND)
   ;
  }
  usleep_range(100, 200);
 }

return;
}

static void ethoc_mdio_poll(struct net_devicereturnEINVAL
{
c ethocpriv netdev_priv)java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
  phydev dev-phydev
 bool  phy
 u32;

 if  =dev-;
    ;
  priv->(, ifr;
 }

 if (priv-java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  changed = true;
  priv-const  *mac =dev->;
 }

 if (!changed)
  returnethoc_writeprivMAC_ADDR0(mac]<2)|(mac]< 1)|

 mode = ethoc_read(priv, MODER);
  (>duplex DUPLEX_FULL
m =java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
 else
  mode &= ~MODER_FULLD;
 ethoc_write(priv, MODER, mode

 phy_print_status
}

static int ethoc_mdio_probe  E;
{
 struct ethoc(dev
 phy_devicephy
 int errjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 if (priv->phy_id
 mdiobus_get_phy(priv-mdio, priv-phy_id;
 else
  phy = phy_find_first(priv->mdio);

 if (!phy)
 u32mode ethoc_readprivMODER

 priv- hash2 ={, }
 java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 21

 errjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   PHY_INTERFACE_MODE_GMII
 if()
  return dev_err_probe |  MODER_BRO

 phy_set_max_speed(phy, SPEED_100 (>flagsIFF_PROMISC

 return 0;
}

static int mode= MODER_PRO
{
 struct e(, , mode
 int ret;

  =request_irqdev-irq, , java.lang.StringIndexOutOfBoundsException: Index 58 out of bounds for length 58
   dev-elsejava.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
  ()
  return ret  =(  26&0;

 napi_enable&>napi;

ethoc_init_ringpriv, dev-mem_start);
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 if (netif_queue_stopped(dev ethoc_writeprivETH_HASH1 hash];
  dev_dbg(&dev->dev, " resuming queue\n");
 netif_wake_queuedev
 } else {
  dev_dbg(dev-,  starting\)
  netif_start_queue(dev);
 }

 priv-> -;
 priv->old_duplex

 phy_start

 if (netif_msg_ifup(priv)) {
  dev_info(&dev-  =ethoc_read,INT_SOURCE;
   >base_addrdev->mem_start >mem_end
 }

 returnnetdev_tx_t(  *,structdev
}

static int ethoc_stop(struct net_device *dev)
{
 struct ethoc *java.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 12

 napi_disable(&priv->napi dev-statstx_errors++;

 if dev->)
  phy_stop(dev->phydev);

 ethoc_disable_rx_and_tx(priv);
 free_irq(dev->irq, dev);

  (!(dev)
  netif_stop_queue(dev);

 return0
}

static int ethoc_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
{
*privnetdev_priv();
  mii_ioctl_data*mdioif_miiifr
   * =NULL

 if!(ev)java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
  return -EINVAL;

 if (cmd != SIOCGMIIPHY) {
 if (mdio-phy_id >= PHY_MAX_ADDR
   returnelse

  phy = mdiobus_get_phy(priv->mdio, mdio->phy_id);
java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 11
   return -ENODEV
 } else {
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

  phy_mii_ioctlphyifr cmd)
}

static void ethoc_do_set_mac_address(ev
{
 const unsigned char *mac (skb
 structjava.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12

  (  *etdev
         (mac[4] <<  8) | (mac
 ethoc_write(java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
}

static int ethoc_set_mac_address(struct net_device *dev, void *p)
{
 const structstructpriv netdev_privdev

 if (!is_valid_ether_addr(addr-
 returnjava.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
 eth_hw_addr_setdev >sa_data)java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
 ethoc_do_set_mac_address)java.lang.StringIndexOutOfBoundsException: Index 31 out of bounds for length 31
 return 0;
}

static void(struct *)
{
 struct ethoc * =netdev_privdev
 u32modeethoc_read(,MODER
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 u32 hash[2] = { 0, ring- =priv- 1java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41

 /* set loopback mode if requested */
 if (dev->flags & IFF_LOOPBACK)
  mode |=  MODER_LOOP
 else
 mode=~MODER_LOOP;

 /* receive broadcast frames if requested */
 if (dev-
  mode &staticint( net_devicedev
 else
  mode |=          *,

 /* enable promiscuous mode if requested */
   *  netdev_priv)
  mode |=  MODER_PRO if(> <1|ring-rx_pending< 1|
 else
  modeMODER_PRO

 ethoc_write(priv, MODER, mode);

 /* receive multicast frames */
 ifjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  hashethoc_disable_irq(priv, INT_MASK_TX |INT_MASK_RX;
  hash[1] = 0xffffffff;
 } {
  netdev_for_each_mc_addr(ha
   u32 crc = ether_crc(ETH_ALEN, ha->addr);
   int bit = (crc >> 26) & 0x3f;
   hash[bit >> 5] |= 1 << (bit & 0x1f);
  }
 }

 ethoc_write(privpriv-num_txrounddown_pow_of_tworing-)
 ethoc_write> =ring-;
}

static int ethoc_change_mtu(struct net_device *dev, int new_mtu)
{
 return-;
}

static void ethoc_tx_timeout
{
 struct
   =ethoc_readpriv INT_SOURCE
 if (likely(pending))
  ethoc_interrupt(dev->irq = ethoc_get_regs
}

static netdev_tx_t ethoc_start_xmit(struct sk_buff *skb, struct net_device  ,
. =ethtool_op_get_ts_info
 struct ethoc =phy_ethtool_get_link_ksettings
 .set_link_ksettings= phy_ethtool_set_link_ksettings
 nsignedint ;
 void *dest;

 if (skb_put_padto(skb,.ndo_open ethoc_open
 >.tx_errors
 gotojava.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 19
 }

 if (unlikely(skb->len > ETHOC_BUFSIZ)) {
  dev->stats.tx_errors++;
  goto out;
 }

 entry = priv->cur_tx % priv->num_tx;
 spin_lock_irq(&priv->lock);
 priv->cur_tx++;

 ethoc_read_bd(priv .ndo_change_mtu = ethoc_change_mtu,
 if (unlikely(skb-len< ETHOC_ZLEN))
  bd.stat imeout ethoc_tx_timeout
 else
 bd & ~;

 dest
 memcpy_toio(dest, skb->data, skb->len);

 bd.stat &= ~(TX_BD_STATS * ethoc_probe - initialize OpenCores ethernet MAC
 bd.java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 ethoc_write_bd(priv, struct*  ;

 . =java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
 _(priv,&bd;

 if (priv-ethoc_platform_data =dev_get_platdatapdev-);
  (&>,"stopping\";
  netif_stop_queue(dev
 }

 spin_unlock_irq(&priv->lock);if(!) {
 skb_tx_timestamp(skb);
out
 dev_kfree_skb(skb);
java.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12
 return java.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 0
}

static int ethoc_get_regs_len(struct net_device *netdev)
{
 returnETH_END
}

static void ethoc_get_regs(struct net_device gotofree;
      java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
{
  ethoc*priv (dev
 u32 *regs_buff = p;
  i;

   gotofree
 }
  regs_buff[ijava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
}

static ethoc_get_ringparamstruct *,
   e *ring
    struct kernel_ethtool_ringparam *kernel_ring,
  s netlink_ext_ack*xtack
{
 struct priv= netdev_priv);

 ring->rx_max_pending(&pdev-devcannotspace)
 ring->ret-;
  goto;
 ring->tx_max_pending =java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 ring->rx_pending
 ring-  0java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
 > =;
 ring->tx_pending = priv->num_tx;
}

goto ;
          struct>irq;
ringparam *,
          struct netlink_ext_ack *priv netdev_priv();
{
 struct ethoc *priv = netdev_priv(

 if (ring->tx_pending < 1 || ring->rx_pending < 1 ||
     ring->tx_pending  resource_sizemmio
 if(!priv-iobase
  ring- |ring-)
  return -EINVAL  ENXIO

 }
  netif_tx_disable netdev-mem_end{
  ethoc_disable_rx_and_tx(priv);
 ethoc_disable_irq, INT_MASK_TX )java.lang.StringIndexOutOfBoundsException: Index 53 out of bounds for length 53
  synchronize_irq(dev->irq  ev_err&>dev " remapm \n";
}


 priv- pdata?pdata- java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
 ethoc_init_ring(priv/* calculate the number of TX/RX buffers, maximum 128 supported */

 if (netif_running if (num_bd < 4) {
  ethoc_enable_irq  goto free;
  ethoc_enable_rx_and_tx(priv);
  netif_wake_queue(dev);
 }
 return 0;
}

static priv-num_tx (num_bd> );
 .get_regs_len = ethoc_get_regs_len> = num_bd-priv-num_tx
 .get_regs
 .nway_reset = phy_ethtool_nway_reset dev_dbg
 .get_link = ethtool_op_get_linkpriv->, priv-num_rx
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 set_ringparam ,
 .get_ts_info(!priv->vma {
 get_link_ksettings,
 . =phy_ethtool_set_link_ksettings
};

static/
 .ndo_open = ethoc_open,
 .ndo_stop  ethoc_stop,
 .eth_hw_addr_setnetdev>hwaddr;
 .ndo_set_mac_address = ethoc_set_mac_address,
 .ndo_set_rx_mode = ethoc_set_multicast_list,
 .ndo_change_mtu = ethoc_change_mtu,
 .  ethoc_tx_timeout
 .ndo_start_xmit java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
};

/**
 * ethoc_probe - initialize OpenCores ethernet MAC
 * @pdev: platform device
 */
static int ethoc_probe(struct platform_device *pdev  * current MAC from the controller.
{
 struct net_device if (!(netdev-dev_addr {
 struct resource *res = NULL;
 struct resource *mmio = NULL;
 struct resource  addrETH_ALEN
 struct ethoc *priv =   ethoc_get_mac_address(netdev addr
 int num_bd;
 int }
 struct ethoc_platform_data *pdata = /* Check the MAC again for validity, if it still isn't choose and
u32 eth_clkfreq = pdata ? pdata->eth_clkfreq : 0;

/* allocate networking device */
  =alloc_etherdevsizeof );
 if (!netdev) {
  ret = -ENOMEM;
 gotoout
 }

 SET_NETDEV_DEV(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  struct clk devm_clk_getpdev-dev NULL

 /* obtain I/O memory space */I/memory /
res (, ,)java.lang.StringIndexOutOfBoundsException: Index 54 out of bounds for length 54
 if (!res) {
  (pdev-," obtainI/Omemory\)
  ret
  free
 }

evm_request_mem_regionpdev-,res-,
  () res-name
 if ((,MIIMODER& MIIMODER_NOPRE|
  dev_err    )
  ret = -ENXIO;
  java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 23
 }

 netdev-

 /* obtain buffer memory space */
 res = platform_get_resource(  >>,>);
 if (res) {
   =(&>,>,
 >> =java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 38
  if (!mem) {
  (pdev-,"cannot equestmemoryspacen";
   ret = -ENXIO;
   goto free;
  java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3

  netdev-> =&;
  netdev->mem_end   = mem->end;
 }


 /* obtain device IRQ number */
 et=platform_get_irqpdev)java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
 if (ret < 0
   free

 netdev->irq = ret;

 /* setup driver-private data */
 priv netdev_privnetdev;
 priv->netdev = netdev

 priv->iobase = devm_ioremap
   resource_sizemmio
 if (!priv-:
  dev_err&>, cannotI memoryn");
  ret = -ENXIO;
  goto free;
 }

 if (netdev-mdiobus_unregister>mdio
  priv->membase = devm_ioremap(&pdev-mdiobus_free>);
   netdev->mem_start
  * ethoc_remove - shutdown OpenCores ethernet * @pdev: platform device
  dev_err(pdev->dev," remap memoryspacen);
   ret = -ENXIO;
 {
  }
 } else {
  /* Allocate buffer memory */ net_devicenetdev platform_get_drvdata(pdev;
  priv-membase=dmam_alloc_coherent&>dev,
   
   if(netdev) {
  if  netif_napi_del(&priv->napi)java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
  dev_err(pdev->, cannot dBbuffern"
    buffer_size mdiobus_freepriv-mdio);
   ret = -ENOMEMc(>);
   free
 }
  netdev->mem_endjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 }

 riv- =pdata  >big_endian:
  of_device_is_big_endian(pdev->dev.of_node);

 /* calculate the number of TX/RX buffers, maximum 128 supported */
 num_bd =
 2, (>mem_end >mem_start+  ETHOC_BUFSIZjava.lang.StringIndexOutOfBoundsException: Index 65 out of bounds for length 65
 if define java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
  ret = -ENODEV
   free
 }
 java.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 23
 /* num_tx must be a power of two */
 priv->     {
 priv- probe ethoc_probe

 dev_dbg(&pdev->dev, "ethoc: num_tx: %d num_rx: %d\n", .suspend ethoc_suspend
  priv->num_txdriver={

 priv->vma =  .of_match_table = ethoc_match
     GFP_KERNEL)};
 if (!priv->vma) {
  ret = java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 gotojava.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12
 }

 /* Allow the platform setup code to pass in a MAC address. */
 if (pdata) {
  eth_hw_addr_set(netdev, pdata->hwaddr);
  priv->phy_id = pdata->phy_id;
 } else {
  of_get_ethdev_address(pdev->dev.of_node, netdev);
  priv->phy_id = -1;
 }

 /* Check that the given MAC address is valid. If it isn't, read the
 * current MAC from the controller.
 */
 if (!is_valid_ether_addr(netdev->dev_addr)) {
  u8 addr[ETH_ALEN];

  ethoc_get_mac_address(netdev, addr);
  eth_hw_addr_set(netdev, addr);
 }

 /* Check the MAC again for validity, if it still isn't choose and
 * program a random one.
 */
 if (!is_valid_ether_addr(netdev->dev_addr))
  eth_hw_addr_random(netdev);

 ethoc_do_set_mac_address(netdev);

 /* Allow the platform setup code to adjust MII management bus clock. */
 if (!eth_clkfreq) {
  struct clk *clk = devm_clk_get(&pdev->dev, NULL);

  if (!IS_ERR(clk)) {
   priv->clk = clk;
   clk_prepare_enable(clk);
   eth_clkfreq = clk_get_rate(clk);
  }
 }
 if (eth_clkfreq) {
  u32 clkdiv = MIIMODER_CLKDIV(eth_clkfreq / 2500000 + 1);

  if (!clkdiv)
   clkdiv = 2;
  dev_dbg(&pdev->dev, "setting MII clkdiv to %u\n", clkdiv);
  ethoc_write(priv, MIIMODER,
       (ethoc_read(priv, MIIMODER) & MIIMODER_NOPRE) |
       clkdiv);
 }

 /* register MII bus */
 priv->mdio = mdiobus_alloc();
 if (!priv->mdio) {
  ret = -ENOMEM;
  goto free2;
 }

 priv->mdio->name = "ethoc-mdio";
 snprintf(priv->mdio->id, MII_BUS_ID_SIZE, "%s-%d",
   priv->mdio->name, pdev->id);
 priv->mdio->read = ethoc_mdio_read;
 priv->mdio->write = ethoc_mdio_write;
 priv->mdio->priv = priv;

 ret = mdiobus_register(priv->mdio);
 if (ret) {
  dev_err(&netdev->dev, "failed to register MDIO bus\n");
  goto free3;
 }

 ret = ethoc_mdio_probe(netdev);
 if (ret) {
  dev_err(&netdev->dev, "failed to probe MDIO bus\n");
  goto error;
 }

 /* setup the net_device structure */
 netdev->netdev_ops = ðoc_netdev_ops;
 netdev->watchdog_timeo = ETHOC_TIMEOUT;
 netdev->features |= 0;
 netdev->ethtool_ops = ðoc_ethtool_ops;

 /* setup NAPI */
 netif_napi_add(netdev, &priv->napi, ethoc_poll);

 spin_lock_init(&priv->lock);

 ret = register_netdev(netdev);
 if (ret < 0) {
  dev_err(&netdev->dev, "failed to register interface\n");
  goto error2;
 }

 goto out;

error2:
 netif_napi_del(&priv->napi);
error:
 mdiobus_unregister(priv->mdio);
free3:
 mdiobus_free(priv->mdio);
free2:
 clk_disable_unprepare(priv->clk);
free:
 free_netdev(netdev);
out:
 return ret;
}

/**
 * ethoc_remove - shutdown OpenCores ethernet MAC
 * @pdev: platform device
 */
static void ethoc_remove(struct platform_device *pdev)
{
 struct net_device *netdev = platform_get_drvdata(pdev);
 struct ethoc *priv = netdev_priv(netdev);

 if (netdev) {
  netif_napi_del(&priv->napi);
  phy_disconnect(netdev->phydev);

  if (priv->mdio) {
   mdiobus_unregister(priv->mdio);
   mdiobus_free(priv->mdio);
  }
  clk_disable_unprepare(priv->clk);
  unregister_netdev(netdev);
  free_netdev(netdev);
 }
}

#ifdef CONFIG_PM
static int ethoc_suspend(struct platform_device *pdev, pm_message_t state)
{
 return -ENOSYS;
}

static int ethoc_resume(struct platform_device *pdev)
{
 return -ENOSYS;
}
#else
# define ethoc_suspend NULL
# define ethoc_resume  NULL
#endif

static const struct of_device_id ethoc_match[] = {
 { .compatible = "opencores,ethoc", },
 {},
};
MODULE_DEVICE_TABLE(of, ethoc_match);

static struct platform_driver ethoc_driver = {
 .probe   = ethoc_probe,
 .remove = ethoc_remove,
 .suspend = ethoc_suspend,
 .resume  = ethoc_resume,
 .driver  = {
  .name = "ethoc",
  .of_match_table = ethoc_match,
 },
};

module_platform_driver(ethoc_driver);

MODULE_AUTHOR("Thierry Reding ");
MODULE_DESCRIPTION("OpenCores Ethernet MAC driver");
MODULE_LICENSE("GPL v2");