--- upstream/dynamips-0.2.5/dev_c3600.c 2007/10/06 16:01:44 1 +++ upstream/dynamips-0.2.8-RC1/dev_c3600.c 2007/10/06 16:33:40 11 @@ -12,13 +12,16 @@ #include #include -#include "mips64.h" +#include "cpu.h" #include "dynamips.h" #include "memory.h" #include "device.h" #include "pci_io.h" +#include "dev_gt.h" #include "cisco_eeprom.h" +#include "dev_rom.h" #include "dev_c3600.h" +#include "dev_c3600_iofpga.h" #include "dev_c3600_bay.h" #include "dev_vtty.h" #include "registry.h" @@ -28,7 +31,7 @@ /* ======================================================================== */ /* Cisco 3620 mainboard EEPROM */ -static m_uint16_t eeprom_c3620_mainboard[64] = { +static m_uint16_t eeprom_c3620_mainboard_data[64] = { 0x0001, 0x0000, 0x0000, 0x0000, 0x0AFF, 0x7318, 0x5011, 0x0020, 0x0000, 0x0000, 0xA0FF, 0x9904, 0x19FF, 0xFFFF, 0xFFFF, 0x0002, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, @@ -39,8 +42,14 @@ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, }; +struct cisco_eeprom eeprom_c3620_mainboard = { + "C3620 Mainboard", + eeprom_c3620_mainboard_data, + sizeof(eeprom_c3620_mainboard_data)/2, +}; + /* Cisco 3640 mainboard EEPROM */ -static m_uint16_t eeprom_c3640_mainboard[64] = { +static m_uint16_t eeprom_c3640_mainboard_data[64] = { 0x0001, 0x0000, 0x0000, 0x0000, 0x0AFF, 0x7316, 0x8514, 0x0040, 0x0000, 0x0000, 0xA1FF, 0x0102, 0x22FF, 0xFFFF, 0xFFFF, 0x0002, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, @@ -51,8 +60,14 @@ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, }; +struct cisco_eeprom eeprom_c3640_mainboard = { + "C3640 Mainboard", + eeprom_c3640_mainboard_data, + sizeof(eeprom_c3640_mainboard_data)/2, +}; + /* Cisco 3660 backplane EEPROM */ -static m_uint16_t eeprom_c3660_backplane[64] = { +static m_uint16_t eeprom_c3660_backplane_data[64] = { 0x04FF, 0x4000, 0xC841, 0x0100, 0xC046, 0x0320, 0x0012, 0x8402, 0x4243, 0x3080, 0x0000, 0x0000, 0x0202, 0xC18B, 0x4841, 0x4430, 0x3434, 0x3431, 0x3135, 0x4A03, 0x0081, 0x0000, 0x0000, 0x0400, @@ -63,6 +78,12 @@ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, }; +struct cisco_eeprom eeprom_c3660_backplane = { + "C3660 Backplane", + eeprom_c3660_backplane_data, + sizeof(eeprom_c3660_backplane_data)/2, +}; + /* ======================================================================== */ /* Chassis Drivers */ /* ======================================================================== */ @@ -71,25 +92,22 @@ static int c3660_init(c3600_t *router); static struct c3600_chassis_driver chassis_drivers[] = { - { "3620" , 3620, 1, c3620_init, - eeprom_c3620_mainboard, sizeof(eeprom_c3620_mainboard)/2 }, - { "3640" , 3640, 1, c3640_init, - eeprom_c3640_mainboard, sizeof(eeprom_c3640_mainboard)/2 }, - { "3660" , 3660, 1, c3660_init, - eeprom_c3660_backplane, sizeof(eeprom_c3660_backplane)/2 }, - - { NULL , -1, 0, NULL }, + { "3620" , 3620, 1, c3620_init, &eeprom_c3620_mainboard }, + { "3640" , 3640, 1, c3640_init, &eeprom_c3640_mainboard }, + { "3660" , 3660, 1, c3660_init, &eeprom_c3660_backplane }, + { NULL , -1, 0, NULL, NULL }, }; /* ======================================================================== */ /* Network Module Drivers */ /* ======================================================================== */ -static struct c3600_nm_driver *nm_drivers[] = { +static struct cisco_card_driver *nm_drivers[] = { &dev_c3600_nm_1e_driver, &dev_c3600_nm_4e_driver, &dev_c3600_nm_1fe_tx_driver, &dev_c3600_nm_4t_driver, &dev_c3600_leopard_2fe_driver, + &dev_c3600_nm_16esw_driver, NULL, }; @@ -97,847 +115,197 @@ /* Cisco 3600 router instances */ /* ======================================================================== */ +/* Initialize default parameters for a C3600 */ +static void c3600_init_defaults(c3600_t *router); + /* Directly extract the configuration from the NVRAM device */ -ssize_t c3600_nvram_extract_config(vm_instance_t *vm,char **buffer) -{ +static ssize_t c3600_nvram_extract_config(vm_instance_t *vm,u_char **buffer) +{ + u_char *base_ptr,*ios_ptr,*cfg_ptr,*end_ptr; + m_uint32_t start,nvlen; + m_uint16_t magic1,magic2; struct vdevice *nvram_dev; - m_uint32_t start,end,clen,nvlen; - m_uint16_t magic1,magic2; - m_uint64_t addr; + off_t nvram_size; + int fd; - if (!(nvram_dev = dev_get_by_name(vm,"nvram"))) - return(-1); + if ((nvram_dev = dev_get_by_name(vm,"nvram"))) + dev_sync(nvram_dev); - addr = nvram_dev->phys_addr + vm->nvram_rom_space; - magic1 = physmem_copy_u16_from_vm(vm,addr+0x06); - magic2 = physmem_copy_u16_from_vm(vm,addr+0x08); + fd = vm_mmap_open_file(vm,"nvram",&base_ptr,&nvram_size); - if ((magic1 != 0xF0A5) || (magic2 != 0xABCD)) { - vm_error(vm,"unable to find IOS magic numbers (0x%x,0x%x)!\n", - magic1,magic2); + if (fd == -1) return(-1); - } - start = physmem_copy_u32_from_vm(vm,addr+0x10) + 1; - end = physmem_copy_u32_from_vm(vm,addr+0x14); - nvlen = physmem_copy_u32_from_vm(vm,addr+0x18); - clen = end - start; + ios_ptr = base_ptr + vm->nvram_rom_space; + end_ptr = base_ptr + nvram_size; - if ((clen + 1) != nvlen) { - vm_error(vm,"invalid configuration size (0x%x)\n",nvlen); + if ((ios_ptr + 0x30) >= end_ptr) { + vm_error(vm,"NVRAM file too small\n"); return(-1); } - if (!(*buffer = malloc(clen+1))) { - vm_error(vm,"unable to allocate config buffer (%u bytes)\n",clen); + magic1 = ntohs(*PTR_ADJUST(m_uint16_t *,ios_ptr,0x06)); + magic2 = ntohs(*PTR_ADJUST(m_uint16_t *,ios_ptr,0x08)); + + if ((magic1 != 0xF0A5) || (magic2 != 0xABCD)) { + vm_error(vm,"unable to find IOS magic numbers (0x%x,0x%x)!\n", + magic1,magic2); return(-1); } - physmem_copy_from_vm(vm,*buffer,addr+start+0x08,clen); - (*buffer)[clen] = 0; - return(clen); -} - -/* Compute NVRAM checksum */ -static u_int16_t nvram_cksum(vm_instance_t *vm,m_uint64_t addr,size_t count) -{ - m_uint32_t sum = 0; + start = ntohl(*PTR_ADJUST(m_uint32_t *,ios_ptr,0x10)) + 1; + nvlen = ntohl(*PTR_ADJUST(m_uint32_t *,ios_ptr,0x18)); - while(count > 1) { - sum = sum + physmem_copy_u16_from_vm(vm,addr); - addr += sizeof(m_uint16_t); - count -= sizeof(m_uint16_t); + if (!(*buffer = malloc(nvlen+1))) { + vm_error(vm,"unable to allocate config buffer (%u bytes)\n",nvlen); + return(-1); } - if (count > 0) - sum = sum + ((physmem_copy_u16_from_vm(vm,addr) & 0xFF) << 8); + cfg_ptr = ios_ptr + start + 0x08; - while(sum>>16) - sum = (sum & 0xffff) + (sum >> 16); + if ((cfg_ptr + nvlen) > end_ptr) { + vm_error(vm,"NVRAM file too small\n"); + return(-1); + } - return(~sum); + memcpy(*buffer,cfg_ptr,nvlen-1); + (*buffer)[nvlen-1] = 0; + return(nvlen-1); } - /* Directly push the IOS configuration to the NVRAM device */ -int c3600_nvram_push_config(vm_instance_t *vm,char *buffer,size_t len) +static int c3600_nvram_push_config(vm_instance_t *vm,u_char *buffer,size_t len) { - struct vdevice *nvram_dev; - m_uint64_t addr,cfg_addr; - m_uint32_t tmp,cfg_offset; - m_uint32_t cklen; + u_char *base_ptr,*ios_ptr,*cfg_ptr; + m_uint32_t cfg_offset,cklen,tmp; m_uint16_t cksum; + int fd; - if (!(nvram_dev = dev_get_by_name(vm,"nvram"))) + fd = vm_mmap_create_file(vm,"nvram",vm->nvram_size*1024,&base_ptr); + + if (fd == -1) return(-1); - addr = nvram_dev->phys_addr + vm->nvram_rom_space; cfg_offset = 0x2c; - cfg_addr = addr + cfg_offset;; + ios_ptr = base_ptr + vm->nvram_rom_space; + cfg_ptr = ios_ptr + cfg_offset; /* Write IOS tag, uncompressed config... */ - physmem_copy_u16_to_vm(vm,addr+0x06,0xF0A5); - physmem_copy_u16_to_vm(vm,addr+0x08,0xABCD); /* Magic number */ - physmem_copy_u16_to_vm(vm,addr+0x0a,0x0001); /* ??? */ - physmem_copy_u16_to_vm(vm,addr+0x0c,0x0000); /* Checksum */ - physmem_copy_u16_to_vm(vm,addr+0x0e,0x0c04); /* IOS version */ + *PTR_ADJUST(m_uint16_t *,ios_ptr,0x06) = htons(0xF0A5); + *PTR_ADJUST(m_uint16_t *,ios_ptr,0x08) = htons(0xABCD); + *PTR_ADJUST(m_uint16_t *,ios_ptr,0x0a) = htons(0x0001); + *PTR_ADJUST(m_uint16_t *,ios_ptr,0x0c) = htons(0x0000); + *PTR_ADJUST(m_uint16_t *,ios_ptr,0x0e) = htons(0x0c04); /* Store file contents to NVRAM */ - physmem_copy_to_vm(vm,buffer,cfg_addr,len); + memcpy(cfg_ptr,buffer,len); /* Write config addresses + size */ - tmp = cfg_addr - addr - 0x08; + tmp = cfg_offset - 0x08; - physmem_copy_u32_to_vm(vm,addr+0x10,tmp); - physmem_copy_u32_to_vm(vm,addr+0x14,tmp + len); - physmem_copy_u32_to_vm(vm,addr+0x18,len); + *PTR_ADJUST(m_uint32_t *,ios_ptr,0x10) = htonl(tmp); + *PTR_ADJUST(m_uint32_t *,ios_ptr,0x14) = htonl(tmp + len); + *PTR_ADJUST(m_uint32_t *,ios_ptr,0x18) = htonl(len); /* Compute the checksum */ - cklen = nvram_dev->phys_len - (vm->nvram_rom_space + 0x08); - cksum = nvram_cksum(vm,addr+0x08,cklen); - physmem_copy_u16_to_vm(vm,addr+0x0c,cksum); + cklen = (vm->nvram_size*1024) - (vm->nvram_rom_space + 0x08); + cksum = nvram_cksum((m_uint16_t *)(ios_ptr+0x08),cklen); + *PTR_ADJUST(m_uint16_t *,ios_ptr,0x0c) = htons(cksum); + + vm_mmap_close_file(fd,base_ptr,vm->nvram_size*1024); return(0); } /* Create a new router instance */ -c3600_t *c3600_create_instance(char *name,int instance_id) +static int c3600_create_instance(vm_instance_t *vm) { c3600_t *router; if (!(router = malloc(sizeof(*router)))) { - fprintf(stderr,"C3600 '%s': Unable to create new instance!\n",name); - return NULL; + fprintf(stderr,"C3600 '%s': Unable to create new instance!\n",vm->name); + return(-1); } memset(router,0,sizeof(*router)); - - if (!(router->vm = vm_create(name,instance_id,VM_TYPE_C3600))) { - fprintf(stderr,"C3600 '%s': unable to create VM instance!\n",name); - goto err_vm; - } + router->vm = vm; + vm->hw_data = router; c3600_init_defaults(router); - router->vm->hw_data = router; - return router; - - err_vm: - free(router); - return NULL; + return(0); } /* Free resources used by a router instance */ -static int c3600_free_instance(void *data,void *arg) +static int c3600_delete_instance(vm_instance_t *vm) { - vm_instance_t *vm = data; - c3600_t *router; + c3600_t *router = VM_C3600(vm); int i; - if (vm->type == VM_TYPE_C3600) { - router = VM_C3600(vm); - - /* Stop all CPUs */ - if (vm->cpu_group != NULL) { - vm_stop(vm); + /* Stop all CPUs */ + if (vm->cpu_group != NULL) { + vm_stop(vm); - if (cpu_group_sync_state(vm->cpu_group) == -1) { - vm_error(vm,"unable to sync with system CPUs.\n"); - return(FALSE); - } + if (cpu_group_sync_state(vm->cpu_group) == -1) { + vm_error(vm,"unable to sync with system CPUs.\n"); + return(FALSE); } - - /* Remove NIO bindings */ - for(i=0;inr_slots;i++) + vm_slot_remove_all_nio_bindings(vm,i); -/* Delete a router instance */ -int c3600_delete_instance(char *name) -{ - return(registry_delete_if_unused(name,OBJ_TYPE_VM, - c3600_free_instance,NULL)); -} + /* Shutdown all Network Modules */ + vm_slot_shutdown_all(vm); -/* Delete all router instances */ -int c3600_delete_all_instances(void) -{ - return(registry_delete_type(OBJ_TYPE_VM,c3600_free_instance,NULL)); -} + /* Free mainboard EEPROM */ + cisco_eeprom_free(&router->mb_eeprom); -/* Save configuration of a C3600 instance */ -void c3600_save_config(c3600_t *router,FILE *fd) -{ - vm_instance_t *vm = router->vm; - struct c3600_nio_binding *nb; - struct c3600_nm_bay *bay; - int i; - - /* General settings */ - fprintf(fd,"c3600 create %s %u\n",vm->name,vm->instance_id); - - fprintf(fd,"c3600 set_chassis %s %s\n", - vm->name,router->chassis_driver->chassis_type); - - /* VM configuration */ - vm_save_config(vm,fd); + /* Free all resources used by VM */ + vm_free(vm); - /* Network Module settings */ - for(i=0;idev_type) { - fprintf(fd,"c3600 add_nm_binding %s %u %s\n", - vm->name,i,bay->dev_type); - } - - for(nb=bay->nio_list;nb;nb=nb->next) { - fprintf(fd,"c3600 add_nio_binding %s %u %u %s\n", - vm->name,i,nb->port_id,nb->nio->name); - } - } - - fprintf(fd,"\n"); + /* Free the router structure */ + free(router); + return(TRUE); } -/* Save configurations of all C3600 instances */ -static void c3600_reg_save_config(registry_entry_t *entry,void *opt,int *err) +/* Save configuration of a C3600 instance */ +static void c3600_save_config(vm_instance_t *vm,FILE *fd) { - vm_instance_t *vm = entry->data; c3600_t *router = VM_C3600(vm); - if (vm->type == VM_TYPE_C3600) - c3600_save_config(router,(FILE *)opt); -} - -void c3600_save_config_all(FILE *fd) -{ - registry_foreach_type(OBJ_TYPE_VM,c3600_reg_save_config,fd,NULL); -} - -/* Set NM EEPROM definition */ -int c3600_nm_set_eeprom(c3600_t *router,u_int nm_bay, - const struct c3600_eeprom *eeprom) -{ - if (nm_bay >= C3600_MAX_NM_BAYS) { - vm_error(router->vm,"c3600_nm_set_eeprom: invalid NM Bay %u.\n",nm_bay); - return(-1); - } - - /* 3620/3640 */ - router->nm_bay[nm_bay].eeprom_data = eeprom->data; - router->nm_bay[nm_bay].eeprom_data_len = eeprom->len; - - /* 3660 */ - router->c3660_nm_eeprom_def[nm_bay].data = eeprom->data; - router->c3660_nm_eeprom_def[nm_bay].data_len = eeprom->len; - return(0); -} - -/* Unset NM EEPROM definition (empty bay) */ -int c3600_nm_unset_eeprom(c3600_t *router,u_int nm_bay) -{ - if (nm_bay >= C3600_MAX_NM_BAYS) { - vm_error(router->vm,"c3600_nm_set_eeprom: invalid NM Bay %u.\n",nm_bay); - return(-1); - } - - /* 3620/3640 */ - router->nm_bay[nm_bay].eeprom_data = NULL; - router->nm_bay[nm_bay].eeprom_data_len = 0; - - /* 3660 */ - router->c3660_nm_eeprom_def[nm_bay].data = NULL; - router->c3660_nm_eeprom_def[nm_bay].data_len = 0; - return(0); -} - -/* Check if a bay has a port adapter */ -int c3600_nm_check_eeprom(c3600_t *router,u_int nm_bay) -{ - if (nm_bay >= C3600_MAX_NM_BAYS) - return(FALSE); - - return((router->nm_bay[nm_bay].eeprom_data != NULL) ? TRUE : FALSE); -} - -/* Get bay info */ -struct c3600_nm_bay *c3600_nm_get_info(c3600_t *router,u_int nm_bay) -{ - if (nm_bay >= C3600_MAX_NM_BAYS) - return NULL; - - return(&router->nm_bay[nm_bay]); -} - -/* Get NM type */ -char *c3600_nm_get_type(c3600_t *router,u_int nm_bay) -{ - struct c3600_nm_bay *bay; - - bay = c3600_nm_get_info(router,nm_bay); - return((bay != NULL) ? bay->dev_type : NULL); -} - -/* Get driver info about the specified slot */ -void *c3600_nm_get_drvinfo(c3600_t *router,u_int nm_bay) -{ - struct c3600_nm_bay *bay; - - bay = c3600_nm_get_info(router,nm_bay); - return((bay != NULL) ? bay->drv_info : NULL); -} - -/* Set driver info for the specified slot */ -int c3600_nm_set_drvinfo(c3600_t *router,u_int nm_bay,void *drv_info) -{ - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - bay->drv_info = drv_info; - return(0); -} - -/* Get a NM driver */ -static struct c3600_nm_driver *c3600_nm_get_driver(char *dev_type) -{ - int i; - - for(i=0;nm_drivers[i];i++) - if (!strcmp(nm_drivers[i]->dev_type,dev_type)) - return nm_drivers[i]; - - return NULL; -} - -/* Add a NM binding */ -int c3600_nm_add_binding(c3600_t *router,char *dev_type,u_int nm_bay) -{ - struct c3600_nm_driver *nm_driver; - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* check that this bay is empty */ - if (bay->dev_type != NULL) { - vm_error(router->vm,"a NM already exists in slot %u.\n",nm_bay); - return(-1); - } - - /* find the NM driver */ - if (!(nm_driver = c3600_nm_get_driver(dev_type))) { - vm_error(router->vm,"unknown NM type '%s'.\n",dev_type); - return(-1); - } - - bay->dev_type = nm_driver->dev_type; - bay->nm_driver = nm_driver; - return(0); -} - -/* Remove a NM binding */ -int c3600_nm_remove_binding(c3600_t *router,u_int nm_bay) -{ - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* stop if this bay is still active */ - if (bay->drv_info != NULL) { - vm_error(router->vm,"slot %u still active.\n",nm_bay); - return(-1); - } - - /* check that this bay is not empty */ - if (bay->dev_type == NULL) { - vm_error(router->vm,"slot %u is empty.\n",nm_bay); - return(-1); - } - - /* remove all NIOs bindings */ - c3600_nm_remove_all_nio_bindings(router,nm_bay); - - bay->dev_type = NULL; - bay->nm_driver = NULL; - return(0); -} - -/* Find a NIO binding */ -struct c3600_nio_binding * -c3600_nm_find_nio_binding(c3600_t *router,u_int nm_bay,u_int port_id) -{ - struct c3600_nio_binding *nb; - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return NULL; - - for(nb=bay->nio_list;nb;nb=nb->next) - if (nb->port_id == port_id) - return nb; - - return NULL; -} - -/* Add a network IO binding */ -int c3600_nm_add_nio_binding(c3600_t *router,u_int nm_bay,u_int port_id, - char *nio_name) -{ - struct c3600_nio_binding *nb; - struct c3600_nm_bay *bay; - netio_desc_t *nio; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* check that a NIO is not already bound to this port */ - if (c3600_nm_find_nio_binding(router,nm_bay,port_id) != NULL) { - vm_error(router->vm,"a NIO already exists for interface %u/%u.\n", - nm_bay,port_id); - return(-1); - } - - /* acquire a reference on the NIO object */ - if (!(nio = netio_acquire(nio_name))) { - vm_error(router->vm,"unable to find NIO '%s'.\n",nio_name); - return(-1); - } - - /* create a new binding */ - if (!(nb = malloc(sizeof(*nb)))) { - vm_error(router->vm,"unable to create NIO binding " - "for interface %u/%u.\n",nm_bay,port_id); - netio_release(nio_name); - return(-1); - } - - memset(nb,0,sizeof(*nb)); - nb->nio = nio; - nb->port_id = port_id; - nb->next = bay->nio_list; - if (nb->next) nb->next->prev = nb; - bay->nio_list = nb; - return(0); -} - -/* Remove a NIO binding */ -int c3600_nm_remove_nio_binding(c3600_t *router,u_int nm_bay,u_int port_id) -{ - struct c3600_nio_binding *nb; - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - if (!(nb = c3600_nm_find_nio_binding(router,nm_bay,port_id))) - return(-1); /* no nio binding for this slot/port */ - - /* tell the NM driver to stop using this NIO */ - if (bay->nm_driver) - bay->nm_driver->nm_unset_nio(router,nm_bay,port_id); - - /* remove this entry from the double linked list */ - if (nb->next) - nb->next->prev = nb->prev; - - if (nb->prev) { - nb->prev->next = nb->next; - } else { - bay->nio_list = nb->next; - } - - /* unreference NIO object */ - netio_release(nb->nio->name); - free(nb); - return(0); -} - -/* Remove all NIO bindings for the specified NM */ -int c3600_nm_remove_all_nio_bindings(c3600_t *router,u_int nm_bay) -{ - struct c3600_nio_binding *nb,*next; - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - for(nb=bay->nio_list;nb;nb=next) { - next = nb->next; - - /* tell the NM driver to stop using this NIO */ - if (bay->nm_driver) - bay->nm_driver->nm_unset_nio(router,nm_bay,nb->port_id); - - /* unreference NIO object */ - netio_release(nb->nio->name); - free(nb); - } - - bay->nio_list = NULL; - return(0); -} - -/* Enable a Network IO descriptor for a Network Module */ -int c3600_nm_enable_nio(c3600_t *router,u_int nm_bay,u_int port_id) -{ - struct c3600_nio_binding *nb; - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* check that we have an NIO binding for this interface */ - if (!(nb = c3600_nm_find_nio_binding(router,nm_bay,port_id))) - return(-1); - - /* check that the driver is defined and successfully initialized */ - if (!bay->nm_driver || !bay->drv_info) - return(-1); - - return(bay->nm_driver->nm_set_nio(router,nm_bay,port_id,nb->nio)); -} - -/* Disable Network IO descriptor of a Network Module */ -int c3600_nm_disable_nio(c3600_t *router,u_int nm_bay,u_int port_id) -{ - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* check that the driver is defined and successfully initialized */ - if (!bay->nm_driver || !bay->drv_info) - return(-1); - - return(bay->nm_driver->nm_unset_nio(router,nm_bay,port_id)); + fprintf(fd,"c3600 set_chassis %s %s\n\n", + vm->name,router->chassis_driver->chassis_type); } -/* Enable all NIO of the specified NM */ -int c3600_nm_enable_all_nio(c3600_t *router,u_int nm_bay) +/* Set EEPROM for the specified slot */ +int c3600_set_slot_eeprom(c3600_t *router,u_int slot, + struct cisco_eeprom *eeprom) { - struct c3600_nio_binding *nb; - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* check that the driver is defined and successfully initialized */ - if (!bay->nm_driver || !bay->drv_info) + if (slot >= C3600_MAX_NM_BAYS) return(-1); - for(nb=bay->nio_list;nb;nb=nb->next) - bay->nm_driver->nm_set_nio(router,nm_bay,nb->port_id,nb->nio); - + router->c3660_nm_eeprom_group[slot].eeprom[0] = eeprom; return(0); } -/* Disable all NIO of the specified NM */ -int c3600_nm_disable_all_nio(c3600_t *router,u_int nm_bay) +/* Get slot/port corresponding to specified network IRQ */ +static inline void +c3600_net_irq_get_slot_port(u_int irq,u_int *slot,u_int *port) { - struct c3600_nio_binding *nb; - struct c3600_nm_bay *bay; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* check that the driver is defined and successfully initialized */ - if (!bay->nm_driver || !bay->drv_info) - return(-1); - - for(nb=bay->nio_list;nb;nb=nb->next) - bay->nm_driver->nm_unset_nio(router,nm_bay,nb->port_id); - - return(0); + irq -= C3600_NETIO_IRQ_BASE; + *port = irq & C3600_NETIO_IRQ_PORT_MASK; + *slot = irq >> C3600_NETIO_IRQ_PORT_BITS; } -/* Initialize a Network Module */ -int c3600_nm_init(c3600_t *router,u_int nm_bay) -{ - struct c3600_nm_bay *bay; - size_t len; - - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); - - /* Check that a device type is defined for this bay */ - if (!bay->dev_type || !bay->nm_driver) { - vm_error(router->vm,"trying to init empty slot %u.\n",nm_bay); - return(-1); - } - - /* Allocate device name */ - len = strlen(bay->dev_type) + 10; - if (!(bay->dev_name = malloc(len))) { - vm_error(router->vm,"unable to allocate device name.\n"); - return(-1); - } - - snprintf(bay->dev_name,len,"%s(%u)",bay->dev_type,nm_bay); - - /* Initialize NM driver */ - if (bay->nm_driver->nm_init(router,bay->dev_name,nm_bay) == 1) { - vm_error(router->vm,"unable to initialize NM %u.\n",nm_bay); - return(-1); - } - - /* Enable all NIO */ - c3600_nm_enable_all_nio(router,nm_bay); - return(0); -} - -/* Shutdown a Network Module */ -int c3600_nm_shutdown(c3600_t *router,u_int nm_bay) +/* Get network IRQ for specified slot/port */ +u_int c3600_net_irq_for_slot_port(u_int slot,u_int port) { - struct c3600_nm_bay *bay; + u_int irq; - if (!(bay = c3600_nm_get_info(router,nm_bay))) - return(-1); + irq = (slot << C3600_NETIO_IRQ_PORT_BITS) + port; + irq += C3600_NETIO_IRQ_BASE; - /* Check that a device type is defined for this bay */ - if (!bay->dev_type || !bay->nm_driver) { - vm_error(router->vm,"trying to shut down empty slot %u.\n",nm_bay); - return(-1); - } - - /* Disable all NIO */ - c3600_nm_disable_all_nio(router,nm_bay); - - /* Shutdown the NM driver */ - if (bay->drv_info && (bay->nm_driver->nm_shutdown(router,nm_bay) == -1)) { - vm_error(router->vm,"unable to shutdown NM %u.\n",nm_bay); - return(-1); - } - - free(bay->dev_name); - bay->dev_name = NULL; - bay->drv_info = NULL; - return(0); -} - -/* Shutdown all NM of a router */ -int c3600_nm_shutdown_all(c3600_t *router) -{ - int i; - - for(i=0;inm_bay[i].dev_type) - continue; - - c3600_nm_shutdown(router,i); - } - - return(0); -} - -/* Maximum number of tokens in a NM description */ -#define NM_DESC_MAX_TOKENS 8 - -/* Create a Network Module (command line) */ -int c3600_cmd_nm_create(c3600_t *router,char *str) -{ - char *tokens[NM_DESC_MAX_TOKENS]; - int i,count,res; - u_int nm_bay; - - /* A port adapter description is like "1:NM-1FE" */ - if ((count = m_strsplit(str,':',tokens,NM_DESC_MAX_TOKENS)) != 2) { - vm_error(router->vm,"unable to parse NM description '%s'.\n",str); - return(-1); - } - - /* Parse the NM bay id */ - nm_bay = atoi(tokens[0]); - - /* Add this new NM to the current NM list */ - res = c3600_nm_add_binding(router,tokens[1],nm_bay); - - /* The complete array was cleaned by strsplit */ - for(i=0;ivm,"unable to parse NIO description '%s'.\n",str); - return(-1); - } - - /* Parse the NM bay */ - nm_bay = atoi(tokens[0]); - - /* Parse the NM port id */ - port_id = atoi(tokens[1]); - - /* Autogenerate a NIO name */ - snprintf(nio_name,sizeof(nio_name),"c3600-i%u/%u/%u", - router->vm->instance_id,nm_bay,port_id); - - /* Create the Network IO descriptor */ - nio = NULL; - nio_type = netio_get_type(tokens[2]); - - switch(nio_type) { - case NETIO_TYPE_UNIX: - if (count != 5) { - vm_error(router->vm, - "invalid number of arguments for UNIX NIO '%s'\n",str); - goto done; - } - - nio = netio_desc_create_unix(nio_name,tokens[3],tokens[4]); - break; - - case NETIO_TYPE_VDE: - if (count != 5) { - vm_error(router->vm, - "invalid number of arguments for VDE NIO '%s'\n",str); - goto done; - } - - nio = netio_desc_create_vde(nio_name,tokens[3],tokens[4]); - break; - - case NETIO_TYPE_TAP: - if (count != 4) { - vm_error(router->vm, - "invalid number of arguments for TAP NIO '%s'\n",str); - goto done; - } - - nio = netio_desc_create_tap(nio_name,tokens[3]); - break; - - case NETIO_TYPE_UDP: - if (count != 6) { - vm_error(router->vm, - "invalid number of arguments for UDP NIO '%s'\n",str); - goto done; - } - - nio = netio_desc_create_udp(nio_name,atoi(tokens[3]), - tokens[4],atoi(tokens[5])); - break; - - case NETIO_TYPE_TCP_CLI: - if (count != 5) { - vm_error(router->vm, - "invalid number of arguments for TCP CLI NIO '%s'\n",str); - goto done; - } - - nio = netio_desc_create_tcp_cli(nio_name,tokens[3],tokens[4]); - break; - - case NETIO_TYPE_TCP_SER: - if (count != 4) { - vm_error(router->vm, - "invalid number of arguments for TCP SER NIO '%s'\n",str); - goto done; - } - - nio = netio_desc_create_tcp_ser(nio_name,tokens[3]); - break; - - case NETIO_TYPE_NULL: - nio = netio_desc_create_null(nio_name); - break; - -#ifdef LINUX_ETH - case NETIO_TYPE_LINUX_ETH: - if (count != 4) { - vm_error(router->vm, - "invalid number of arguments for Linux Eth NIO '%s'\n", - str); - goto done; - } - - nio = netio_desc_create_lnxeth(nio_name,tokens[3]); - break; -#endif - -#ifdef GEN_ETH - case NETIO_TYPE_GEN_ETH: - if (count != 4) { - vm_error(router->vm, - "invalid number of arguments for Generic Eth NIO '%s'\n", - str); - goto done; - } - - nio = netio_desc_create_geneth(nio_name,tokens[3]); - break; -#endif - - default: - vm_error(router->vm,"unknown NETIO type '%s'\n",tokens[2]); - goto done; - } - - if (!nio) { - vm_error(router->vm,"unable to create NETIO " - "descriptor for NM slot %u\n",nm_bay); - goto done; - } - - if (c3600_nm_add_nio_binding(router,nm_bay,port_id,nio_name) == -1) { - vm_error(router->vm,"unable to add NETIO binding for slot %u\n",nm_bay); - netio_release(nio_name); - netio_delete(nio_name); - goto done; - } - - netio_release(nio_name); - res = 0; - - done: - /* The complete array was cleaned by strsplit */ - for(i=0;idev_type, - !nm_drivers[i]->supported ? "(NOT WORKING)" : ""); - } - - printf("\n"); + return(irq); } /* Get a chassis driver */ @@ -953,30 +321,29 @@ } /* Set the base MAC address of the chassis */ -static int c3600_burn_mac_addr(m_uint16_t *data,size_t data_len, - n_eth_addr_t *addr) +static int c3600_burn_mac_addr(c3600_t *router,n_eth_addr_t *addr) { m_uint8_t eeprom_ver; size_t offset; /* Read EEPROM format version */ - cisco_eeprom_get_byte(data,data_len,0,&eeprom_ver); + cisco_eeprom_get_byte(&router->mb_eeprom,0,&eeprom_ver); switch(eeprom_ver) { case 0: - cisco_eeprom_set_region(data,data_len,2,addr->eth_addr_byte,6); + cisco_eeprom_set_region(&router->mb_eeprom,2,addr->eth_addr_byte,6); break; case 4: - if (!cisco_eeprom_v4_find_field(data,data_len,0xC3,&offset)) { - cisco_eeprom_set_region(data,data_len,offset, + if (!cisco_eeprom_v4_find_field(&router->mb_eeprom,0xC3,&offset)) { + cisco_eeprom_set_region(&router->mb_eeprom,offset, addr->eth_addr_byte,6); } break; default: - fprintf(stderr,"c3600_burn_mac_addr: unable to handle " - "EEPROM version %u\n",eeprom_ver); + vm_error(router->vm,"c3600_burn_mac_addr: unable to handle " + "EEPROM version %u\n",eeprom_ver); return(-1); } @@ -992,8 +359,7 @@ } /* Set the chassis base MAC address */ - c3600_burn_mac_addr(router->mb_eeprom_data,sizeof(router->mb_eeprom_data), - &router->mac_addr); + c3600_burn_mac_addr(router,&router->mac_addr); return(0); } @@ -1015,14 +381,20 @@ router->chassis_driver = driver; /* Copy the mainboard EEPROM */ - memcpy(router->mb_eeprom_data,driver->mb_eeprom,driver->mb_eeprom_len << 1); + if (cisco_eeprom_copy(&router->mb_eeprom,driver->eeprom) == -1) { + vm_error(router->vm,"unable to set chassis EEPROM '%s'.\n",chassis_type); + return(-1); + } /* Set the chassis base MAC address */ - c3600_burn_mac_addr(router->mb_eeprom_data,sizeof(router->mb_eeprom_data), - &router->mac_addr); + c3600_burn_mac_addr(router,&router->mac_addr); + + /* The motherboard has 2 integrated FastEthernet ports on a 3660 */ + if (driver->chassis_id == 3660) { + vm_slot_remove_binding(router->vm,0,0); + vm_slot_add_binding(router->vm,"Leopard-2FE",0,0); + } - router->mb_eeprom.data = router->mb_eeprom_data; - router->mb_eeprom.data_len = driver->mb_eeprom_len; return(0); } @@ -1036,7 +408,7 @@ } /* Show the list of available chassis drivers */ -void c3600_chassis_show_drivers(void) +static void c3600_chassis_show_drivers(void) { int i; @@ -1087,7 +459,7 @@ int i; /* Set the processor type: R4700 */ - mips64_set_prid(vm->boot_cpu,MIPS_PRID_R4700); + mips64_set_prid(CPU_MIPS64(vm->boot_cpu),MIPS_PRID_R4700); /* Initialize the Galileo GT-64010 PCI controller */ if (c3600_init_gt64010(router) == -1) @@ -1095,7 +467,7 @@ /* Initialize PCI map (no PCI bridge for this chassis) */ for(i=0;inm_bay[i].pci_map = vm->pci_bus[0]; + vm->slots_pci_bus[i] = vm->pci_bus[0]; vm->elf_machine_id = C3620_ELF_MACHINE_ID; return(0); @@ -1109,7 +481,7 @@ int i; /* Set the processor type: R4700 */ - mips64_set_prid(vm->boot_cpu,MIPS_PRID_R4700); + mips64_set_prid(CPU_MIPS64(vm->boot_cpu),MIPS_PRID_R4700); /* Initialize the Galileo GT-64010 PCI controller */ if (c3600_init_gt64010(router) == -1) @@ -1124,11 +496,11 @@ bay = c3600_nm_get_bay_info(3640,i); /* Map the NM PCI bus */ - router->nm_bay[i].pci_map = vm->pci_bus_pool[i & 1]; + vm->slots_pci_bus[i] = vm->pci_bus_pool[i & 1]; if (bay && (bay->pci_bridge_device != -1)) dev_dec21052_init(vm->pci_bus[0],bay->pci_bridge_device, - router->nm_bay[i].pci_map); + vm->slots_pci_bus[i]); } vm->elf_machine_id = C3640_ELF_MACHINE_ID; @@ -1144,7 +516,7 @@ int i; /* Set the processor type: R5271 */ - mips64_set_prid(vm->boot_cpu,MIPS_PRID_R527x); + mips64_set_prid(CPU_MIPS64(vm->boot_cpu),MIPS_PRID_R527x); /* Initialize the Galileo GT-64120 PCI controller */ if (c3600_init_gt64120(router) == -1) @@ -1157,25 +529,22 @@ } /* Slot 0 is mapped to the first bus of GT64120 */ - router->nm_bay[0].pci_map = vm->pci_bus[0]; + vm->slots_pci_bus[0] = vm->pci_bus[0]; /* Initialize PCI map and PCI bridges */ for(i=1;inm_bay[i].pci_map = vm->pci_bus_pool[i]; + vm->slots_pci_bus[i] = vm->pci_bus_pool[i]; /* Slots 1-6 are mapped to the second bus of GT64120 */ if (bay && (bay->pci_bridge_device != -1)) dev_dec21152_init(vm->pci_bus[1],bay->pci_bridge_device, - router->nm_bay[i].pci_map); + vm->slots_pci_bus[i]); } - /* The motherboard has 2 integrated FastEthernet ports */ - c3600_nm_add_binding(router,"Leopard-2FE",0); - - vm->elf_machine_id = C3640_ELF_MACHINE_ID; + vm->elf_machine_id = C3660_ELF_MACHINE_ID; return(0); } @@ -1201,17 +570,22 @@ } /* Initialize default parameters for a C3600 */ -void c3600_init_defaults(c3600_t *router) +static void c3600_init_defaults(c3600_t *router) { vm_instance_t *vm = router->vm; n_eth_addr_t *m; m_uint16_t pid; + /* Set platform slots characteristics */ + vm->nr_slots = C3600_MAX_NM_BAYS; + vm->slots_type = CISCO_CARD_TYPE_NM; + vm->slots_drivers = nm_drivers; + pid = (m_uint16_t)getpid(); /* Generate a chassis MAC address based on the instance ID */ m = &router->mac_addr; - m->eth_addr_byte[0] = 0xCC; + m->eth_addr_byte[0] = vm_get_mac_addr_msb(vm); m->eth_addr_byte[1] = vm->instance_id & 0xFF; m->eth_addr_byte[2] = pid >> 8; m->eth_addr_byte[3] = pid & 0xFF; @@ -1225,22 +599,22 @@ vm->ram_size = C3600_DEFAULT_RAM_SIZE; vm->rom_size = C3600_DEFAULT_ROM_SIZE; vm->nvram_size = C3600_DEFAULT_NVRAM_SIZE; - vm->conf_reg = C3600_DEFAULT_CONF_REG; + vm->conf_reg_setup = C3600_DEFAULT_CONF_REG; vm->clock_divisor = C3600_DEFAULT_CLOCK_DIV; vm->nvram_rom_space = C3600_NVRAM_ROM_RES_SIZE; - router->nm_iomem_size = C3600_DEFAULT_IOMEM_SIZE; + vm->nm_iomem_size = C3600_DEFAULT_IOMEM_SIZE; vm->pcmcia_disk_size[0] = C3600_DEFAULT_DISK0_SIZE; vm->pcmcia_disk_size[1] = C3600_DEFAULT_DISK1_SIZE; } /* Initialize the C3600 Platform */ -int c3600_init_platform(c3600_t *router) +static int c3600_init_platform(c3600_t *router) { vm_instance_t *vm = router->vm; - struct c3600_nm_bay *nm_bay; cpu_mips_t *cpu; - int i; + cpu_gen_t *gen; + vm_obj_t *obj; /* Copy config register setup into "active" config register */ vm->conf_reg = vm->conf_reg_setup; @@ -1252,17 +626,24 @@ vm->cpu_group = cpu_group_create("System CPU"); /* Initialize the virtual MIPS processor */ - if (!(cpu = cpu_create(vm,0))) { + if (!(gen = cpu_create(vm,CPU_TYPE_MIPS64,0))) { vm_error(vm,"unable to create CPU!\n"); return(-1); } + cpu = CPU_MIPS64(gen); + /* Add this CPU to the system CPU group */ - cpu_group_add(vm->cpu_group,cpu); - vm->boot_cpu = cpu; + cpu_group_add(vm->cpu_group,gen); + vm->boot_cpu = gen; + + /* Initialize the IRQ routing vectors */ + vm->set_irq = mips64_vm_set_irq; + vm->clear_irq = mips64_vm_clear_irq; /* Mark the Network IO interrupt as high priority */ cpu->irq_idle_preempt[C3600_NETIO_IRQ] = TRUE; + cpu->irq_idle_preempt[C3600_GT64K_IRQ] = TRUE; cpu->irq_idle_preempt[C3600_DUART_IRQ] = TRUE; /* Copy some parameters from VM to CPU (idle PC, ...) */ @@ -1280,8 +661,9 @@ /* Remote emulator control */ dev_remote_control_init(vm,0x16000000,0x1000); - /* Bootflash */ - dev_bootflash_init(vm,"bootflash",C3600_BOOTFLASH_ADDR,(8 * 1048576)); + /* Bootflash (8 Mb) */ + dev_bootflash_init(vm,"bootflash","c3600-bootflash-8mb", + C3600_BOOTFLASH_ADDR); /* NVRAM and calendar */ dev_nvram_init(vm,"nvram", @@ -1294,6 +676,11 @@ if (dev_c3600_iofpga_init(router,C3600_IOFPGA_ADDR,0x40000) == -1) return(-1); + if (!(obj = vm_object_find(router->vm,"io_fpga"))) + return(-1); + + router->iofpga_data = obj->data; + /* PCI IO space */ if (!(vm->pci_io_space = pci_io_data_init(vm,C3600_PCI_IO_ADDR))) return(-1); @@ -1303,41 +690,29 @@ return(-1); /* Initialize RAM */ - dev_ram_init(vm,"ram",vm->ram_mmap,0x00000000ULL,vm->ram_size*1048576); + vm_ram_init(vm,0x00000000ULL); /* Initialize ROM */ if (!vm->rom_filename) { /* use embedded ROM */ - dev_rom_init(vm,"rom",C3600_ROM_ADDR,vm->rom_size*1048576); + dev_rom_init(vm,"rom",C3600_ROM_ADDR,vm->rom_size*1048576, + mips64_microcode,mips64_microcode_len); } else { /* use alternate ROM */ - dev_ram_init(vm,"rom",TRUE,C3600_ROM_ADDR,vm->rom_size*1048576); + dev_ram_init(vm,"rom",TRUE,TRUE,NULL,FALSE, + C3600_ROM_ADDR,vm->rom_size*1048576); } /* Initialize the NS16552 DUART */ - dev_ns16552_init(vm,C3600_DUART_ADDR,0x1000,C3600_DUART_IRQ, + dev_ns16552_init(vm,C3600_DUART_ADDR,0x1000,3,C3600_DUART_IRQ, vm->vtty_con,vm->vtty_aux); /* Cirrus Logic PD6729 (PCI-to-PCMCIA host adapter) */ dev_clpd6729_init(vm,vm->pci_bus[0],20,vm->pci_io_space,0x4402,0x4403); /* Initialize Network Modules */ - for(i=0;inm_bay[i]; - - if (!nm_bay->dev_type) - continue; - - if (c3600_nm_init(router,i) == -1) { - vm_error(vm,"unable to create Network Module \"%s\"\n", - nm_bay->dev_type); - return(-1); - } - } - - /* Enable NVRAM operations to load/store configs */ - vm->nvram_extract_config = c3600_nvram_extract_config; - vm->nvram_push_config = c3600_nvram_push_config; + if (vm_slot_init_all(vm) == -1) + return(-1); /* Show device list */ c3600_show_hardware(router); @@ -1345,9 +720,10 @@ } /* Boot the IOS image */ -int c3600_boot_ios(c3600_t *router) +static int c3600_boot_ios(c3600_t *router) { vm_instance_t *vm = router->vm; + cpu_mips_t *cpu; if (!vm->boot_cpu) return(-1); @@ -1362,10 +738,12 @@ } /* Reset the boot CPU */ - mips64_reset(vm->boot_cpu); + cpu = CPU_MIPS64(vm->boot_cpu); + mips64_reset(cpu); /* Load IOS image */ - if (mips64_load_elf_image(vm->boot_cpu,vm->ios_image, + if (mips64_load_elf_image(cpu,vm->ios_image, + (vm->ghost_status == VM_GHOST_RAM_USE), &vm->ios_entry_point) < 0) { vm_error(vm,"failed to load Cisco IOS image '%s'.\n",vm->ios_image); @@ -1375,22 +753,67 @@ /* Launch the simulation */ printf("\nC3600 '%s': starting simulation (CPU0 PC=0x%llx), " "JIT %sabled.\n", - vm->name,vm->boot_cpu->pc,vm->jit_use ? "en":"dis"); + vm->name,cpu->pc,vm->jit_use ? "en":"dis"); vm_log(vm,"C3600_BOOT", "starting instance (CPU0 PC=0x%llx,idle_pc=0x%llx,JIT %s)\n", - vm->boot_cpu->pc,vm->boot_cpu->idle_pc,vm->jit_use ? "on":"off"); - + cpu->pc,cpu->idle_pc,vm->jit_use ? "on":"off"); + /* Start main CPU */ - vm->status = VM_STATUS_RUNNING; - cpu_start(vm->boot_cpu); + if (vm->ghost_status != VM_GHOST_RAM_GENERATE) { + vm->status = VM_STATUS_RUNNING; + cpu_start(vm->boot_cpu); + } else { + vm->status = VM_STATUS_SHUTDOWN; + } return(0); } +/* Set an IRQ */ +static void c3600_set_irq(vm_instance_t *vm,u_int irq) +{ + c3600_t *router = VM_C3600(vm); + cpu_mips_t *cpu0 = CPU_MIPS64(vm->boot_cpu); + u_int slot,port; + + switch(irq) { + case 0 ... 7: + mips64_set_irq(cpu0,irq); + + if (cpu0->irq_idle_preempt[irq]) + cpu_idle_break_wait(cpu0->gen); + break; + + case C3600_NETIO_IRQ_BASE ... C3600_NETIO_IRQ_END: + c3600_net_irq_get_slot_port(irq,&slot,&port); + dev_c3600_iofpga_net_set_irq(router->iofpga_data,slot,port); + break; + } +} + +/* Clear an IRQ */ +static void c3600_clear_irq(vm_instance_t *vm,u_int irq) +{ + c3600_t *router = VM_C3600(vm); + cpu_mips_t *cpu0 = CPU_MIPS64(vm->boot_cpu); + u_int slot,port; + + switch(irq) { + case 0 ... 7: + mips64_clear_irq(cpu0,irq); + break; + + case C3600_NETIO_IRQ_BASE ... C3600_NETIO_IRQ_END: + c3600_net_irq_get_slot_port(irq,&slot,&port); + dev_c3600_iofpga_net_clear_irq(router->iofpga_data,slot,port); + break; + } +} + /* Initialize a Cisco 3600 instance */ -int c3600_init_instance(c3600_t *router) +static int c3600_init_instance(vm_instance_t *vm) { - vm_instance_t *vm = router->vm; + c3600_t *router = VM_C3600(vm); m_uint32_t rom_entry_point; cpu_mips_t *cpu0; @@ -1405,6 +828,10 @@ return(-1); } + /* IRQ routing */ + vm->set_irq = c3600_set_irq; + vm->clear_irq = c3600_clear_irq; + /* Load IOS configuration file */ if (vm->ios_config != NULL) { vm_nvram_push_config(vm,vm->ios_config); @@ -1412,11 +839,11 @@ } /* Load ROM (ELF image or embedded) */ - cpu0 = vm->boot_cpu; + cpu0 = CPU_MIPS64(vm->boot_cpu); rom_entry_point = (m_uint32_t)MIPS_ROM_PC; if ((vm->rom_filename != NULL) && - (mips64_load_elf_image(cpu0,vm->rom_filename,&rom_entry_point) < 0)) + (mips64_load_elf_image(cpu0,vm->rom_filename,0,&rom_entry_point) < 0)) { vm_error(vm,"unable to load alternate ROM '%s', " "fallback to embedded ROM.\n\n",vm->rom_filename); @@ -1433,10 +860,8 @@ } /* Stop a Cisco 3600 instance */ -int c3600_stop_instance(c3600_t *router) +static int c3600_stop_instance(vm_instance_t *vm) { - vm_instance_t *vm = router->vm; - printf("\nC3600 '%s': stopping simulation.\n",vm->name); vm_log(vm,"C3600_STOP","stopping simulation.\n"); @@ -1451,7 +876,73 @@ } /* Free resources that were used during execution to emulate hardware */ - c3600_nm_shutdown_all(router); + vm_slot_shutdown_all(vm); vm_hardware_shutdown(vm); return(0); } + +/* Get MAC address MSB */ +static u_int c3600_get_mac_addr_msb(void) +{ + return(0xCC); +} + +/* Parse specific options for the Cisco 3600 platform */ +static int c3600_cli_parse_options(vm_instance_t *vm,int option) +{ + c3600_t *router = VM_C3600(vm); + + switch(option) { + /* IO memory reserved for NMs (in percents!) */ + case OPT_IOMEM_SIZE: + vm->nm_iomem_size = 0x8000 | atoi(optarg); + break; + + /* Chassis type */ + case 't': + c3600_chassis_set_type(router,optarg); + break; + + /* Unknown option */ + default: + return(-1); + } + + return(0); +} + +/* Show specific CLI options */ +static void c3600_cli_show_options(vm_instance_t *vm) +{ + printf(" -t : Select Chassis type (default: \"%s\")\n" + " --iomem-size : IO memory (in percents, default: %u)\n" + " -p : Define a Network Module\n" + " -s : Bind a Network IO interface to a " + "Network Module\n", + C3600_DEFAULT_CHASSIS,vm->nm_iomem_size); +} + +/* Platform definition */ +static vm_platform_t c3600_platform = { + "c3600", "C3600", "3600", + c3600_create_instance, + c3600_delete_instance, + c3600_init_instance, + c3600_stop_instance, + c3600_nvram_extract_config, + c3600_nvram_push_config, + c3600_get_mac_addr_msb, + c3600_save_config, + c3600_cli_parse_options, + c3600_cli_show_options, + c3600_chassis_show_drivers, +}; + +/* Register the c3600 platform */ +int c3600_platform_register(void) +{ + if (vm_platform_register(&c3600_platform) == -1) + return(-1); + + return(hypervisor_c3600_init(&c3600_platform)); +}