123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245 |
- #include "memimg.h"
- #include <stdlib.h>
- #include <stdio.h>
- #include <string.h>
- mi_patch *mi_make_patch(unsigned long base, unsigned long top)
- {
- mi_patch *pat;
- pat=malloc(sizeof(mi_patch));
- if(pat == NULL) {
- return NULL;
- }
- pat->base=base;
- pat->top=top;
- pat->contents=malloc(sizeof(mi_byte_t)*(top-base));
- if(pat->contents == NULL) {
- free(pat);
- return NULL;
- }
- memset(pat->contents, 0xff, sizeof(mi_byte_t)*(top-base));
- pat->mask=malloc(sizeof(char)*(top-base));
- if(pat->mask == NULL) {
- free(pat->contents);
- free(pat);
- return NULL;
- }
- memset(pat->mask, 0, sizeof(char)*(top-base));
- return pat;
- }
- void mi_free_patch(mi_patch *p)
- {
- if(p == NULL) {
- return;
- }
- free(p->contents);
- free(p->mask);
- free(p);
- }
- void mi_free_image(mi_image *i)
- {
- if(i == NULL) {
- return;
- }
- mi_free_patch(i->program);
- mi_free_patch(i->id);
- mi_free_patch(i->config);
- mi_free_patch(i->devid);
- mi_free_patch(i->eeprom);
- free(i);
- }
- void mi_modify_patch(mi_patch *p, int base, int len, mi_byte_t *data)
- {
- int i;
- if(p == NULL) {
- return;
- }
- if(base<p->base || base+len-1 > p->top) {
- printf("*** mi_modify_patch(): patch out of range\n");
- return;
- }
- for(i=0;i<len;i++) {
- p->contents[base - p->base + i]=data[i];
- p->mask[base - p->base + i]=0xff;
- }
- }
- mi_image *mi_load_hexfile(char *filename)
- {
- mi_image *img;
- hex_record *r;
- FILE *f;
- hex_file *hf;
- if(filename == NULL) {
- return NULL;
- }
- f=fopen(filename, "r");
- if(f == NULL) {
- return NULL;
- }
- hf=hex_open(f);
- if(hf == NULL) {
- fclose(f);
- return NULL;
- }
- img=malloc(sizeof(mi_image));
- if(img == NULL) {
- fclose(f);
- free(hf);
- return NULL;
- }
-
- img->program = NULL;
- img->id = NULL;
- img->config = NULL;
- img->devid = NULL;
- img->eeprom = NULL;
- img->program=mi_make_patch(MI_PROGRAM_BASE, MI_PROGRAM_TOP);
- img->id=mi_make_patch(MI_ID_BASE, MI_ID_TOP);
- img->config=mi_make_patch(MI_CONFIG_BASE, MI_CONFIG_TOP);
- img->devid=mi_make_patch(MI_DEVID_BASE, MI_DEVID_TOP);
- img->eeprom=mi_make_patch(MI_EEPROM_BASE, MI_EEPROM_TOP);
- if(img->program == NULL || img->id == NULL || img->config == NULL
- || img->devid == NULL || img->eeprom == NULL) {
- fclose(f);
- free(hf);
- mi_free_image(img);
- return NULL;
- }
- while((r=hex_read(hf))) {
- if(r->type == 0) {
-
- if(r->addr >= MI_PROGRAM_BASE && r->addr <= MI_PROGRAM_TOP) {
-
- mi_modify_patch(img->program, r->addr, r->datlen, r->data);
- }
- if(r->addr >= MI_ID_BASE && r->addr <= MI_ID_TOP) {
-
- mi_modify_patch(img->id, r->addr, r->datlen, r->data);
- }
- if(r->addr >= MI_CONFIG_BASE && r->addr <= MI_CONFIG_TOP) {
-
- mi_modify_patch(img->config, r->addr, r->datlen, r->data);
- }
- if(r->addr >= MI_DEVID_BASE && r->addr <= MI_DEVID_TOP) {
-
- mi_modify_patch(img->devid, r->addr, r->datlen, r->data);
- }
- }
- free(r);
-
- }
- free(hf);
- fclose(f);
- return img;
- }
|