--- upstream/dynamips-0.2.6-RC1/dev_c7200.c 2007/10/06 16:03:58 2 +++ upstream/dynamips-0.2.6-RC5/dev_c7200.c 2007/10/06 16:09:07 6 @@ -17,6 +17,7 @@ #include "memory.h" #include "device.h" #include "pci_io.h" +#include "dev_gt.h" #include "cisco_eeprom.h" #include "dev_c7200.h" #include "dev_vtty.h" @@ -90,7 +91,7 @@ /* * CPU EEPROM array. */ -static struct c7200_eeprom c7200_cpu_eeprom[] = { +static struct cisco_eeprom c7200_cpu_eeprom[] = { { "npe-100", eeprom_cpu_npe100_data, sizeof(eeprom_cpu_npe100_data)/2 }, { "npe-150", eeprom_cpu_npe150_data, sizeof(eeprom_cpu_npe150_data)/2 }, { "npe-175", eeprom_cpu_npe175_data, sizeof(eeprom_cpu_npe175_data)/2 }, @@ -125,7 +126,7 @@ /* * Midplane EEPROM array. */ -static struct c7200_eeprom c7200_midplane_eeprom[] = { +static struct cisco_eeprom c7200_midplane_eeprom[] = { { "std", eeprom_midplane_data, sizeof(eeprom_midplane_data)/2 }, { "vxr", eeprom_vxr_midplane_data, sizeof(eeprom_vxr_midplane_data)/2 }, { NULL, NULL, 0 }, @@ -150,7 +151,7 @@ /* * PEM EEPROM array. */ -static struct c7200_eeprom c7200_pem_eeprom[] = { +static struct cisco_eeprom c7200_pem_eeprom[] = { { "npe-175", eeprom_pem_npe175_data, sizeof(eeprom_pem_npe175_data)/2 }, { "npe-225", eeprom_pem_npe225_data, sizeof(eeprom_pem_npe225_data)/2 }, { NULL, NULL, 0 }, @@ -168,7 +169,8 @@ &dev_c7200_pa_8t_driver, &dev_c7200_pa_a1_driver, &dev_c7200_pa_pos_oc3_driver, - &dev_c7200_pa_4b_driver, + &dev_c7200_pa_4b_driver, + &dev_c7200_pa_mc8te1_driver, NULL, }; @@ -201,33 +203,39 @@ }; /* ======================================================================== */ -/* Empty EEPROM for PAs */ -/* ======================================================================== */ -static const m_uint16_t eeprom_pa_empty[64] = { - 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, -}; - -/* ======================================================================== */ /* Cisco 7200 router instances */ /* ======================================================================== */ /* Directly extract the configuration from the NVRAM device */ ssize_t c7200_nvram_extract_config(vm_instance_t *vm,char **buffer) { + u_char *base_ptr,*ios_ptr,*cfg_ptr,*end_ptr; + m_uint32_t start,end,nvlen,clen; + 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; + m_uint64_t nvram_addr; + off_t nvram_size; + int fd; - if (!(nvram_dev = dev_get_by_name(vm,"nvram"))) + if ((nvram_dev = dev_get_by_name(vm,"nvram"))) + dev_sync(nvram_dev); + + fd = vm_mmap_open_file(vm,"nvram",&base_ptr,&nvram_size); + + if (fd == -1) + return(-1); + + nvram_addr = VM_C7200(vm)->npe_driver->nvram_addr; + ios_ptr = base_ptr + vm->nvram_rom_space; + end_ptr = base_ptr + nvram_size; + + if ((ios_ptr + 0x30) >= end_ptr) { + vm_error(vm,"NVRAM file too small\n"); return(-1); + } - 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); + 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", @@ -235,9 +243,9 @@ 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); + start = ntohl(*PTR_ADJUST(m_uint32_t *,ios_ptr,0x10)) + 1; + end = ntohl(*PTR_ADJUST(m_uint32_t *,ios_ptr,0x14)); + nvlen = ntohl(*PTR_ADJUST(m_uint32_t *,ios_ptr,0x18)); clen = end - start; if ((clen + 1) != nvlen) { @@ -245,106 +253,102 @@ return(-1); } - if ((start <= nvram_dev->phys_addr) || (end <= nvram_dev->phys_addr) || - (end <= start)) - { - vm_error(vm,"invalid configuration markers (start=0x%x,end=0x%x)\n", - start,end); + if (!(*buffer = malloc(clen+1))) { + vm_error(vm,"unable to allocate config buffer (%u bytes)\n",clen); return(-1); } - if (!(*buffer = malloc(clen+1))) { - vm_error(vm,"unable to allocate config buffer (%u bytes)\n",clen); + cfg_ptr = base_ptr + (start - nvram_addr); + + if ((start < nvram_addr) || ((cfg_ptr + clen) > end_ptr)) { + vm_error(vm,"NVRAM file too small\n"); return(-1); } - physmem_copy_from_vm(vm,*buffer,start,clen); + memcpy(*buffer,cfg_ptr,clen); (*buffer)[clen] = 0; return(clen); } /* Directly push the IOS configuration to the NVRAM device */ int c7200_nvram_push_config(vm_instance_t *vm,char *buffer,size_t len) -{ - struct vdevice *nvram_dev; - m_uint64_t addr,cfg_addr; - m_uint32_t cklen; +{ + u_char *base_ptr,*ios_ptr,*cfg_ptr; + m_uint32_t cfg_addr,cfg_offset; + m_uint32_t nvram_addr,cklen; m_uint16_t cksum; + int fd; + + fd = vm_mmap_create_file(vm,"nvram",vm->nvram_size*1024,&base_ptr); - if (!(nvram_dev = dev_get_by_name(vm,"nvram"))) + if (fd == -1) return(-1); - addr = nvram_dev->phys_addr + vm->nvram_rom_space; - cfg_addr = addr + 0x2c; + cfg_offset = 0x2c; + ios_ptr = base_ptr + vm->nvram_rom_space; + cfg_ptr = ios_ptr + cfg_offset; + + nvram_addr = VM_C7200(vm)->npe_driver->nvram_addr; + cfg_addr = nvram_addr + vm->nvram_rom_space + 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); /* zero */ - physmem_copy_u16_to_vm(vm,addr+0x0e,0x0000); /* 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(0x0000); /* Store file contents to NVRAM */ - physmem_copy_to_vm(vm,buffer,cfg_addr,len); + memcpy(cfg_ptr,buffer,len); /* Write config addresses + size */ - physmem_copy_u32_to_vm(vm,addr+0x10,cfg_addr); - physmem_copy_u32_to_vm(vm,addr+0x14,cfg_addr + len); - physmem_copy_u32_to_vm(vm,addr+0x18,len); + *PTR_ADJUST(m_uint32_t *,ios_ptr,0x10) = htonl(cfg_addr); + *PTR_ADJUST(m_uint32_t *,ios_ptr,0x14) = htonl(cfg_addr + 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); - return(0); -} - -/* Find an EEPROM in the specified array */ -struct c7200_eeprom *c7200_get_eeprom(struct c7200_eeprom *eeproms,char *name) -{ - int i; + 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); - for(i=0;eeproms[i].name;i++) - if (!strcmp(eeproms[i].name,name)) - return(&eeproms[i]); - - return NULL; + vm_mmap_close_file(fd,base_ptr,vm->nvram_size*1024); + return(0); } /* Get an EEPROM for a given NPE model */ -struct c7200_eeprom *c7200_get_cpu_eeprom(char *npe_name) +static const struct cisco_eeprom *c7200_get_cpu_eeprom(char *npe_name) { - return(c7200_get_eeprom(c7200_cpu_eeprom,npe_name)); + return(cisco_eeprom_find(c7200_cpu_eeprom,npe_name)); } /* Get an EEPROM for a given midplane model */ -struct c7200_eeprom *c7200_get_midplane_eeprom(char *midplane_name) +static const struct cisco_eeprom * +c7200_get_midplane_eeprom(char *midplane_name) { - return(c7200_get_eeprom(c7200_midplane_eeprom,midplane_name)); + return(cisco_eeprom_find(c7200_midplane_eeprom,midplane_name)); } /* Get a PEM EEPROM for a given NPE model */ -struct c7200_eeprom *c7200_get_pem_eeprom(char *npe_name) +static const struct cisco_eeprom *c7200_get_pem_eeprom(char *npe_name) { - return(c7200_get_eeprom(c7200_pem_eeprom,npe_name)); + return(cisco_eeprom_find(c7200_pem_eeprom,npe_name)); } /* Set the base MAC address of the chassis */ -static int c7200_burn_mac_addr(m_uint16_t *data,size_t data_len, - n_eth_addr_t *addr) +static int c7200_burn_mac_addr(c7200_t *router,n_eth_addr_t *addr) { m_uint8_t eeprom_ver; /* Read EEPROM format version */ - cisco_eeprom_get_byte(data,data_len,0,&eeprom_ver); + cisco_eeprom_get_byte(&router->mp_eeprom,0,&eeprom_ver); if (eeprom_ver != 1) { - fprintf(stderr,"c7200_burn_mac_addr: unable to handle " + vm_error(router->vm,"c7200_burn_mac_addr: unable to handle " "EEPROM version %u\n",eeprom_ver); return(-1); } - cisco_eeprom_set_region(data,data_len,12,addr->eth_addr_byte,6); + cisco_eeprom_set_region(&router->mp_eeprom,12,addr->eth_addr_byte,6); return(0); } @@ -418,6 +422,11 @@ /* Free specific HW resources */ c7200_free_hw_ressources(router); + /* Free EEPROMs */ + cisco_eeprom_free(&router->cpu_eeprom); + cisco_eeprom_free(&router->mp_eeprom); + cisco_eeprom_free(&router->pem_eeprom); + /* Free all resources used by VM */ vm_free(vm); @@ -496,7 +505,7 @@ /* Set NPE eeprom definition */ static int c7200_npe_set_eeprom(c7200_t *router) { - struct c7200_eeprom *eeprom; + const struct cisco_eeprom *eeprom; if (!(eeprom = c7200_get_cpu_eeprom(router->npe_driver->npe_type))) { vm_error(router->vm,"unknown NPE \"%s\" (internal error)!\n", @@ -504,15 +513,18 @@ return(-1); } - router->cpu_eeprom.data = eeprom->data; - router->cpu_eeprom.data_len = eeprom->len; + if (cisco_eeprom_copy(&router->cpu_eeprom,eeprom) == -1) { + vm_error(router->vm,"unable to set NPE EEPROM.\n"); + return(-1); + } + return(0); } /* Set PEM eeprom definition */ static int c7200_pem_set_eeprom(c7200_t *router) { - struct c7200_eeprom *eeprom; + const struct cisco_eeprom *eeprom; if (!(eeprom = c7200_get_pem_eeprom(router->npe_driver->npe_type))) { vm_error(router->vm,"no PEM EEPROM found for NPE type \"%s\"!\n", @@ -520,22 +532,28 @@ return(-1); } - router->pem_eeprom.data = eeprom->data; - router->pem_eeprom.data_len = eeprom->len; + if (cisco_eeprom_copy(&router->pem_eeprom,eeprom) == -1) { + vm_error(router->vm,"unable to set PEM EEPROM.\n"); + return(-1); + } + return(0); } /* Set PA EEPROM definition */ int c7200_pa_set_eeprom(c7200_t *router,u_int pa_bay, - const struct c7200_eeprom *eeprom) + const struct cisco_eeprom *eeprom) { if (pa_bay >= C7200_MAX_PA_BAYS) { vm_error(router->vm,"c7200_pa_set_eeprom: invalid PA Bay %u.\n",pa_bay); return(-1); } - - router->pa_bay[pa_bay].eeprom.data = eeprom->data; - router->pa_bay[pa_bay].eeprom.data_len = eeprom->len; + + if (cisco_eeprom_copy(&router->pa_bay[pa_bay].eeprom,eeprom) == -1) { + vm_error(router->vm,"c7200_pa_set_eeprom: no memory.\n"); + return(-1); + } + return(0); } @@ -547,25 +565,17 @@ return(-1); } - router->pa_bay[pa_bay].eeprom.data = (m_uint16_t *)eeprom_pa_empty; - router->pa_bay[pa_bay].eeprom.data_len = sizeof(eeprom_pa_empty)/2; + cisco_eeprom_free(&router->pa_bay[pa_bay].eeprom); return(0); } /* Check if a bay has a port adapter */ int c7200_pa_check_eeprom(c7200_t *router,u_int pa_bay) { - struct nmc93c46_eeprom_def *def; - if (!pa_bay || (pa_bay >= C7200_MAX_PA_BAYS)) - return(0); - - def = &router->pa_bay[pa_bay].eeprom; - - if (def->data == eeprom_pa_empty) - return(0); + return(FALSE); - return(1); + return(cisco_eeprom_valid(&router->pa_bay[pa_bay].eeprom)); } /* Get bay info */ @@ -1208,7 +1218,7 @@ /* Set Midplane type */ int c7200_midplane_set_type(c7200_t *router,char *midplane_type) { - struct c7200_eeprom *eeprom; + const struct cisco_eeprom *eeprom; m_uint8_t version; if (router->vm->status == VM_STATUS_RUNNING) { @@ -1222,20 +1232,19 @@ return(-1); } - memcpy(router->mp_eeprom_data,eeprom->data,eeprom->len << 1); + /* Copy the midplane EEPROM */ + if (cisco_eeprom_copy(&router->mp_eeprom,eeprom) == -1) { + vm_error(router->vm,"unable to set midplane EEPROM.\n"); + return(-1); + } /* Set the chassis base MAC address */ - c7200_burn_mac_addr(router->mp_eeprom_data,sizeof(router->mp_eeprom_data), - &router->mac_addr); - - router->mp_eeprom.data = router->mp_eeprom_data; - router->mp_eeprom.data_len = eeprom->len; - router->midplane_type = eeprom->name; + c7200_burn_mac_addr(router,&router->mac_addr); /* Get the midplane version */ - cisco_eeprom_get_byte(router->mp_eeprom.data,router->mp_eeprom.data_len*2, - 2,&version); - router->midplane_version = version; + cisco_eeprom_get_byte(&router->mp_eeprom,2,&version); + router->midplane_version = version; + router->midplane_type = eeprom->name; return(0); } @@ -1248,8 +1257,7 @@ } /* Set the chassis base MAC address */ - c7200_burn_mac_addr(router->mp_eeprom_data,sizeof(router->mp_eeprom_data), - &router->mac_addr); + c7200_burn_mac_addr(router,&router->mac_addr); return(0); } @@ -1638,7 +1646,7 @@ /* 32 Mb of I/O memory */ vm->iomem_size = 32; - dev_ram_init(vm,"iomem",vm->ram_mmap,C7200_IOMEM_ADDR,32*1048576); + dev_ram_init(vm,"iomem",vm->ram_mmap,TRUE,NULL,C7200_IOMEM_ADDR,32*1048576); /* Initialize the two Galileo GT-64120 system controllers */ if (c7200_init_dual_gt64120(router) == -1) @@ -1695,7 +1703,7 @@ if (vm->ram_size > C7200_BASE_RAM_LIMIT) { vm->iomem_size = vm->ram_size - C7200_BASE_RAM_LIMIT; vm->ram_size = C7200_BASE_RAM_LIMIT; - dev_ram_init(vm,"ram1",vm->ram_mmap, + dev_ram_init(vm,"ram1",vm->ram_mmap,TRUE,NULL, C7200_IOMEM_ADDR,vm->iomem_size*1048576); } @@ -1823,7 +1831,7 @@ /* Generate a chassis MAC address based on the instance ID */ m = &router->mac_addr; - m->eth_addr_byte[0] = 0xCA; + 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; @@ -1845,6 +1853,10 @@ vm->pcmcia_disk_size[0] = C7200_DEFAULT_DISK0_SIZE; vm->pcmcia_disk_size[1] = C7200_DEFAULT_DISK1_SIZE; + + /* Enable NVRAM operations to load/store configs */ + vm->nvram_extract_config = c7200_nvram_extract_config; + vm->nvram_push_config = c7200_nvram_push_config; } /* Run the checklist */ @@ -1902,6 +1914,7 @@ /* Mark the Network IO interrupt as high priority */ cpu0->irq_idle_preempt[C7200_NETIO_IRQ] = TRUE; + cpu0->irq_idle_preempt[C7200_GT64K_IRQ] = TRUE; /* Copy some parameters from VM to CPU0 (idle PC, ...) */ cpu0->idle_pc = vm->idle_pc; @@ -1940,7 +1953,7 @@ 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) { @@ -1948,7 +1961,8 @@ dev_rom_init(vm,"rom",C7200_ROM_ADDR,vm->rom_size*1048576); } else { /* use alternate ROM */ - dev_ram_init(vm,"rom",TRUE,C7200_ROM_ADDR,vm->rom_size*1048576); + dev_ram_init(vm,"rom",TRUE,TRUE,NULL, + C7200_ROM_ADDR,vm->rom_size*1048576); } /* PCI IO space */ @@ -1980,10 +1994,6 @@ c7200_pa_init(router,0); } - /* Enable NVRAM operations to load/store configs */ - vm->nvram_extract_config = c7200_nvram_extract_config; - vm->nvram_push_config = c7200_nvram_push_config; - /* Verify the check list */ if (c7200_checklist(router) == -1) return(-1); @@ -2015,7 +2025,8 @@ /* Load IOS image */ if (mips64_load_elf_image(vm->boot_cpu,vm->ios_image, - &vm->ios_entry_point) < 0) + (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); return(-1); @@ -2031,8 +2042,12 @@ vm->boot_cpu->pc,vm->boot_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); } @@ -2060,7 +2075,7 @@ 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);