1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
|
/*Note: this file is copy from 7312 BSP, and untested yet*/
#include <rtems.h>
#include <sys/mbuf.h>
#include <bsp/irq.h>
#include <libchip/cs8900.h>
#include <assert.h>
#define CS8900_BASE 0x20000300
unsigned int bsp_cs8900_io_base = 0;
unsigned int bsp_cs8900_memory_base = 0;
static void cs8900_isr(void *);
char g_enetbuf[1520];
static void cs8900_isr(void *arg)
{
cs8900_interrupt(LPC22xx_INTERRUPT_EINT2, arg);
}
/* cs8900_io_set_reg - set one of the I/O addressed registers */
void cs8900_io_set_reg (cs8900_device *cs, unsigned short reg, unsigned short data)
{
/* works the same for all values of dev */
/*
printf("cs8900_io_set_reg: reg: %#6x, val %#6x\n",
CS8900_BASE + reg,
data);
*/
*(unsigned short *)(CS8900_BASE + reg) = data;
}
/* cs8900_io_get_reg - reads one of the I/O addressed registers */
unsigned short cs8900_io_get_reg (cs8900_device *cs, unsigned short reg)
{
unsigned short val;
/* works the same for all values of dev */
val = *(unsigned short *)(CS8900_BASE + reg);
/*
printf("cs8900_io_get_reg: reg: %#6x, val %#6x\n", reg, val);
*/
return val;
}
/* cs8900_mem_set_reg - sets one of the registers mapped through
* PacketPage
*/
void cs8900_mem_set_reg (cs8900_device *cs, unsigned long reg, unsigned short data)
{
/* works the same for all values of dev */
cs8900_io_set_reg(cs, CS8900_IO_PACKET_PAGE_PTR, reg);
cs8900_io_set_reg(cs, CS8900_IO_PP_DATA_PORT0, data);
}
/* cs8900_mem_get_reg - reads one of the registers mapped through
* PacketPage
*/
unsigned short cs8900_mem_get_reg (cs8900_device *cs, unsigned long reg)
{
/* works the same for all values of dev */
cs8900_io_set_reg(cs, CS8900_IO_PACKET_PAGE_PTR, reg);
return cs8900_io_get_reg(cs, CS8900_IO_PP_DATA_PORT0);
}
void cs8900_attach_interrupt (cs8900_device *cs)
{
rtems_status_code status = RTEMS_SUCCESSFUL;
status = rtems_interrupt_handler_install(
LPC22xx_INTERRUPT_EINT2,
"Network",
RTEMS_INTERRUPT_UNIQUE,
cs8900_isr,
cs
);
assert(status == RTEMS_SUCCESSFUL);
}
void cs8900_detach_interrupt (cs8900_device *cs)
{
rtems_status_code status = RTEMS_SUCCESSFUL;
status = rtems_interrupt_handler_remove(
LPC22xx_INTERRUPT_EINT2,
cs8900_isr,
cs
);
assert(status == RTEMS_SUCCESSFUL);
}
unsigned short cs8900_get_data_block (cs8900_device *cs, unsigned char *data)
{
int len;
int i;
len = cs8900_mem_get_reg(cs, CS8900_PP_RxLength);
for (i = 0; i < ((len + 1) / 2); i++) {
((short *)data)[i] = cs8900_io_get_reg(cs,
CS8900_IO_RX_TX_DATA_PORT0);
}
return len;
}
void cs8900_tx_load (cs8900_device *cs, struct mbuf *m)
{
int len;
unsigned short *data;
int i;
len = 0;
do {
memcpy(&g_enetbuf[len], mtod(m, const void *), m->m_len);
len += m->m_len;
m = m->m_next;
} while (m != 0);
data = (unsigned short *) &g_enetbuf[0];
for (i = 0; i < ((len + 1) / 2); i++) {
cs8900_io_set_reg(cs,
CS8900_IO_RX_TX_DATA_PORT0,
data[i]);
}
}
|
