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

   1 /***************************************************************************
   2  *   Copyright (C) 2010 by Spencer Oliver                                  *
   3  *   spen@spen-soft.co.uk                                                  *
   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
  25 static struct flash_bank *virtual_get_master_bank(struct flash_bank *bank)
  26 {
  27         struct flash_bank *master_bank;
  28
  29         master_bank = get_flash_bank_by_name_noprobe(bank->driver_priv);
  30         if (master_bank == NULL)
  31                 LOG_ERROR("master flash bank '%s' does not exist", (char *)bank->driver_priv);
  32
  33         return master_bank;
  34 }
  35
  36 static void virtual_update_bank_info(struct flash_bank *bank)
  37 {
  38         struct flash_bank *master_bank = virtual_get_master_bank(bank);
  39
  40         if (master_bank == NULL)
  41                 return;
  42
  43         /* update the info we do not have */
  44         bank->size = master_bank->size;
  45         bank->chip_width = master_bank->chip_width;
  46         bank->bus_width = master_bank->bus_width;
  47         bank->erased_value = master_bank->erased_value;
  48         bank->default_padded_value = master_bank->default_padded_value;
  49         bank->write_start_alignment = master_bank->write_start_alignment;
  50         bank->write_end_alignment = master_bank->write_end_alignment;
  51         bank->minimal_write_gap = master_bank->minimal_write_gap;
  52         bank->num_sectors = master_bank->num_sectors;
  53         bank->sectors = master_bank->sectors;
  54         bank->num_prot_blocks = master_bank->num_prot_blocks;
  55         bank->prot_blocks = master_bank->prot_blocks;
  56 }
  57
  58 FLASH_BANK_COMMAND_HANDLER(virtual_flash_bank_command)
  59 {
  60         if (CMD_ARGC < 7)
  61                 return ERROR_COMMAND_SYNTAX_ERROR;
  62
  63         /* get the master flash bank */
  64         const char *bank_name = CMD_ARGV[6];
  65         struct flash_bank *master_bank = get_flash_bank_by_name_noprobe(bank_name);
  66
  67         if (master_bank == NULL) {
  68                 LOG_ERROR("master flash bank '%s' does not exist", bank_name);
  69                 return ERROR_FLASH_OPERATION_FAILED;
  70         }
  71
  72         /* save master bank name - use this to get settings later */
  73         bank->driver_priv = strdup(bank_name);
  74
  75         return ERROR_OK;
  76 }
  77
  78 static int virtual_protect(struct flash_bank *bank, int set, unsigned int first,
  79                 unsigned int last)
  80 {
  81         struct flash_bank *master_bank = virtual_get_master_bank(bank);
  82
  83         if (master_bank == NULL)
  84                 return ERROR_FLASH_OPERATION_FAILED;
  85
  86         return flash_driver_protect(master_bank, set, first, last);
  87 }
  88
  89 static int virtual_protect_check(struct flash_bank *bank)
  90 {
  91         struct flash_bank *master_bank = virtual_get_master_bank(bank);
  92
  93         if (master_bank == NULL)
  94                 return ERROR_FLASH_OPERATION_FAILED;
  95
  96         if (master_bank->driver->protect_check == NULL)
  97                 return ERROR_FLASH_OPER_UNSUPPORTED;
  98
  99         /* call master handler */
 100         return master_bank->driver->protect_check(master_bank);
 101 }
 102
 103 static int virtual_erase(struct flash_bank *bank, unsigned int first,
 104                 unsigned int last)
 105 {
 106         struct flash_bank *master_bank = virtual_get_master_bank(bank);
 107         int retval;
 108
 109         if (master_bank == NULL)
 110                 return ERROR_FLASH_OPERATION_FAILED;
 111
 112         /* call master handler */
 113         retval = master_bank->driver->erase(master_bank, first, last);
 114         if (retval != ERROR_OK)
 115                 return retval;
 116
 117         return ERROR_OK;
 118 }
 119
 120 static int virtual_write(struct flash_bank *bank, const uint8_t *buffer,
 121                 uint32_t offset, uint32_t count)
 122 {
 123         struct flash_bank *master_bank = virtual_get_master_bank(bank);
 124         int retval;
 125
 126         if (master_bank == NULL)
 127                 return ERROR_FLASH_OPERATION_FAILED;
 128
 129         /* call master handler */
 130         retval = master_bank->driver->write(master_bank, buffer, offset, count);
 131         if (retval != ERROR_OK)
 132                 return retval;
 133
 134         return ERROR_OK;
 135 }
 136
 137 static int virtual_probe(struct flash_bank *bank)
 138 {
 139         struct flash_bank *master_bank = virtual_get_master_bank(bank);
 140         int retval;
 141
 142         if (master_bank == NULL)
 143                 return ERROR_FLASH_OPERATION_FAILED;
 144
 145         /* call master handler */
 146         retval = master_bank->driver->probe(master_bank);
 147         if (retval != ERROR_OK)
 148                 return retval;
 149
 150         /* update the info we do not have */
 151         virtual_update_bank_info(bank);
 152
 153         return ERROR_OK;
 154 }
 155
 156 static int virtual_auto_probe(struct flash_bank *bank)
 157 {
 158         struct flash_bank *master_bank = virtual_get_master_bank(bank);
 159         int retval;
 160
 161         if (master_bank == NULL)
 162                 return ERROR_FLASH_OPERATION_FAILED;
 163
 164         /* call master handler */
 165         retval = master_bank->driver->auto_probe(master_bank);
 166         if (retval != ERROR_OK)
 167                 return retval;
 168
 169         /* update the info we do not have */
 170         virtual_update_bank_info(bank);
 171
 172         return ERROR_OK;
 173 }
 174
 175 static int virtual_info(struct flash_bank *bank, struct command_invocation *cmd)
 176 {
 177         struct flash_bank *master_bank = virtual_get_master_bank(bank);
 178
 179         if (master_bank == NULL)
 180                 return ERROR_FLASH_OPERATION_FAILED;
 181
 182         command_print_sameline(cmd, "%s driver for flash bank %s at " TARGET_ADDR_FMT,
 183                         bank->driver->name, master_bank->name, master_bank->base);
 184
 185         return ERROR_OK;
 186 }
 187
 188 static int virtual_blank_check(struct flash_bank *bank)
 189 {
 190         struct flash_bank *master_bank = virtual_get_master_bank(bank);
 191         int retval;
 192
 193         if (master_bank == NULL)
 194                 return ERROR_FLASH_OPERATION_FAILED;
 195
 196         /* call master handler */
 197         retval = master_bank->driver->erase_check(master_bank);
 198         if (retval != ERROR_OK)
 199                 return retval;
 200
 201         return ERROR_OK;
 202 }
 203
 204 static int virtual_flash_read(struct flash_bank *bank,
 205                 uint8_t *buffer, uint32_t offset, uint32_t count)
 206 {
 207         struct flash_bank *master_bank = virtual_get_master_bank(bank);
 208         int retval;
 209
 210         if (master_bank == NULL)
 211                 return ERROR_FLASH_OPERATION_FAILED;
 212
 213         /* call master handler */
 214         retval = master_bank->driver->read(master_bank, buffer, offset, count);
 215         if (retval != ERROR_OK)
 216                 return retval;
 217
 218         return ERROR_OK;
 219 }
 220
 221 const struct flash_driver virtual_flash = {
 222         .name = "virtual",
 223         .flash_bank_command = virtual_flash_bank_command,
 224         .erase = virtual_erase,
 225         .protect = virtual_protect,
 226         .write = virtual_write,
 227         .read = virtual_flash_read,
 228         .probe = virtual_probe,
 229         .auto_probe = virtual_auto_probe,
 230         .erase_check = virtual_blank_check,
 231         .protect_check = virtual_protect_check,
 232         .info = virtual_info,
 233         .free_driver_priv = default_flash_free_driver_priv,
 234 };