mips_sys

1) /* MIPS I system
2)  * Copyright 2011-2012 Stefan Schuermans <stefan@schuermans.info>
3)  * Copyleft GNU public license V2 or later
4)  *          http://www.gnu.org/copyleft/gpl.html
5)  */
6) 

7) #include "config.h"

8) #include "eth.h"
9) 

10) static volatile unsigned int *const eth_ptr =
11)   (volatile unsigned int *)0x80000400;
12) 
13) static unsigned int eth_idx_hw;

14) static unsigned int eth_rx_buf[2][381]; /* max frame: 1522 byte = 380.5 int */

15) static unsigned int *eth_rx_pos;

16) 

17) static unsigned int eth_rx_cnt;
18) 
19) static unsigned int eth_tx_cnt;
20) 

21) /**
22)  * @brief set MAC address
23)  * @param[in] mac MAC address
24)  */
25) static void eth_mac_set(const unsigned char mac[6])
26) {
27)   unsigned int i;
28)   for (i = 0; i < 6; ++i)
29)     ((volatile unsigned char *)(eth_ptr + 12))[i] = mac[i];
30) }
31) 

32) /**

33)  * @brief provide new receive buffer
34)  * @param[in] ptr pointer to new receive buffer
35)  * @param[in] sz size of new receive buffer

36)  */

37) static void eth_rx_new_buf(void *ptr, unsigned int sz)

38) {

39)   eth_ptr[4] = (unsigned int)ptr; /* new start */
40)   eth_ptr[5] = (unsigned int)ptr + sz; /* new end */
41)   eth_ptr[6] = 1; /* set flag */
42)   while (eth_ptr[6] == 1); /* wait until processed */

43) }
44) 
45) /**

46)  * @brief get buffer position of ethernet receiver
47)  * @return current buffer position of ethernet receiver
48)  *
49)  * eveything before this position can be read

50)  */

51) static void * eth_rx_get_pos(void)
52) {
53)   return (void *)eth_ptr[0];
54) }
55) 

56) /** initialize MAC address */
57) void eth_mac_init(void)
58) {

59)   eth_mac_set(config_mac.mac);

60) }
61) 

62) /** initialize receiver */
63) void eth_rx_init(void)

64) {

65)   /* give buffer 0 to HW */

66)   eth_idx_hw = 0;
67)   eth_rx_new_buf(eth_rx_buf[0], sizeof(eth_rx_buf[0]));

68)   /* buffer 1 owned by SW is empty */

69)   eth_rx_buf[1][0] = 0;
70)   eth_rx_pos = eth_rx_buf[1];

71)   /* no packets received yet */
72)   eth_rx_cnt = 0;
73) }
74) 
75) /** initialize transmitter */
76) void eth_tx_init(void)
77) {
78)   /* no packets transmitted yet */
79)   eth_tx_cnt = 0;

80) }
81) 
82) /**
83)  * @brief get next received packet
84)  * @param[out] *pptr pointer to packet data
85)  * @param[out] *psz size of packet
86)  * @return if a packet was received
87)  */
88) int eth_rx(void **pptr, unsigned int *psz)
89) {

90)   /* current SW buffer is empty and HW buffer contains a packet */

91)   if (*eth_rx_pos == 0 && eth_rx_get_pos() != eth_rx_buf[eth_idx_hw]) {

92)     /* swap buffers */

93)     eth_idx_hw = 1 - eth_idx_hw;

94)     /* give new HW buffer to HW */

95)     eth_rx_new_buf(eth_rx_buf[eth_idx_hw], sizeof(eth_rx_buf[eth_idx_hw]));

96)     /* start reading packet data at begin of new SW buffer */

97)     eth_rx_pos = eth_rx_buf[1 - eth_idx_hw];
98)   }
99) 

100)   /* SW buffer contains a packet */

101)   if (*eth_rx_pos > 0) {

102)     /* return size and pointer, advance position */

103)     *psz = *eth_rx_pos;
104)     eth_rx_pos++;
105)     *pptr = eth_rx_pos;
106)     eth_rx_pos += *psz >> 2;

107)     ++eth_rx_cnt; /* count received packets */

108)     return 1;
109)   }
110) 

111)   /* no packet received */

112)   return 0;

113) }
114) 

115) /**
116)  * @brief transmit packet

117)  * @param[in] ptr pointer to packet data
118)  * @param[in] sz size of packet
119)  *
120)  * Padding will be appended if sz is not a multiple of 4 or smaller 60 bytes.
121)  * The buffer pointed to by ptr must be sufficiently large.

122)  */

123) void eth_tx(const void *ptr, unsigned int sz)

124) {
125)   eth_ptr[8] = (unsigned int)ptr; /* start */
126)   eth_ptr[9] = (unsigned int)ptr + sz; /* end */
127)   eth_ptr[10] = 1; /* set flag */
128)   while (eth_ptr[10] == 1); /* wait until processed */

129)   ++eth_tx_cnt; /* count transmitted packets */
130) }
131) 
132) /** get number of received packets */
133) unsigned int eth_rx_get_cnt(void)
134) {
135)   return eth_rx_cnt;
136) }
137) 
138) /** get number of transmitted packets */
139) unsigned int eth_tx_get_cnt(void)
140) {
141)   return eth_tx_cnt;