/* MSPDebug - debugging tool for MSP430 MCUs
 * Copyright (C) 2009, 2010 Daniel Beer
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 */

#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include "coff.h"
#include "util.h"
#include "output.h"

struct coff_header {
	uint16_t        version;
	int             sec_count;
	uint32_t        timestamp;
	int             stab_start;
	int             stab_count;
	int             opt_bytes;
	uint16_t        flags;
	uint16_t        target_id;
};

/* Header sizes */
#define FILE_HEADER_SIZE        22
#define OPT_HEADER_SIZE         28
#define SHDR_SIZE               48
#define STAB_ENTRY_SIZE         18

/* Bits in the flags field */
#define F_RELFLG        0x0001
#define F_EXEC          0x0002
#define F_LSYMS         0x0008
#define F_LITTLE        0x0100
#define F_BIG           0x0200
#define F_SYMMERGE      0x1000

/* Section header flags */
#define STYP_REG        0x00000000
#define STYP_DSECT      0x00000001
#define STYP_NOLOAD     0x00000002
#define STYP_GROUP      0x00000004
#define STYP_PAD        0x00000008
#define STYP_COPY       0x00000010
#define STYP_TEXT       0x00000020
#define STYP_DATA       0x00000040
#define STYP_BSS        0x00000080
#define STYP_BLOCK      0x00001000
#define STYP_PASS       0x00002000
#define STYP_CLINK      0x00004000
#define STYP_VECTOR     0x00008000
#define STYP_PADDED     0x00010000

/* Symbol storage classes */
#define C_NULL          0
#define C_AUTO          1
#define C_EXT           2
#define C_STAT          3
#define C_REG           4
#define C_EXTREF        5
#define C_LABEL         6
#define C_ULABEL        7
#define C_MOS           8
#define C_ARG           9
#define C_STRTAG        10
#define C_MOU           11
#define C_UNTAG         12
#define C_TPDEF         13
#define C_USTATIC       14
#define C_ENTAG         15
#define C_MOE           16
#define C_REGPARM       17
#define C_FIELD         18
#define C_UEXT          19
#define C_STATLAB       20
#define C_EXTLAB        21
#define C_VARARG        22
#define C_BLOCK         100
#define C_FCN           101
#define C_EOS           102
#define C_FILE          103
#define C_LINE          104

/* MSP430 magic number */
#define MSP430_MAGIC    0x00a0

static int read_block(FILE *in, int offset, int size, void *buf)
{
	int len;

	if (size < 0) {
		printc_err("coff: invalid size: %d\n", size);
		return -1;
	}

	if (fseek(in, offset, SEEK_SET) < 0) {
		printc_err("coff: can't seek to offset %d: %s\n",
			offset, strerror(errno));
		return -1;
	}

	len = fread(buf, 1, size, in);
	if (len < 0) {
		printc_err("coff: can't read %d bytes from "
			"offset %d: %s\n",
			size, offset, strerror(errno));
		return -1;
	}

	if (len < size) {
		printc_err("coff: can't read %d bytes from "
			"offset %d: short read\n",
			size, offset);
		return -1;
	}

	return 0;
}

static void parse_header(const uint8_t *data, struct coff_header *hdr)
{
	hdr->version = LE_WORD(data, 0);
	hdr->sec_count = LE_WORD(data, 2);
	hdr->timestamp = LE_LONG(data, 4);
	hdr->stab_start = LE_LONG(data, 8);
	hdr->stab_count = LE_LONG(data, 12);
	hdr->opt_bytes = LE_WORD(data, 16);
	hdr->flags = LE_WORD(data, 18);
	hdr->target_id = LE_WORD(data, 20);
}

static int read_header(FILE *in, struct coff_header *hdr)
{
	uint8_t hdr_data[FILE_HEADER_SIZE];

	if (read_block(in, 0, FILE_HEADER_SIZE, hdr_data) < 0) {
		printc_err("coff: failed to extract COFF header\n");
		return -1;
	}

	parse_header(hdr_data, hdr);
	return 0;
}

int coff_check(FILE *in)
{
	uint8_t data[FILE_HEADER_SIZE];

	rewind(in);
	if (fread(data, 1, FILE_HEADER_SIZE, in) != FILE_HEADER_SIZE)
		return 0;

	return data[20] == 0xa0 && !data[21];
}

static int read_sechdrs(FILE *in, const struct coff_header *hdr,
			uint8_t **ret_tab)
{
	uint8_t *table;
	int alloc_size = SHDR_SIZE * hdr->sec_count;

	if (!hdr->sec_count) {
		*ret_tab = NULL;
		return 0;
	}

	table = malloc(alloc_size);
	if (!table) {
		pr_error("coff: can't allocate memory for section headers");
		return -1;
	}

	if (read_block(in, hdr->opt_bytes + FILE_HEADER_SIZE,
		       SHDR_SIZE * hdr->sec_count, table) < 0) {
		printc_err("coff: can't read section headers\n");
		free(table);
		return -1;
	}

	*ret_tab = table;
	return hdr->sec_count;
}

static int load_section(FILE *in, uint32_t addr, uint32_t offset,
			uint32_t size,
			binfile_imgcb_t cb, void *user_data)
{
	uint8_t *section;

	if (!size)
		return 0;

	section = malloc(size);
	if (!section) {
		printc_err("coff: couldn't allocate memory for "
			"section at 0x%x: %s\n", offset, strerror(errno));
		return -1;
	}

	if (read_block(in, offset, size, section) < 0) {
		printc_err("coff: couldn't read section at 0x%x\n",
			offset);
		free(section);
		return -1;
	}

	if (cb(user_data, addr, section, size) < 0) {
		free(section);
		return -1;
	}

	free(section);
	return 0;
}

int coff_extract(FILE *in, binfile_imgcb_t cb, void *user_data)
{
	struct coff_header hdr;
	uint8_t *shdrs;
	int ret = 0;
	int i;

	if (read_header(in, &hdr) < 0)
		return -1;

	if (read_sechdrs(in, &hdr, &shdrs) < 0)
		return -1;

	for (i = 0; i < hdr.sec_count; i++) {
		uint8_t *header = shdrs + SHDR_SIZE * i;
		uint32_t flags = LE_LONG(header, 40);

		if (((flags & STYP_TEXT) || (flags & STYP_DATA)) &&
		    !(flags & STYP_NOLOAD)) {
			uint32_t addr = LE_LONG(header, 8);
			uint32_t offset = LE_LONG(header, 20);
			uint32_t size = LE_LONG(header, 16);

			if (load_section(in, addr, offset, size,
					 cb, user_data) < 0) {
				printc_err("coff: error while loading "
					"section %d\n", i);
				ret = -1;
				break;
			}
		}
	}

	if (shdrs)
		free(shdrs);

	return ret;
}

static int read_strtab(FILE *in, const struct coff_header *hdr,
		       char **ret_tab)
{
	char *strtab;
	int file_size;
	int alloc_size;
	int strtab_len;
	int strtab_start = hdr->stab_count * STAB_ENTRY_SIZE + hdr->stab_start;

	if (fseek(in, 0, SEEK_END) < 0) {
		printc_err("coff: can't seek to end\n");
		return -1;
	}

	file_size = ftell(in);
	strtab_len = file_size - strtab_start;

	if (strtab_len < 0) {
		printc_err("coff: invalid string table size\n");
		return -1;
	}

	if (!strtab_len) {
		*ret_tab = NULL;
		return 0;
	}

	alloc_size = strtab_len + 1;
	strtab = malloc(alloc_size);
	if (!strtab) {
		pr_error("coff: can't allocate memory for string table");
		return -1;
	}

	if (read_block(in, strtab_start, strtab_len, strtab) < 0) {
		printc_err("coff: failed to read string table\n");
		free(strtab);
		return -1;
	}

	strtab[strtab_len] = 0;
	*ret_tab = strtab;
	return strtab_len;
}

static int read_symtab(FILE *in, const struct coff_header *hdr,
		       uint8_t **ret_tab)
{
	uint8_t *table;
	int alloc_size = STAB_ENTRY_SIZE * hdr->stab_count;

	if (!hdr->stab_count) {
		*ret_tab = NULL;
		return 0;
	}

	table = malloc(alloc_size);
	if (!table) {
		pr_error("coff: failed to allocate memory for symbol table");
		return -1;
	}

	if (read_block(in, hdr->stab_start,
		       STAB_ENTRY_SIZE * hdr->stab_count, table) < 0) {
		printc_err("coff: failed to read symbol table\n");
		free(table);
		return -1;
	}

	*ret_tab = table;
	return hdr->stab_count;
}

int coff_syms(FILE *in, stab_t stab)
{
	struct coff_header hdr;
	char *strtab;
	uint8_t *symtab;
	int strtab_len;
	int i;
	int ret = 0;

	if (read_header(in, &hdr) < 0)
		return -1;

	strtab_len = read_strtab(in, &hdr, &strtab);
	if (strtab_len < 0)
		return -1;

	if (read_symtab(in, &hdr, &symtab) < 0) {
		if (strtab)
			free(strtab);
		return -1;
	}

	for (i = 0; i < hdr.stab_count; i++) {
		uint8_t *entry = symtab + i * STAB_ENTRY_SIZE;
		uint32_t value = LE_LONG(entry, 8);
		int storage_class = entry[16];
		char namebuf[9];
		const char *name = NULL;

		if (LE_LONG(entry, 0)) {
			memcpy(namebuf, entry, 8);
			namebuf[8] = 0;
			name = namebuf;
		} else {
			uint32_t offset = LE_LONG(entry, 4);

			if (offset >= 4 && offset < strtab_len)
				name = strtab + offset;
		}

		if ((storage_class == C_EXT || storage_class == C_LABEL) &&
		    stab_set(stab, name, value) < 0) {
			printc_err("coff: failed to insert symbol\n");
			ret = -1;
			break;
		}

		/* Skip auxiliary entries */
		i += entry[17];
	}

	if (symtab)
		free(symtab);
	if (strtab)
		free(strtab);

	return ret;
}