freecalypso-reveng: fluid-mnf/fileio.c annotate

annotate fluid-mnf/fileio.c @ 332:e5db9a45e596

frbl/reconst/serial.c: 0x1d4 static function reconstructed

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sat, 07 Mar 2020 01:32:59 +0000
parents	9cecc930d78f
children	b730c7844233

rev	line source
311 9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 * FLUID (Flash Loader Utility Independent of Device)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 *
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 * Copyright Texas Instruments, 2001.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * Mads Meisner-Jensen, mmj@ti.com.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 *
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 * File reading/loading
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 *
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 * $Id: fileio.c 1.24 Mon, 28 Apr 2003 08:49:16 +0200 tsj $
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 *
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 #include "fluid.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 #include "flash.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 #include "fileio.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 #include "misc.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 #include "trace.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 #include "../target/target.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 #include "../inc/secure_types.h" // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 #include <stdio.h>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 #include <malloc.h>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #include <stdlib.h>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #include <string.h>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 * Globals
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 extern int bootloader_is_secure_rom;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 extern int a_certified_cmd_file_name;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #define HEX_MOTOROLA_LINE_SIZE 32 // number of bytes in each line
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #define HEX_MOTOROLA_ADDR_SIZE 32 // number of bits in addresses (16, 24 or 32)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 struct {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 char type;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 char size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 uint32 addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 uint8 data[128];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 uint8 dummy; // required - don't remove!
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 } mhex;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 int hexfile_read(char name, char buf, int buf_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 char *usage_map, int usage_map_chunk_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 int hexline_motorola_read(char* line);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 int hextoint(char *src, int digits);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 void hextobytes(uint8 dst, char src, int bytes);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 int hexblock_write(char *buf, int size, unsigned long addr, int addr_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 char hexfile_type);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 int hexline_motorola_write(char *buf, int size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 unsigned long addr, int addr_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 int hexfile_write_open(char name, char hexfile_type, char buf, int size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 int hexfile_write_close(char hexfile_type, int addr_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 * File Reading
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 // Convert image from one endian type to another. The memory width is
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 // specified with <width>.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 void buffer_endian_convert(unsigned char *buf, int buf_size, int width)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 unsigned char tmp1, tmp2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 int i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 tr(TrHexWrite, "buffer_endian_convert(*, %d, %d)\n", buf_size, width);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 for (i = 0; i < buf_size; i += width) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 if (width == 16 \|\| width == 2) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 tmp1 = buf[i+0];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 buf[i+0] = buf[i+1];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 buf[i+1] = tmp1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 else if (width == 32 \|\| width == 4) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 tmp1 = buf[i+0];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 tmp2 = buf[i+1];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 buf[i+0] = buf[i+3];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 buf[i+1] = buf[i+2];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 buf[i+2] = tmp2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 buf[i+3] = tmp1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 int file_read_rc(char *filename)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 // TODO: Read the .fluidrc file. It can contain the following
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 // directives:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 //
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 // path = <path> /* semi-colon? separated list of directories in which
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 // to look for m0 files etc. */
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 // target = [h]\|[c]
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 // baudrate = <baudrate>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 // port = <port>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 // more?
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 return 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 extern void tr_image_usage_map(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 int file_read_image(char *image, int image_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 char *usage_map, int usage_map_chunk_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 int size, size_total = 0, i = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 int time_load;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 flowf(NORMAL, "Reading image file:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 memset(image, 0xFF, image_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 memset(usage_map, 0, image_size / usage_map_chunk_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 if (arg_file_list[0] == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 main_warning(E_FILE_INPUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 time_load = stopwatch_start();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 while (arg_file_list[i] != NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 flowf(NORMAL, " '%s'", arg_file_list[i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 if ((size = hexfile_read(arg_file_list[i], image, image_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 usage_map, usage_map_chunk_size)) < 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 flowf(ALWAYS, " MESSAGE: File '%s' not found\n", arg_file_list[i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 main_error(size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 size_total += size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 flowf(NORMAL, " (%dkB)", (size + 512) / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 i++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 if (arg_file_list[i] != NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 flowf(NORMAL, ",");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 time_load = (stopwatch_stop(time_load) + 50) /100;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 flowf(BLABBER, " (%d.%ds)", time_load / 10, time_load % 10);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 flowf(NORMAL, " ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 // Now convert image from big endian to little endian format
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 buffer_endian_convert(image, image_size, arg_hexfile_memwidth);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 return size_total;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 int file_read_cmd(char image, int image_size, char filename)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 //char filename[20] = "cmd.m0";
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 memset(image, 0, image_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 flowf(BLABBER, "Reading cmd file '%s': ", filename);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 if ((image_size = hexfile_read(filename, image, image_size, 0, 0)) < 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 flowf(ALWAYS, "MESSAGE: File '%s' not found\n", filename);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 main_error(image_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 flowf(BLABBER, "(%dB) ok\n", image_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 return image_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 int file_read_method(char image, int image_size, struct device_s device)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 char filename[20];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 strncpy(filename,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 algorithm_name_lookup_by_id(device->algorithm_id),
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 20 - sizeof(".m0"));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 strcat(filename, ".m0");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 memset(image, 0, image_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 flowf(BLABBER, "Reading method file '%s': ", filename);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 if ((image_size = hexfile_read(filename, image, image_size, 0, 0)) < 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 flowf(ALWAYS, "MESSAGE: File '%s' not found\n", filename);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 main_error(image_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 flowf(BLABBER, "(%dB) ok\n", image_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 return image_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 * Hex File Read Functions
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 // Read an input file in Motorola (or Intel) hex format. On success, return
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 // the number of raw data bytes read.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 int hexfile_read(char filename, char buf, int buf_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 char *usage_map, int usage_map_chunk_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 FILE* stream;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 char line[100];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 uint32 addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 int type, mysize = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 // First look for file in current directory. Then look for it in the
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 // directory where the fluid executable was found.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 flowf(DEBUG, "(looking for '%s') ", filename);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 if ((stream = fopen(filename, "rt")) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 char buf[256];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 flowf(DEBUG, "(oops) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 if (pathname_make(buf, sizeof(buf), argv_0, filename) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 return E_BUFFER;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 flowf(DEBUG, "(looking for '%s') ", buf);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 if ((stream = fopen(buf, "rt")) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 return E_FILE_OPEN;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 flowf(DEBUG, "(ok) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 // TODO?: Read the first character of the file and determine the file
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 // type this way (Motorola format, Intel format or .out format)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 type = 'S';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 while (fgets(line, 100, stream) != NULL) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 switch (type) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 case 'S':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 if (hexline_motorola_read(line)) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 mysize += (int) mhex.size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 if (bootloader_is_secure_rom &&
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 strcmp(filename, (char *)&a_certified_cmd_file_name) == 0 &&
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 mhex.addr >= CMD_SECURE_CALP_OFFSET) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 // The flash programmer is linked to 0x08020000 in internal
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 // SRAM.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 addr = mhex.addr - CMD_SECURE_CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 else if (mhex.addr >= CALP_OFFSET)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 // Assume linked to Calypso Plus (0x04000000 Flash Base)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 addr = mhex.addr - CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 addr = mhex.addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 if (addr > (uint32) buf_size) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 fprintf(stderr, "Address too big: 0x%08X\n", (int) addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 return E_FILE_BUF_SMALL;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 memcpy(&buf[addr], &mhex.data[0], mhex.size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 // Update the image usage map
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 if (usage_map != NULL) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 usage_map[(addr) / usage_map_chunk_size] = 'x';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 usage_map[(addr + mhex.size - 1) / usage_map_chunk_size] = 'x';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 case '?':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 // Intel format
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 case 'O':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 // .out format
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 default:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 return E_FILE_FORMAT;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 fclose(stream);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 return mysize;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 // Read and decode one line of a Motorola hex file.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 // Original design and code by Delta Technologies, 2001.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 int hexline_motorola_read(char* line)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 mhex.type = (uint8) line[1] - '0';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 mhex.size = hextoint(&line[2], 2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 tr(TrHexRead, "S%d%02X", mhex.type, mhex.size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 switch (mhex.type) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 case 0:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 // First record in file - no action required
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 mhex.size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 case 1:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 // Data record 16-bit address: S1nnAAAAxxxxxxxxxxxxxxxCC
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 mhex.size -= 3;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 mhex.addr = hextoint(&line[4], 4);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 tr(TrCont\|TrHexRead, "%04X", mhex.addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 hextobytes(&mhex.data[0], &line[8], mhex.size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 case 2:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 // Data record 24-bit address: S2nnAAAAAAxxxxxxxxxxxxxxxCC
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 mhex.size -= 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 mhex.addr = hextoint(&line[4], 6);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 tr(TrCont\|TrHexRead, "%06X", mhex.addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 hextobytes(&mhex.data[0], &line[10], mhex.size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 case 3:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 // Data record 32-bit address: S3nnAAAAAAAAxxxxxxxxxxxxxxxCC
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 mhex.size -= 5;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 mhex.addr = hextoint(&line[4], 8);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 tr(TrCont\|TrHexRead, "%08X", mhex.addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 hextobytes(&mhex.data[0], &line[12], mhex.size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 case 7:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 // End of file record 32-bit address
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 mhex.size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 case 8:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 // End of file record 24-bit address
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 mhex.size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 case 9:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 // End of file record 16-bit address
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 mhex.size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 default:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 fprintf(stderr, "WARNING: Illegal hex line: %s\n", line);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 main_error(E_FILE_FORMAT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 tr(TrCont\|TrHexRead, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 return mhex.size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 int hextoint(char *src, int digits)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 int number = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 char ch;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 while (digits-- && *src) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 ch = *src++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 if (ch >= '0' && ch <= '9')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 ch = ch - '0';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 else if (ch >= 'A' && ch <= 'F')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 ch = ch - 'A' + 10;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 else if (ch >= 'a' && ch <= 'f')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 ch = ch - 'a' + 10;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 number = (number << 4) + ch;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 return number;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 void hextobytes(uint8 dst, char src, int bytes)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 while (bytes-- && *src) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 *dst++ =
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 (src[0] - (src[0] <= '9' ? '0' : 'A' - 10)) * 16 +
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 (src[1] - (src[1] <= '9' ? '0' : 'A' - 10));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 src += 2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 tr(TrCont\|TrHexRead, "%02X", dst[-1]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 * File Writing
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 static FILE* ostream;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 int file_write_image(char *image, int image_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 struct image_part_s *image_list)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 int size, size_total = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 struct image_part_s *image_list_start = image_list;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 if (arg_show_hexdump == 0 && arg_file_list[0] == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 main_fatal(E_FILE_OUTPUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 if (arg_file_list[1] != NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 main_fatal(E_ARG_MULTI);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 if (arg_file_list[0] != NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 flowf(NORMAL, "Writing flash image file: '%s' ", arg_file_list[0]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 if ((size = hexfile_write_open(arg_file_list[0], arg_hexfile_type,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 image, image_size)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 main_error(size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 while (image_list->size != 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 // Note that we wrap/mirror memory each 'image_size' bytes
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 if ((size =
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 hexblock_write(&image[image_list->addr & (image_size - 1)],
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 image_list->size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 image_list->addr, 32,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 arg_hexfile_type)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 main_error(E_FILE_BUF_SMALL);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 size_total += size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 flowf(NORMAL, "(%dkB) ", (size + 512) / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 image_list++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 if (hexfile_write_close(arg_hexfile_type, 32) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 main_error(E_FILE_CLOSE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 flowf(NORMAL, " ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 if (arg_show_hexdump) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 image_list = image_list_start;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 while (image_list->size != 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 hexdump(&image[image_list->addr & (image_size - 1)],
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 image_list->size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 image_list->addr, 1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 putchar('\n');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 image_list++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 return size_total;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 int file_write_die_id(unsigned char die_id, char filename) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 int i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 if (arg_hexfile_type == 'b') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 // Binary write
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 if ((ostream = fopen(filename, "wb")) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 return E_FILE_OPEN;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 if (fwrite(die_id, C_WORD32LGB * C_DIE_ID_SIZE, 1, ostream) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 return E_FILE_WRITE;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 // Text write
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 if ((ostream = fopen(filename, "wt")) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 return E_FILE_OPEN;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 for (i = 0 ; i < (C_WORD32LGB * C_DIE_ID_SIZE) ; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 fprintf(ostream, "0x%2.2x ", die_id[i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 fclose(ostream);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 return 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 * Hex File Write Functions
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 int hexblock_write(char *buf, int size, unsigned long addr, int addr_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 char hexfile_type)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 int size_start = size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 int line_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 tr(TrHexWrite, "hexblock_write(*, %d, 0x%x, %d, '%c')\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 size, addr, addr_size, hexfile_type);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 while (size > 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 switch (hexfile_type) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 case 'b':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 line_size = fwrite(buf, 1, size, ostream);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 if (line_size < size_start)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 return E_FILE_WRITE;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 case 'm':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 case 'S':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 line_size = (size > HEX_MOTOROLA_LINE_SIZE ?
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 HEX_MOTOROLA_LINE_SIZE : size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 hexline_motorola_write(buf, line_size, addr, addr_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 case '?':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 // Intel format
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 default:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 main_fatal(E_FILE_FORMAT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 buf += line_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 size -= line_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 addr += line_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 return size_start;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 int hexfile_write_open(char name, char hexfile_type, char buf, int size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 if ((ostream = fopen(name, "wt")) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 return E_FILE_OPEN;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 // Write file header
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 switch (hexfile_type) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 case 'b':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 // Binary format --- close file, then reopen it for binary writing
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 if (fclose(ostream) == EOF)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 return E_FILE_OPEN;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 if ((ostream = fopen(name, "wb")) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 return E_FILE_OPEN;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 flowf(VERBOSE, "(binary) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 case 'm':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 case 'S':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 // Motorola hex files are always in big endian format.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 flowf(VERBOSE, "(motorola) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 buffer_endian_convert(buf, size, arg_hexfile_memwidth);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 fprintf(ostream,"S0030000FC\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 case '?':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 flowf(VERBOSE, "(intel) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 // Intel format
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 default:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 return E_FILE_FORMAT;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 return 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 int hexfile_write_close(char hexfile_type, int addr_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 switch (hexfile_type) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 case 'b':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 // Binary format --- do nothing
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526 case 'm':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 case 'S':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 switch (addr_size) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 case 16: fprintf(ostream, "S9030000FC\n"); break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 case 24: fprintf(ostream, "S804000000FB\n"); break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 case 32: fprintf(ostream, "S70500000000FA\n"); break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 case '?':
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 // Intel format
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 default:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 return E_FILE_FORMAT;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 fclose(ostream);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 return 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 int hexline_motorola_write(char *buf, int size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 unsigned long addr, int addr_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549 uint8 cksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550 int i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 tr(TrHexWrite, "hexline_motorola_write(*, %d, 0x%x, %d)\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 size, addr, addr_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 if (addr_size == 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556 if ((addr + (unsigned long)(size - 1)) < 0x10000L)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 addr_size = 16;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 else if ((addr + (unsigned long)(size - 1)) < 0x1000000L)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 addr_size = 24;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 addr_size = 32;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 switch (addr_size) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 case 16:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 fprintf(ostream, "S1%02X%04lX", size + 3, addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 cksum = size + 3;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 case 24:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 fprintf(ostream, "S2%02X%06lX", size + 4, addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 cksum = size + 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 case 32:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 fprintf(ostream, "S3%02X%08lX", size + 5, addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 cksum = size + 5;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 cksum +=
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 (uint8) ((addr >> 24) & 0xFF) +
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 (uint8) ((addr >> 16) & 0xFF) +
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 (uint8) ((addr >> 8) & 0xFF) +
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 (uint8) ((addr >> 0) & 0xFF);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 for (i = 0; i < size; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 fprintf(ostream,"%02X", buf[i] & 0xFF);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 cksum += buf[i];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 cksum = ~cksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 fprintf(ostream,"%02X\n", cksum);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 return 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592

FreeCalypso > hg > freecalypso-reveng

annotate fluid-mnf/fileio.c @ 332:e5db9a45e596