git.gag.com Git - fw/openocd/blob - src/flash/nor/faux.c

   1 /***************************************************************************
   2  *   Copyright (C) 2009 Øyvind Harboe                                      *
   3  *   oyvind.harboe@zylin.com                                               *
   4  *                                                                         *
   5  *   This program is free software; you can redistribute it and/or modify  *
   6  *   it under the terms of the GNU General Public License as published by  *
   7  *   the Free Software Foundation; either version 2 of the License, or     *
   8  *   (at your option) any later version.                                   *
   9  *                                                                         *
  10  *   This program is distributed in the hope that it will be useful,       *
  11  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
  12  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
  13  *   GNU General Public License for more details.                          *
  14  *                                                                         *
  15  *   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 #ifdef HAVE_CONFIG_H
  20 #include "config.h"
  21 #endif
  22
  23 #include "imp.h"
  24 #include <target/image.h>
  25 #include "hello.h"
  26
  27 struct faux_flash_bank {
  28         struct target *target;
  29         uint8_t *memory;
  30         uint32_t start_address;
  31 };
  32
  33 static const int sector_size = 0x10000;
  34
  35
  36 /* flash bank faux <base> <size> <chip_width> <bus_width> <target#> <driverPath>
  37  */
  38 FLASH_BANK_COMMAND_HANDLER(faux_flash_bank_command)
  39 {
  40         struct faux_flash_bank *info;
  41
  42         if (CMD_ARGC < 6)
  43                 return ERROR_COMMAND_SYNTAX_ERROR;
  44
  45         info = malloc(sizeof(struct faux_flash_bank));
  46         if (!info) {
  47                 LOG_ERROR("no memory for flash bank info");
  48                 return ERROR_FAIL;
  49         }
  50         info->memory = malloc(bank->size);
  51         if (!info->memory) {
  52                 free(info);
  53                 LOG_ERROR("no memory for flash bank info");
  54                 return ERROR_FAIL;
  55         }
  56         bank->driver_priv = info;
  57
  58         /* Use 0x10000 as a fixed sector size. */
  59         uint32_t offset = 0;
  60         bank->num_sectors = bank->size/sector_size;
  61         bank->sectors = malloc(sizeof(struct flash_sector) * bank->num_sectors);
  62         for (unsigned int i = 0; i < bank->num_sectors; i++) {
  63                 bank->sectors[i].offset = offset;
  64                 bank->sectors[i].size = sector_size;
  65                 offset += bank->sectors[i].size;
  66                 bank->sectors[i].is_erased = -1;
  67                 bank->sectors[i].is_protected = 0;
  68         }
  69
  70         info->target = get_target(CMD_ARGV[5]);
  71         if (!info->target) {
  72                 LOG_ERROR("target '%s' not defined", CMD_ARGV[5]);
  73                 free(info->memory);
  74                 free(info);
  75                 return ERROR_FAIL;
  76         }
  77         return ERROR_OK;
  78 }
  79
  80 static int faux_erase(struct flash_bank *bank, unsigned int first,
  81                 unsigned int last)
  82 {
  83         struct faux_flash_bank *info = bank->driver_priv;
  84         memset(info->memory + first*sector_size, 0xff, sector_size*(last-first + 1));
  85         return ERROR_OK;
  86 }
  87
  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         memcpy(info->memory + offset, buffer, count);
  92         return ERROR_OK;
  93 }
  94
  95 static int faux_info(struct flash_bank *bank, struct command_invocation *cmd)
  96 {
  97         command_print_sameline(cmd, "faux flash driver");
  98         return ERROR_OK;
  99 }
 100
 101 static int faux_probe(struct flash_bank *bank)
 102 {
 103         return ERROR_OK;
 104 }
 105
 106 static const struct command_registration faux_command_handlers[] = {
 107         {
 108                 .name = "faux",
 109                 .mode = COMMAND_ANY,
 110                 .help = "faux flash command group",
 111                 .chain = hello_command_handlers,
 112                 .usage = "",
 113         },
 114         COMMAND_REGISTRATION_DONE
 115 };
 116
 117 const struct flash_driver faux_flash = {
 118         .name = "faux",
 119         .commands = faux_command_handlers,
 120         .flash_bank_command = faux_flash_bank_command,
 121         .erase = faux_erase,
 122         .write = faux_write,
 123         .read = default_flash_read,
 124         .probe = faux_probe,
 125         .auto_probe = faux_probe,
 126         .erase_check = default_flash_blank_check,
 127         .info = faux_info,
 128         .free_driver_priv = default_flash_free_driver_priv,
 129 };