#include <gelf.h>
#include "sim_elf.h"
+#include "sim_vcd_file.h"
+#include "avr_eeprom.h"
+
+void avr_load_firmware(avr_t * avr, elf_firmware_t * firmware)
+{
+ if (firmware->frequency)
+ avr->frequency = firmware->frequency;
+ if (firmware->vcc)
+ avr->vcc = firmware->vcc;
+ if (firmware->avcc)
+ avr->avcc = firmware->avcc;
+ if (firmware->aref)
+ avr->aref = firmware->aref;
+#if CONFIG_SIMAVR_TRACE
+ avr->trace_data->codeline = firmware->codeline;
+#endif
+
+ avr_loadcode(avr, firmware->flash, firmware->flashsize, firmware->flashbase);
+ avr->codeend = firmware->flashsize + firmware->flashbase - firmware->datasize;
+ if (firmware->eeprom && firmware->eesize) {
+ avr_eeprom_desc_t d = { .ee = firmware->eeprom, .offset = 0, .size = firmware->eesize };
+ avr_ioctl(avr, AVR_IOCTL_EEPROM_SET, &d);
+ }
+
+ avr_set_command_register(avr, firmware->command_register_addr);
+ avr_set_console_register(avr, firmware->console_register_addr);
+
+ // rest is initialization of the VCD file
+
+ if (firmware->tracecount == 0)
+ return;
+ avr->vcd = malloc(sizeof(*avr->vcd));
+ memset(avr->vcd, 0, sizeof(*avr->vcd));
+ avr_vcd_init(avr,
+ firmware->tracename[0] ? firmware->tracename: "gtkwave_trace.vcd",
+ avr->vcd,
+ firmware->traceperiod >= 1000 ? firmware->traceperiod : 1000);
+
+ printf("Creating VCD trace file '%s'\n", avr->vcd->filename);
+ for (int ti = 0; ti < firmware->tracecount; ti++) {
+ if (firmware->trace[ti].mask == 0xff || firmware->trace[ti].mask == 0) {
+ // easy one
+ avr_irq_t * all = avr_iomem_getirq(avr, firmware->trace[ti].addr, AVR_IOMEM_IRQ_ALL);
+ if (!all) {
+ printf("%s: unable to attach trace to address %04x\n",
+ __FUNCTION__, firmware->trace[ti].addr);
+ } else {
+ avr_vcd_add_signal(avr->vcd, all, 8, firmware->trace[ti].name);
+ }
+ } else {
+ int count = 0;
+ for (int bi = 0; bi < 8; bi++)
+ if (firmware->trace[ti].mask & (1 << bi))
+ count++;
+ for (int bi = 0; bi < 8; bi++)
+ if (firmware->trace[ti].mask & (1 << bi)) {
+ avr_irq_t * bit = avr_iomem_getirq(avr, firmware->trace[ti].addr, bi);
+ if (!bit) {
+ printf("%s: unable to attach trace to address %04x\n",
+ __FUNCTION__, firmware->trace[ti].addr);
+ break;
+ }
+
+ if (count == 1) {
+ avr_vcd_add_signal(avr->vcd, bit, 1, firmware->trace[ti].name);
+ break;
+ }
+ char comp[128];
+ sprintf(comp, "%s.%d", firmware->trace[ti].name, bi);
+ avr_vcd_add_signal(avr->vcd, bit, 1, firmware->trace[ti].name);
+ }
+ }
+ }
+ // if the firmware has specified a command register, do NOT start the trace here
+ // the firmware probably knows best when to start/stop it
+ if (!firmware->command_register_addr)
+ avr_vcd_start(avr->vcd);
+}
+
+static void elf_parse_mmcu_section(elf_firmware_t * firmware, uint8_t * src, uint32_t size)
+{
+ while (size) {
+ uint8_t tag = *src++;
+ uint8_t ts = *src++;
+ int next = size > 2 + ts ? 2 + ts : size;
+ // printf("elf_parse_mmcu_section %d, %d / %d\n", tag, ts, size);
+ switch (tag) {
+ case AVR_MMCU_TAG_FREQUENCY:
+ firmware->frequency =
+ src[0] | (src[1] << 8) | (src[2] << 16) | (src[3] << 24);
+ break;
+ case AVR_MMCU_TAG_NAME:
+ strcpy(firmware->mmcu, (char*)src);
+ break;
+ case AVR_MMCU_TAG_VCC:
+ firmware->vcc =
+ src[0] | (src[1] << 8) | (src[2] << 16) | (src[3] << 24);
+ break;
+ case AVR_MMCU_TAG_AVCC:
+ firmware->avcc =
+ src[0] | (src[1] << 8) | (src[2] << 16) | (src[3] << 24);
+ break;
+ case AVR_MMCU_TAG_AREF:
+ firmware->aref =
+ src[0] | (src[1] << 8) | (src[2] << 16) | (src[3] << 24);
+ break;
+ case AVR_MMCU_TAG_VCD_TRACE: {
+ uint8_t mask = src[0];
+ uint16_t addr = src[1] | (src[2] << 8);
+ char * name = (char*)src + 3;
+ printf("AVR_MMCU_TAG_VCD_TRACE %04x:%02x - %s\n", addr, mask, name);
+ firmware->trace[firmware->tracecount].mask = mask;
+ firmware->trace[firmware->tracecount].addr = addr;
+ strncpy(firmware->trace[firmware->tracecount].name, name,
+ sizeof(firmware->trace[firmware->tracecount].name));
+ firmware->tracecount++;
+ } break;
+ case AVR_MMCU_TAG_VCD_FILENAME: {
+ strcpy(firmware->tracename, (char*)src);
+ } break;
+ case AVR_MMCU_TAG_VCD_PERIOD: {
+ firmware->traceperiod =
+ src[0] | (src[1] << 8) | (src[2] << 16) | (src[3] << 24);
+ } break;
+ case AVR_MMCU_TAG_SIMAVR_COMMAND: {
+ firmware->command_register_addr = src[0] | (src[1] << 8);
+ } break;
+ case AVR_MMCU_TAG_SIMAVR_CONSOLE: {
+ firmware->console_register_addr = src[0] | (src[1] << 8);
+ } break;
+ }
+ size -= next;
+ src += next - 2; // already incremented
+ }
+}
int elf_read_firmware(const char * file, elf_firmware_t * firmware)
{
memset(firmware->codeline,0, bitesize);
#endif
- /* this is actualy mandatory !! otherwise elf_begin() fails */
+ /* this is actually mandatory !! otherwise elf_begin() fails */
if (elf_version(EV_CURRENT) == EV_NONE) {
/* library out of date - recover from error */
}
firmware->bsssize = s->d_size;
} else if (!strcmp(name, ".mmcu")) {
Elf_Data *s = elf_getdata(scn, NULL);
- firmware->mmcu = *((struct avr_mcu_t*)s->d_buf);
- printf("%s: avr_mcu_t size %ld / read %ld\n", __FUNCTION__, sizeof(struct avr_mcu_t), s->d_size);
+ elf_parse_mmcu_section(firmware, s->d_buf, s->d_size);
+ //printf("%s: avr_mcu_t size %ld / read %ld\n", __FUNCTION__, sizeof(struct avr_mcu_t), s->d_size);
// avr->frequency = f_cpu;
}
#if ELF_SYMBOLS
} else {
// code
if (firmware->codeline[sym.st_value >> 1] == NULL) {
- avr_symbol_t * s = firmware->codeline[sym.st_value >> 1] = malloc(sizeof(avr_symbol_t*));
+ avr_symbol_t * s = firmware->codeline[sym.st_value >> 1] = malloc(sizeof(avr_symbol_t));
s->symbol = strdup(name);
s->addr = sym.st_value;
}
// hdump("code", data_text->d_buf, data_text->d_size);
memcpy(firmware->flash + offset, data_text->d_buf, data_text->d_size);
offset += data_text->d_size;
- printf("Loaded %d .text\n", data_text->d_size);
+ printf("Loaded %zu .text\n", data_text->d_size);
}
if (data_data) {
// hdump("data", data_data->d_buf, data_data->d_size);
memcpy(firmware->flash + offset, data_data->d_buf, data_data->d_size);
- printf("Loaded %d .data\n", data_data->d_size);
+ printf("Loaded %zu .data\n", data_data->d_size);
offset += data_data->d_size;
firmware->datasize = data_data->d_size;
}
// hdump("eeprom", data_ee->d_buf, data_ee->d_size);
firmware->eeprom = malloc(data_ee->d_size);
memcpy(firmware->eeprom, data_ee->d_buf, data_ee->d_size);
- printf("Loaded %d .eeprom\n", data_ee->d_size);
+ printf("Loaded %zu .eeprom\n", data_ee->d_size);
firmware->eesize = data_ee->d_size;
}
// hdump("flash", avr->flash, offset);