faux.c 3.91 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/***************************************************************************
 *   Copyright (C) 2009 Øyvind Harboe                                      *
 *   oyvind.harboe@zylin.com                                               *
 *                                                                         *
 *   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     *
16
 *   along with this program.  If not, see <http://www.gnu.org/licenses/>. *
17
 ***************************************************************************/
18

19 20 21 22
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

Zachary T Welch's avatar
Zachary T Welch committed
23
#include "imp.h"
24
#include <target/image.h>
25
#include "hello.h"
26

27
struct faux_flash_bank {
Zachary T Welch's avatar
Zachary T Welch committed
28
	struct target *target;
29 30
	uint8_t *memory;
	uint32_t start_address;
31
};
32 33 34 35 36 37

static const int sectorSize = 0x10000;


/* flash bank faux <base> <size> <chip_width> <bus_width> <target#> <driverPath>
 */
38
FLASH_BANK_COMMAND_HANDLER(faux_flash_bank_command)
39
{
40
	struct faux_flash_bank *info;
41

42
	if (CMD_ARGC < 6)
Mathias K's avatar
Mathias K committed
43
		return ERROR_COMMAND_SYNTAX_ERROR;
44

45
	info = malloc(sizeof(struct faux_flash_bank));
46
	if (info == NULL) {
47 48 49 50
		LOG_ERROR("no memory for flash bank info");
		return ERROR_FAIL;
	}
	info->memory = malloc(bank->size);
51
	if (info->memory == NULL) {
52 53 54 55 56 57 58 59 60 61
		free(info);
		LOG_ERROR("no memory for flash bank info");
		return ERROR_FAIL;
	}
	bank->driver_priv = info;

	/* Use 0x10000 as a fixed sector size. */
	int i = 0;
	uint32_t offset = 0;
	bank->num_sectors = bank->size/sectorSize;
62
	bank->sectors = malloc(sizeof(struct flash_sector) * bank->num_sectors);
63
	for (i = 0; i < bank->num_sectors; i++) {
64 65 66 67 68 69 70
		bank->sectors[i].offset = offset;
		bank->sectors[i].size = sectorSize;
		offset += bank->sectors[i].size;
		bank->sectors[i].is_erased = -1;
		bank->sectors[i].is_protected = 0;
	}

71
	info->target = get_target(CMD_ARGV[5]);
72
	if (info->target == NULL) {
73
		LOG_ERROR("target '%s' not defined", CMD_ARGV[5]);
74 75 76 77 78 79 80
		free(info->memory);
		free(info);
		return ERROR_FAIL;
	}
	return ERROR_OK;
}

81
static int faux_erase(struct flash_bank *bank, int first, int last)
82
{
83
	struct faux_flash_bank *info = bank->driver_priv;
84 85 86 87
	memset(info->memory + first*sectorSize, 0xff, sectorSize*(last-first + 1));
	return ERROR_OK;
}

88
static int faux_write(struct flash_bank *bank, const uint8_t *buffer, uint32_t offset, uint32_t count)
89
{
90
	struct faux_flash_bank *info = bank->driver_priv;
91 92 93 94
	memcpy(info->memory + offset, buffer, count);
	return ERROR_OK;
}

95
static int faux_info(struct flash_bank *bank, char *buf, int buf_size)
96 97 98 99 100
{
	snprintf(buf, buf_size, "faux flash driver");
	return ERROR_OK;
}

101
static int faux_probe(struct flash_bank *bank)
102 103 104
{
	return ERROR_OK;
}
105

106 107 108 109 110 111
static const struct command_registration faux_command_handlers[] = {
	{
		.name = "faux",
		.mode = COMMAND_ANY,
		.help = "faux flash command group",
		.chain = hello_command_handlers,
112
		.usage = "",
113 114 115 116
	},
	COMMAND_REGISTRATION_DONE
};

117
const struct flash_driver faux_flash = {
David Brownell's avatar
David Brownell committed
118 119 120 121 122
	.name = "faux",
	.commands = faux_command_handlers,
	.flash_bank_command = faux_flash_bank_command,
	.erase = faux_erase,
	.write = faux_write,
123
	.read = default_flash_read,
David Brownell's avatar
David Brownell committed
124 125 126
	.probe = faux_probe,
	.auto_probe = faux_probe,
	.erase_check = default_flash_blank_check,
127 128
	.info = faux_info,
	.free_driver_priv = default_flash_free_driver_priv,
David Brownell's avatar
David Brownell committed
129
};