1 |
/* |
2 |
* Cisco router simulation platform. |
3 |
* Copyright (c) 2007 Christophe Fillot (cf@utc.fr) |
4 |
* |
5 |
* WIC Modules. |
6 |
*/ |
7 |
|
8 |
#include <stdio.h> |
9 |
#include <stdlib.h> |
10 |
#include <string.h> |
11 |
#include <stdarg.h> |
12 |
#include <unistd.h> |
13 |
#include <time.h> |
14 |
#include <errno.h> |
15 |
#include <assert.h> |
16 |
|
17 |
#include "utils.h" |
18 |
#include "net.h" |
19 |
#include "net_io.h" |
20 |
#include "ptask.h" |
21 |
#include "vm.h" |
22 |
#include "dev_gt.h" |
23 |
#include "dev_c2691.h" |
24 |
#include "dev_wic_serial.h" |
25 |
|
26 |
/* Get the MPSC channel associated to a WIC sub-slot */ |
27 |
static int dev_c2691_mb_wic_get_mpsc_chan(struct cisco_card *card, |
28 |
u_int port_id, |
29 |
u_int *mpsc_chan) |
30 |
{ |
31 |
u_int cid; |
32 |
|
33 |
cid = card->subslot_id + port_id; |
34 |
|
35 |
switch(cid) { |
36 |
/* WIC 0 port 0 mapped to GT96100 MPSC1 */ |
37 |
case 0x10: |
38 |
*mpsc_chan = 1; |
39 |
break; |
40 |
|
41 |
/* WIC 0 port 1 mapped to GT96100 MPSC0 */ |
42 |
case 0x11: |
43 |
*mpsc_chan = 0; |
44 |
break; |
45 |
|
46 |
/* WIC 1 port 0 mapped to GT96100 MPSC4 */ |
47 |
case 0x20: |
48 |
*mpsc_chan = 4; |
49 |
break; |
50 |
|
51 |
/* WIC 1 port 1 mapped to GT96100 MPSC2 */ |
52 |
case 0x21: |
53 |
*mpsc_chan = 2; |
54 |
break; |
55 |
|
56 |
/* WIC 2 port 0 mapped to GT96100 MPSC5 */ |
57 |
case 0x30: |
58 |
*mpsc_chan = 5; |
59 |
break; |
60 |
|
61 |
/* WIC 2 port 1 mapped to GT96100 MPSC3 */ |
62 |
case 0x31: |
63 |
*mpsc_chan = 3; |
64 |
break; |
65 |
|
66 |
default: |
67 |
return(-1); |
68 |
} |
69 |
|
70 |
return(0); |
71 |
} |
72 |
|
73 |
/* Initialize a WIC-1T in the specified slot */ |
74 |
static int dev_c2691_mb_wic1t_init(vm_instance_t *vm,struct cisco_card *card) |
75 |
{ |
76 |
struct wic_serial_data *wic_data; |
77 |
m_uint64_t phys_addr; |
78 |
u_int wic_id; |
79 |
|
80 |
/* Create the WIC device */ |
81 |
wic_id = (card->subslot_id >> 4) - 1; |
82 |
|
83 |
if (c2691_get_onboard_wic_addr(wic_id,&phys_addr) == -1) { |
84 |
vm_error(vm,"WIC","invalid slot %u (subslot_id=%u)\n", |
85 |
wic_id,card->subslot_id); |
86 |
return(-1); |
87 |
} |
88 |
|
89 |
wic_data = dev_wic_serial_init(vm,card->dev_name,WIC_SERIAL_MODEL_1T, |
90 |
phys_addr,C2691_WIC_SIZE); |
91 |
|
92 |
if (!wic_data) |
93 |
return(-1); |
94 |
|
95 |
/* Set the EEPROM */ |
96 |
cisco_card_set_eeprom(vm,card,cisco_eeprom_find_wic("WIC-1T")); |
97 |
|
98 |
/* Store device info into the router structure */ |
99 |
card->drv_info = wic_data; |
100 |
return(0); |
101 |
} |
102 |
|
103 |
/* Remove a WIC-1T from the specified slot */ |
104 |
static int |
105 |
dev_c2691_mb_wic1t_shutdown(vm_instance_t *vm,struct cisco_card *card) |
106 |
{ |
107 |
/* Remove the WIC device */ |
108 |
dev_wic_serial_remove(card->drv_info); |
109 |
|
110 |
/* Remove the WIC EEPROM */ |
111 |
cisco_card_unset_eeprom(card); |
112 |
return(0); |
113 |
} |
114 |
|
115 |
/* Bind a Network IO descriptor */ |
116 |
static int |
117 |
dev_c2691_mb_wic1t_set_nio(vm_instance_t *vm,struct cisco_card *card, |
118 |
u_int port_id,netio_desc_t *nio) |
119 |
{ |
120 |
u_int mpsc_chan; |
121 |
|
122 |
if ((port_id > 0) || |
123 |
(dev_c2691_mb_wic_get_mpsc_chan(card,port_id,&mpsc_chan) == -1)) |
124 |
return(-1); |
125 |
|
126 |
return(dev_gt96100_mpsc_set_nio(VM_C2691(vm)->gt_data,mpsc_chan,nio)); |
127 |
} |
128 |
|
129 |
/* Unbind a Network IO descriptor */ |
130 |
static int |
131 |
dev_c2691_mb_wic1t_unset_nio(vm_instance_t *vm,struct cisco_card *card, |
132 |
u_int port_id) |
133 |
{ |
134 |
u_int mpsc_chan; |
135 |
|
136 |
if ((port_id > 0) || |
137 |
(dev_c2691_mb_wic_get_mpsc_chan(card,port_id,&mpsc_chan) == -1)) |
138 |
return(-1); |
139 |
|
140 |
return(dev_gt96100_mpsc_unset_nio(VM_C2691(vm)->gt_data,mpsc_chan)); |
141 |
} |
142 |
|
143 |
/* Initialize a WIC-2T in the specified slot */ |
144 |
static int dev_c2691_mb_wic2t_init(vm_instance_t *vm,struct cisco_card *card) |
145 |
{ |
146 |
struct wic_serial_data *wic_data; |
147 |
m_uint64_t phys_addr; |
148 |
u_int wic_id; |
149 |
|
150 |
/* Create the WIC device */ |
151 |
wic_id = (card->subslot_id >> 4) - 1; |
152 |
|
153 |
if (c2691_get_onboard_wic_addr(wic_id,&phys_addr) == -1) { |
154 |
vm_error(vm,"WIC","invalid slot %u (subslot_id=%u)\n", |
155 |
wic_id,card->subslot_id); |
156 |
return(-1); |
157 |
} |
158 |
|
159 |
wic_data = dev_wic_serial_init(vm,card->dev_name,WIC_SERIAL_MODEL_2T, |
160 |
phys_addr,C2691_WIC_SIZE); |
161 |
|
162 |
if (!wic_data) |
163 |
return(-1); |
164 |
|
165 |
/* Set the EEPROM */ |
166 |
cisco_card_set_eeprom(vm,card,cisco_eeprom_find_wic("WIC-2T")); |
167 |
|
168 |
/* Store device info into the router structure */ |
169 |
card->drv_info = wic_data; |
170 |
return(0); |
171 |
} |
172 |
|
173 |
/* Remove a WIC-2T from the specified slot */ |
174 |
static int |
175 |
dev_c2691_mb_wic2t_shutdown(vm_instance_t *vm,struct cisco_card *card) |
176 |
{ |
177 |
/* Remove the WIC device */ |
178 |
dev_wic_serial_remove(card->drv_info); |
179 |
|
180 |
/* Remove the WIC EEPROM */ |
181 |
cisco_card_unset_eeprom(card); |
182 |
return(0); |
183 |
} |
184 |
|
185 |
/* Bind a Network IO descriptor */ |
186 |
static int |
187 |
dev_c2691_mb_wic2t_set_nio(vm_instance_t *vm,struct cisco_card *card, |
188 |
u_int port_id,netio_desc_t *nio) |
189 |
{ |
190 |
u_int mpsc_chan; |
191 |
|
192 |
if ((port_id > 1) || |
193 |
(dev_c2691_mb_wic_get_mpsc_chan(card,port_id,&mpsc_chan) == -1)) |
194 |
return(-1); |
195 |
|
196 |
return(dev_gt96100_mpsc_set_nio(VM_C2691(vm)->gt_data,mpsc_chan,nio)); |
197 |
} |
198 |
|
199 |
/* Unbind a Network IO descriptor */ |
200 |
static int |
201 |
dev_c2691_mb_wic2t_unset_nio(vm_instance_t *vm,struct cisco_card *card, |
202 |
u_int port_id) |
203 |
{ |
204 |
u_int mpsc_chan; |
205 |
|
206 |
if ((port_id > 1) || |
207 |
(dev_c2691_mb_wic_get_mpsc_chan(card,port_id,&mpsc_chan) == -1)) |
208 |
return(-1); |
209 |
|
210 |
return(dev_gt96100_mpsc_unset_nio(VM_C2691(vm)->gt_data,mpsc_chan)); |
211 |
} |
212 |
|
213 |
/* Cisco 2691 WIC-1T driver (for mainboard) */ |
214 |
struct cisco_card_driver dev_c2691_mb_wic1t_driver = { |
215 |
"WIC-1T", 1, 0, |
216 |
dev_c2691_mb_wic1t_init, |
217 |
dev_c2691_mb_wic1t_shutdown, |
218 |
NULL, |
219 |
dev_c2691_mb_wic1t_set_nio, |
220 |
dev_c2691_mb_wic1t_unset_nio, |
221 |
NULL, |
222 |
}; |
223 |
|
224 |
/* Cisco 2691 WIC-2T driver (for mainboard) */ |
225 |
struct cisco_card_driver dev_c2691_mb_wic2t_driver = { |
226 |
"WIC-2T", 1, 0, |
227 |
dev_c2691_mb_wic2t_init, |
228 |
dev_c2691_mb_wic2t_shutdown, |
229 |
NULL, |
230 |
dev_c2691_mb_wic2t_set_nio, |
231 |
dev_c2691_mb_wic2t_unset_nio, |
232 |
NULL, |
233 |
}; |
234 |
|
235 |
/* WIC drivers (mainbord slots) */ |
236 |
struct cisco_card_driver *dev_c2691_mb_wic_drivers[] = { |
237 |
&dev_c2691_mb_wic1t_driver, |
238 |
&dev_c2691_mb_wic2t_driver, |
239 |
NULL, |
240 |
}; |