upstream/dynamips-0.2.6-RC2/dev_c3600_eth.c

/*  
 * Cisco C3600 simulation platform.
 * Copyright (c) 2006 Christophe Fillot (cf@utc.fr)
 *
 * Ethernet Network Modules.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <stdarg.h>
#include <unistd.h>
#include <time.h>
#include <errno.h>
#include <assert.h>

#include "utils.h"
#include "net.h"
#include "net_io.h"
#include "ptask.h"
#include "dev_am79c971.h"
#include "dev_c3600.h"
#include "dev_c3600_bay.h"

/* Multi-Ethernet NM with Am79c971 chips */
struct nm_eth_data {
   u_int nr_port;
   struct am79c971_data *port[8];
};

/*
 * dev_c3600_nm_eth_init()
 *
 * Add an Ethernet Network Module into specified slot.
 */
static int dev_c3600_nm_eth_init(c3600_t *router,char *name,u_int nm_bay,
                                 int nr_port,int interface_type,
                                 const struct cisco_eeprom *eeprom)
{
   struct nm_bay_info *bay_info;
   struct nm_eth_data *data;
   int i;

   /* Allocate the private data structure */
   if (!(data = malloc(sizeof(*data)))) {
      fprintf(stderr,"%s: out of memory\n",name);
      return(-1);
   }

   memset(data,0,sizeof(*data));
   data->nr_port = nr_port;

   /* Set the EEPROM */
   c3600_nm_set_eeprom(router,nm_bay,eeprom);

   /* Get PCI bus info about this bay */
   bay_info = c3600_nm_get_bay_info(c3600_chassis_get_id(router),nm_bay);
      
   if (!bay_info) {
      fprintf(stderr,"%s: unable to get info for NM bay %u\n",name,nm_bay);
      return(-1);
   }

   /* Create the AMD Am971c971 chip(s) */
   for(i=0;i<data->nr_port;i++) {
      data->port[i] = dev_am79c971_init(router->vm,name,interface_type,
                                        router->nm_bay[nm_bay].pci_map,
                                        bay_info->pci_device + i,
                                        C3600_NETIO_IRQ);
   }

   /* Store device info into the router structure */
   return(c3600_nm_set_drvinfo(router,nm_bay,data));
}

/* Remove an Ethernet NM from the specified slot */
static int dev_c3600_nm_eth_shutdown(c3600_t *router,u_int nm_bay) 
{
   struct c3600_nm_bay *bay;
   struct nm_eth_data *data;
   int i;

   if (!(bay = c3600_nm_get_info(router,nm_bay)))
      return(-1);

   data = bay->drv_info;

   /* Remove the NM EEPROM */
   c3600_nm_unset_eeprom(router,nm_bay);

   /* Remove the AMD Am79c971 chips */
   for(i=0;i<data->nr_port;i++)
      dev_am79c971_remove(data->port[i]);

   free(data);
   return(0);
}

/* Bind a Network IO descriptor */
static int dev_c3600_nm_eth_set_nio(c3600_t *router,u_int nm_bay,
                                    u_int port_id,netio_desc_t *nio)
{
   struct nm_eth_data *d;

   d = c3600_nm_get_drvinfo(router,nm_bay);

   if (!d || (port_id >= d->nr_port))
      return(-1);

   dev_am79c971_set_nio(d->port[port_id],nio);
   return(0);
}

/* Unbind a Network IO descriptor */
static int dev_c3600_nm_eth_unset_nio(c3600_t *router,u_int nm_bay,
                                      u_int port_id)
{
   struct nm_eth_data *d;

   d = c3600_nm_get_drvinfo(router,nm_bay);

   if (!d || (port_id >= d->nr_port))
      return(-1);

   dev_am79c971_unset_nio(d->port[port_id]);
   return(0);
}

/* ====================================================================== */
/* NM-1E                                                                  */
/* ====================================================================== */

/*
 * dev_c3600_nm_1e_init()
 *
 * Add a NM-1E Network Module into specified slot.
 */
static int dev_c3600_nm_1e_init(c3600_t *router,char *name,u_int nm_bay)
{
   return(dev_c3600_nm_eth_init(router,name,nm_bay,1,AM79C971_TYPE_10BASE_T,
                                cisco_eeprom_find_nm("NM-1E")));
}

/* ====================================================================== */
/* NM-4E                                                                  */
/* ====================================================================== */

/*
 * dev_c3600_nm_4e_init()
 *
 * Add a NM-4E Network Module into specified slot.
 */
static int dev_c3600_nm_4e_init(c3600_t *router,char *name,u_int nm_bay)
{
   return(dev_c3600_nm_eth_init(router,name,nm_bay,4,AM79C971_TYPE_10BASE_T,
                                cisco_eeprom_find_nm("NM-4E")));
}

/* ====================================================================== */
/* NM-1FE-TX                                                              */
/* ====================================================================== */

/*
 * dev_c3600_nm_1fe_tx_init()
 *
 * Add a NM-1FE-TX Network Module into specified slot.
 */
static int dev_c3600_nm_1fe_tx_init(c3600_t *router,char *name,u_int nm_bay)
{
   return(dev_c3600_nm_eth_init(router,name,nm_bay,1,AM79C971_TYPE_100BASE_TX,
                                cisco_eeprom_find_nm("NM-1FE-TX")));
}

/* ====================================================================== */
/* Leopard-2FE                                                            */
/* ====================================================================== */

/* 
 * Leopard-2FE: 2 FastEthernet ports on C3660 motherboard.
 *
 * Leopard-2FE is the FRU/Product Number displayed by "show diag".
 */
static m_uint16_t eeprom_c3600_leopard_2fe_data[] = {
   0x04FF, 0xC18B, 0x4A41, 0x4230, 0x3530, 0x3330, 0x3454, 0x3809,
   0x3440, 0x00B3, 0xC046, 0x0320, 0x0012, 0x8104, 0x4241, 0x3085,
   0x1C0C, 0xA202, 0x80FF, 0xFFFF, 0xFFC4, 0x08FF, 0xFFFF, 0xFFFF,
   0xFFFF, 0xFFA1, 0xFFFF, 0xFFFF, 0x03FF, 0x04FF, 0xC508, 0xFFFF,
   0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF,
   0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF,
   0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF,
   0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFF00,
};

static const struct cisco_eeprom eeprom_c3600_leopard_2fe = {
   "Leopard-2FE", (m_uint16_t *)eeprom_c3600_leopard_2fe_data, 
   sizeof(eeprom_c3600_leopard_2fe_data)/2,
};

/*
 * dev_c3600_leopard_2fe_init()
 *
 * Add Leopard-2FE (only Cisco 3660, in slot 0).
 */
static int dev_c3600_leopard_2fe_init(c3600_t *router,char *name,u_int nm_bay)
{
   if (nm_bay != 0) {
      fprintf(stderr,"C3600 %s: Leopard-2FE can only be put in slot 0\n",
              router->vm->name);
      return(-1);
   }

   return(dev_c3600_nm_eth_init(router,name,0,2,AM79C971_TYPE_100BASE_TX,
                                &eeprom_c3600_leopard_2fe));
}

/* ====================================================================== */

/* NM-1FE-TX driver */
struct c3600_nm_driver dev_c3600_nm_1fe_tx_driver = {
   "NM-1FE-TX", 1, 0,
   dev_c3600_nm_1fe_tx_init, 
   dev_c3600_nm_eth_shutdown,
   dev_c3600_nm_eth_set_nio,
   dev_c3600_nm_eth_unset_nio,
   NULL,
};

/* NM-1E driver */
struct c3600_nm_driver dev_c3600_nm_1e_driver = {
   "NM-1E", 1, 0,
   dev_c3600_nm_1e_init, 
   dev_c3600_nm_eth_shutdown,
   dev_c3600_nm_eth_set_nio,
   dev_c3600_nm_eth_unset_nio,
   NULL,
};

/* NM-4E driver */
struct c3600_nm_driver dev_c3600_nm_4e_driver = {
   "NM-4E", 1, 0,
   dev_c3600_nm_4e_init, 
   dev_c3600_nm_eth_shutdown,
   dev_c3600_nm_eth_set_nio,
   dev_c3600_nm_eth_unset_nio,
   NULL,
};

/* Leopard-2FE driver */
struct c3600_nm_driver dev_c3600_leopard_2fe_driver = {
   "Leopard-2FE", 1, 0,
   dev_c3600_leopard_2fe_init, 
   dev_c3600_nm_eth_shutdown,
   dev_c3600_nm_eth_set_nio,
   dev_c3600_nm_eth_unset_nio,
   NULL,
};
1	/*
2	* Cisco C3600 simulation platform.
3	* Copyright (c) 2006 Christophe Fillot (cf@utc.fr)
4	*
5	* Ethernet Network 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 "dev_am79c971.h"
22	#include "dev_c3600.h"
23	#include "dev_c3600_bay.h"
24
25	/* Multi-Ethernet NM with Am79c971 chips */
26	struct nm_eth_data {
27	u_int nr_port;
28	struct am79c971_data *port[8];
29	};
30
31	/*
32	* dev_c3600_nm_eth_init()
33	*
34	* Add an Ethernet Network Module into specified slot.
35	*/
36	static int dev_c3600_nm_eth_init(c3600_t router,char name,u_int nm_bay,
37	int nr_port,int interface_type,
38	const struct cisco_eeprom *eeprom)
39	{
40	struct nm_bay_info *bay_info;
41	struct nm_eth_data *data;
42	int i;
43
44	/* Allocate the private data structure */
45	if (!(data = malloc(sizeof(*data)))) {
46	fprintf(stderr,"%s: out of memory\n",name);
47	return(-1);
48	}
49
50	memset(data,0,sizeof(*data));
51	data->nr_port = nr_port;
52
53	/* Set the EEPROM */
54	c3600_nm_set_eeprom(router,nm_bay,eeprom);
55
56	/* Get PCI bus info about this bay */
57	bay_info = c3600_nm_get_bay_info(c3600_chassis_get_id(router),nm_bay);
58
59	if (!bay_info) {
60	fprintf(stderr,"%s: unable to get info for NM bay %u\n",name,nm_bay);
61	return(-1);
62	}
63
64	/* Create the AMD Am971c971 chip(s) */
65	for(i=0;i<data->nr_port;i++) {
66	data->port[i] = dev_am79c971_init(router->vm,name,interface_type,
67	router->nm_bay[nm_bay].pci_map,
68	bay_info->pci_device + i,
69	C3600_NETIO_IRQ);
70	}
71
72	/* Store device info into the router structure */
73	return(c3600_nm_set_drvinfo(router,nm_bay,data));
74	}
75
76	/* Remove an Ethernet NM from the specified slot */
77	static int dev_c3600_nm_eth_shutdown(c3600_t *router,u_int nm_bay)
78	{
79	struct c3600_nm_bay *bay;
80	struct nm_eth_data *data;
81	int i;
82
83	if (!(bay = c3600_nm_get_info(router,nm_bay)))
84	return(-1);
85
86	data = bay->drv_info;
87
88	/* Remove the NM EEPROM */
89	c3600_nm_unset_eeprom(router,nm_bay);
90
91	/* Remove the AMD Am79c971 chips */
92	for(i=0;i<data->nr_port;i++)
93	dev_am79c971_remove(data->port[i]);
94
95	free(data);
96	return(0);
97	}
98
99	/* Bind a Network IO descriptor */
100	static int dev_c3600_nm_eth_set_nio(c3600_t *router,u_int nm_bay,
101	u_int port_id,netio_desc_t *nio)
102	{
103	struct nm_eth_data *d;
104
105	d = c3600_nm_get_drvinfo(router,nm_bay);
106
107	if (!d \|\| (port_id >= d->nr_port))
108	return(-1);
109
110	dev_am79c971_set_nio(d->port[port_id],nio);
111	return(0);
112	}
113
114	/* Unbind a Network IO descriptor */
115	static int dev_c3600_nm_eth_unset_nio(c3600_t *router,u_int nm_bay,
116	u_int port_id)
117	{
118	struct nm_eth_data *d;
119
120	d = c3600_nm_get_drvinfo(router,nm_bay);
121
122	if (!d \|\| (port_id >= d->nr_port))
123	return(-1);
124
125	dev_am79c971_unset_nio(d->port[port_id]);
126	return(0);
127	}
128
129	/* ====================================================================== */
130	/* NM-1E */
131	/* ====================================================================== */
132
133	/*
134	* dev_c3600_nm_1e_init()
135	*
136	* Add a NM-1E Network Module into specified slot.
137	*/
138	static int dev_c3600_nm_1e_init(c3600_t router,char name,u_int nm_bay)
139	{
140	return(dev_c3600_nm_eth_init(router,name,nm_bay,1,AM79C971_TYPE_10BASE_T,
141	cisco_eeprom_find_nm("NM-1E")));
142	}
143
144	/* ====================================================================== */
145	/* NM-4E */
146	/* ====================================================================== */
147
148	/*
149	* dev_c3600_nm_4e_init()
150	*
151	* Add a NM-4E Network Module into specified slot.
152	*/
153	static int dev_c3600_nm_4e_init(c3600_t router,char name,u_int nm_bay)
154	{
155	return(dev_c3600_nm_eth_init(router,name,nm_bay,4,AM79C971_TYPE_10BASE_T,
156	cisco_eeprom_find_nm("NM-4E")));
157	}
158
159	/* ====================================================================== */
160	/* NM-1FE-TX */
161	/* ====================================================================== */
162
163	/*
164	* dev_c3600_nm_1fe_tx_init()
165	*
166	* Add a NM-1FE-TX Network Module into specified slot.
167	*/
168	static int dev_c3600_nm_1fe_tx_init(c3600_t router,char name,u_int nm_bay)
169	{
170	return(dev_c3600_nm_eth_init(router,name,nm_bay,1,AM79C971_TYPE_100BASE_TX,
171	cisco_eeprom_find_nm("NM-1FE-TX")));
172	}
173
174	/* ====================================================================== */
175	/* Leopard-2FE */
176	/* ====================================================================== */
177
178	/*
179	* Leopard-2FE: 2 FastEthernet ports on C3660 motherboard.
180	*
181	* Leopard-2FE is the FRU/Product Number displayed by "show diag".
182	*/
183	static m_uint16_t eeprom_c3600_leopard_2fe_data[] = {
184	0x04FF, 0xC18B, 0x4A41, 0x4230, 0x3530, 0x3330, 0x3454, 0x3809,
185	0x3440, 0x00B3, 0xC046, 0x0320, 0x0012, 0x8104, 0x4241, 0x3085,
186	0x1C0C, 0xA202, 0x80FF, 0xFFFF, 0xFFC4, 0x08FF, 0xFFFF, 0xFFFF,
187	0xFFFF, 0xFFA1, 0xFFFF, 0xFFFF, 0x03FF, 0x04FF, 0xC508, 0xFFFF,
188	0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF,
189	0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF,
190	0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF,
191	0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFF00,
192	};
193
194	static const struct cisco_eeprom eeprom_c3600_leopard_2fe = {
195	"Leopard-2FE", (m_uint16_t *)eeprom_c3600_leopard_2fe_data,
196	sizeof(eeprom_c3600_leopard_2fe_data)/2,
197	};
198
199	/*
200	* dev_c3600_leopard_2fe_init()
201	*
202	* Add Leopard-2FE (only Cisco 3660, in slot 0).
203	*/
204	static int dev_c3600_leopard_2fe_init(c3600_t router,char name,u_int nm_bay)
205	{
206	if (nm_bay != 0) {
207	fprintf(stderr,"C3600 %s: Leopard-2FE can only be put in slot 0\n",
208	router->vm->name);
209	return(-1);
210	}
211
212	return(dev_c3600_nm_eth_init(router,name,0,2,AM79C971_TYPE_100BASE_TX,
213	&eeprom_c3600_leopard_2fe));
214	}
215
216	/* ====================================================================== */
217
218	/* NM-1FE-TX driver */
219	struct c3600_nm_driver dev_c3600_nm_1fe_tx_driver = {
220	"NM-1FE-TX", 1, 0,
221	dev_c3600_nm_1fe_tx_init,
222	dev_c3600_nm_eth_shutdown,
223	dev_c3600_nm_eth_set_nio,
224	dev_c3600_nm_eth_unset_nio,
225	NULL,
226	};
227
228	/* NM-1E driver */
229	struct c3600_nm_driver dev_c3600_nm_1e_driver = {
230	"NM-1E", 1, 0,
231	dev_c3600_nm_1e_init,
232	dev_c3600_nm_eth_shutdown,
233	dev_c3600_nm_eth_set_nio,
234	dev_c3600_nm_eth_unset_nio,
235	NULL,
236	};
237
238	/* NM-4E driver */
239	struct c3600_nm_driver dev_c3600_nm_4e_driver = {
240	"NM-4E", 1, 0,
241	dev_c3600_nm_4e_init,
242	dev_c3600_nm_eth_shutdown,
243	dev_c3600_nm_eth_set_nio,
244	dev_c3600_nm_eth_unset_nio,
245	NULL,
246	};
247
248	/* Leopard-2FE driver */
249	struct c3600_nm_driver dev_c3600_leopard_2fe_driver = {
250	"Leopard-2FE", 1, 0,
251	dev_c3600_leopard_2fe_init,
252	dev_c3600_nm_eth_shutdown,
253	dev_c3600_nm_eth_set_nio,
254	dev_c3600_nm_eth_unset_nio,
255	NULL,
256	};