void sim_init()
{
/* Create memory and register files */
initialized = 1;
mem = init_mem(MEM_SIZE);
reg = init_reg();
/* create 5 pipe registers */
pc_state = new_pipe(sizeof(pc_ele), (void *) &bubble_pc);
if_id_state = new_pipe(sizeof(if_id_ele), (void *) &bubble_if_id);
id_ex_state = new_pipe(sizeof(id_ex_ele), (void *) &bubble_id_ex);
ex_mem_state = new_pipe(sizeof(ex_mem_ele), (void *) &bubble_ex_mem);
mem_wb_state = new_pipe(sizeof(mem_wb_ele), (void *) &bubble_mem_wb);
/* connect them to the pipeline stages */
pc_next = pc_state->next;
pc_curr = pc_state->current;
if_id_next = if_id_state->next;
if_id_curr = if_id_state->current;
id_ex_next = id_ex_state->next;
id_ex_curr = id_ex_state->current;
ex_mem_next = ex_mem_state->next;
ex_mem_curr = ex_mem_state->current;
mem_wb_next = mem_wb_state->next;
mem_wb_curr = mem_wb_state->current;
sim_reset();
clear_mem(mem);
}
static void run(const char *name, void (*scen)(void))
{
uint8_t page_buf[1 << sim_nand.log2_page_size];
struct dhara_journal journal;
printf("========================================"
"================================\n"
"%s\n"
"========================================"
"================================\n\n", name);
sim_reset();
dhara_journal_init(&journal, &sim_nand, page_buf);
/* All tests are tuned for this value */
assert(journal.log2_ppc == 2);
scen();
jt_enqueue_sequence(&journal, 0, 30);
jt_dequeue_sequence(&journal, 0, 30);
sim_dump();
printf("\n");
}
void sim_init()
{
/* Create memory and register files */
initialized = 1;
mem = init_mem(MEM_SIZE);
reg = init_reg();
sim_reset();
clear_mem(mem);
}
void cli_cmd_reset(size_t argc,const sASTNode **argv) {
UNUSED(argv);
if(argc != 0)
cmds_throwEx(NULL);
mprintf("Resetting...");
sim_reset();
cmds_reset();
mprintf("\n");
}
/* Implement command versions of the simulation functions */
int simResetCmd(ClientData clientData, Tcl_Interp *interp,
int argc, char *argv[])
{
sim_interp = interp;
if (argc != 1) {
interp->result = "No arguments allowed";
return TCL_ERROR;
}
sim_reset();
if (post_load_mem) {
free_mem(mem);
mem = copy_mem(post_load_mem);
}
interp->result = exc_name(EXC_NONE);
return TCL_OK;
}
int simLoadCodeCmd(ClientData clientData, Tcl_Interp *interp,
int argc, char *argv[])
{
FILE *object_file;
int code_count;
sim_interp = interp;
if (argc != 2) {
interp->result = "One argument required";
return TCL_ERROR;
}
object_file = fopen(argv[1], "r");
if (!object_file) {
sprintf(tcl_msg, "Couldn't open code file '%s'", argv[1]);
interp->result = tcl_msg;
return TCL_ERROR;
}
sim_reset();
code_count = load_mem(mem, object_file, 0);
post_load_mem = copy_mem(mem);
sprintf(tcl_msg, "%d", code_count);
interp->result = tcl_msg;
fclose(object_file);
return TCL_OK;
}
int main(int argc, char *argv[])
{
int i, n;
bool wasRunning = FALSE;
bool save_cfg = FALSE;
bool change_settings_ui(menu_e *menu, u1_t key, bool *skip_first, cfg_t *cfg);
bool show_ip = FALSE;
bool config_valid, config_key = FALSE;
bool config_ip = FALSE, config_nm = FALSE, config_gw = FALSE, config_am = FALSE;
u4_t key;
menu_e menu;
int addr_mode;
int ip[4], nm[4], gw[4], bc[4];
FILE *cfp, *efp;
char *config_file = ROOT_DIR "/.5370.config";
cfg_t *cfg = &cfg_buf;
dsp_7seg_init(FALSE); // panic routine can't use display until bus is setup
// silently ignores unrecognized arguments
for (i=1; i<argc; i++) {
if (strcmp(argv[i], "-bg") == 0) background_mode = TRUE;
if (strcmp(argv[i], "-ip") == 0) show_ip = TRUE;
if (strcmp(argv[i], "-no") == 0) menu_action = FALSE;
if (strcmp(argv[i], "?")==0 || strcmp(argv[i], "-?")==0 || strcmp(argv[i], "--?")==0 || strcmp(argv[i], "-h")==0 ||
strcmp(argv[i], "h")==0 || strcmp(argv[i], "-help")==0 || strcmp(argv[i], "--h")==0 || strcmp(argv[i], "--help")==0) {
printf( "-rcl|-recall [name] load key settings from named profile\n"
"-hpib-hard use the original HPIB hardware interface, assuming installed\n"
"-hpib-sim simulate the HPIB interface in software (debug mode)\n"
"-hpib-net simulate and re-direct transfers over an Ethernet connection\n"
"-ip show IP address of Ethernet interface and exit\n"
);
xit(0);
}
}
lprintf("HP%s v%d.%d\n", INST_STR, FIRMWARE_VER_MAJ, FIRMWARE_VER_MIN);
lprintf("compiled: %s %s\n", __DATE__, __TIME__);
sim_args(TRUE, argc, argv);
hpib_args(TRUE, argc, argv);
sim_init();
web_server_init();
if (!menu_action) printf("menu action disabled\n");
reset:
// To support the action of the 'reset' key most code files have a reset routine that zeros static variables.
// This is similar to the C runtime idea of zeroing the bss when a program is first run.
if (wasRunning) {
wasRunning = FALSE;
net_reset(NET_HPIB);
net_reset(NET_TELNET);
web_server_stop();
skip_first = save_cfg = config_key = config_ip = config_nm = config_gw = config_am = FALSE;
}
sim_reset();
if (!(bus_read(RREG_LDACSR) & DSR_VOK)) {
lprintf("waiting for 5370 power\n");
usleep(1000000);
while (!(bus_read(RREG_LDACSR) & DSR_VOK)) {
sched_yield();
usleep(250000);
}
lprintf("5370 power on\n");
usleep(1000000);
} else {
lprintf("5370 is powered on\n");
}
// display firmware version
dsp_7seg_init(TRUE);
dsp_7seg_str(DSP_LEFT, INST_STR, DSP_CLEAR);
dsp_7seg_chr(POS(10), 'v');
dsp_7seg_num(POS(11), POS_IS_LSD, FIRMWARE_VER_MAJ, DEFAULT_WIDTH, SPACE_FILL);
dsp_7seg_num(POS(12), POS_IS_MSD, FIRMWARE_VER_MIN, FIELD_WIDTH(0), ZERO_FILL);
dsp_7seg_dp(POS(12));
dsp_leds_clr_all();
delay(2000);
if ((cfp = fopen(config_file, "r")) == NULL) {
if (errno != ENOENT) sys_panic(config_file);
config_valid = FALSE;
} else {
while (fgets(lbuf, LBUF, cfp)) {
if ((sscanf(lbuf, "key 0x%x", &key) == 1) && (key == 0xcafe5370)) config_key = TRUE; else
if (sscanf(lbuf, "am %d", &addr_mode) == 1) config_am = TRUE; else
if (sscanf(lbuf, "ip %d.%d.%d.%d", &ip[0], &ip[1], &ip[2], &ip[3]) == 4) config_ip = TRUE; else
if (sscanf(lbuf, "nm %d.%d.%d.%d", &nm[0], &nm[1], &nm[2], &nm[3]) == 4) config_nm = TRUE; else
if (sscanf(lbuf, "gw %d.%d.%d.%d", &gw[0], &gw[1], &gw[2], &gw[3]) == 4) config_gw = TRUE; else
;
}
assert((addr_mode == 0) || (addr_mode == 1));
menu = cfg->menu = (addr_mode == 0)? M_DHCP : M_IP;
if (config_key && config_ip && config_nm && config_gw && config_am) {
printf("valid config file %s\n", config_file);
config_valid = TRUE;
if (menu == M_IP) {
printf("setting interface address\n");
sprintf(lbuf, "ifconfig eth0 %d.%d.%d.%d netmask %d.%d.%d.%d",
ip[0], ip[1], ip[2], ip[3], nm[0], nm[1], nm[2], nm[3]);
if (menu_action) system(lbuf);
sprintf(lbuf, "route add default %d.%d.%d.%d", gw[0], gw[1], gw[2], gw[3]);
if (menu_action) system(lbuf);
}
} else {
printf("invalid config file %s\n", config_file);
config_valid = FALSE;
}
fclose(cfp);
}
if (!config_valid) {
menu = cfg->menu = M_DHCP; // try DHCP first if not valid config
}
#define ENET_RETRY 20
if (menu == M_DHCP) { // see if interface configured by DHCP
gw[3]=gw[2]=gw[1]=gw[0]=0; // ifconfig doesn't tell us the gateway, only the broadcast which we don't care about
// sometimes the link is slow to come up, so retry a few times
for (i=0; i<ENET_RETRY; i++) {
if ((efp = popen("ifconfig eth0", "r")) == NULL) sys_panic("ifconfig eth0");
char *lp = lbuf;
n=0;
while (fgets(lp, LBUF, efp)) {
if ((n = sscanf(lp, "%*[ ]inet addr:%d.%d.%d.%d Bcast:%d.%d.%d.%d Mask:%d.%d.%d.%d",
&ip[0], &ip[1], &ip[2], &ip[3],
&bc[0], &bc[1], &bc[2], &bc[3],
&nm[0], &nm[1], &nm[2], &nm[3])) == 12)
break;
}
pclose(efp);
if (n == 12) break;
delay(1000);
}
} else {
i=0; // interface configured manually above
}
if (i != ENET_RETRY) {
for (i=0; i<4; i++) {
cfg->ip[i] = ip[i]; cfg->nm[i] = nm[i]; cfg->gw[i] = gw[i];
}
if (menu == M_DHCP) lprintf("via DHCP ");
lprintf("eth0: ip %d.%d.%d.%d mask %d.%d.%d.%d ",
ip[0], ip[1], ip[2], ip[3], nm[0], nm[1], nm[2], nm[3]);
if (menu != M_DHCP) lprintf("gw %d.%d.%d.%d", gw[0], gw[1], gw[2], gw[3]);
lprintf("\n");
dsp_7seg_str(DSP_LEFT, "ip", DSP_CLEAR);
display_ipaddr(cfg->ip);
} else {
lprintf("eth0: not configured from DHCP?");
dsp_7seg_str(DSP_LEFT, "no dhcp?", DSP_CLEAR);
}
if (!config_valid && (i == ENET_RETRY)) { // configuration not valid, DHCP failed, so set some defaults
menu = cfg->menu = M_IP;
bcopy(default_ipinfo, cfg->if_ipinfo, sizeof(default_ipinfo));
save_cfg = TRUE;
}
if (show_ip) xit(0);
delay(2000); // show ip on display for a moment before continuing
net_connect(NET_HPIB, SERVER, NULL, HPIB_TCP_PORT);
net_connect(NET_TELNET, SERVER, NULL, TELNET_TCP_PORT);
web_server_start();
// place a call here to setup your measurement extension code
meas_extend_example_init();
// reset key held down during a reboot -- drop into menu mode
preempt_reset_key(TRUE);
// while in the boot routine the reset key either starts the app or saves the changed config
app_state = S_MENU;
while (1) {
u1_t key;
sim_input(); // for remote debugging of menu mode
key = handler_dev_display_read(RREG_KEY_SCAN); // called instead of bus_read() so simulated keys will be returned
switch(app_state) {
case S_MENU:
if (key != KEY(RESET)) {
app_state = S_START;
break;
}
dsp_7seg_str(DSP_LEFT, "ready", DSP_CLEAR);
printf("ready\n");
dsp_led_set(RESET);
wait_key_release();
dsp_led_clr(RESET);
dsp_7seg_str(DSP_LEFT, "chg settings", DSP_CLEAR);
printf("menu mode\n");
skip_first = TRUE;
menu = M_HALT; // first menu item displayed
// light up the keys valid during menu mode
for (i=0; settings_keys[i].key; i++) {
dsp_led_set(settings_keys[i].key);
}
app_state = S_MENU_POLL;
break;
case S_MENU_POLL:
if (key == KEY(RESET)) {
dsp_led_set(RESET);
wait_key_release();
dsp_led_clr(RESET);
app_state = S_MENU_DONE;
break;
}
if (change_settings_ui(&menu, key, &skip_first, cfg)) save_cfg = TRUE;
break;
case S_MENU_DONE:
if (!skip_first && (menu == M_HALT)) {
// Debian takes a while to halt, but nicely clears the GPIOs so the
// display goes blank right when halted.
// Angstrom with Gnome disabled halts very fast, but doesn't
// clear the GPIOs like Debian. So we get the PRU to poll the LEDs
// until they go off, then blank the display.
dsp_7seg_str(DSP_LEFT, " halting...", DSP_CLEAR);
printf("halting...\n");
#ifdef DIST_DEBIAN
if (menu_action) system("halt");
exit(0);
#endif
#ifdef DIST_ANGSTROM
dsp_7seg_chr(POS(0), ' '); // preload address & data
send_pru_cmd(PRU_HALT);
if (menu_action) system("halt");
exit(0);
#endif
} else
if (menu == M_CANCEL || (skip_first && (menu == M_HALT))) {
app_state = S_START;
break;
} else {
if (menu != M_DHCP) menu = M_IP;
if (menu != cfg->menu) save_cfg = TRUE;
}
if (save_cfg) {
dsp_7seg_str(DSP_LEFT, "config changed", DSP_CLEAR);
delay(2000);
cfg->menu = menu;
if (menu == M_DHCP) {
dsp_7seg_str(DSP_LEFT, "using dhcp mode", DSP_CLEAR);
} else {
dsp_7seg_str(DSP_LEFT, "using ip mode", DSP_CLEAR);
}
delay(2000);
dsp_7seg_str(DSP_LEFT, "saving config", DSP_CLEAR);
if ((cfp = fopen(config_file, "w")) == NULL) sys_panic(config_file);
printf("writing config file %s\n", config_file);
fprintf(cfp, "key 0xcafe5370\n");
fprintf(cfp, "am %d\n", (cfg->menu == M_DHCP)? 0:1);
fprintf(cfp, "ip %d.%d.%d.%d\n", cfg->ip[0], cfg->ip[1], cfg->ip[2], cfg->ip[3]);
fprintf(cfp, "nm %d.%d.%d.%d\n", cfg->nm[0], cfg->nm[1], cfg->nm[2], cfg->nm[3]);
fprintf(cfp, "gw %d.%d.%d.%d\n", cfg->gw[0], cfg->gw[1], cfg->gw[2], cfg->gw[3]);
fclose(cfp);
delay(2000);
}
app_state = S_START;
break;
case S_START:
if (wasRunning) { // if previous sim was interrupted must reset before starting new one
goto reset;
}
preempt_reset_key(FALSE);
sim_main();
preempt_reset_key(TRUE);
handler_dev_display_read(RREG_KEY_SCAN); // flush extra sim reset key, if any
delay(1000);
// this sim was interrupted, so can't restart a new sim without doing a reset first
wasRunning = TRUE;
// if key still down after one second delay enter menu mode, else treat as simple reset
if (handler_dev_display_read(RREG_KEY_SCAN) == KEY(RESET)) {
app_state = S_MENU;
} else {
goto reset;
}
break;
}
}
return 0;
}
int main(void)
{
const size_t page_size = 1 << sim_nand.log2_page_size;
struct dhara_map map;
uint8_t page_buf[page_size];
int write_seed = 0;
int i;
sim_reset();
dhara_map_init(&map, &sim_nand, page_buf, GC_RATIO);
dhara_map_resume(&map, NULL);
printf("resumed, head = %d\n", map.journal.head);
/* Write pages until we have just barely wrapped around, but not
* yet hit a checkpoint.
*/
for (i = 0; i < 200; i++)
mt_write(&map, i, write_seed++);
printf("written a little, head = %d\n", map.journal.head);
for (i = 0; i < 200; i++)
mt_write(&map, i, write_seed++);
printf("written a little, head = %d\n", map.journal.head);
for (i = 0; i < 200; i++)
mt_write(&map, i, write_seed++);
printf("written a little, head = %d\n", map.journal.head);
for (i = 0; i < 79; i++)
mt_write(&map, i, write_seed++);
printf("written a little, head = %d\n", map.journal.head);
assert(map.journal.head == 1); /* Required for this test */
/* Now, see what happens on resume if we don't sync.
*
* Here's where a bug occured: the new epoch counter was not
* incremented when finding the next free user page, if that
* procedure required wrapping around the end of the chip from
* the last checkblock. From this point on, new pages written
* are potentially lost, because they will be wrongly identified
* as older than the pages coming physically later in the chip.
*/
printf("before resume: head = %d, tail = %d, epoch = %d\n",
map.journal.head, map.journal.tail, map.journal.epoch);
dhara_map_resume(&map, NULL);
printf("resumed, head = %d, tail = %d, epoch = %d\n",
map.journal.head, map.journal.tail, map.journal.epoch);
for (i = 0; i < 2; i++)
mt_write(&map, i, i + 10000);
printf("written new data, head = %d\n", map.journal.head);
dhara_map_sync(&map, NULL);
/* Try another resume */
printf("--------------------------------------------------------\n");
printf("before resume: head = %d, tail = %d, epoch = %d\n",
map.journal.head, map.journal.tail, map.journal.epoch);
mt_assert(&map, 0, 10000);
mt_assert(&map, 1, 10001);
dhara_map_resume(&map, NULL);
printf("resumed, head = %d, tail = %d, epoch = %d\n",
map.journal.head, map.journal.tail, map.journal.epoch);
mt_assert(&map, 0, 10000);
mt_assert(&map, 1, 10001);
return 0;
}
static void xtensa_sim_init(MachineState *machine)
{
XtensaCPU *cpu = NULL;
CPUXtensaState *env = NULL;
MemoryRegion *ram, *rom;
ram_addr_t ram_size = machine->ram_size;
const char *cpu_model = machine->cpu_model;
const char *kernel_filename = machine->kernel_filename;
int n;
if (!cpu_model) {
cpu_model = XTENSA_DEFAULT_CPU_MODEL;
}
for (n = 0; n < smp_cpus; n++) {
cpu = cpu_xtensa_init(cpu_model);
if (cpu == NULL) {
error_report("unable to find CPU definition '%s'",
cpu_model);
exit(EXIT_FAILURE);
}
env = &cpu->env;
env->sregs[PRID] = n;
qemu_register_reset(sim_reset, cpu);
/* Need MMU initialized prior to ELF loading,
* so that ELF gets loaded into virtual addresses
*/
sim_reset(cpu);
}
ram = g_malloc(sizeof(*ram));
memory_region_init_ram(ram, NULL, "xtensa.sram", ram_size, &error_fatal);
vmstate_register_ram_global(ram);
memory_region_add_subregion(get_system_memory(), 0, ram);
rom = g_malloc(sizeof(*rom));
memory_region_init_ram(rom, NULL, "xtensa.rom", 0x1000, &error_fatal);
vmstate_register_ram_global(rom);
memory_region_add_subregion(get_system_memory(), 0xfe000000, rom);
if (kernel_filename) {
uint64_t elf_entry;
uint64_t elf_lowaddr;
#ifdef TARGET_WORDS_BIGENDIAN
int success = load_elf(kernel_filename, translate_phys_addr, cpu,
&elf_entry, &elf_lowaddr, NULL, 1, ELF_MACHINE, 0);
#else
int success = load_elf(kernel_filename, translate_phys_addr, cpu,
&elf_entry, &elf_lowaddr, NULL, 0, ELF_MACHINE, 0);
#endif
if (success > 0) {
env->pc = elf_entry;
}
}
}