mirror of
https://github.com/xcat2/xNBA.git
synced 2024-12-15 15:51:44 +00:00
526 lines
15 KiB
C
526 lines
15 KiB
C
/**************************************************************************
|
|
Etherboot - BOOTP/TFTP Bootstrap Program
|
|
P2001 NIC driver for Etherboot
|
|
***************************************************************************/
|
|
|
|
/*
|
|
* Copyright (C) 2004 Tobias Lorenz
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
/* to get some global routines like printf */
|
|
#include "etherboot.h"
|
|
/* to get the interface to the body of the program */
|
|
#include "nic.h"
|
|
/* to get the ISA support functions, if this is an ISA NIC */
|
|
#include "isa.h"
|
|
|
|
#include "hardware.h"
|
|
#include "lxt971a.h"
|
|
#include "timer.h"
|
|
|
|
|
|
/* NIC specific static variables go here */
|
|
static unsigned char MAC_HW_ADDR[6]={MAC_HW_ADDR_DRV};
|
|
|
|
/* DMA descriptors and buffers */
|
|
#define NUM_RX_DESC 4 /* Number of Rx descriptor registers. */
|
|
#define DMA_BUF_SIZE 2048 /* Buffer size */
|
|
static DMA_DSC txd __attribute__ ((__section__(".dma.desc")));
|
|
static DMA_DSC rxd[NUM_RX_DESC] __attribute__ ((__section__(".dma.desc")));
|
|
static unsigned char rxb[NUM_RX_DESC * DMA_BUF_SIZE] __attribute__ ((__section__(".dma.buffer")));
|
|
static unsigned char txb[ DMA_BUF_SIZE] __attribute__ ((__section__(".dma.buffer")));
|
|
static unsigned int cur_rx;
|
|
|
|
/* Device selectors */
|
|
static unsigned int cur_channel; // DMA channel : 0..3
|
|
static unsigned int cur_phy; // PHY Address : 0..31
|
|
static P2001_ETH_regs_ptr EU; // Ethernet Unit : 0x0018_000 with _=0..3
|
|
static P2001_ETH_regs_ptr MU; // Management Unit: 0x00180000
|
|
|
|
#define MDIO_MAXCOUNT 1000 /* mdio abort */
|
|
static unsigned int mdio_error; /* mdio error */
|
|
|
|
/* Function prototypes */
|
|
static void p2001_eth_mdio_init ();
|
|
static void p2001_eth_mdio_write(unsigned int phyadr, unsigned int regadr, unsigned int data);
|
|
static unsigned int p2001_eth_mdio_read (unsigned int phyadr, unsigned int regadr);
|
|
extern unsigned int p2001_eth_mdio_error;
|
|
|
|
static int p2001_eth_poll (struct nic *nic, int retrieve);
|
|
static void p2001_eth_transmit (struct nic *nic, const char *d,
|
|
unsigned int t, unsigned int s, const char *p);
|
|
|
|
static void p2001_eth_irq (struct nic *nic, irq_action_t action);
|
|
|
|
static void p2001_eth_init ();
|
|
static void p2001_eth_disable (struct dev *dev);
|
|
|
|
static int p2001_eth_check_link(unsigned int phy);
|
|
static int p2001_eth_probe (struct dev *dev, unsigned short *probe_addrs __unused);
|
|
|
|
|
|
/**************************************************************************
|
|
PHY MANAGEMENT UNIT - Read/write
|
|
***************************************************************************/
|
|
static void p2001_eth_mdio_init()
|
|
{
|
|
/* reset ethernet PHYs */
|
|
printf("Resetting PHYs...\n");
|
|
|
|
/* GPIO24/25: TX_ER2/TX_ER0 */
|
|
/* GPIO26/27: PHY_RESET/TX_ER1 */
|
|
P2001_GPIO->PIN_MUX |= 0x0018;
|
|
// 31-16: 0000 1111 0000 0000
|
|
P2001_GPIO->GPIO2_En |= 0x0400;
|
|
|
|
P2001_GPIO->GPIO2_Out |= 0x04000000;
|
|
P2001_GPIO->GPIO2_Out &= ~0x0400;
|
|
mdelay(500);
|
|
P2001_GPIO->GPIO2_Out |= 0x0400;
|
|
|
|
/* set management unit clock divisor */
|
|
// max. MDIO CLK = 2.048 MHz (EU.doc)
|
|
// max. MDIO CLK = 8.000 MHz (LXT971A)
|
|
// sysclk/(2*(n+1)) = MDIO CLK <= 2.048 MHz
|
|
// n >= sysclk/4.096 MHz - 1
|
|
#if SYSCLK == 73728000
|
|
P2001_MU->MU_DIV = 17; // 73.728 MHZ =17=> 2.020 MHz
|
|
#else
|
|
//MU->MU_DIV = (SYSCLK/4.096)-1;
|
|
#error "Please define a proper MDIO CLK divisor for that sysclk."
|
|
#endif
|
|
asm("nop \n nop");
|
|
}
|
|
|
|
static void p2001_eth_mdio_write(unsigned int phyadr, unsigned int regadr, unsigned int data)
|
|
{
|
|
static unsigned int count;
|
|
count = 0;
|
|
|
|
/* Warten bis Hardware inaktiv (MIU = "0") */
|
|
while ((MU->MU_CNTL & 0x8000) && (count < MDIO_MAXCOUNT))
|
|
count++;
|
|
|
|
/* Schreiben MU_DATA */
|
|
MU->MU_DATA = data;
|
|
|
|
/* Schreiben MU_CNTL */
|
|
MU->MU_CNTL = regadr + (phyadr<<5) + (1<<10);
|
|
|
|
/* Warten bis Hardware aktiv (MIU = "1") */
|
|
while (((MU->MU_CNTL & 0x8000) == 0) && (count < MDIO_MAXCOUNT))
|
|
count++;
|
|
//asm("nop \r\n nop");
|
|
|
|
/* Warten bis Hardware inaktiv (MIU = "0") */
|
|
while ((MU->MU_CNTL & 0x8000) && (count < MDIO_MAXCOUNT))
|
|
count++;
|
|
|
|
mdio_error = (count >= MDIO_MAXCOUNT);
|
|
}
|
|
|
|
static unsigned int p2001_eth_mdio_read(unsigned int phyadr, unsigned int regadr)
|
|
{
|
|
static unsigned int count;
|
|
count = 0;
|
|
|
|
do {
|
|
/* Warten bis Hardware inaktiv (MIU = "0") */
|
|
while ((MU->MU_CNTL & 0x8000) && (count < MDIO_MAXCOUNT))
|
|
count++;
|
|
|
|
/* Schreiben MU_CNTL */
|
|
MU->MU_CNTL = regadr + (phyadr<<5) + (2<<10);
|
|
|
|
/* Warten bis Hardware aktiv (MIU = "1") */
|
|
while (((MU->MU_CNTL & 0x8000) == 0) && (count < MDIO_MAXCOUNT))
|
|
count++;
|
|
//asm("nop \r\n nop");
|
|
|
|
/* Warten bis Hardware inaktiv (MIU = "0") */
|
|
while ((MU->MU_CNTL & 0x8000) && (count < MDIO_MAXCOUNT))
|
|
count++;
|
|
|
|
/* Fehler, wenn MDIO Read Error (MRE = "1") */
|
|
} while ((MU->MU_CNTL & 0x4000) && (count < MDIO_MAXCOUNT));
|
|
|
|
/* Lesen MU_DATA */
|
|
mdio_error = (count >= MDIO_MAXCOUNT);
|
|
return MU->MU_DATA;
|
|
}
|
|
|
|
|
|
/**************************************************************************
|
|
POLL - Wait for a frame
|
|
***************************************************************************/
|
|
/* Function: p2001_eth_poll
|
|
*
|
|
* Description: checks for a received packet and returns it if found.
|
|
*
|
|
* Arguments: struct nic *nic: NIC data structure
|
|
*
|
|
* Returns: 1 if a packet was received.
|
|
* 0 if no pacet was received.
|
|
*
|
|
* Side effects:
|
|
* Returns (copies) the packet to the array nic->packet.
|
|
* Returns the length of the packet in nic->packetlen.
|
|
*/
|
|
static int p2001_eth_poll(struct nic *nic, int retrieve)
|
|
{
|
|
/* return true if there's an ethernet packet ready to read */
|
|
/* nic->packet should contain data on return */
|
|
/* nic->packetlen should contain length of data */
|
|
|
|
int retstat = 0;
|
|
|
|
if (rxd[cur_rx].stat & (1<<31)) // OWN
|
|
return retstat;
|
|
|
|
if (!retrieve)
|
|
return 1;
|
|
|
|
nic->packetlen = rxd[cur_rx].cntl & 0xffff;
|
|
|
|
if (rxd[cur_rx].stat & ((1<<26)|(1<<25)|(1<<24)|(1<<23)|(1<<22))) {
|
|
/* corrupted packet received */
|
|
printf("p2001_eth_poll: Corrupted packet received, stat = %X\n",
|
|
rxd[cur_rx].stat);
|
|
retstat = 0;
|
|
} else {
|
|
/* give packet to higher routine */
|
|
memcpy(nic->packet, (rxb + cur_rx*DMA_BUF_SIZE), nic->packetlen);
|
|
retstat = 1;
|
|
}
|
|
|
|
#ifdef DEBUG_NIC
|
|
printf("p2001_eth_poll: packet from %! to %! received\n",
|
|
(rxb+cur_rx*DMA_BUF_SIZE)+ETH_ALEN,
|
|
(rxb+cur_rx*DMA_BUF_SIZE));
|
|
#endif
|
|
|
|
/* disable receiver */
|
|
// FIXME: is that ok? it can produce grave errors.
|
|
EU->RMAC_DMA_EN = 0; /* clear run bit */
|
|
|
|
/* return the descriptor and buffer to receive ring */
|
|
rxd[cur_rx].stat = (1<<31) | (1<<30) | (1<<29); // DSC0 OWN|START|END
|
|
rxd[cur_rx].cntl = (1<<23); // DSC1 RECEIVE
|
|
rxd[cur_rx].cntl |= cur_channel << 16; // DSC1 CHANNEL
|
|
rxd[cur_rx].cntl |= DMA_BUF_SIZE; // DSC1 LEN
|
|
|
|
if (++cur_rx == NUM_RX_DESC)
|
|
cur_rx = 0;
|
|
|
|
/* enable receiver */
|
|
if (!(EU->RMAC_DMA_EN & 0x01))
|
|
EU->RMAC_DMA_EN = 0x01; /* set run bit */
|
|
|
|
#ifdef DEBUG_NIC
|
|
printf("RMAC_MIB0..5: %d:%d:%d:%d:%d:%d\n",
|
|
EU->RMAC_MIB0, EU->RMAC_MIB1,
|
|
EU->RMAC_MIB2, EU->RMAC_MIB3,
|
|
EU->RMAC_MIB4, EU->RMAC_MIB5);
|
|
#endif
|
|
|
|
return retstat; /* initially as this is called to flush the input */
|
|
}
|
|
|
|
|
|
/**************************************************************************
|
|
TRANSMIT - Transmit a frame
|
|
***************************************************************************/
|
|
/* Function: p2001_eth_transmit
|
|
*
|
|
* Description: transmits a packet and waits for completion or timeout.
|
|
*
|
|
* Arguments: char d[6]: destination ethernet address.
|
|
* unsigned short t: ethernet protocol type.
|
|
* unsigned short s: size of the data-part of the packet.
|
|
* char *p: the data for the packet.
|
|
*
|
|
* Returns: void.
|
|
*/
|
|
static void p2001_eth_transmit(
|
|
struct nic *nic __unused,
|
|
const char *d, /* Destination */
|
|
unsigned int t, /* Type */
|
|
unsigned int s, /* size */
|
|
const char *p) /* Packet */
|
|
{
|
|
unsigned int nstype;
|
|
#ifdef DEBUG_NIC
|
|
unsigned int status;
|
|
#endif
|
|
|
|
/* assemble packet */
|
|
memcpy(txb, d, ETH_ALEN); // destination
|
|
memcpy(txb+ETH_ALEN, nic->node_addr, ETH_ALEN); // source
|
|
nstype = htons(t);
|
|
memcpy(txb+2*ETH_ALEN, (char*)&nstype, 2); // type
|
|
memcpy(txb+ETH_HLEN, p, s); // packet
|
|
s += ETH_HLEN;
|
|
|
|
/* pad to minimum packet size */
|
|
// while (s<ETH_ZLEN)
|
|
// txb[s++] = '\0';
|
|
// TMAC_CNTL.ATP does the same
|
|
|
|
#ifdef DEBUG_NIC
|
|
printf("p2001_eth_transmit: packet from %! to %! sent\n", txb+ETH_ALEN, txb);
|
|
#endif
|
|
|
|
/* configure descriptor */
|
|
txd.stat = (1<<31) | (1<<30) | (1<<29); // DSC0 OWN|START|END
|
|
txd.cntl = cur_channel << 16; // DSC1 CHANNEL
|
|
txd.cntl |= s; // DSC1 LEN
|
|
|
|
/* restart the transmitter */
|
|
EU->TMAC_DMA_EN = 0x01; /* set run bit */
|
|
while(EU->TMAC_DMA_EN & 0x01) ; /* wait */
|
|
|
|
#ifdef DEBUG_NIC
|
|
/* check status */
|
|
status = EU->TMAC_DMA_STAT;
|
|
if (status & ~(0x40))
|
|
printf("p2001_eth_transmit: dma status=0x%hx\n", status);
|
|
|
|
printf("TMAC_MIB6..7: %d:%d\n", EU->TMAC_MIB6, EU->TMAC_MIB7);
|
|
#endif
|
|
}
|
|
|
|
|
|
/**************************************************************************
|
|
IRQ - Enable, Disable or Force Interrupts
|
|
***************************************************************************/
|
|
/* Function: p2001_eth_irq
|
|
*
|
|
* Description: Enable, Disable, or Force, interrupts
|
|
*
|
|
* Arguments: struct nic *nic: NIC data structure
|
|
* irq_action_t action: Requested action
|
|
*
|
|
* Returns: void.
|
|
*/
|
|
|
|
static void
|
|
p2001_eth_irq(struct nic *nic __unused, irq_action_t action __unused)
|
|
{
|
|
switch ( action ) {
|
|
case DISABLE :
|
|
break;
|
|
case ENABLE :
|
|
break;
|
|
case FORCE :
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
/**************************************************************************
|
|
INIT - Initialize device
|
|
***************************************************************************/
|
|
/* Function: p2001_init
|
|
*
|
|
* Description: resets the ethernet controller chip and various
|
|
* data structures required for sending and receiving packets.
|
|
*
|
|
* returns: void.
|
|
*/
|
|
static void p2001_eth_init()
|
|
{
|
|
static int i;
|
|
|
|
/* disable transceiver */
|
|
// EU->TMAC_DMA_EN = 0; /* clear run bit */
|
|
// EU->RMAC_DMA_EN = 0; /* clear run bit */
|
|
|
|
/* set rx filter (physical mac addresses) */
|
|
EU->RMAC_PHYU =
|
|
(MAC_HW_ADDR[0]<< 8) +
|
|
(MAC_HW_ADDR[1]<< 0);
|
|
EU->RMAC_PHYL =
|
|
(MAC_HW_ADDR[2]<<24) +
|
|
(MAC_HW_ADDR[3]<<16) +
|
|
(MAC_HW_ADDR[4]<<8 ) +
|
|
(MAC_HW_ADDR[5]<<0 );
|
|
|
|
/* initialize the tx descriptor ring */
|
|
// txd.stat = (1<<31) | (1<<30) | (1<<29); // DSC0 OWN|START|END
|
|
// txd.cntl = cur_channel << 16; // DSC1 CHANNEL
|
|
// txd.cntl |= DMA_BUF_SIZE; // DSC1 LEN
|
|
txd.buf = &txb; // DSC2 BUFFER
|
|
txd.next = &txd; // DSC3 NEXTDSC @self
|
|
EU->TMAC_DMA_DESC = &txd;
|
|
|
|
/* initialize the rx descriptor ring */
|
|
cur_rx = 0;
|
|
for (i = 0; i < NUM_RX_DESC; i++) {
|
|
rxd[i].stat = (1<<31) | (1<<30) | (1<<29); // DSC0 OWN|START|END
|
|
rxd[i].cntl = (1<<23); // DSC1 RECEIVE
|
|
rxd[i].cntl |= cur_channel << 16; // DSC1 CHANNEL
|
|
rxd[i].cntl |= DMA_BUF_SIZE; // DSC1 LEN
|
|
rxd[i].buf = &rxb[i*DMA_BUF_SIZE]; // DSC2 BUFFER (EU-RX data)
|
|
rxd[i].next = &rxd[i+1]; // DSC3 NEXTDSC @next
|
|
}
|
|
rxd[NUM_RX_DESC-1].next = &rxd[0]; // DSC3 NEXTDSC @first
|
|
EU->RMAC_DMA_DESC = &rxd[0];
|
|
|
|
/* set transmitter mode */
|
|
EU->TMAC_CNTL = (1<<4) | /* COI: Collision ignore */
|
|
//(1<<3) | /* CSI: Carrier Sense ignore */
|
|
(1<<2); /* ATP: Automatic Transmit Padding */
|
|
|
|
/* set receive mode */
|
|
EU->RMAC_CNTL = (1<<3) | /* BROAD: Broadcast packets */
|
|
(1<<1); /* PHY : Packets to out MAC address */
|
|
|
|
/* enable receiver */
|
|
EU->RMAC_DMA_EN = 1; /* set run bit */
|
|
}
|
|
|
|
|
|
/**************************************************************************
|
|
DISABLE - Turn off ethernet interface
|
|
***************************************************************************/
|
|
static void p2001_eth_disable(struct dev *dev __unused)
|
|
{
|
|
/* put the card in its initial state */
|
|
/* This function serves 3 purposes.
|
|
* This disables DMA and interrupts so we don't receive
|
|
* unexpected packets or interrupts from the card after
|
|
* etherboot has finished.
|
|
* This frees resources so etherboot may use
|
|
* this driver on another interface
|
|
* This allows etherboot to reinitialize the interface
|
|
* if something is something goes wrong.
|
|
*/
|
|
|
|
/* disable transmitter */
|
|
EU->TMAC_DMA_EN = 0; /* clear run bit */
|
|
|
|
/* disable receiver */
|
|
EU->RMAC_DMA_EN = 0; /* clear run bit */
|
|
}
|
|
|
|
|
|
/**************************************************************************
|
|
LINK - Check for valid link
|
|
***************************************************************************/
|
|
static int p2001_eth_check_link(unsigned int phy)
|
|
{
|
|
static int status;
|
|
static unsigned int count;
|
|
count = 0;
|
|
|
|
/* Use 0x3300 for restarting NWay */
|
|
printf("Starting auto-negotiation... ");
|
|
p2001_eth_mdio_write(phy, Adr_LXT971A_Control, 0x3300);
|
|
if (mdio_error)
|
|
goto failed;
|
|
|
|
/* Bits 1.5 and 17.7 are set to 1 once the Auto-Negotiation process to completed. */
|
|
do {
|
|
mdelay(500);
|
|
status = p2001_eth_mdio_read(phy, Adr_LXT971A_Status1);
|
|
if (mdio_error || (count++ > 6)) // 6*500ms = 3s timeout
|
|
goto failed;
|
|
} while (!(status & 0x20));
|
|
|
|
/* Bits 1.2 and 17.10 are set to 1 once the link is established. */
|
|
if (p2001_eth_mdio_read(phy, Adr_LXT971A_Status1) & 0x04) {
|
|
/* Bits 17.14 and 17.9 can be used to determine the link operation conditions (speed and duplex). */
|
|
printf("Valid link, operating at: %sMb-%s\n",
|
|
(p2001_eth_mdio_read(phy, Adr_LXT971A_Status2) & 0x4000) ? "100" : "10",
|
|
(p2001_eth_mdio_read(phy, Adr_LXT971A_Status2) & 0x0200) ? "FD" : "HD");
|
|
return 1;
|
|
}
|
|
|
|
failed:
|
|
if (mdio_error)
|
|
printf("Failed\n");
|
|
else
|
|
printf("No valid link\n");
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**************************************************************************
|
|
PROBE - Look for an adapter, this routine's visible to the outside
|
|
***************************************************************************/
|
|
static int p2001_eth_probe(struct dev *dev, unsigned short *probe_addrs __unused)
|
|
{
|
|
struct nic *nic = (struct nic *)dev;
|
|
/* if probe_addrs is 0, then routine can use a hardwired default */
|
|
static int board_found;
|
|
static int valid_link;
|
|
|
|
/* reset phys and configure mdio clk */
|
|
p2001_eth_mdio_init();
|
|
|
|
/* find the correct PHY/DMA/MAC combination */
|
|
MU = P2001_MU; // MU for all PHYs is only in EU0
|
|
printf("Searching for P2001 NICs...\n");
|
|
for (cur_channel=0; cur_channel<4; cur_channel++) {
|
|
switch(cur_channel) {
|
|
case 0:
|
|
EU = P2001_EU0;
|
|
cur_phy = 0;
|
|
break;
|
|
case 1:
|
|
EU = P2001_EU1;
|
|
cur_phy = 1;
|
|
break;
|
|
case 2:
|
|
EU = P2001_EU2;
|
|
cur_phy = 2;
|
|
break;
|
|
case 3:
|
|
EU = P2001_EU3;
|
|
cur_phy = 3;
|
|
break;
|
|
}
|
|
|
|
/* first a non destructive test for initial value RMAC_TLEN=1518 */
|
|
board_found = (EU->RMAC_TLEN == 1518);
|
|
if (board_found) {
|
|
printf("Checking EU%d...\n", cur_channel);
|
|
|
|
valid_link = p2001_eth_check_link(cur_phy);
|
|
if (valid_link) {
|
|
/* initialize device */
|
|
p2001_eth_init(nic);
|
|
|
|
/* set node address */
|
|
printf("Setting MAC address to %!\n", MAC_HW_ADDR);
|
|
memcpy(nic->node_addr, MAC_HW_ADDR, 6);
|
|
|
|
/* point to NIC specific routines */
|
|
dev->disable = p2001_eth_disable;
|
|
nic->poll = p2001_eth_poll;
|
|
nic->transmit = p2001_eth_transmit;
|
|
nic->irq = p2001_eth_irq;
|
|
|
|
/* Report the ISA pnp id of the board */
|
|
dev->devid.vendor_id = htons(GENERIC_ISAPNP_VENDOR);
|
|
dev->devid.vendor_id = htons(0x1234);
|
|
return 1;
|
|
}
|
|
}
|
|
}
|
|
/* else */
|
|
return 0;
|
|
}
|
|
|
|
ISA_ROM("p2001_eth", "P2001 Ethernet Driver")
|
|
static struct isa_driver p2001_eth_driver __isa_driver = {
|
|
.type = NIC_DRIVER,
|
|
.name = "P2001 Ethernet Driver",
|
|
.probe = p2001_eth_probe,
|
|
.ioaddrs = 0,
|
|
};
|