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

annotate fluid-mnf/machine.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	435e041897f2

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 * Original state-machine logic by Delta Technologies, Copyright, 2001.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 *
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 * Core functionality. State machines and support functions.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 *
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 * $Id: machine.c 1.35.1.37 Mon, 28 Apr 2003 08:49:16 +0200 tsj $
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 #include "fluid.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 #include "flash.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 #include "target.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 #include "fileio.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 #include "../target/protocol.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 #include "misc.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 #include "lz.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 #include "trace.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #include "../inc/ram_load.h"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #include "../inc/secure_types.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 #include <stdio.h>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #include <malloc.h>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #include <stdlib.h>
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 #include <string.h>
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 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 * Constants and typedefs
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 ******************************************************************************/
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 // Due to memory wrap/mirror used in flash_read_machine(), IMAGE_SIZE_MAX
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 // must be a power of two.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #define IMAGE_SIZE_MAX (8 * 1024 * 1024)
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 #define IMAGE_CHUNK_SIZE 8192
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #define ERASE_LIST_SIZE_MAX 256
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #define SECTOR_MAP_SIZE_MAX 256
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #define TARGET_PROGRAM_SIZE_MAX (8 * 1024)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #define READ_LIST_SIZE_MAX 40
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 #define RETRIES_MAX 30
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 // Default target receive delay in milli-seconds.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 #define TARGET_RECV_DELAY 250
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #define TARGET_RECV_LONG_DELAY 1000
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 // Default target reset delay in milli-seconds.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #define TARGET_RESET_DELAY 200
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 // CS_MODE 0: Flash at 0x04000000 @ CS5 on E-Sample
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 #define CALP_OFFSET 0x04000000
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
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 * Globals
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 ******************************************************************************/
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 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 T_RAM_LOADER d_ram_loader;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 T_FRAME d_frame;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 UWORD16 d_certificate_length = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 char a_certified_cmd_file_name[] = "cmdp_cert.m0";
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 struct target_s {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 uint32 cmd_load_addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 uint32 method_load_addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 const char type;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 const char *name;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 const char *prefix;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 };
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 // Note that the ROM bootloader of Calypso rev. A devices are unable to
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 // write the bottom 128kB of internal RAM. Therefore the address have been
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 // changed from 0x804000 to 0x0820000
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 const struct target_s target[] =
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 { 0x0000000, 0x0000000, 'u', "Unknown", "oops" },
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 { 0x0000000, 0x0000000, 'u', "Unknown1", "oops1" },
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 { 0x0000000, 0x0000000, 'G', "Gemini?", "gem?" },
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 { 0x3004000, 0x3000000, 'U', "Ulysses", "uly" },
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 { 0x0820000, 0x0800000, 'C', "Calypso", "cal" },
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 { 0x0804000, 0x0800000, 'c', "Calypso Lite", "cal_l" },
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 { 0x8020000, 0x8000100, 'P', "Calypso Plus", "cal_p" }
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 int target_type;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 int target_clk; // 13000000 or 14745600
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 struct device_s *device;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 uint8 target_program[TARGET_PROGRAM_SIZE_MAX];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 int target_program_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 int target_fifo_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 uint8 image[IMAGE_SIZE_MAX];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 int image_size; // size of image buffer
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 int image_chunk_size; // number of bytes in each chunk
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 int image_size_in_chunks; // size of image buffer in chunks
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 // Each byte in the image_map represents one chunk of the image. Each byte
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 // can have one of the following values:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 // '\0' = no data in this chunk
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 // 's' = skip this chunk when programming
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 // 'c' = chunk checksum ok, skip this chunk when programming
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 // 'x' = used
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 uint8 image_map[IMAGE_SIZE_MAX / IMAGE_CHUNK_SIZE];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 int image_map_size; // number of entries in image_map
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 // Each byte in the sector_map represents one sector. Each byte can have one
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 // of the following values:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 // '\0' = sector unused (don't erase)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 // 'c' = sector already empty/erased (don't erase) (not used)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 // 's' = skip this sector when erasing (due to erase override)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 // 'X' = force erase this sector (due to erase override)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 // 'x' = erase this sector (normal case --- sector is covered by image)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 int sector_map[SECTOR_MAP_SIZE_MAX];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 int sector_map_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 int erase_list[ERASE_LIST_SIZE_MAX];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 int erase_list_size;
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 struct image_part_s read_list[READ_LIST_SIZE_MAX];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 int read_list_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 int read_total_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 int image_map_count_used_chunks(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 int image_map_update(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 int sector_map_init(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 void image_map_show(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 void sector_map_show(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 void target_timers_show(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 void parse_arg_erase_override(char *p);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 void parse_arg_read(char *p);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 void parse_arg_write(char *p);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 void error_proto(char ch, char ch_expected);
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 int target_type_set(uint16 code);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 void f_print_signalling_response(int level);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 void f_print_certificate_platform_data(int level, T_MANUFACTURER_CERTIFICATE_PLATFORM_DATA *p_certificate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 void f_print_certificate(int level, T_MANUFACTURER_CERTIFICATE_FLASH_PROGRAMMER *p_certificate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 void f_print_parameter_nack_status(int level, UWORD8 d_parameter_nack_sts);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 void f_print_write_nack_status(int level, UWORD8 d_write_nack_sts);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 UWORD8 f_convert_uart_baud_rate(UWORD32 d_baud_rate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 void target_imei_protection(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154
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 * Main
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 void bootloader_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 void cmd_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 void flash_checksum_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 void flash_detect_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 void method_download_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 void flash_program_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 void flash_read_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 void target_reset_machine(void);
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 void fluid_machine(void)
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 int error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 // If user has specifically asked fluid just to reset the target, we do
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 // that and only that! This way, we can use fluid just to reset the
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 // target without doing anything else!
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 if (arg_target_reset == 2 && arg_dry_run) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 flowf(VERBOSE, "Resetting target: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 target_reset(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 target_wait(0, TARGET_RESET_DELAY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 target_reset(1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 flowf(VERBOSE, "ok\n");
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 file_read_devices("devices.txt");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 if (arg_list_devices) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 devices_list();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 exit(0);
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 image_size = IMAGE_SIZE_MAX;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 image_chunk_size = IMAGE_CHUNK_SIZE;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 image_map_size = IMAGE_SIZE_MAX / image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 image_size_in_chunks =
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 (image_size + image_chunk_size - 1) / image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 // Read the flash image file(s) unless user wants to read from the flash
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 if (*arg_read == 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 file_read_image(image, IMAGE_SIZE_MAX, image_map, image_chunk_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 // Optionally overwrite image with values given on the command-line
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 parse_arg_write(arg_write);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 if (arg_image_map_show)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 image_map_show();
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 if ((error = target_driver_init(arg_uart_port, 115200,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 arg_uart_flowcontrol)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 if (target_type_set(arg_target_type) != 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 flowf(VERBOSE, "Target type '%s' selected.\n", target[target_type].name);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 // Conditionally disable tracing
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 if (arg_debug_trace_pe)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 tr_enable(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 if (arg_debug_resume) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 // If resuming in command interpreter, we should set the baudrate
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 // because we do not pass through the code that normally sets it.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 if ((error = target_driver_baudrate(arg_uart_baudrate)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 bootloader_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 cmd_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 if (*arg_read != 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 parse_arg_read(arg_read);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 flash_read_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 file_write_image(image, image_size, read_list);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 if (arg_checksum)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 flash_checksum_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 flash_detect_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 if (!arg_debug_resume) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 method_download_machine();
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 tr_enable(1); // Ensure full tracing is on
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 flash_program_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 if (arg_imeisv && arg_platform_certificate_addr)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 target_imei_protection();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 if (arg_timers_show)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 target_timers_show();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 if (arg_target_reset == 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 target_reset_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 }
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 * Bootloader (TI Target Monitor) Access
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 ******************************************************************************/
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 // Invoke the Fluid bootloader embedded in the TI bootloader/target-monitor
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 // code. The command to enter the loader is 0xAA 0x01 0xDD, which must be
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 // received by the phone within 50ms from reset.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 int bootloader_is_rom;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 int bootloader_is_secure_rom; // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 int bootloader_blocksize_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 void bootloader_fluid_init(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 void bootloader_rom_init(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 void bootloader_secure_rom_init(void); // Secure Calypso Plus
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 void bootloader_machine(void)
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 // FIXME: why do we have to send an additional char (0) ?
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 uint8 sendbuf_rom[3] = { '<', 'i', 0x0 };
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 uint8 sendbuf_fluid[3] = { 0xAA, 0x01, 0xDD };
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 int i, error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 char ch1, ch2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 UWORD16 d_j;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 target_trace_enable(0);
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 flowf(NORMAL, "Bootloader: ");
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 // Wait a short while with power removed, then flush receive buffer.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 target_power(1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 target_reset(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 target_wait(0, TARGET_RESET_DELAY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 target_reset(1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 target_recv_reset();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 // Continuously send Fluid Bootloader escape sequence until we get an
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 // acknowledgement. Note that we have to establish contact within 50ms
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 // from reset, otherwise we lose our chance! Note that we actually wait
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 // up to 500ms because the target may take some time to reset.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 i = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 flowf(DEBUG, "(ROM/fluid-delay = %d/%d, ",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 arg_boot_delay_rom, arg_boot_delay_fluid);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 switch (arg_rom_bootloader) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 case -1:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 if ((error = target_driver_baudrate(115200)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 case +1:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 if ((error = target_driver_baudrate(19200)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 while (1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 target_recv_reset();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 // If we are allowed to try fluid bootloader...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 if (arg_rom_bootloader != +1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 // If we should ONLY try fluid bootloader...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 flowf(DEBUG, "F");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 if (arg_rom_bootloader == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 if ((error = target_driver_baudrate(115200)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 target_send(sendbuf_fluid, 3);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 if (target_wait(1, arg_boot_delay_fluid) > 0 &&
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 target_getchar() == PROTO_HELLO) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 bootloader_is_rom = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 bootloader_is_secure_rom = 0; // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 }
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 // If we are allowed to try ROM bootloader...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 if (arg_rom_bootloader != -1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 flowf(DEBUG, "R");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 if (arg_rom_bootloader == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 if ((error = target_driver_baudrate(19200)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 target_send(sendbuf_rom, 3);
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 if (target_wait(1, arg_boot_delay_rom) >= 1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 ch1 = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 if (ch1 == '>') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 if (target_wait(1, arg_boot_delay_rom) >= 1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 ch2 = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 if (ch2 == 'i') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 bootloader_is_rom = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 if (target_wait(2, arg_boot_delay_rom) < 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 flowf(DEBUG, ", Non-secure boot ROM code");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 flowf(DEBUG, ", Secure Calypso Plus ROM)");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 ch1 = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 ch2 = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 d_ram_loader.d_romcode_version = (UWORD16)(ch1) & 0xFF;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 d_ram_loader.d_romcode_version \|= ((UWORD16)(ch2 & 0xFF)) << 8;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 //d_ram_loader.d_romcode_version \|= (((UWORD16)ch2) << 8) & 0xFF00;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 if (d_ram_loader.d_romcode_version == 0x0410 \|\| d_ram_loader.d_romcode_version == 0x0411) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 bootloader_is_secure_rom = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 if (target_wait((C_WORD32LGB * C_MD5HASHLG), TARGET_RECV_DELAY) < (C_WORD32LGB * C_MD5HASHLG))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 main_fatal(E_RECV_TIMEOUT);
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 for (d_j = 0 ; d_j < (C_WORD32LGB * C_MD5HASHLG) ; d_j++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 d_ram_loader.a_hash_man_pub_key[d_j] = target_getchar();
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 if (target_wait((C_WORD32LGB * C_DIE_ID_SIZE), TARGET_RECV_DELAY) < (C_WORD32LGB * C_DIE_ID_SIZE))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 main_fatal(E_RECV_TIMEOUT);
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 for (d_j = 0 ; d_j < (C_WORD32LGB * C_DIE_ID_SIZE) ; d_j++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 d_ram_loader.a_die_id[d_j] = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 // SIGNALLING RESPONSE
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 f_print_signalling_response(VERBOSE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 if (*arg_die_id_file_name != 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 if ((error = file_write_die_id(&d_ram_loader.a_die_id[0], arg_die_id_file_name)) < 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 flowf(NORMAL, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 main_fatal(error);
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 flowf(NORMAL, "\nDie id retrieved and written to %s.\n", arg_die_id_file_name);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 exit(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 }
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 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 flowf(NORMAL, "\nSecure Calypso Plus ROM Code Version 0x%4.4x is not supported by FLUID.\n", d_ram_loader.d_romcode_version);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 main_fatal(E_BOOTLOADER);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 // End Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 flowf(DEBUG, "?");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 // If target is still not responding, we could not control the reset
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 // line, so we ask the user to reset the target
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 if (i++ == RETRIES_MAX)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 flowf (NORMAL, "(reset target) ");
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 (!bootloader_is_secure_rom)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 flowf(DEBUG, ") ");
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 // Read the command interpreter image file.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 if (bootloader_is_secure_rom)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 target_program_size = file_read_cmd(target_program, TARGET_PROGRAM_SIZE_MAX, a_certified_cmd_file_name);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 target_program_size = file_read_cmd(target_program, TARGET_PROGRAM_SIZE_MAX, "cmd.m0");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 if (target_program_size == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 main_error(E_FILE_EMPTY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 if (bootloader_is_secure_rom)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 bootloader_secure_rom_init();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 else if (bootloader_is_rom)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 bootloader_rom_init();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 bootloader_fluid_init();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 flowf(NORMAL, ") ok\n");
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 void bootloader_fluid_init(void)
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 int divider;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 char version;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 uint8 data[4];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 uint16 chip_id_code;
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 flowf(NORMAL, "(fluid");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 target_clk = 13000000;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 // Now send baudrate to make the target stop sending 'H'ello.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 divider = target_uart_baudrate_divider_get(target_clk, 115200);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 flowf(DEBUG, ", baudrate = ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 target_putchar(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 target_putchar((char) divider);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 flowf(DEBUG, "%d, ", 115200);
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 // Wait a short while before flushing receive buffer. Then make sure
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 // that the target is indeed silent
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 target_wait(0, 10);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 target_recv_reset();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 if (target_wait(1, 50) > 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 main_fatal(E_RECV_ANTITIMEOUT);
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 // NOTEME: The sequence below to query the Bootloader VERSION has to
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 // have 100ms + 100ms delays. It seems as unnecessarily large delays but
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 // practice shows that they cannot be shorter. To be investigated...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 // Get version of bootloader
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 target_putchar(PROTO_VERSION);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 if (target_wait(1, TARGET_RECV_DELAY) < 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 version = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 flowf(NORMAL, ", version %c", version);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 // Bootloader revision 3 and upwards supports generic query
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 if (version < '3') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 main_fatal(E_BOOTLOADER);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 target_trace_enable(1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 target_putchar(PROTO_QUERY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 target_putchar(PROTO_QUERY_CHIP);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 if (target_wait(4, TARGET_RECV_DELAY) < 4)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 target_recv(data, 4);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 chip_id_code = data[0] + (data[1] << 8);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 if (target_type_set(chip_id_code) == 0 \|\| arg_verbose >= VERBOSE) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 flowf(VERBOSE, ", chipid = 0x%04X", chip_id_code);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 if (target_type_set(chip_id_code) == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 main_fatal(E_TARGET_TYPE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 flowf(VERBOSE, ", %s", target[target_type].name);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 }
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 void bootloader_rom_init(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 int error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 char ch, version = '?';
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 // Initialization: 115200 bps, 39 MHz DPLL, no timeout
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 uint8 sendbuf[11] = { '<', 'p', 0x00, 0x0D, 0x14, 0x25,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 0x22, 0x00, 0x00, 0x00, 0x00};
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 // Initialization: 115200 bps, 13 MHz DPLL, no timeout.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 //uint8 sendbuf[11] = { '<', 'p', 0x00, 0x00, 0x1C, 0xE7,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 // 0x22, 0x00, 0x00, 0x00, 0x00 };
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 flowf(NORMAL, "(ROM");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 // Configure/init the ROM bootloader
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 flowf(VERBOSE, ", baudrate = %d", 115200);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 target_send(sendbuf, 11);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 // Wait until DPLL is settled and target responds
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 if (target_wait(4, 300) < 4)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 if ((ch = target_getchar ()) != '>')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 error_proto(ch, '>');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 if ((ch = target_getchar ()) != 'p')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 error_proto(ch, 'p');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 // Receive maximum blocksize
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 bootloader_blocksize_max = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 bootloader_blocksize_max += target_getchar() << 8;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 bootloader_blocksize_max -= 10; // Subtract the block header
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 flowf(DEBUG, ", blocksize = %iB", bootloader_blocksize_max);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 if ((error = target_driver_baudrate (115200)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 flowf(NORMAL, ", version %c", version);
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 // NOTEME: Can we be sure that it is always a Calypso type?
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 target_type_set('c');
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 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 void bootloader_secure_rom_init(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 int error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 UWORD8 d_char;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 UWORD16 d_j;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 // cmdp_cert.m0 has been 16 bit aligned using hex470, so the memory width
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 // parameter is set to 2 bytes.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 buffer_endian_convert(target_program, target_program_size, 2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 // Check if firmware manufacturer certificate stored in flash is requested
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 if (arg_request_certificate) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 // Clear the request
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 arg_request_certificate = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 d_ram_loader.b_certificate_request = C_FALSE;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 // Certificate Request
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 d_frame.a_data[0] = '<';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 d_frame.a_data[1] = 'c';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540 d_frame.d_max_byte = 2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 target_send(&d_frame.a_data[0], d_frame.d_max_byte);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 // Certificate Response
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545 target_expect_char('>', arg_boot_delay_rom);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 target_expect_char('c', arg_boot_delay_rom);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 if (target_wait(2, TARGET_RECV_DELAY) < 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 d_ram_loader.u_firm_cert.a_firm_cert[0] = target_getchar ();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 d_ram_loader.u_firm_cert.a_firm_cert[1] = target_getchar ();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 d_certificate_length = (UWORD16)(d_ram_loader.u_firm_cert.a_firm_cert[0]) & 0xFF;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 d_certificate_length \|= ((UWORD16)(d_ram_loader.u_firm_cert.a_firm_cert[1]) << 8) & 0xFF00;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 // We have already read two bytes of the certificate for the CERT_SIZE
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 // and the certificate signature is handled later.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 for (d_j = 2 ; d_j < d_certificate_length - (C_WORD32LGB * C_MANUF_SIG_SIZE); d_j++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 if (target_wait(1, arg_boot_delay_rom * 4) > 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 d_ram_loader.u_firm_cert.a_firm_cert[d_j] = target_getchar ();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 for (d_j = 0; d_j < (C_WORD32LGB * C_MANUF_SIG_SIZE); d_j++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 if (target_wait(1, arg_boot_delay_rom * 4) > 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 d_ram_loader.a_Certsig[d_j] = target_getchar ();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 d_ram_loader.u_firm_cert.a_firm_cert[d_j + sizeof(T_MANUFACTURER_CERTIFICATE_PLATFORM_DATA) - (C_WORD32LGB * C_MANUF_SIG_SIZE)] = d_ram_loader.a_Certsig[d_j];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 f_print_certificate_platform_data(NORMAL, &d_ram_loader.u_firm_cert.d_firm_cert);
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
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 // Parameter Request
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 d_ram_loader.d_baud_rate = f_convert_uart_baud_rate(arg_uart_baudrate_during_cmd_download);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 d_ram_loader.d_uart_timeout = arg_uart_timeout_configuration; // TODO: Verify that MSB byte is sent in first position.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 d_frame.a_data[0] = '<';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 d_frame.a_data[1] = 'p';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 d_frame.a_data[2] = d_ram_loader.d_baud_rate;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 memcpy(&d_frame.a_data[3], &d_ram_loader.d_uart_timeout, sizeof(UWORD32));
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 d_frame.d_max_byte = 3 + sizeof(UWORD32);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 d_certificate_length = (UWORD16)(target_program[0]) & 0xFF;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 d_certificate_length \|= ((UWORD16)(target_program[1]) & 0xFF) << 8;
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 for (d_j = 0 ; d_j < d_certificate_length; d_j++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 d_ram_loader.u_code_certificate.a_code_certificate[d_j] = target_program[d_j];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 f_print_certificate(DEBUG, &d_ram_loader.u_code_certificate.d_code_certificate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 // Send the data
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 target_send(&d_frame.a_data[0], d_frame.d_max_byte);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 target_send(&target_program[0], d_certificate_length);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 // Parameter Response
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602 if (target_wait(2, TARGET_RECV_DELAY) < 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 if ((d_char = target_getchar ()) != '>')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 error_proto(d_char, '>');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 if ((d_char = target_getchar ()) != 'p') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 if (d_char == 'P') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 // PARAMETER_NACK_RESPONSE
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 if (target_wait(1, arg_boot_delay_rom) >= 1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 d_ram_loader.d_param_req_sts = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 f_print_parameter_nack_status(NORMAL, d_ram_loader.d_param_req_sts);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 error_proto(d_char, 'p');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 // PARAMETER_ACK_RESPONSE
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621 flowf(NORMAL, "\n(Secure ROM");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 if ((error = target_driver_baudrate (arg_uart_baudrate_during_cmd_download)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 // Configure/init the ROM bootloader
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 flowf(VERBOSE, ", UART baud rate during download of flash programmer, %s = %d Kbps", a_certified_cmd_file_name, arg_uart_baudrate_during_cmd_download);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 // End Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632 * Command Interpreter Download
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 int cmd_baudrate(int baudrate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636 void cmd_machine_fluid(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 void cmd_machine_rom(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638 void cmd_machine_secure_rom(void); // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 void cmd_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 char ramcs0, ch;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 uint8 count = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644 uint16 chip_id;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 flowf(VERBOSE, "Command Interpreter: (");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 target_trace_enable(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 if (bootloader_is_secure_rom)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 cmd_machine_secure_rom();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 else if (bootloader_is_rom)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654 cmd_machine_rom();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656 cmd_machine_fluid();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 // Now send 'H'ello command to target and get the response, such as
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659 // hardware type etc.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660 while (count < RETRIES_MAX) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 target_putchar(PROTO_HELLO);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662 if (target_wait(1, TARGET_RECV_DELAY) >= 1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663 ch = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 flowf(DEBUG, ", received %c (0x%2.2x)", ch, ch);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665 if (ch == PROTO_READY)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668 count++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 if (count == RETRIES_MAX)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 if (target_wait(5, TARGET_RECV_DELAY) < 4)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677 chip_id = (target_getchar() & 0xFF);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 chip_id \|= (target_getchar() & 0xFF) << 8;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 ramcs0 = (target_getchar() == 'R');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 ch = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 flowf(BLABBER, ", SRAM = %dk", (1 << ch) / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 target_fifo_size = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 flowf(DEBUG, ", fifo = %d", target_fifo_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685 if (target_type_set(chip_id) == 0 \|\| arg_verbose >= VERBOSE) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 flowf(BLABBER, ", ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 flowf(VERBOSE, "chipid = 0x%04X", chip_id);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 if (target_type_set(chip_id) == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 main_fatal(E_TARGET_TYPE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 flowf(VERBOSE, ", %s", target[target_type].name);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 if (ramcs0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694 flowf(VERBOSE, ", RAM");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 // Configure target
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 target_putchar(PROTO_INIT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 target_putchar(target[target_type].type);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 target_expect_char(PROTO_READY, TARGET_RECV_DELAY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 // Change baudrate. First try to change to new baudrate. If this fails,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 // try 115.2 Kbps. If this also fails, panic and bail out.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 if (arg_uart_baudrate != 115200) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704 flowf(VERBOSE, ", baudrate = ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705 flowf(VERBOSE, "%d", arg_uart_baudrate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 if (!cmd_baudrate(arg_uart_baudrate)) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 arg_uart_baudrate = 115200;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708 flowf(VERBOSE, " %d", arg_uart_baudrate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 if (!cmd_baudrate(arg_uart_baudrate))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713 flowf(VERBOSE, ") ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714 flowf(VERBOSE, "ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718 // There is a bug in ROM code 0x0410 which means that the secure boot
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719 // loader cannot boot if the firmware certificate size is greater than the
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720 // max size of 0xFFF8. A workaround is to change the memory mapping on CS5
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721 // by initially setting DIP switches 9 and 10 to ON and thereby exchanging
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 // the mapping of RAM and flash. While waiting, set the DIP switches back
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723 // to OFF. See SECURITY.txt and BUG03314 in CALPLUS228.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 if (arg_delay_for_changing_cs5 != 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725 flowf(NORMAL, "\nWaiting %d seconds for changing memory mapping on CS5 or connecting via JTAG...\n", arg_delay_for_changing_cs5);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 target_wait(0, arg_delay_for_changing_cs5 * 1000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730 int cmd_baudrate(int baudrate)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 int error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 int divider;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734 char xxo;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736 target_putchar(PROTO_BAUDRATE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737 if (baudrate == 230400 \|\| baudrate == 460800 \|\| baudrate == 921600) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 // Changing the target clock frequency to 14 MHz
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 target_clk = 14745600;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 // If we are using a 14 MHz compatible baud rate, we should enable the
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 // eXternal Xtal Oscillator of the target
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 xxo = PROTO_BAUDRATE_XXO;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 target_clk = 13000000;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 xxo = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749 divider = target_uart_baudrate_divider_get(target_clk, baudrate);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 target_putchar(xxo);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751 target_putchar((char) divider);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753 if ((error = target_driver_baudrate(baudrate)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 // Wait for acknowledgement
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757 if (target_wait(1, 2 * TARGET_RECV_DELAY) >= 1 &&
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 target_getchar() == PROTO_READY) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 return 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 if ((error = target_driver_baudrate(115200)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 return 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768 void cmd_machine_fluid(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 uint8 sendbuf[1+4+2];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 int error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773 // Send 'Download' command header. Then wait for acknowledgement.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774 buf_put1(&sendbuf[0], PROTO_DOWNLOAD);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775 buf_put4(&sendbuf[1], target[target_type].cmd_load_addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 buf_put2(&sendbuf[1+4], (uint16) target_program_size / 2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 target_send(sendbuf, 1+4+2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 flowf(BLABBER, "0x%X", target[target_type].cmd_load_addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 if ((error = target_expect_char(PROTO_READY, TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782 // Send data. Then wait for acknowledgement.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 target_trace_enable(1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 target_send(target_program, target_program_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 flowf(BLABBER, ", %d", target_program_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 void cmd_machine_rom(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790 uint8 sendbuf[10], *buf;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791 int error, i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792 int block_addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 int block_offset = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 int block_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795 uint8 ch, blksum, cksum = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797 // NOTEME: Can we be sure that it is always a Calypso type?
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 target_type_set('c');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 block_addr = target[target_type].cmd_load_addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802 buffer_endian_convert(target_program, target_program_size, 2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804 flowf(BLABBER, "0x%X, ", target[target_type].cmd_load_addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806 // Transfer the target program as blocks
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807 while (block_offset < target_program_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 block_size = target_program_size - block_offset;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	810 if (block_size > bootloader_blocksize_max)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811 block_size = bootloader_blocksize_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 // Initialize block transfer
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 buf = sendbuf;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 buf += buf_put1(buf, '<');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 buf += buf_put1(buf, 'w');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 buf += buf_put1(buf, 0x01); // block index - just use #1 - not important
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818 buf += buf_put1(buf, 0x01); // block number - just use #1 - not important
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 buf += buf_put2no(buf, (uint16) block_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820 buf += buf_put4no(buf, block_addr + block_offset);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	821 target_send(sendbuf, 10);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	822
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823 // Send the data
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824 target_send(&target_program[block_offset], block_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 // Calculate block check-sum
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827 blksum = 5;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828 blksum += block_size & 0x00ff;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829 blksum += (((block_addr + block_offset) & 0xff000000) >> 24);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 blksum += (((block_addr + block_offset) & 0x00ff0000) >> 16);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831 blksum += (((block_addr + block_offset) & 0x0000ff00) >> 8);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 blksum += ( (block_addr + block_offset) & 0x000000ff);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833 for (i = block_offset; i < (block_offset + block_size); i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	834 blksum += target_program[i];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 cksum += ~blksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 block_offset = block_offset + block_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 if ((error = target_expect_char ('>', TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 main_fatal (error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 if ((error = target_expect_char ('w', TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842 main_fatal (error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	844 flowf(BLABBER, ".");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	845 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	846 flowf(BLABBER, ", %d", target_program_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	847 target_wait(0, 100);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	848
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	849 // Request compare of checksum
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	850 target_putchar('<');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	851 target_putchar('c');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	852 target_putchar((char) ~cksum);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	853
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	854 if ((error = target_expect_char('>', TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	855 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 if ((error = target_expect_char('c', TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	857 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	858 if ((error = target_wait(1, TARGET_RECV_DELAY)) < 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	859 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	860 ch = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	861 flowf(DEBUG, ", cksum = 0x%x (0x%x)", ch, cksum);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	862 if (ch != cksum)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	863 main_fatal(E_SEND_CHECKSUM);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	864
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	865 // Branch to code
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	866 buf = sendbuf;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	867 buf += buf_put1(buf, '<');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	868 buf += buf_put1(buf, 'b');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	869 buf += buf_put4no(buf, target[target_type].cmd_load_addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	870 target_send(sendbuf, 6);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	871
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	872 if (target_wait(2, TARGET_RECV_DELAY) < 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	873 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	874 if ((ch = target_getchar()) != '>')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	875 error_proto(ch, '>');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	876 if ((ch = target_getchar()) != 'b')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	877 error_proto(ch, 'b');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	878
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	879 target_wait(0, 100);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	880 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	881
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	882 // Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	883 void cmd_machine_secure_rom(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	884 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	885 UWORD8 d_char;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	886 UWORD16 d_i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	887
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	888 target_type_set('p');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	889 flowf(BLABBER, "0x%X", d_ram_loader.u_code_certificate.d_code_certificate.d_Addcode);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	890 flowf(DEBUG, ")");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	891
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	892 // Prepare the write command
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	893 d_ram_loader.d_nb_byte_in_block = (UWORD32) arg_block_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	894 d_ram_loader.d_nb_byte_sent = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	895 d_ram_loader.d_block_address = d_ram_loader.u_code_certificate.d_code_certificate.d_Addcode;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	896
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	897 while (d_ram_loader.d_nb_byte_sent < d_ram_loader.u_code_certificate.d_code_certificate.d_Codesize) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	898 flowf(DEBUG, "\nCurrent write parameters:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	899 flowf(DEBUG, " Max Number of Bytes in Block: %ld\n", d_ram_loader.d_nb_byte_in_block);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	900 flowf(DEBUG, " Block Address : 0x%8.8lx\n", d_ram_loader.d_block_address);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	901 flowf(DEBUG, " Code Size : %ld\n", d_ram_loader.u_code_certificate.d_code_certificate.d_Codesize);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	902 flowf(DEBUG, " Bytes sent : %ld\n", d_ram_loader.d_nb_byte_sent);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	903
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	904 // Set block size
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	905 d_ram_loader.d_block_size = d_ram_loader.u_code_certificate.d_code_certificate.d_Codesize - d_ram_loader.d_nb_byte_sent;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	906 if (d_ram_loader.d_block_size > d_ram_loader.d_nb_byte_in_block)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	907 d_ram_loader.d_block_size = d_ram_loader.d_nb_byte_in_block;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	908
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	909 flowf(DEBUG, " Block Size : %ld\n", d_ram_loader.d_block_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	910
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	911 // Write Request
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	912 d_frame.a_data[0] = '<';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	913 d_frame.a_data[1] = 'w';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	914
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	915 // Send block size
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	916 for (d_i = 0; d_i < 32; d_i += 8)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	917 d_frame.a_data[2 + d_i / 8] = (UWORD8)(d_ram_loader.d_block_size >> (24 - d_i));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	918
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	919 // Send block address
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	920 for (d_i = 0; d_i < 32; d_i += 8)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	921 d_frame.a_data[2 + sizeof(UWORD32) + d_i / 8] = (UWORD8)(d_ram_loader.d_block_address >> (24 - d_i));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	922
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	923 d_frame.d_max_byte = 2 + sizeof(UWORD32) + sizeof(UWORD32);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	924
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	925 // Send the data
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	926 target_send(&d_frame.a_data[0], d_frame.d_max_byte);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	927 target_send(&target_program[d_certificate_length + d_ram_loader.d_nb_byte_sent], d_ram_loader.d_block_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	928
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	929 // Update next block address
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	930 d_ram_loader.d_block_address += d_ram_loader.d_block_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	931 d_ram_loader.d_nb_byte_sent += d_ram_loader.d_block_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	932
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	933 // Write Response
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	934 if (target_wait(2, TARGET_RECV_DELAY) < 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	935 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	936
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	937 if ((d_char = target_getchar ()) != '>')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	938 error_proto(d_char, '>');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	939
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	940 if ((d_char = target_getchar ()) != 'w') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	941 if (d_char == 'W') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	942 // WRITE_NACK_RESPONSE
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	943 if (target_wait(1, arg_boot_delay_rom) >= 1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	944 d_ram_loader.d_write_status = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	945 f_print_write_nack_status(NORMAL, d_ram_loader.d_write_status);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	946 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	947 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	948 error_proto(d_char, 'w');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	949 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	950
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	951 // WRITE_ACK_RESPONSE
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	952 } // End while
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	953 if (arg_verbose == BLABBER)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	954 flowf(BLABBER, ", ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	955 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	956 flowf(DEBUG, "(");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	957
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	958 flowf(BLABBER, "%d", d_ram_loader.d_nb_byte_sent);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	959 target_wait(0, 100);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	960
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	961 // Abort Request
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	962 d_frame.a_data[0] = '<';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	963 d_frame.a_data[1] = 'a';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	964 d_frame.d_max_byte = 2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	965
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	966 target_send(&d_frame.a_data[0], d_frame.d_max_byte);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	967 target_wait(0, 100);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	968 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	969
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	970 void f_print_signalling_response(int level) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	971 UWORD16 d_i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	972
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	973 flowf(level, "\nSignalling Response:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	974
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	975 flowf(level, " ROM Code Version: 0x%4.4x\n", d_ram_loader.d_romcode_version);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	976
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	977 flowf(level, " Hash (ManPubKey): ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	978 for (d_i = 0; d_i < (C_WORD32LGB * C_MD5HASHLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	979 if (d_i == (C_WORD32LGB * C_MD5HASHLG) / 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	980 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	981 flowf(level, "0x%2.2x ", d_ram_loader.a_hash_man_pub_key[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	982 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	983 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	984
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	985 flowf(level, " Die Id : ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	986 for (d_i = 0; d_i < (C_WORD32LGB * C_DIE_ID_SIZE); d_i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	987 flowf(level, "0x%2.2x ", d_ram_loader.a_die_id[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	988 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	989 } /* f_print_signalling_response() */
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	990
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	991 void f_print_certificate_platform_data(int level, T_MANUFACTURER_CERTIFICATE_PLATFORM_DATA *p_certificate) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	992 UWORD16 d_i, d_j, d_max = 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	993
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	994 flowf(level, "\nFirmware Manufacturer Certificate:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	995 flowf(level, "----------------------------------\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	996
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	997 flowf(level, " Size of Certificate: %d bytes\n", p_certificate->d_manufacturer_certificate.d_Certsize);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	998 flowf(level, " Type of Certificate: 0x%2.2x\n", p_certificate->d_manufacturer_certificate.d_Certtype);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	999 flowf(level, " Emulation Request : 0x%2.2x\n", p_certificate->d_manufacturer_certificate.d_Debugrequest);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1000 flowf(level, " Address of Code : 0x%8.8lx\n", p_certificate->d_manufacturer_certificate.d_Addcode);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1001 flowf(level, " Size of Code : %ld bytes\n", p_certificate->d_manufacturer_certificate.d_Codesize);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1002 flowf(level, " Entry Point Address: 0x%8.8lx\n", p_certificate->d_manufacturer_certificate.d_CodeStartAdd);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1003
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1004 flowf(level, " Manufacturer Public Key:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1005 flowf(level, " Public Modulus:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1006 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1007 for (d_i = 0; d_i < (C_RSAKEYLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1008 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1009 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1010 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1011 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1012 flowf(level, "0x%8.8lx ", p_certificate->d_manufacturer_certificate.d_Manpubkey.a_Modulus[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1013 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1014 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1015 flowf(level, " Public Modulus Length:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1016 flowf(level, " 0x%8.8lx\n", p_certificate->d_manufacturer_certificate.d_Manpubkey.d_ModulusLength);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1017 flowf(level, " Public Exponent:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1018 flowf(level, " 0x%8.8lx\n", p_certificate->d_manufacturer_certificate.d_Manpubkey.d_Exponent);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1019
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1020 flowf(level, " Originator Public Key:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1021 flowf(level, " Public Modulus:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1022 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1023 for (d_i = 0; d_i < (C_RSAKEYLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1024 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1025 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1026 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1027 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1028 flowf(level, "0x%8.8lx ", p_certificate->d_manufacturer_certificate.d_Origpubkey.a_Modulus[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1029 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1030 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1031 flowf(level, " Public Modulus Length:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1032 flowf(level, " 0x%8.8lx\n", p_certificate->d_manufacturer_certificate.d_Origpubkey.d_ModulusLength);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1033 flowf(level, " Public Exponent:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1034 flowf(level, " 0x%8.8lx\n", p_certificate->d_manufacturer_certificate.d_Origpubkey.d_Exponent);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1035
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1036 flowf(level, " Originator Public Key Signature:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1037 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1038 for (d_i = 0; d_i < (C_RSASIGLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1039 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1040 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1041 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1042 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1043 flowf(level, "0x%8.8lx ", p_certificate->d_manufacturer_certificate.a_Origpubkeysig[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1044 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1045 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1046
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1047 flowf(level, " Software Signature:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1048 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1049 for (d_i = 0; d_i < (C_RSASIGLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1050 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1051 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1052 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1053 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1054 flowf(level, "0x%8.8lx ", p_certificate->d_manufacturer_certificate.a_Swsig[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1055 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1056 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1057
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1058 flowf(level, " Configuration Parameters:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1059 flowf(level, " CONF_CS5 register: %4.4x\n",p_certificate->d_manufacturer_certificate.d_Confparam.d_conf_cs5);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1060 flowf(level, " EXWS_CS5 register: %4.4x\n",p_certificate->d_manufacturer_certificate.d_Confparam.d_exws_cs5);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1061 flowf(level, " EX_CTRL register : %4.4x\n",p_certificate->d_manufacturer_certificate.d_Confparam.d_ex_ctrl);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1062 flowf(level, " CS image request : %4.4x\n",p_certificate->d_manufacturer_certificate.d_Confparam.d_cs_img_req);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1063 flowf(level, " Flash size : %ld bytes\n",p_certificate->d_manufacturer_certificate.d_Confparam.d_flash_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1064 flowf(level, " Granularity : %ld words\n",p_certificate->d_manufacturer_certificate.d_Confparam.d_granularity);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1065
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1066 flowf(level, " Die Id: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1067 for(d_i = 0; d_i < (C_DIE_ID_SIZE); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1068 flowf(level, "0x%8.8lx ", p_certificate->d_manufacturer_certificate.a_die_id[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1069 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1070 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1071
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1072 if (p_certificate->d_manufacturer_certificate.d_Certsize > (sizeof(T_MANUFACTURER_CERTIFICATE) + (C_WORD32LGB * C_MANUF_SIG_SIZE))) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1073 flowf(level, " Platform Data:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1074 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1075 for(d_i = 0; d_i < (p_certificate->d_manufacturer_certificate.d_Certsize - sizeof(T_MANUFACTURER_CERTIFICATE) - (C_WORD32LGB * C_MANUF_SIG_SIZE)) / sizeof(UWORD32); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1076 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1077 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1078 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1079 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1080 flowf(level, "0x%8.8lx ", p_certificate->a_platform_data[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1081 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1082 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1083 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1084
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1085 flowf(level, " Certificate Signature:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1086 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1087 for (d_i = 0; d_i < (C_MANUF_SIG_SIZE); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1088 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1089 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1090 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1091 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1092 flowf(level, "0x%8.8lx ", p_certificate->a_Certsig[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1093 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1094 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1095 } /* f_print_certificate_platform_data() */
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1096
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1097 void f_print_certificate(int level, T_MANUFACTURER_CERTIFICATE_FLASH_PROGRAMMER *p_certificate) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1098 UWORD16 d_i, d_j, d_max = 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1099
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1100 flowf(level, "\nFlash Programmer Manufacturer Certificate:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1101 flowf(level, "------------------------------------------\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1102
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1103 flowf(level, " Size of Certificate: %d bytes\n", p_certificate->d_Certsize);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1104 flowf(level, " Type of Certificate: 0x%2.2x\n", p_certificate->d_Certtype);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1105 flowf(level, " Emulation Request : 0x%2.2x\n", p_certificate->d_Debugrequest);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1106 flowf(level, " Address of Code : 0x%8.8lx\n", p_certificate->d_Addcode);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1107 flowf(level, " Size of Code : %ld bytes\n", p_certificate->d_Codesize);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1108 flowf(level, " Entry Point Address: 0x%8.8lx\n", p_certificate->d_CodeStartAdd);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1109
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1110 flowf(level, " Manufacturer Public key:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1111 flowf(level, " Public Modulus:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1112 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1113 for (d_i = 0; d_i < (C_RSAKEYLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1114 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1115 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1116 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1117 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1118 flowf(level, "0x%8.8lx ", p_certificate->d_Manpubkey.a_Modulus[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1119 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1120 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1121 flowf(level, " Public Modulus Length:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1122 flowf(level, " 0x%8.8lx\n", p_certificate->d_Manpubkey.d_ModulusLength);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1123 flowf(level, " Public Exponent:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1124 flowf(level, " 0x%8.8lx\n", p_certificate->d_Manpubkey.d_Exponent);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1125
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1126 flowf(level, " Originator Public key:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1127 flowf(level, " Public Modulus:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1128 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1129 for (d_i = 0; d_i < (C_RSAKEYLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1130 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1131 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1132 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1133 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1134 flowf(level, "0x%8.8lx ", p_certificate->d_Origpubkey.a_Modulus[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1135 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1136 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1137 flowf(level, " Public Modulus Length:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1138 flowf(level, " 0x%8.8lx\n", p_certificate->d_Origpubkey.d_ModulusLength);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1139 flowf(level, " Public Exponent:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1140 flowf(level, " 0x%8.8lx\n", p_certificate->d_Origpubkey.d_Exponent);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1141
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1142 flowf(level, " Originator Public Key Signature:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1143 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1144 for (d_i = 0; d_i < (C_RSASIGLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1145 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1146 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1147 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1148 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1149 flowf(level, "0x%8.8lx ", p_certificate->a_Origpubkeysig[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1150 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1151 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1152
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1153 flowf(level, " Software Signature:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1154 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1155 for (d_i = 0; d_i < (C_RSASIGLG); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1156 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1157 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1158 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1159 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1160 flowf(level, "0x%8.8lx ", p_certificate->a_Swsig[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1161 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1162 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1163
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1164 flowf(level, " Configuration Parameters:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1165 flowf(level, " CONF_CS5 register: %4.4x\n",p_certificate->d_Confparam.d_conf_cs5);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1166 flowf(level, " EXWS_CS5 register: %4.4x\n",p_certificate->d_Confparam.d_exws_cs5);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1167 flowf(level, " EX_CTRL register : %4.4x\n",p_certificate->d_Confparam.d_ex_ctrl);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1168 flowf(level, " CS image request : %4.4x\n",p_certificate->d_Confparam.d_cs_img_req);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1169 flowf(level, " Flash size : %ld bytes\n",p_certificate->d_Confparam.d_flash_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1170 flowf(level, " Granularity : %ld words\n",p_certificate->d_Confparam.d_granularity);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1171
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1172 flowf(level, " Die Id: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1173 for(d_i = 0; d_i < (C_DIE_ID_SIZE); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1174 flowf(level, "0x%8.8lx ", p_certificate->a_die_id[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1175 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1176 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1177
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1178 flowf(level, " Certificate Signature:");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1179 d_j = d_max;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1180 for (d_i = 0; d_i < (C_MANUF_SIG_SIZE); d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1181 if (d_j++ == d_max) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1182 flowf(level, "\n ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1183 d_j = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1184 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1185 flowf(level, "0x%8.8lx ", p_certificate->a_Certsig[d_i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1186 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1187 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1188 } /* f_print_certificate() */
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1189
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1190 void f_print_parameter_nack_status(int level, UWORD8 d_parameter_nack_sts) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1191 flowf(level, "\nParameter NAck Response Status:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1192 flowf(level, " 0x%2.2x", d_parameter_nack_sts);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1193
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1194 switch(d_parameter_nack_sts) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1195 case 0x01 : { flowf(level, " Incorrect baud rate\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1196 case 0x02 : { flowf(level, " Incorrect certificate\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1197 case 0x03 : { flowf(level, " Incorrect code address\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1198 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1199
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1200 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1201 } /* f_print_parameter_nack_status() */
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1202
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1203 void f_print_write_nack_status(int level, UWORD8 d_write_nack_sts) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1204 flowf(level, "\nWrite NAck Response Status:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1205 flowf(level, " 0x%2.2x", d_write_nack_sts);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1206
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1207 switch(d_write_nack_sts) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1208 case 0x01 : { flowf(level, " Incorrect block address\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1209 case 0x02 : { flowf(level, " Non-64 bytes block size\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1210 case 0x03 : { flowf(level, " First block is not code address\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1211 case 0x04 : { flowf(level, " Error in firmware signature check\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1212 case 0x05 : { flowf(level, " Received code size does not match the code size in certificate\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1213 case 0x06 : { flowf(level, " Error during block hashing\n"); break; }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1214 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1215
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1216 flowf(level, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1217 } /* f_print_write_nack_status() */
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1218
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1219 UWORD8 f_convert_uart_baud_rate(UWORD32 d_baud_rate) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1220 UWORD8 d_converted_baud_rate;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1221
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1222 switch (d_baud_rate) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1223 case 0:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1224 case 812:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1225 case 812500: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1226 d_converted_baud_rate = 0x00;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1227 arg_uart_baudrate_during_cmd_download = 812500;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1228 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1229 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1230 case 1:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1231 case 406:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1232 case 406250: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1233 d_converted_baud_rate = 0x01;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1234 arg_uart_baudrate_during_cmd_download = 406250;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1235 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1236 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1237 case 2:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1238 case 203:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1239 case 203125: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1240 d_converted_baud_rate = 0x02;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1241 arg_uart_baudrate_during_cmd_download = 203125;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1242 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1243 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1244 case 3:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1245 case 115:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1246 case 115200: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1247 d_converted_baud_rate = 0x03;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1248 arg_uart_baudrate_during_cmd_download = 115200;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1249 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1250 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1251 case 4:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1252 case 57:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1253 case 57600: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1254 d_converted_baud_rate = 0x04;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1255 arg_uart_baudrate_during_cmd_download = 57600;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1256 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1257 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1258 case 5:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1259 case 38:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1260 case 38400: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1261 d_converted_baud_rate = 0x05;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1262 arg_uart_baudrate_during_cmd_download = 38400;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1263 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1264 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1265 case 6:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1266 case 28:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1267 case 28800: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1268 d_converted_baud_rate = 0x06;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1269 arg_uart_baudrate_during_cmd_download = 28800;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1270 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1271 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1272 case 7:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1273 case 19:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1274 case 19200: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1275 d_converted_baud_rate = 0x07;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1276 arg_uart_baudrate_during_cmd_download = 19200;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1277 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1278 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1279 default: {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1280 d_converted_baud_rate = 0x03;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1281 arg_uart_baudrate_during_cmd_download = 115200;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1282 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1283 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1284 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1285
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1286 return d_converted_baud_rate;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1287 } /* f_convert_uart_baud_rate() */
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1288
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1289 void target_imei_protection(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1290 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1291 uint8 a_imeisv[C_IMEISV_BYTES];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1292 uint8 a_platform_cert_addr[C_PLATFORM_CERT_ADDR_BYTES];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1293 uint8 d_i, d_digit, d_temp;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1294 uint8 d_error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1295
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1296 flowf(NORMAL, "\nIMEI protection: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1297
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1298 if (arg_dry_run) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1299 flowf(NORMAL, "(dry-run) ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1300 return;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1301 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1302
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1303 target_putchar(PROTO_IMEI_PROTECT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1304
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1305 // Send IMEI-SV
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1306 for (d_i = 0; d_i < C_IMEISV_DIGITS; d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1307 sscanf(arg_imeisv++, "%1d", &d_digit);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1308 if (!(d_i & 1))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1309 d_temp = d_digit << 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1310 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1311 d_temp \|= d_digit;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1312 a_imeisv[d_i / 2] = d_temp;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1313 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1314 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1315
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1316 target_send(a_imeisv, C_IMEISV_BYTES);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1317 target_expect_char(PROTO_READY, TARGET_RECV_DELAY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1318
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1319 // Send platform certificate address
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1320 for (d_i = 0; d_i < C_PLATFORM_CERT_ADDR_DIGITS; d_i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1321 sscanf(arg_platform_certificate_addr++, "%1x", &d_digit);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1322 if (!(d_i & 1))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1323 d_temp = d_digit << 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1324 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1325 d_temp \|= d_digit;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1326 a_platform_cert_addr[d_i / 2] = d_temp;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1327 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1328 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1329
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1330 target_send(a_platform_cert_addr, C_PLATFORM_CERT_ADDR_BYTES);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1331 target_expect_char(PROTO_READY, TARGET_RECV_DELAY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1332
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1333 // Check if address range is erased
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1334 if (target_wait(1, TARGET_RECV_DELAY) < 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1335 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1336
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1337 d_error = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1338 if (d_error == PROTO_ERROR_VERIFY) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1339 flowf(NORMAL, "\n The address range for platform certificate and IMEI-SV is not erased.\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1340 main_fatal(E_FLASH_VERIFY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1341 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1342
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1343 if (d_error != PROTO_READY)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1344 error_proto(d_error, PROTO_READY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1345
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1346 // Verify that the binding service call in target has succeeded
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1347 if (target_wait(1, TARGET_RECV_DELAY) < 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1348 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1349
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1350 d_error = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1351 if (d_error == PROTO_ERROR_ROM_SSERVICE) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1352 flowf(NORMAL, "\n The Run-Time Loader (Binding) Service failed.\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1353 main_fatal(E_ROM_SSERVICE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1354 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1355
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1356 if (d_error != PROTO_FLASH_START)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1357 error_proto(d_error, PROTO_FLASH_START);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1358
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1359 // Receive acknowledgement for programming the platform certificate
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1360 if (target_wait(1, TARGET_RECV_DELAY) < 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1361 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1362
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1363 d_error = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1364 if (d_error != PROTO_PROGRAM) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1365 flowf(NORMAL, "\n Platform certificate was not stored correctly in flash.\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1366 error_proto(d_error, PROTO_PROGRAM);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1367 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1368
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1369 // Receive acknowledgement for programming the IMEI-SV
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1370 if (target_wait(1, TARGET_RECV_DELAY) < 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1371 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1372
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1373 d_error = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1374 if (d_error != PROTO_PROGRAM) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1375 flowf(NORMAL, "\n IMEI-SV was not stored correctly in flash.\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1376 error_proto(d_error, PROTO_PROGRAM);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1377 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1378
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1379 flowf(NORMAL, "Platform certificate and IMEI-SV stored in flash.\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1380 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1381
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1382 // End Secure Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1383
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1384 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1385 * Flash Detect
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1386 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1387
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1388 void flash_detect_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1389 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1390 uint8 data[12];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1391 uint16 m0, d0, m1, d1, d1ex1, d1ex2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1392
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1393 flowf(NORMAL, "Flash Detect: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1394 target_trace_enable(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1395
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1396 if (arg_device_id0 != -1 \|\| arg_device_id1 != -1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1397 // Device auto-detection is disabled
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1398 m0 = m1 = arg_device_id0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1399 d0 = d1 = arg_device_id1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1400 flowf(VERBOSE, "(ID override) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1401 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1402 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1403 target_putchar(PROTO_DETECT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1404 if (target_wait(12, TARGET_RECV_DELAY) < 12)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1405 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1406
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1407 target_recv(data, 12);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1408 m0 = data[0] + (data[1] << 8); // Intel manufacturer id
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1409 d0 = data[2] + (data[3] << 8); // Intel device id
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1410 m1 = data[4] + (data[5] << 8); // AMD manufacturer id
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1411 d1 = data[6] + (data[7] << 8); // AMD device di
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1412 d1ex1 = data[8] + (data[9] << 8); // AMD extended device id
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1413 d1ex2 = data[10] + (data[11] << 8); // AMD extended device id
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1414 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1415
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1416 // Lookup multi-id device
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1417 if ((m1 == MANUFACT_AMD \|\| m1 == MANUFACT_FUJITSU) && d1 == 0x227E) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1418 flowf(NORMAL, "Multi-id device detected: (0x%04X, 0x%04X, 0x%04X)\n"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1419 , d1, d1ex1, d1ex2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1420 d1 = (d1ex1 << 8) \| (d1ex2 & 0xFF);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1421 flowf(DEBUG, "Multi-id converted to: 0x%04X\n", d1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1422
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1423 if ((device = device_lookup_by_id(m1, d1)) == NULL) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1424 flowf(NORMAL, "Id not found, lookup default multi-id conf.\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1425 // Backward compatible/keep default multi-id configuration
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1426 device = device_lookup_by_id(m1, 0x227E);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1427 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1428 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1429
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1430 // Lookup device with AMD and Intel ids
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1431 else if ((device = device_lookup_by_id(m1, d1)) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1432 device = device_lookup_by_id(m0, d0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1433
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1434 if (device == NULL \|\| arg_verbose >= DEBUG) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1435 flowf(NORMAL, "(0x%02X, 0x%04X, 0x%02X, 0x%04X) ", m0, d0, m1, d1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1436 if (device == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1437 main_fatal(E_FLASH_UNKNOWN);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1438 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1439
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1440 if (arg_verbose >= NORMAL) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1441 device_print(device, 's');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1442 flowf(NORMAL, " ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1443 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1444
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1445 // Note that device_id is only 0x227E if the Multi-id configuration not
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1446 // is found in device.txt (else device_id will be the 'converted' id)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1447 if (arg_device_id0 == -1 && arg_device_id1 == -1 &&
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1448 (device->manufacturer_id == MANUFACT_FUJITSU \|\|
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1449 device->manufacturer_id == MANUFACT_AMD )
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1450 && device->device_id == 0x227E) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1451 flowf(NORMAL, "Warning: Extended device codes are supported when detecting flash devices,\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1452 flowf(NORMAL, " but the detected multi-id configuration is not found in device.txt. \n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1453 flowf(NORMAL, " Update the device.txt manually if the default flash device is invalid.\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1454 flowf(NORMAL, " Currently, %s %s is used as default.\n\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1455 manufacturer_name_lookup_by_id(device->manufacturer_id), device->name);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1456 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1457 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1458
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1459
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1460 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1461 * Method Load
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1462 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1463
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1464 void method_download_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1465 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1466 char sendbuf[1+2+4];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1467 int error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1468
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1469 target_program_size = file_read_method(target_program,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1470 TARGET_PROGRAM_SIZE_MAX,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1471 device);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1472
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1473 flowf(BLABBER, "Method Download: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1474 target_trace_enable(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1475
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1476 // Send 'Download' command header. Then wait for acknowledgement.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1477 buf_put1(&sendbuf[0], PROTO_DOWNLOAD);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1478 buf_put4(&sendbuf[1], target[target_type].method_load_addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1479 buf_put2(&sendbuf[1+4], (uint16) target_program_size / 2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1480 target_send(sendbuf, 1+4+2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1481 flowf(BLABBER, "(0x%X", target[target_type].method_load_addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1482 if ((error = target_expect_char(PROTO_READY, TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1483 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1484
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1485 // Send data. Then wait for acknowledgement.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1486 target_trace_enable(1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1487 target_send(target_program, target_program_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1488 flowf(BLABBER, ", %d) ", target_program_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1489 if ((error = target_expect_char(PROTO_READY, TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1490 main_fatal(error);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1491
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1492 flowf(BLABBER, "ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1493 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1494
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1495
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1496 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1497 * Flash Checksum
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1498 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1499
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1500 int time_checksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1501
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1502 #define CHECKSUMS 8
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1503
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1504 void flash_checksum_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1505 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1506 unsigned char sendbuf[1+1+4+4CHECKSUMS], buf;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1507 uint32 addr, cksum, mycksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1508 uint16 word;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1509 uint8 data[4];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1510 int index = 0, chunks, n, i, j;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1511 int line = -1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1512 struct {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1513 uint32 index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1514 uint32 addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1515 uint32 mycksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1516 } block[CHECKSUMS];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1517
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1518 chunks = image_map_count_used_chunks();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1519 flowf(NORMAL, "Checksumming (%d * %dkB = %dkB): ",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1520 chunks, image_chunk_size / 1024,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1521 chunks * image_chunk_size / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1522 target_trace_enable(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1523
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1524 time_checksum = stopwatch_start();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1525 while (chunks > 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1526 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1527 n = (chunks > CHECKSUMS ? CHECKSUMS : chunks);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1528
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1529 buf = sendbuf;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1530 buf += buf_put1(buf, PROTO_CHECKSUM);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1531 buf += buf_put1(buf, (unsigned char) n);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1532 buf += buf_put4(buf, image_chunk_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1533
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1534 for (i = 0; i < n; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1535 // Find next used entry in image_map
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1536 while (image_map[index] != 'x' && index < image_map_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1537 index++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1538
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1539 if (index == image_map_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1540 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1541
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1542 addr = index * image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1543 block[i].index = index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1544 block[i].addr = addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1545
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1546 buf += buf_put4(buf, addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1547
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1548 index++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1549 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1550 target_send(sendbuf, buf - sendbuf);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1551
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1552 // Compute checksums while we wait for reply
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1553 for (i = 0; i < n; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1554 index = block[i].index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1555 addr = block[i].addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1556 for (j = 0, mycksum = 0; j < image_chunk_size; j += 2) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1557 word = (image[addr + j + 1] << 8) \| image[addr + j + 0];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1558 mycksum += word * ((addr + j) & 0xFFFF);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1559 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1560 block[i].mycksum = mycksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1561 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1562
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1563 if (target_wait(4 * n, TARGET_RECV_LONG_DELAY) <= 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1564 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1565
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1566 for (i = 0; i < n; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1567 target_recv(data, 4);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1568 cksum = data[0] + (data[1] << 8) + (data[2] << 16) + (data[3] << 24);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1569 mycksum = block[i].mycksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1570 index = block[i].index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1571
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1572 if (cksum == mycksum)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1573 image_map[index] = 'c';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1574
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1575 if (arg_checksum_show) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1576 // This is a far from perfect dump of checksums... We don't know
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1577 // the exact block number of each checksum in a line.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1578 if (line != (int) index / 4) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1579 flowf(NORMAL, "\n%4d:", index);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1580 line = index / 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1581 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1582 if (cksum == mycksum)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1583 flowf(NORMAL, "%08X ", cksum);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1584 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1585 flowf(NORMAL, "%08X/%08X ", cksum, mycksum);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1586
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1587 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1588 else if (arg_verbose >= VERBOSE) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1589 flowf(VERBOSE, "%c", (image_map[index] == 'c' ? 'c' : '.'));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1590 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1591 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1592 index++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1593 chunks -= n;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1594 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1595 time_checksum = (stopwatch_stop(time_checksum) + 50) / 100;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1596 flowf(BLABBER, " (%d.%ds)", time_checksum / 10, time_checksum % 10);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1597 flowf(NORMAL, " ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1598 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1599
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1600
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1601 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1602 * Flash Program
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1603 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1604
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1605 int time_program;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1606 int programs_recv, programs_send, erasures;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1607 int index, src_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1608 uint32 dst;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1609 char *src;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1610
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1611 void flash_erase_machine(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1612 int flash_operation_wait(int delay);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1613 int flash_program_next(void);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1614
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1615 void flash_program_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1616 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1617 uint8 cksum, sendbuf[1+4+4];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1618 int i, te, tp, tt;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1619 int expected, chunks, total_size, sectors;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1620 int image_chunk_size_old = image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1621 char ch;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1622
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1623 programs_recv = programs_send = erasures = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1624 index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1625
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1626 // Prepare erase
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1627 erase_list_size = sectors = sector_map_init();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1628 i = image_map_count_used_chunks();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1629
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1630 if (arg_skip_erase)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1631 erase_list_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1632
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1633 time_compute(device, erase_list_size,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1634 i * image_chunk_size, i, &te, &tp, &tt);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1635
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1636 flowf(BLABBER, "Estimated time (uncompressed) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1637 if (te + tp > tt)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1638 flowf(BLABBER, "(erase + program = total): %ds + %ds = %ds\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1639 te/1000, tp/1000, te/1000 + tp/1000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1640 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1641 flowf(BLABBER, "transfer: %ds\n", tt/1000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1642
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1643 chunks = image_map_count_used_chunks();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1644 flowf(NORMAL, "Program: (%d sectors, %d*%dk=%dk) ",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1645 sectors,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1646 chunks, image_chunk_size / 1024,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1647 chunks * image_chunk_size / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1648 target_trace_enable(1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1649
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1650 // Expected total number of acknowledgements
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1651 expected = erase_list_size + chunks;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1652
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1653 if (arg_dry_run) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1654 flowf(NORMAL, "(dry-run) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1655 if (arg_dry_run == 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1656 image_chunk_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1657 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1658
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1659 if (arg_skip_erase)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1660 flowf(NORMAL, "(skip erase) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1661
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1662 // Start erase
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1663 flash_erase_machine();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1664
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1665 if (arg_dry_run == 0 \|\| arg_dry_run == 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1666 progress_begin(expected);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1667
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1668 // Start the flash state machine in the target
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1669 target_putchar(PROTO_FLASH_START);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1670 target_putchar(arg_compress ? PROTO_COMPRESS : 0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1671 ch = flash_operation_wait(TARGET_RECV_DELAY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1672 if (ch != PROTO_READY)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1673 error_proto(ch, PROTO_READY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1674 if (arg_compress) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1675 compress_init();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1676 total_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1677 // Worst case "compressed" buffer is 9/8 of original data size.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1678 if ((src = malloc(9 * image_chunk_size / 8)) == NULL)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1679 main_fatal(E_MEMORY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1680 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1681
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1682 time_program = stopwatch_start();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1683
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1684 if (flash_program_next() && *arg_erase_override == 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1685 //Nothing to program
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1686 target_putchar(PROTO_FLASH_END);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1687 if ((ch = target_expect_char(PROTO_FLASH_END, TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1688 main_fatal(ch);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1689 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1690 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1691 while (programs_recv + erasures < expected) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1692 total_size += src_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1693
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1694 if (arg_progress == 'x')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1695 flowf(NORMAL, "(0x%06X, %d) ", dst, src_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1696
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1697 if (src_size > 0 &&
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1698 (arg_dry_run == 0 \|\| arg_dry_run == 2))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1699 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1700 buf_put1(&sendbuf[0], PROTO_PROGRAM);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1701 buf_put4(&sendbuf[1], src_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1702 buf_put4(&sendbuf[1+4], dst);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1703 target_send(sendbuf, 1+4+4);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1704
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1705 for (i = 0, cksum = 0; i < src_size; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1706 cksum += src[i];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1707 cksum = (0x100 - cksum) & 0xFF;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1708
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1709 // Wait for acknowledgement of command start
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1710 //while ((ch = flash_operation_wait(4000)) != PROTO_READY)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1711 // ;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1712
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1713 // Make sure that the target FIFO not is full
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1714 while (programs_send - programs_recv >= target_fifo_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1715 flash_operation_wait(4000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1716
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1717 // Send data bytes and checksum.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1718 target_send(src, src_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1719 target_putchar(cksum);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1720 programs_send++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1721
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1722 if (arg_verbose >= DEBUG)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1723 progress_update_simple('T');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1724 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1725
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1726 // We compress and send next block while sending
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1727 // current block to target
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1728 if (arg_dry_run == 0 \|\| arg_dry_run == 2) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1729 if (flash_program_next()) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1730 // Wait for remaining acknowledgements
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1731 flowf(DEBUG, "W%d", expected - (programs_recv + erasures));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1732 while (programs_recv + erasures < expected)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1733 flash_operation_wait(4000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1734 target_putchar(PROTO_FLASH_END);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1735 if ((ch = target_expect_char(PROTO_FLASH_END, TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1736 main_fatal(ch);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1737 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1738 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1739 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1740 // Wait for acknowledgement of data transfer
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1741 while ((ch = flash_operation_wait(4000)) != PROTO_READY)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1742 ;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1743 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1744 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1745 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1746 if (flash_program_next())
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1747 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1748 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1749 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1750 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1751
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1752 if (arg_dry_run == 0 \|\| arg_dry_run == 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1753 progress_end(programs_recv + erasures);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1754 flowf(NORMAL, "ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1755
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1756 time_program = stopwatch_stop(time_program);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1757 flowf(VERBOSE, "Used time: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1758 if (arg_compress && chunks) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1759 image_chunk_size = image_chunk_size_old;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1760 flowf(VERBOSE, "(compressed to %d%%) ",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1761 100 * total_size / (chunks * image_chunk_size));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1762 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1763 flowf(VERBOSE, "%.1fs ok\n", (double) time_program / 1000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1764 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1765
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1766
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1767 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1768 * Flash Program sub functions
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1769 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1770
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1771 void flash_erase_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1772 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1773 uint8 sendbuf[1+2+4*256]; // NOTEME: static limit!
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1774 int i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1775 char ch;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1776
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1777 if (arg_dry_run)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1778 erase_list_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1779
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1780 if (erase_list_size > 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1781 buf_put1(&sendbuf[0], PROTO_ERASE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1782 buf_put2(&sendbuf[1], (uint16) erase_list_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1783 for (i = 0; i < erase_list_size; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1784 buf_put4(&sendbuf[1+2+4*i], erase_list[i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1785 target_send(sendbuf, 1+2+4*erase_list_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1786
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1787 if ((ch = target_expect_char(PROTO_READY, TARGET_RECV_DELAY)) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1788 main_fatal(ch);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1789 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1790 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1791
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1792 // Setup address and size of next block to transfer. Also compress the
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1793 // block. Return non-zero if this was the last block. Otherwise return zero.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1794 int flash_program_next(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1795 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1796 int oldindex;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1797
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1798 // Find next used entry in image_map
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1799 while (index < image_map_size && image_map[index] != 'x')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1800 index++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1801
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1802 oldindex = index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1803
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1804 if (index < image_map_size) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1805 dst = index * image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1806 if (arg_compress) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1807 src_size = compress(src, &image[dst], image_chunk_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1808 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1809 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1810 src = &image[dst];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1811 src_size = image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1812 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1813 index++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1814 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1815 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1816 dst = 0xFFFFFFFF;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1817 src_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1818 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1819
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1820 return (oldindex >= image_map_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1821 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1822
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1823 int flash_operation_wait(int delay)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1824 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1825 int n;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1826 char ch;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1827
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1828 tr(TrMachines, "fow() ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1829
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1830 if ((n = target_wait(1, delay)) < 1)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1831 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1832
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1833 // Minor optimization to avoid waiting for every char...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1834 while (n--) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1835 ch = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1836
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1837 if (ch == PROTO_READY) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1838 if (arg_verbose >= DEBUG)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1839 progress_update_simple('R');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1840 if (programs_send - programs_recv >= target_fifo_size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1841 progress_update_simple('W'); // Wait target FIFO is full
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1842 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1843 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1844
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1845 switch (ch) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1846 case PROTO_READY:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1847 break; // just return the char
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1848 case PROTO_PROGRAM:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1849 programs_recv++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1850 progress_update_simple('P');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1851 progress_update(programs_recv + erasures);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1852 break; // just return the char
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1853 case PROTO_ERASE:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1854 erasures++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1855 progress_update_simple('E');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1856 progress_update(programs_recv + erasures);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1857 if (arg_progress == 'x')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1858 flowf(NORMAL, "E ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1859 break; // just return the char
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1860 case PROTO_FLASH_END:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1861 progress_update_simple('Z');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1862 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1863 case PROTO_ERROR_CKSUM:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1864 main_fatal(E_SEND_CHECKSUM);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1865 case PROTO_ERROR_MEMORY:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1866 main_fatal(E_MEMORY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1867 case PROTO_ERROR_VERIFY:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1868 main_fatal(E_FLASH_VERIFY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1869 case PROTO_ERROR_FLASH_TIMEOUT:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1870 main_fatal(E_FLASH_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1871 case PROTO_ERROR_FLASH_COMMAND:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1872 main_fatal(E_FLASH_COMMAND);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1873 case PROTO_ERROR_FLASH_VPP:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1874 main_fatal(E_FLASH_VPPRANGE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1875 case PROTO_ERROR_FLASH_LOCKED:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1876 main_fatal(E_FLASH_LOCKED);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1877 case PROTO_ERROR_FLASH_UNKNOWN:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1878 main_fatal(E_FLASH_ERROR);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1879 case PROTO_ERROR_INVALID:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1880 main_fatal(E_INVALID);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1881 case PROTO_ERROR_FIFO_OVERFLOW:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1882 main_fatal(E_FIFO_OVERFLOW);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1883 case PROTO_ERROR:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1884 default:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1885 flowf(NORMAL, "flash_operation_wait() got unexpected char '%c' 0x%02X (%d chars waiting)\n", (' ' <= ch && ch < 127 ? ch : '.'), ch, n);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1886 // main_fatal(E_PROTO_ERROR);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1887 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1888 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1889
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1890 return ch;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1891 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1892
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1893 void target_timers_show(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1894 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1895 int data[8], i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1896 struct {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1897 double erase;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1898 double program;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1899 double recvonly;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1900 double recv;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1901 double comm;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1902 double setup;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1903 double overhead;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1904 double dezip;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1905 double erase_sector;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1906 double program_word;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1907 } timer;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1908 double tmp, total, resolution = (double) (16 * 32 * 1000 / 13e6);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1909
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1910 // Use only 14 MHz for D-/E-Sample specific rates (not for e.g. 812.5K).
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1911 if ((arg_uart_baudrate == 230400) \|\| (arg_uart_baudrate == 460800) \|\| (arg_uart_baudrate == 921600))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1912 resolution = resolution * 13 / 14.746;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1913
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1914 flowf(NORMAL,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1915 "Target Timers:\n"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1916 " (erase + program + recvonly + recv + comm + setup + overhead + dezip)\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1917
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1918 if (arg_dry_run)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1919 for (i = 0; i < 8; i++) data[i] = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1920 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1921 target_putchar(PROTO_TIMERS);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1922 if (target_wait(sizeof(data), TARGET_RECV_DELAY) <= 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1923 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1924 target_recv(&data, sizeof(data));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1925 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1926
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1927 // Convert all timers to milliseconds
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1928 timer.erase = resolution * data[0];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1929 timer.program = resolution * data[1];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1930 timer.recvonly = resolution * data[2];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1931 timer.recv = resolution * data[3];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1932 timer.comm = resolution * data[4];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1933 timer.setup = resolution * data[5];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1934 timer.overhead = resolution * data[6];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1935 timer.dezip = resolution * data[7];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1936
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1937 // Because we do erase-while-transfer in the target the reported erase
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1938 // time has some inherent tolerance, especially at low baudrates. It
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1939 // might make sense to adjust the sector erase time by half the chunk
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1940 // transfer time, although this is just another approximation!?
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1941
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1942 // total = timer.erase + timer.program + timer.recvonly + timer.recv + timer.comm + timer.setup;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1943 flowf(NORMAL, "%8.0f + %7.0f + %8.0f + %6.0f + %5.0f + %5.0f + %8.0f + %5.0f\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1944 timer.erase, timer.program, timer.recvonly, timer.recv,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1945 timer.comm, timer.setup, timer.overhead, timer.dezip);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1946
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1947 flowf(DEBUG, "resolution = %f, %d, %d, %d, %d, %d, %d, %d, %d\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1948 resolution, data[0], data[1], data[2], data[3], data[4],
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1949 data[5], data[6], data[7]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1950
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1951 if (arg_timers_extended_show) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1952 int chunks, size_total, not_zero = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1953 flowf(NORMAL, "Target Timers Extended:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1954
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1955 if (erase_list_size == 0 \|\| arg_dry_run)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1956 flowf(NORMAL, " Erase time = 0.0ms/sector\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1957 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1958 timer.erase_sector = timer.erase / erase_list_size / 1000;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1959 flowf(NORMAL, " Erase time = %.1fs / %d sectors = %.0fms/sector\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1960 timer.erase / 1000, erase_list_size, timer.erase_sector * 1000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1961 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1962
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1963 chunks = image_map_count_used_chunks();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1964 size_total = chunks * image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1965 if (size_total == 0 \|\| arg_dry_run) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1966 size_total = 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1967 not_zero = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1968 flowf(NORMAL, " Program time = 0.0us/word = 0ms/MB\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1969 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1970 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1971 timer.program_word = timer.program / 1000 / (size_total / 2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1972 flowf(NORMAL, " Program time = %.1fs / %dkwords = %.2fus/word = %.0fms/MB\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1973 timer.program / 1000, size_total / 1024 / 2,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1974 timer.program_word * 1000000,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1975 timer.program_word * 1000 * 512 * 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1976 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1977
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1978 flowf(NORMAL, " Receive-only time = %.1fs = %.0fms/MB\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1979 timer.recvonly / 1000,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1980 not_zero * timer.recvonly * 1024 * 1024 / size_total);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1981
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1982 flowf(NORMAL, " Overhead time = %.1fs = %.0fms/MB\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1983 timer.overhead / 1000,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1984 not_zero * timer.overhead * 1024 * 1024 / size_total);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1985
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1986 flowf(NORMAL, " Setup time = %.1fs = %.0fms/MB\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1987 timer.setup / 1000,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1988 not_zero * timer.setup * 1024 * 1024 / size_total);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1989
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1990 total = timer.erase + timer.program + timer.recvonly + timer.overhead +
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1991 timer.setup;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1992 flowf(NORMAL,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1993 "Total time: (erase + prog + recvonly + overhead + setup) = %.1fs\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1994 total / 1000);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1995
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1996 flowf(NORMAL, " Receive time = %.1fs = %.0fms/MB\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1997 timer.recv / 1000, timer.recv * 1024 * 1024 / size_total);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1998
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1999 flowf(NORMAL, " Communication time = %.1fs = %.0fms/MB\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2000 timer.comm / 1000, timer.comm * 1024 * 1024 / size_total);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2001
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2002 flowf(NORMAL, " Dezip time = %.1fs = %.0fms/MB\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2003 timer.dezip / 1000, timer.dezip * 1024 * 1024 / size_total);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2004
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2005 // Now compute the overall performance. Note that the theoretical
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2006 // limit compuation is somewhat flawed in that it assumes 64kB
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2007 // sector sizes.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2008
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2009 tmp = (double) not_zero * total / 1000 * 1024 * 1024 / size_total;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2010 flowf(NORMAL, " Performance = %.0fs/MB\n", tmp);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2011 #if 0
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2012 flowf(BLABBER, " (%.1f * min possible, %.1f * theoretical limit)",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2013 time_program / (timer.program + timer.erase),
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2014 tmp / (16 * timer.erase_sector + 512 * 1024 * timer.program_word));
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2015 flowf(NORMAL, "\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2016 #endif
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2017 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2018 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2019
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2020
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2021 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2022 * Flash Read
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2023 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2024
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2025 int time_read;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2026
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2027 void flash_read_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2028 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2029 int i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2030 unsigned char sendbuf[1+4+4];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2031 int size, read_size, done_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2032 int read_size_max = image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2033 uint32 addr, index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2034 uint8 cksum, mycksum;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2035
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2036 flowf(NORMAL, "Reading Flash: (%dkB) ", read_total_size / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2037 target_trace_enable(0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2038
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2039 //read_size_max = 256;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2040 time_read = stopwatch_start();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2041 progress_begin(read_total_size / read_size_max);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2042
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2043 while (read_list[index].size > 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2044 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2045 // Find next range to read
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2046 size = read_list[index].size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2047 addr = read_list[index].addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2048 index++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2049
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2050 while (size > 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2051 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2052 read_size = (size > read_size_max ? read_size_max : size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2053
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2054 // Read address interval is [MIN..MAX[
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2055 // If odd MAX address was specified round up to next even
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2056 if ((read_size % 2 == 1) && (read_size < read_size_max)) read_size++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2057
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2058 if (arg_progress == 'x')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2059 flowf(DEBUG, "(0x%06X, %d) ", addr, read_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2060
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2061 if (!arg_dry_run)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2062 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2063 buf_put1(&sendbuf[0], PROTO_READ);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2064 buf_put4(&sendbuf[1] , read_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2065 buf_put4(&sendbuf[1+4], addr);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2066 target_send(sendbuf, 1+4+4);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2067
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2068 if (target_wait(read_size, TARGET_RECV_LONG_DELAY) <= 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2069 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2070 // 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	2071 target_recv(&image[addr & (image_size - 1)], read_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2072 for (i = 0, mycksum = 0; i < read_size; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2073 mycksum ^= image[(addr + i) & (image_size - 1)];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2074
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2075 if (target_wait(1, TARGET_RECV_DELAY) <= 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2076 main_fatal(E_RECV_TIMEOUT);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2077 cksum = target_getchar();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2078
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2079 if (cksum != mycksum)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2080 main_fatal(E_RECV_CHECKSUM);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2081 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2082 done_size += read_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2083 size -= read_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2084 addr += read_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2085
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2086 progress_update(done_size / read_size_max);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2087 progress_update_simple('0' + read_size / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2088 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2089 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2090 progress_end(done_size / read_size_max);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2091 flowf(NORMAL, " ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2092
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2093 time_read = stopwatch_stop(time_read);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2094 flowf(VERBOSE, "Used time: %ds ok\n", time_read);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2095 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2096
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2097
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2098 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2099 * Flash Reset
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2100 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2101
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2102 void target_reset_machine(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2103 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2104 int error;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2105
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2106 flowf(VERBOSE, "Resetting target: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2107
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2108 if (arg_dry_run) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2109 flowf(VERBOSE, "(dry-run) ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2110 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2111 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2112 target_putchar(PROTO_RESET);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2113 target_expect_char(PROTO_READY, TARGET_RECV_DELAY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2114 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2115 flowf(VERBOSE, "ok\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2116 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2117
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2118
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2119 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2120 * Show Functions (dump internal data structures)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2121 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2122
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2123 void image_map_show(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2124 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2125 uint32 addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2126 int i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2127
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2128 flowf(ALWAYS, "image map of %d * %dkB chunks (x = used, s = skip, c = checksum ok):",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2129 image_size_in_chunks, image_chunk_size / 1024);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2130
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2131 // For each chunk of the image usage map...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2132 for (i = 0, addr = 0; i < image_size_in_chunks; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2133 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2134 if ((i % 64) == 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2135 flowf(ALWAYS, "\n%4dkB: ", (int) addr >> 10);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2136 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2137 putchar(image_map[i] != 0 ? image_map[i] : '.');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2138 addr += image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2139 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2140 putchar('\n');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2141 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2142
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2143 void sector_map_show(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2144 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2145 struct sector_s *sectors = device->memmap->sectors;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2146 int i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2147
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2148 char n;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2149 uint32 addr = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2150
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2151 flowf(ALWAYS, "sector map (x = used, s = skip, X = force erase):");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2152
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2153 // For each sector of the device definition...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2154 for (i = 0; i < device->memmap->size; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2155 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2156 if ((addr & 0xFFFFF) == 0) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2157 flowf(ALWAYS, "\n%2dMB: ", (int) addr >> 20);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2158 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2159 n = (sector_map[i] ? sector_map[i] : '.');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2160 putchar(n);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2161
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2162 addr += sectors[i].size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2163 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2164 putchar('\n');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2165 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2166
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2167
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2168 /******************************************************************************
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2169 * Utility Functions
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2170 ******************************************************************************/
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2171
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2172 int image_is_within(int start, int end)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2173 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2174 return !(start < 0 \|\| image_size <= start \|\|
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2175 end < 0 \|\| image_size < end \|\|
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2176 end < start);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2177 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2178
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2179 // Set the image usage map in the range [start..end[ as used
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2180 int image_map_set(int start, int end)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2181 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2182 if (!image_is_within(start, end))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2183 return -1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2184
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2185 do {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2186 image_map[start / image_chunk_size] = 'x';
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2187 start += image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2188 } while (start < end);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2189
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2190 return 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2191 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2192
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2193 int target_type_set(uint16 code)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2194 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2195 // If there is an override from the command-line, use that
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2196 if (arg_target_type != 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2197 code = arg_target_type;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2198
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2199 switch (code)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2200 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2201 case 'h': // Hercules
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2202 case 'u': // Ulysses
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2203 case '3': // Chipset 3
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2204 case CHIP_ID_ULYSSES_0:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2205 case CHIP_ID_ULYSSES_A:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2206 case CHIP_ID_HERCULES_A:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2207 case CHIP_ID_HERCULES_B:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2208 target_type = 3;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2209 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2210
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2211 case 'c': // Calypso
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2212 case '4': // Chipset 4
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2213 // case 's': // Samson
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2214 case CHIP_ID_CALYPSO_A:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2215 case CHIP_ID_CALYPSO_B:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2216 case CHIP_ID_CALYPSO_C:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2217 target_type = 4;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2218 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2219
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2220 case 'l': // Calypso Lite
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2221 case CHIP_ID_CALYPSO_L:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2222 target_type = 5;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2223 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2224
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2225 case 'p': // Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2226 case CHIP_ID_CALYPSO_PLUS:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2227 case CHIP_ID_CALYPSO_PLUS_A:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2228 target_type = 6;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2229 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2230
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2231 default:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2232 target_type = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2233 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2234
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2235 return target_type;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2236 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2237
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2238 int image_map_count_used_chunks(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2239 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2240 int used, i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2241
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2242 // For each image chunk
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2243 for (i = 0, used = 0; i < image_size_in_chunks; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2244 if (image_map[i] == 'x')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2245 used++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2246 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2247 return used;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2248 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2249
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2250 // When the sector_map have been changed, we have to update the image_map
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2251 // such that we don't attempt to program within sectors that are not going
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2252 // to be programmed anyway (due to the erase override). We also have to
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2253 // program chunks contained in sectors that are going to be erased, even
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2254 // though the chunks have been check-summed ok.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2255 int image_map_update(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2256 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2257 struct sector_s *sectors = device->memmap->sectors;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2258 int changed, chunks, i, j;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2259 int map_index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2260
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2261 map_index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2262 changed = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2263
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2264 // For each sector of the device definition...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2265 for (i = 0; i < device->memmap->size; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2266 chunks = sectors[i].size / image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2267 // For each image--map-chunk contained in current sector...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2268 for (j = 0; j < chunks; j++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2269 if (!(sector_map[i] == 'x' \|\| sector_map[i] == 'X') &&
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2270 image_map[map_index + j] == 'x') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2271 image_map[map_index + j] = 's'; // skip
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2272 changed++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2273 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2274 else if ((sector_map[i] == 'x' \|\| sector_map[i] == 'X')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2275 && image_map[map_index + j] == 'c') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2276 image_map[map_index + j] = 'x'; // include!
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2277 changed++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2278 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2279 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2280 map_index += chunks;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2281 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2282 return changed;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2283 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2284
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2285 int sector_map_init(void)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2286 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2287 struct sector_s *sectors = device->memmap->sectors;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2288 int map_index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2289 int used_list_index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2290 int used, chunks, i, j;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2291
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2292 sector_map_size = SECTOR_MAP_SIZE_MAX;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2293
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2294 memset(sector_map, 0, sector_map_size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2295
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2296 // Generate the sector_map from the image_map
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2297 map_index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2298
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2299 // For each sector of the device definition...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2300 for (i = 0; i < device->memmap->size; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2301
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2302 chunks = sectors[i].size / image_chunk_size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2303
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2304 // For each image-usage-map-chunk contained in current sector...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2305 for (j = 0, used = 0; j < chunks; j++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2306 if (image_map[map_index + j] == 'x')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2307 used++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2308
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2309 sector_map[i] = (used ? 'x' : 0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2310 map_index += chunks;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2311 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2312
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2313 parse_arg_erase_override(arg_erase_override);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2314
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2315 // Generate the erase_list
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2316 // For each sector of the device definition...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2317 used_list_index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2318 for (i = 0; i < device->memmap->size; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2319 if (sector_map[i] == 'x' \|\| sector_map[i] == 'X')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2320 erase_list[used_list_index++] = sectors[i].addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2321 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2322
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2323 if (arg_sector_map_show)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2324 sector_map_show();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2325
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2326 if (arg_sector_list_show) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2327 flowf(ALWAYS, "sector used list: ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2328 for (i = 0; i < used_list_index; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2329 flowf(ALWAYS, "0x%06X ", erase_list[i]);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2330 putchar('\n');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2331 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2332
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2333 return used_list_index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2334 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2335
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2336 int parse_range(char p, char p_end, int n1, int *n2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2337 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2338 char *my_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2339 int read_offset_calp = (*arg_read != 0 && target[target_type].type == 'P');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2340
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2341 *n2 = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2342
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2343 *n1 = strtol(p, &my_end, 0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2344 if (p == my_end)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2345 return 0; // error: no chars converted
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2346
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2347 if (my_end == 'k' \|\| my_end == 'K') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2348 *n1 <<= 10;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2349 if (read_offset_calp) *n1 += CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2350 my_end++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2351 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2352 else if (*my_end == 'M') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2353 *n1 <<= 20;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2354 if (read_offset_calp) *n1 += CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2355 my_end++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2356 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2357
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2358 *p_end = my_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2359 if (my_end[0] != '.' \|\| my_end[1] != '.')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2360 return 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2361 p = my_end + 2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2362
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2363 *n2 = strtol(p, &my_end, 0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2364 if (p == my_end)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2365 return 0; // error: no chars converted
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2366
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2367 if (my_end == 'k' \|\| my_end == 'K') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2368 *n2 <<= 10;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2369 if (read_offset_calp) *n2 += CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2370 my_end++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2371 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2372 else if (*my_end == 'M') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2373 *n2 <<= 20;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2374 if (read_offset_calp) *n2 += CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2375 my_end++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2376 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2377
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2378 *p_end = my_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2379 return 2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2380 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2381
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2382 // Parse and decode the erase override command line option string. The
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2383 // sector_map is updated accordingly.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2384 void parse_arg_erase_override(char *p)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2385 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2386 struct sector_s *sectors = device->memmap->sectors;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2387 int sector_bottom, sector_top;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2388 int changed, i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2389
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2390 tr(TrBegin\| TrArgParser, "erase_override:\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2391 while (*p)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2392 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2393 char *p_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2394 int num, sign, n1 = 0, n2 = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2395
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2396 if (p != '-' && p != '+')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2397 main_error(E_ERASE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2398
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2399 sign = (*p == '-' ? -1 : +1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2400 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2401
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2402 if (p == '') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2403 sign = sign * 2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2404 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2405 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2406 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2407 num = parse_range(p, &p_end, &n1, &n2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2408 if (num == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2409 main_error(E_ERASE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2410 p = p_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2411 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2412
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2413 switch (sign) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2414 case -1:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2415 case +1:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2416 if (num == 1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2417 // Support for absolute addresses on Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2418 if (n1 >= CALP_OFFSET) n1 -= CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2419
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2420 if (n1 > sector_map_size) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2421 // For all sectors...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2422 for (i = 0; i < device->memmap->size; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2423 sector_bottom = sectors[i].addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2424 sector_top = sector_bottom + sectors[i].size - 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2425
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2426 if (n1 >= sector_bottom && n1 < sector_top) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2427 sector_map[i] = (sign > 0 ? 'X' : 's');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2428 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2429 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2430 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2431 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2432 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2433 sector_map[n1] = (sign > 0 ? 'X' : 's');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2434 tr(TrArgParser, "%c%d\n", sign > 0 ? '+' : '-', n1);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2435 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2436 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2437 // Support for absolute addresses on Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2438 if (n1 >= CALP_OFFSET && n2 >= CALP_OFFSET) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2439 n1 -= CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2440 n2 -= CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2441 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2442
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2443 if (n1 > sector_map_size \|\| n2 > sector_map_size) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2444 // n1 and n2 must respresent an address range
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2445 if (n1 >= n2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2446 main_error(E_ERASE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2447
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2448 // For all sectors...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2449 for (i = 0; i < device->memmap->size; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2450 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2451 sector_bottom = sectors[i].addr;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2452 sector_top = sector_bottom + sectors[i].size - 1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2453
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2454 // If either sector bottom or top is contained in
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2455 // [n1..n2[
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2456 if ((n1 <= sector_bottom && sector_bottom < n2) \|\|
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2457 (n1 <= sector_top && sector_top < n2)) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2458 sector_map[i] = (sign > 0 ? 'X' : 's');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2459 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2460 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2461 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2462 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2463 // n1 and n2 must respresent a sector range
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2464 for (i = n1; i < n2; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2465 sector_map[i] = (sign > 0 ? 'X' : 's');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2466 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2467 tr(TrArgParser,
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2468 "%c%d..%d\n", sign > 0 ? '+' : '-', n1, n2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2469 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2470 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2471 case -2:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2472 case +2:
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2473 // Fill whole sector_map...
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2474 for (i = 0; i < device->memmap->size; i++)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2475 sector_map[i] = (sign > 0 ? 'X' : 's');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2476 tr(TrArgParser, "%c*\n", sign > 0 ? '+' : '-');
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2477 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2478 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2479 // skip optional comma
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2480 if (*p == ',')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2481 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2482 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2483 tr(TrEnd\| TrArgParser, "");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2484
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2485 changed = image_map_update();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2486
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2487 // If image map was changed, we trace it again.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2488 if (changed && arg_image_map_show)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2489 image_map_show();
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2490 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2491
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2492 void parse_arg_read(char *p)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2493 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2494 read_total_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2495 read_list_size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2496
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2497 tr(TrArgParser, "parse_arg_read() {\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2498 while (*p)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2499 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2500 char *p_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2501 int num, n1, n2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2502
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2503 if (p == '') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2504 n1 = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2505 n2 = 0x1000000; // sufficiently large (16MB)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2506 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2507 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2508 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2509 num = parse_range(p, &p_end, &n1, &n2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2510 tr(TrArgParser, "parse_range('%s', ...)\n"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2511 " { #%d, p_end = '%s', n1 = 0x%x, n2 = 0x%x } %d\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2512 p, read_list_size, p_end, n1, n2, num);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2513 if (num != 2 \|\| n1 > n2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2514 main_error(E_ADDR_RANGE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2515 p = p_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2516 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2517 read_list[read_list_size].addr = n1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2518 read_list[read_list_size].size = n2 - n1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2519 read_total_size += n2 - n1;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2520 read_list_size++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2521 if (read_list_size >= READ_LIST_SIZE_MAX)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2522 main_error(E_ARG_TOOMANY);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2523
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2524 if (*p == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2525 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2526
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2527 if (*p == ',')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2528 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2529 else
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2530 main_error(E_READ_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2531 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2532 // Terminate the read_list with zeroes.
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2533 read_list[read_list_size].addr = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2534 read_list[read_list_size].size = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2535
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2536 tr(TrArgParser, "}\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2537 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2538
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2539 void parse_arg_write(char *p)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2540 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2541 tr(TrArgParser, "parse_arg_write() {\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2542
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2543 while (*p)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2544 {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2545 char bytes[1024];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2546 char *p_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2547 int num, n1, n2;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2548 int index, value, size, i;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2549
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2550 num = parse_range(p, &p_end, &n1, &n2);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2551 tr(TrArgParser, "parse_range('%s', ...)\n"
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2552 " { p_end = '%s', n1 = 0x%x, n2 = 0x%x } %d\n",
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2553 p, p_end, n1, n2, num);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2554
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2555 if (num < 1 \|\| num > 2)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2556 main_error(E_ADDR_RANGE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2557
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2558 p = p_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2559
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2560 if (*p++ != '=')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2561 main_error(E_WRITE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2562
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2563 tr(TrArgParser, " { ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2564 if (*p == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2565 main_error(E_WRITE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2566
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2567 index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2568 while (*p) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2569 if (*p == '\"') {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2570 // Collect text string
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2571 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2572 tr(TrCont\|TrArgParser, "'");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2573 while (*p) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2574 if (*p == '\"')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2575 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2576 if (p[0] == '\\' && p[1] == '\"')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2577 p++; // skip leading backslash
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2578 if (p[0] == '\\' && p[1] == '\\')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2579 p++; // skip leading backslash
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2580 tr(TrCont\|TrArgParser, "%c", *p);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2581 bytes[index] = *p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2582 if (index++ >= sizeof(bytes))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2583 main_error(E_WRITE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2584 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2585 if (*p++ != '\"')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2586 main_error(E_WRITE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2587 tr(TrCont\|TrArgParser, "' ");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2588 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2589 else {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2590 // Collect byte string
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2591 value = strtol(p, &p_end, 0);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2592 if (p == p_end)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2593 main_error(E_WRITE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2594 if (value < 0 \|\| 255 < value)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2595 main_error(E_WRITE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2596 bytes[index] = value;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2597 if (index++ >= sizeof(bytes))
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2598 main_error(E_WRITE_SPEC);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2599 p = p_end;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2600
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2601 tr(TrCont\|TrArgParser, "0x%x ", value);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2602 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2603 if (p == ':' \|\| p == 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2604 break;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2605 if (*p == ',')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2606 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2607 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2608 size = index;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2609 tr(TrArgParser, "} %d\n", size);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2610
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2611 if (num == 1) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2612 // Support for absolute addresses on Calypso Plus
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2613 if (n1 >= CALP_OFFSET) n1 -= CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2614
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2615 n2 = n1 + size;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2616 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2617 else if (n1 >= CALP_OFFSET && n2 >= CALP_OFFSET) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2618 n1 -= CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2619 n2 -= CALP_OFFSET;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2620 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2621
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2622 if (image_map_set(n1, n2) < 0)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2623 main_error(E_ADDR_RANGE);
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2624
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2625 index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2626 for (i = n1; i < n2; i++) {
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2627 image[i] = bytes[index++];
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2628 if (index >= size)
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2629 index = 0;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2630 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2631 if (*p == ':')
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2632 p++;
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2633 }
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2634 tr(TrArgParser, "}\n");
9cecc930d78f fluid-mnf: original source from TI, Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2635 }

FreeCalypso > hg > freecalypso-reveng

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