OpenCores
URL https://opencores.org/ocsvn/or1k_soc_on_altera_embedded_dev_kit/or1k_soc_on_altera_embedded_dev_kit/trunk

Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

[/] [or1k_soc_on_altera_embedded_dev_kit/] [trunk/] [soc/] [sw/] [orpmon/] [drivers/] [eth.c] - Blame information for rev 20

Details | Compare with Previous | View Log

Line No. Rev Author Line
1 20 xianfeng
#include "board.h"
2
#if OC_LAN==1
3
 
4
#include "common.h"
5
#include "support.h"
6
#include "uart.h"
7
#include "eth.h"
8
#include "int.h"
9
#include "spr_defs.h"
10
 
11
extern int printf (const char *fmt, ...);
12
extern void lolev_ie(void);
13
extern void lolev_idis(void);
14
 
15
int tx_next;  /* Next buffer to be given to the user */
16
int tx_last;  /* Next buffer to be checked if packet sent */
17
int tx_full;
18
int rx_next;  /* Next buffer to be checked for new packet and given to the user */
19
void (*receive)(volatile unsigned char *add, int len); /* Pointer to function to be called
20
                                        when frame is received */
21
 
22
unsigned long eth_data[((ETH_TXBD_NUM + ETH_RXBD_NUM) * ETH_MAXBUF_LEN)/4] = {0};
23
#undef ETH_DATA_BASE
24
#define ETH_DATA_BASE ((unsigned long)eth_data)
25
 
26
static void
27
print_packet(unsigned long add, int len)
28
{
29
  int i;
30
 
31
  printf("ipacket: add = %lx len = %d\n", add, len);
32
  for(i = 0; i < len; i++) {
33
      if(!(i % 16))
34
          printf("\n");
35
      printf(" %.2x", *(((unsigned char *)add) + i));
36
  }
37
  printf("\n");
38
}
39
 
40
void init_tx_bd_pool(void)
41
{
42
  eth_bd  *bd;
43
  int i;
44
 
45
  bd = (eth_bd *)ETH_BD_BASE;
46
 
47
  for(i = 0; i < ETH_TXBD_NUM; i++) {
48
    /* Set Tx BD status */
49
    bd[i].len_status = 0 << 16 | ETH_TX_BD_PAD | ETH_TX_BD_CRC | ETH_RX_BD_IRQ;
50
 
51
    /* Initialize Tx buffer pointer */
52
    bd[i].addr = ETH_DATA_BASE + (i * ETH_MAXBUF_LEN);
53
  }
54
 
55
  bd[i-1].len_status |= ETH_TX_BD_WRAP; // Last Tx BD - Wrap
56
}
57
 
58
void init_rx_bd_pool(void)
59
{
60
  eth_bd  *bd;
61
  int i;
62
 
63
  bd = (eth_bd *)ETH_BD_BASE + ETH_TXBD_NUM;
64
 
65
  for(i = 0; i < ETH_RXBD_NUM; i++){
66
 
67
    /* Set Rx BD status */
68
    bd[i].len_status = 0 << 16 | ETH_RX_BD_EMPTY | ETH_RX_BD_IRQ;
69
 
70
    /* Initialize Rx buffer pointer */
71
    bd[i].addr = ETH_DATA_BASE + ((ETH_TXBD_NUM + i) * ETH_MAXBUF_LEN);
72
  }
73
 
74
  bd[i-1].len_status |= ETH_RX_BD_WRAP; // Last Rx BD - Wrap
75
}
76
 
77
/* Ethernet interrupt handler */
78
void eth_int (void)
79
{
80
}
81
 
82
void eth_init (void (*rec)(volatile unsigned char *, int))
83
{
84
  /* Reset ethernet core */
85
  REG32(ETH_REG_BASE + ETH_MODER) = ETH_MODER_RST;    /* Reset ON */
86
  REG32(ETH_REG_BASE + ETH_MODER) &= ~ETH_MODER_RST;  /* Reset OFF */
87
 
88
  /* Setting TX BD number */
89
  REG32(ETH_REG_BASE + ETH_TX_BD_NUM) = ETH_TXBD_NUM;
90
 
91
  // Set PHY to 10 Mbps full duplex
92
  REG32(ETH_REG_BASE + ETH_MIIADDRESS) = 0<<8;
93
  REG32(ETH_REG_BASE + ETH_MIITX_DATA) = 0x0100;
94
  REG32(ETH_REG_BASE + ETH_MIICOMMAND) = ETH_MIICOMMAND_WCTRLDATA;
95
  while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
96
 
97
  while(1){
98
    REG32(ETH_REG_BASE + ETH_MIIADDRESS) = 1<<8;
99
    REG32(ETH_REG_BASE + ETH_MIICOMMAND) = ETH_MIICOMMAND_RSTAT;
100
    while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
101
    if(REG32(ETH_REG_BASE + ETH_MIIRX_DATA) & 0x04)
102
      break;
103
  }
104
 
105
  /* Set min/max packet length */
106
  REG32(ETH_REG_BASE + ETH_PACKETLEN) = 0x00400600;
107
 
108
  /* Set IPGT register to recomended value */
109
  REG32(ETH_REG_BASE + ETH_IPGT) =  0x00000012;
110
 
111
  /* Set IPGR1 register to recomended value */
112
  REG32(ETH_REG_BASE + ETH_IPGR1) =  0x0000000c;
113
 
114
  /* Set IPGR2 register to recomended value */
115
  REG32(ETH_REG_BASE + ETH_IPGR2) =  0x00000012;
116
 
117
  /* Set COLLCONF register to recomended value */
118
  REG32(ETH_REG_BASE + ETH_COLLCONF) =  0x000f003f;
119
 
120
#if 0
121
  REG32(ETH_REG_BASE + ETH_CTRLMODER) = OETH_CTRLMODER_TXFLOW | OETH_CTRLMODER_RXFLOW;
122
#else
123
  REG32(ETH_REG_BASE + ETH_CTRLMODER) = 0;
124
#endif
125
 
126
  /* Initialize RX and TX buffer descriptors */
127
  init_rx_bd_pool();
128
  init_tx_bd_pool();
129
 
130
  /* Initialize tx pointers */
131
  tx_next = 0;
132
  tx_last = 0;
133
  tx_full = 0;
134
 
135
  /* Initialize rx pointers */
136
  rx_next = 0;
137
  receive = rec;
138
 
139
  /* Set local MAC address */
140
  REG32(ETH_REG_BASE + ETH_MAC_ADDR1) = ETH_MACADDR0 << 8 |
141
            ETH_MACADDR1;
142
  REG32(ETH_REG_BASE + ETH_MAC_ADDR0) = ETH_MACADDR2 << 24 |
143
            ETH_MACADDR3 << 16 |
144
            ETH_MACADDR4 << 8 |
145
            ETH_MACADDR5;
146
 
147
  /* Clear all pending interrupts */
148
  REG32(ETH_REG_BASE + ETH_INT) = 0xffffffff;
149
 
150
  /* Promisc, IFG, CRCEn */
151
  REG32(ETH_REG_BASE + ETH_MODER) |= ETH_MODER_PAD | ETH_MODER_IFG | ETH_MODER_CRCEN;
152
 
153
  /* Enable interrupt sources */
154
#if 0
155
  regs->int_mask = ETH_INT_MASK_TXB        |
156
                   ETH_INT_MASK_TXE        |
157
                   ETH_INT_MASK_RXF        |
158
                   ETH_INT_MASK_RXE        |
159
                   ETH_INT_MASK_BUSY       |
160
                   ETH_INT_MASK_TXC        |
161
                   ETH_INT_MASK_RXC;
162
#else
163
  REG32(ETH_REG_BASE + ETH_INT_MASK) = 0x00000000;
164
#endif
165
 
166
  /* Enable receiver and transmiter */
167
  REG32(ETH_REG_BASE + ETH_MODER) |= ETH_MODER_RXEN | ETH_MODER_TXEN;
168
 
169
  /* Register interrupt handler */
170
  int_add (ETH_IRQ, eth_int);
171
}
172
 
173
/* Returns pointer to next free buffer; NULL if none available */
174
void *eth_get_tx_buf ()
175
{
176
  eth_bd  *bd;
177
  unsigned long add;
178
 
179
  if(tx_full)
180
    return (void *)0;
181
 
182
  bd = (eth_bd *)ETH_BD_BASE;
183
 
184
  if(bd[tx_next].len_status & ETH_TX_BD_READY)
185
    return (void *)0;
186
 
187
  add = bd[tx_next].addr;
188
 
189
  tx_next = (tx_next + 1) & ETH_TXBD_NUM_MASK;
190
 
191
  if(tx_next == tx_last)
192
    tx_full = 1;
193
 
194
  return (void *)add;
195
}
196
 
197
/* Send a packet at address */
198
void eth_send (void *buf, unsigned long len)
199
{
200
  eth_bd  *bd;
201
 
202
  bd = (eth_bd *)ETH_BD_BASE;
203
 
204
  bd[tx_last].addr = (unsigned long)buf;
205
  bd[tx_last].len_status &= 0x0000ffff & ~ETH_TX_BD_STATS;
206
  bd[tx_last].len_status |= len << 16 | ETH_TX_BD_READY;
207
 
208
  tx_last = (tx_last + 1) & ETH_TXBD_NUM_MASK;
209
  tx_full = 0;
210
}
211
 
212
/* Waits for packet and pass it to the upper layers */
213
unsigned long eth_rx (void)
214
{
215
  eth_bd  *bd;
216
  unsigned long len = 0;
217
 
218
  bd = (eth_bd *)ETH_BD_BASE + ETH_TXBD_NUM;
219
 
220
  while(1) {
221
 
222
    int bad = 0;
223
 
224
    if(bd[rx_next].len_status & ETH_RX_BD_EMPTY)
225
      return len;
226
 
227
    if(bd[rx_next].len_status & ETH_RX_BD_OVERRUN) {
228
      printf("eth rx: ETH_RX_BD_OVERRUN\n");
229
      bad = 1;
230
    }
231
    if(bd[rx_next].len_status & ETH_RX_BD_INVSIMB) {
232
      printf("eth rx: ETH_RX_BD_INVSIMB\n");
233
      bad = 1;
234
    }
235
    if(bd[rx_next].len_status & ETH_RX_BD_DRIBBLE) {
236
      printf("eth rx: ETH_RX_BD_DRIBBLE\n");
237
      bad = 1;
238
    }
239
    if(bd[rx_next].len_status & ETH_RX_BD_TOOLONG) {
240
      printf("eth rx: ETH_RX_BD_TOOLONG\n");
241
      bad = 1;
242
    }
243
    if(bd[rx_next].len_status & ETH_RX_BD_SHORT) {
244
      printf("eth rx: ETH_RX_BD_SHORT\n");
245
      bad = 1;
246
    }
247
    if(bd[rx_next].len_status & ETH_RX_BD_CRCERR) {
248
      printf("eth rx: ETH_RX_BD_CRCERR\n");
249
      bad = 1;
250
    }
251
    if(bd[rx_next].len_status & ETH_RX_BD_LATECOL) {
252
      printf("eth rx: ETH_RX_BD_LATECOL\n");
253
      bad = 1;
254
    }
255
 
256
    if(!bad) {
257
      receive((void *)bd[rx_next].addr, bd[rx_next].len_status >> 16);
258
      len += bd[rx_next].len_status >> 16;
259
    }
260
 
261
    bd[rx_next].len_status &= ~ETH_RX_BD_STATS;
262
    bd[rx_next].len_status |= ETH_RX_BD_EMPTY;
263
 
264
    rx_next = (rx_next + 1) & ETH_RXBD_NUM_MASK;
265
  }
266
}
267
 
268
void eth_int_enable(void)
269
{
270
  REG32(ETH_REG_BASE + ETH_INT_MASK) =  ETH_INT_MASK_TXB        |
271
                                        ETH_INT_MASK_TXE        |
272
                                        ETH_INT_MASK_RXF        |
273
                                        ETH_INT_MASK_RXE        |
274
                                        ETH_INT_MASK_BUSY       |
275
                                        ETH_INT_MASK_TXC        |
276
                                        ETH_INT_MASK_RXC;
277
}
278
 
279
void eth_halt(void)
280
{
281
  /* Enable receiver and transmiter */
282
  REG32(ETH_REG_BASE + ETH_MODER) &= ~(ETH_MODER_RXEN | ETH_MODER_TXEN);
283
}
284
#endif

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.