--- /dev/null
+/***************************************************************************\r
+ * Copyright (C) 2009 by *\r
+ * Rolf Meeser <rolfm_9dq@yahoo.de> *\r
+ * *\r
+ * This program is free software; you can redistribute it and/or modify *\r
+ * it under the terms of the GNU General Public License as published by *\r
+ * the Free Software Foundation; either version 2 of the License, or *\r
+ * (at your option) any later version. *\r
+ * *\r
+ * This program is distributed in the hope that it will be useful, *\r
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of *\r
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *\r
+ * GNU General Public License for more details. *\r
+ * *\r
+ * You should have received a copy of the GNU General Public License *\r
+ * along with this program; if not, write to the *\r
+ * Free Software Foundation, Inc., *\r
+ * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *\r
+ ***************************************************************************/\r
+\r
+#ifdef HAVE_CONFIG_H\r
+#include "config.h"\r
+#endif\r
+\r
+\r
+#include "image.h"\r
+\r
+#include "lpc2900.h"\r
+#include "binarybuffer.h"\r
+#include "armv4_5.h"\r
+\r
+\r
+/* 1024 bytes */\r
+#define KiB 1024\r
+\r
+/* Some flash constants */\r
+#define FLASH_PAGE_SIZE 512 /* bytes */\r
+#define FLASH_ERASE_TIME 100000 /* microseconds */\r
+#define FLASH_PROGRAM_TIME 1000 /* microseconds */\r
+\r
+/* Chip ID / Feature Registers */\r
+#define CHIPID 0xE0000000 /* Chip ID */\r
+#define FEAT0 0xE0000100 /* Chip feature 0 */\r
+#define FEAT1 0xE0000104 /* Chip feature 1 */\r
+#define FEAT2 0xE0000108 /* Chip feature 2 (contains flash size indicator) */\r
+#define FEAT3 0xE000010C /* Chip feature 3 */\r
+\r
+#define EXPECTED_CHIPID 0x209CE02B /* Chip ID of all LPC2900 devices */\r
+\r
+/* Flash/EEPROM Control Registers */\r
+#define FCTR 0x20200000 /* Flash control */\r
+#define FPTR 0x20200008 /* Flash program-time */\r
+#define FTCTR 0x2020000C /* Flash test control */\r
+#define FBWST 0x20200010 /* Flash bridge wait-state */\r
+#define FCRA 0x2020001C /* Flash clock divider */\r
+#define FMSSTART 0x20200020 /* Flash Built-In Selft Test start address */\r
+#define FMSSTOP 0x20200024 /* Flash Built-In Selft Test stop address */\r
+#define FMS16 0x20200028 /* Flash 16-bit signature */\r
+#define FMSW0 0x2020002C /* Flash 128-bit signature Word 0 */\r
+#define FMSW1 0x20200030 /* Flash 128-bit signature Word 1 */\r
+#define FMSW2 0x20200034 /* Flash 128-bit signature Word 2 */\r
+#define FMSW3 0x20200038 /* Flash 128-bit signature Word 3 */\r
+\r
+#define EECMD 0x20200080 /* EEPROM command */\r
+#define EEADDR 0x20200084 /* EEPROM address */\r
+#define EEWDATA 0x20200088 /* EEPROM write data */\r
+#define EERDATA 0x2020008C /* EEPROM read data */\r
+#define EEWSTATE 0x20200090 /* EEPROM wait state */\r
+#define EECLKDIV 0x20200094 /* EEPROM clock divider */\r
+#define EEPWRDWN 0x20200098 /* EEPROM power-down/start */\r
+#define EEMSSTART 0x2020009C /* EEPROM BIST start address */\r
+#define EEMSSTOP 0x202000A0 /* EEPROM BIST stop address */\r
+#define EEMSSIG 0x202000A4 /* EEPROM 24-bit BIST signature */\r
+\r
+#define INT_CLR_ENABLE 0x20200FD8 /* Flash/EEPROM interrupt clear enable */\r
+#define INT_SET_ENABLE 0x20200FDC /* Flash/EEPROM interrupt set enable */\r
+#define INT_STATUS 0x20200FE0 /* Flash/EEPROM interrupt status */\r
+#define INT_ENABLE 0x20200FE4 /* Flash/EEPROM interrupt enable */\r
+#define INT_CLR_STATUS 0x20200FE8 /* Flash/EEPROM interrupt clear status */\r
+#define INT_SET_STATUS 0x20200FEC /* Flash/EEPROM interrupt set status */\r
+\r
+/* Interrupt sources */\r
+#define INTSRC_END_OF_PROG (1 << 28)\r
+#define INTSRC_END_OF_BIST (1 << 27)\r
+#define INTSRC_END_OF_RDWR (1 << 26)\r
+#define INTSRC_END_OF_MISR (1 << 2)\r
+#define INTSRC_END_OF_BURN (1 << 1)\r
+#define INTSRC_END_OF_ERASE (1 << 0)\r
+\r
+\r
+/* FCTR bits */\r
+#define FCTR_FS_LOADREQ (1 << 15)\r
+#define FCTR_FS_CACHECLR (1 << 14)\r
+#define FCTR_FS_CACHEBYP (1 << 13)\r
+#define FCTR_FS_PROGREQ (1 << 12)\r
+#define FCTR_FS_RLS (1 << 11)\r
+#define FCTR_FS_PDL (1 << 10)\r
+#define FCTR_FS_PD (1 << 9)\r
+#define FCTR_FS_WPB (1 << 7)\r
+#define FCTR_FS_ISS (1 << 6)\r
+#define FCTR_FS_RLD (1 << 5)\r
+#define FCTR_FS_DCR (1 << 4)\r
+#define FCTR_FS_WEB (1 << 2)\r
+#define FCTR_FS_WRE (1 << 1)\r
+#define FCTR_FS_CS (1 << 0)\r
+/* FPTR bits */\r
+#define FPTR_EN_T (1 << 15)\r
+/* FTCTR bits */\r
+#define FTCTR_FS_BYPASS_R (1 << 29)\r
+#define FTCTR_FS_BYPASS_W (1 << 28)\r
+/* FMSSTOP bits */\r
+#define FMSSTOP_MISR_START (1 << 17)\r
+/* EEMSSTOP bits */\r
+#define EEMSSTOP_STRTBIST (1 << 31)\r
+\r
+/* Index sector */\r
+#define ISS_CUSTOMER_START1 (0x830)\r
+#define ISS_CUSTOMER_END1 (0xA00)\r
+#define ISS_CUSTOMER_SIZE1 (ISS_CUSTOMER_END1 - ISS_CUSTOMER_START1)\r
+#define ISS_CUSTOMER_NWORDS1 (ISS_CUSTOMER_SIZE1 / 4)\r
+#define ISS_CUSTOMER_START2 (0xA40)\r
+#define ISS_CUSTOMER_END2 (0xC00)\r
+#define ISS_CUSTOMER_SIZE2 (ISS_CUSTOMER_END2 - ISS_CUSTOMER_START2)\r
+#define ISS_CUSTOMER_NWORDS2 (ISS_CUSTOMER_SIZE2 / 4)\r
+#define ISS_CUSTOMER_SIZE (ISS_CUSTOMER_SIZE1 + ISS_CUSTOMER_SIZE2)\r
+\r
+\r
+\r
+/**\r
+ * Private data for \c lpc2900 flash driver.\r
+ */\r
+typedef struct lpc2900_flash_bank_s\r
+{\r
+ /**\r
+ * Holds the value read from CHIPID register.\r
+ * The driver will not load if the chipid doesn't match the expected\r
+ * value of 0x209CE02B of the LPC2900 family. A probe will only be done\r
+ * if the chipid does not yet contain the expected value.\r
+ */\r
+ uint32_t chipid;\r
+\r
+ /**\r
+ * String holding device name.\r
+ * This string is set by the probe function to the type number of the\r
+ * device. It takes the form "LPC29xx".\r
+ */\r
+ char * target_name;\r
+\r
+ /**\r
+ * System clock frequency.\r
+ * Holds the clock frequency in Hz, as passed by the configuration file\r
+ * to the <tt>flash bank</tt> command.\r
+ */\r
+ uint32_t clk_sys_fmc;\r
+\r
+ /**\r
+ * Flag to indicate that dangerous operations are possible.\r
+ * This flag can be set by passing the correct password to the\r
+ * <tt>lpc2900 password</tt> command. If set, other dangerous commands,\r
+ * which operate on the index sector, can be executed.\r
+ */\r
+ uint32_t risky;\r
+\r
+ /**\r
+ * Maximum contiguous block of internal SRAM (bytes).\r
+ * Autodetected by the driver. Not the total amount of SRAM, only the\r
+ * the largest \em contiguous block!\r
+ */\r
+ uint32_t max_ram_block;\r
+\r
+} lpc2900_flash_bank_t;\r
+\r
+\r
+\r
+\r
+static int lpc2900_register_commands(struct command_context_s *cmd_ctx);\r
+static int lpc2900_flash_bank_command(struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc,\r
+ struct flash_bank_s *bank);\r
+static int lpc2900_erase(struct flash_bank_s *bank, int first, int last);\r
+static int lpc2900_protect(struct flash_bank_s *bank, int set, int first, int last);\r
+static int lpc2900_write(struct flash_bank_s *bank,\r
+ uint8_t *buffer, uint32_t offset, uint32_t count);\r
+static int lpc2900_probe(struct flash_bank_s *bank);\r
+static int lpc2900_erase_check(struct flash_bank_s *bank);\r
+static int lpc2900_protect_check(struct flash_bank_s *bank);\r
+static int lpc2900_info(struct flash_bank_s *bank, char *buf, int buf_size);\r
+\r
+static uint32_t lpc2900_wait_status(flash_bank_t *bank, uint32_t mask, int timeout);\r
+static void lpc2900_setup(struct flash_bank_s *bank);\r
+static uint32_t lpc2900_is_ready(struct flash_bank_s *bank);\r
+static uint32_t lpc2900_read_security_status(struct flash_bank_s *bank);\r
+static uint32_t lpc2900_run_bist128(struct flash_bank_s *bank,\r
+ uint32_t addr_from, uint32_t addr_to,\r
+ uint32_t (*signature)[4] );\r
+static uint32_t lpc2900_address2sector(struct flash_bank_s *bank, uint32_t offset);\r
+static uint32_t lpc2900_calc_tr( uint32_t clock, uint32_t time );\r
+\r
+\r
+/*********************** Helper functions **************************/\r
+\r
+\r
+/**\r
+ * Wait for an event in mask to occur in INT_STATUS.\r
+ *\r
+ * Return when an event occurs, or after a timeout.\r
+ *\r
+ * @param[in] bank Pointer to the flash bank descriptor\r
+ * @param[in] mask Mask to be used for INT_STATUS\r
+ * @param[in] timeout Timeout in ms\r
+ */\r
+static uint32_t lpc2900_wait_status( flash_bank_t *bank,\r
+ uint32_t mask,\r
+ int timeout )\r
+{\r
+ uint32_t int_status;\r
+ target_t *target = bank->target;\r
+\r
+\r
+ do\r
+ {\r
+ alive_sleep(1);\r
+ timeout--;\r
+ target_read_u32(target, INT_STATUS, &int_status);\r
+ }\r
+ while( ((int_status & mask) == 0) && (timeout != 0) );\r
+\r
+ if (timeout == 0)\r
+ {\r
+ LOG_DEBUG("Timeout!");\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+/**\r
+ * Set up the flash for erase/program operations.\r
+ *\r
+ * Enable the flash, and set the correct CRA clock of 66 kHz.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ */\r
+static void lpc2900_setup( struct flash_bank_s *bank )\r
+{\r
+ uint32_t fcra;\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+\r
+ /* Power up the flash block */\r
+ target_write_u32( bank->target, FCTR, FCTR_FS_WEB | FCTR_FS_CS );\r
+\r
+\r
+ fcra = (lpc2900_info->clk_sys_fmc / (3 * 66000)) - 1;\r
+ target_write_u32( bank->target, FCRA, fcra );\r
+}\r
+\r
+\r
+\r
+/**\r
+ * Check if device is ready.\r
+ *\r
+ * Check if device is ready for flash operation:\r
+ * Must have been successfully probed.\r
+ * Must be halted.\r
+ */\r
+static uint32_t lpc2900_is_ready( struct flash_bank_s *bank )\r
+{\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+ if( lpc2900_info->chipid != EXPECTED_CHIPID )\r
+ {\r
+ return ERROR_FLASH_BANK_NOT_PROBED;\r
+ }\r
+\r
+ if( bank->target->state != TARGET_HALTED )\r
+ {\r
+ LOG_ERROR( "Target not halted" );\r
+ return ERROR_TARGET_NOT_HALTED;\r
+ }\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Read the status of sector security from the index sector.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ */\r
+static uint32_t lpc2900_read_security_status( struct flash_bank_s *bank )\r
+{\r
+ uint32_t status;\r
+ if( (status = lpc2900_is_ready( bank )) != ERROR_OK )\r
+ {\r
+ return status;\r
+ }\r
+\r
+ target_t *target = bank->target;\r
+\r
+ /* Enable ISS access */\r
+ target_write_u32(target, FCTR, FCTR_FS_CS | FCTR_FS_WEB | FCTR_FS_ISS);\r
+\r
+ /* Read the relevant block of memory from the ISS sector */\r
+ uint32_t iss_secured_field[ 0x230/16 ][ 4 ];\r
+ target_read_memory(target, bank->base + 0xC00, 4, 0x230/4,\r
+ (uint8_t *)iss_secured_field);\r
+\r
+ /* Disable ISS access */\r
+ target_write_u32(target, FCTR, FCTR_FS_CS | FCTR_FS_WEB);\r
+\r
+ /* Check status of each sector. Note that the sector numbering in the LPC2900\r
+ * is different from the logical sector numbers used in OpenOCD!\r
+ * Refer to the user manual for details.\r
+ *\r
+ * All zeros (16x 0x00) are treated as a secured sector (is_protected = 1)\r
+ * All ones (16x 0xFF) are treated as a non-secured sector (is_protected = 0)\r
+ * Anything else is undefined (is_protected = -1). This is treated as\r
+ * a protected sector!\r
+ */\r
+ int sector;\r
+ int index;\r
+ for( sector = 0; sector < bank->num_sectors; sector++ )\r
+ {\r
+ /* Convert logical sector number to physical sector number */\r
+ if( sector <= 4 )\r
+ {\r
+ index = sector + 11;\r
+ }\r
+ else if( sector <= 7 )\r
+ {\r
+ index = sector + 27;\r
+ }\r
+ else\r
+ {\r
+ index = sector - 8;\r
+ }\r
+\r
+ bank->sectors[sector].is_protected = -1;\r
+\r
+ if (\r
+ (iss_secured_field[index][0] == 0x00000000) &&\r
+ (iss_secured_field[index][1] == 0x00000000) &&\r
+ (iss_secured_field[index][2] == 0x00000000) &&\r
+ (iss_secured_field[index][3] == 0x00000000) )\r
+ {\r
+ bank->sectors[sector].is_protected = 1;\r
+ }\r
+\r
+ if (\r
+ (iss_secured_field[index][0] == 0xFFFFFFFF) &&\r
+ (iss_secured_field[index][1] == 0xFFFFFFFF) &&\r
+ (iss_secured_field[index][2] == 0xFFFFFFFF) &&\r
+ (iss_secured_field[index][3] == 0xFFFFFFFF) )\r
+ {\r
+ bank->sectors[sector].is_protected = 0;\r
+ }\r
+ }\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Use BIST to calculate a 128-bit hash value over a range of flash.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ * @param addr_from\r
+ * @param addr_to\r
+ * @param signature\r
+ */\r
+static uint32_t lpc2900_run_bist128(struct flash_bank_s *bank,\r
+ uint32_t addr_from,\r
+ uint32_t addr_to,\r
+ uint32_t (*signature)[4] )\r
+{\r
+ target_t *target = bank->target;\r
+\r
+ /* Clear END_OF_MISR interrupt status */\r
+ target_write_u32( target, INT_CLR_STATUS, INTSRC_END_OF_MISR );\r
+\r
+ /* Start address */\r
+ target_write_u32( target, FMSSTART, addr_from >> 4);\r
+ /* End address, and issue start command */\r
+ target_write_u32( target, FMSSTOP, (addr_to >> 4) | FMSSTOP_MISR_START );\r
+\r
+ /* Poll for end of operation. Calculate a reasonable timeout. */\r
+ if( lpc2900_wait_status( bank, INTSRC_END_OF_MISR, 1000 ) != ERROR_OK )\r
+ {\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* Return the signature */\r
+ target_read_memory( target, FMSW0, 4, 4, (uint8_t *)signature );\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Return sector number for given address.\r
+ *\r
+ * Return the (logical) sector number for a given relative address.\r
+ * No sanity check is done. It assumed that the address is valid.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ * @param offset Offset address relative to bank start\r
+ */\r
+static uint32_t lpc2900_address2sector( struct flash_bank_s *bank,\r
+ uint32_t offset )\r
+{\r
+ uint32_t address = bank->base + offset;\r
+\r
+\r
+ /* Run through all sectors of this bank */\r
+ int sector;\r
+ for( sector = 0; sector < bank->num_sectors; sector++ )\r
+ {\r
+ /* Return immediately if address is within the current sector */\r
+ if( address < (bank->sectors[sector].offset + bank->sectors[sector].size) )\r
+ {\r
+ return sector;\r
+ }\r
+ }\r
+\r
+ /* We should never come here. If we do, return an arbitrary sector number. */\r
+ return 0;\r
+}\r
+\r
+\r
+\r
+\r
+/**\r
+ * Write one page to the index sector.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ * @param pagenum Page number (0...7)\r
+ * @param page Page array (FLASH_PAGE_SIZE bytes)\r
+ */\r
+static int lpc2900_write_index_page( struct flash_bank_s *bank,\r
+ int pagenum,\r
+ uint8_t (*page)[FLASH_PAGE_SIZE] )\r
+{\r
+ /* Only pages 4...7 are user writable */\r
+ if( (pagenum < 4) || (pagenum > 7) )\r
+ {\r
+ LOG_ERROR( "Refuse to burn index sector page %" PRIu32, pagenum );\r
+ return ERROR_COMMAND_ARGUMENT_INVALID;\r
+ }\r
+\r
+ /* Get target, and check if it's halted */\r
+ target_t *target = bank->target;\r
+ if( target->state != TARGET_HALTED )\r
+ {\r
+ LOG_ERROR( "Target not halted" );\r
+ return ERROR_TARGET_NOT_HALTED;\r
+ }\r
+\r
+ /* Private info */\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+ /* Enable flash block and set the correct CRA clock of 66 kHz */\r
+ lpc2900_setup( bank );\r
+\r
+ /* Un-protect the index sector */\r
+ target_write_u32( target, bank->base, 0 );\r
+ target_write_u32( target, FCTR,\r
+ FCTR_FS_LOADREQ | FCTR_FS_WPB | FCTR_FS_ISS |\r
+ FCTR_FS_WEB | FCTR_FS_WRE | FCTR_FS_CS );\r
+\r
+ /* Set latch load mode */\r
+ target_write_u32( target, FCTR,\r
+ FCTR_FS_ISS | FCTR_FS_WEB | FCTR_FS_WRE | FCTR_FS_CS );\r
+\r
+ /* Write whole page to flash data latches */\r
+ if( target_write_memory( target,\r
+ bank->base + pagenum * FLASH_PAGE_SIZE,\r
+ 4, FLASH_PAGE_SIZE / 4, (uint8_t *)page) != ERROR_OK )\r
+ {\r
+ LOG_ERROR( "Index sector write failed @ page %" PRIu32, pagenum );\r
+ target_write_u32( target, FCTR, FCTR_FS_CS | FCTR_FS_WEB );\r
+\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* Clear END_OF_BURN interrupt status */\r
+ target_write_u32( target, INT_CLR_STATUS, INTSRC_END_OF_BURN );\r
+\r
+ /* Set the program/erase time to FLASH_PROGRAM_TIME */\r
+ target_write_u32(target, FPTR,\r
+ FPTR_EN_T | lpc2900_calc_tr( lpc2900_info->clk_sys_fmc,\r
+ FLASH_PROGRAM_TIME ));\r
+\r
+ /* Trigger flash write */\r
+ target_write_u32( target, FCTR,\r
+ FCTR_FS_PROGREQ | FCTR_FS_ISS |\r
+ FCTR_FS_WPB | FCTR_FS_WRE | FCTR_FS_CS );\r
+\r
+ /* Wait for the end of the write operation. If it's not over after one\r
+ * second, something went dreadfully wrong... :-(\r
+ */\r
+ if( lpc2900_wait_status( bank, INTSRC_END_OF_BURN, 1000 ) != ERROR_OK )\r
+ {\r
+ LOG_ERROR( "Index sector write failed @ page %" PRIu32, pagenum );\r
+ target_write_u32( target, FCTR, FCTR_FS_CS | FCTR_FS_WEB );\r
+\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ target_write_u32( target, FCTR, FCTR_FS_CS | FCTR_FS_WEB );\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+/**\r
+ * Calculate FPTR.TR register value for desired program/erase time.\r
+ *\r
+ * @param clock System clock in Hz\r
+ * @param time Program/erase time in µs\r
+ */\r
+static uint32_t lpc2900_calc_tr( uint32_t clock, uint32_t time )\r
+{\r
+ /* ((time[µs]/1e6) * f[Hz]) + 511\r
+ * FPTR.TR = -------------------------------\r
+ * 512\r
+ *\r
+ * The result is the \r
+ */\r
+\r
+ uint32_t tr_val = (uint32_t)((((time / 1e6) * clock) + 511.0) / 512.0);\r
+\r
+ return tr_val;\r
+}\r
+\r
+\r
+/*********************** Private flash commands **************************/\r
+\r
+\r
+/**\r
+ * Command to determine the signature of the whole flash.\r
+ *\r
+ * Uses the Built-In-Self-Test (BIST) to generate a 128-bit hash value\r
+ * of the flash content.\r
+ *\r
+ * @param cmd_ctx\r
+ * @param cmd\r
+ * @param args\r
+ * @param argc\r
+ */\r
+static int lpc2900_handle_signature_command( struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc )\r
+{\r
+ flash_bank_t *bank;\r
+ uint32_t status;\r
+ uint32_t signature[4];\r
+\r
+\r
+ if( argc < 1 )\r
+ {\r
+ LOG_WARNING( "Too few arguments. Call: lpc2900 signature <bank#>" );\r
+ return ERROR_FLASH_BANK_INVALID;\r
+ }\r
+\r
+ /* Get the bank descriptor */\r
+ bank = get_flash_bank_by_num( strtoul(args[0], NULL, 0) );\r
+ if( !bank )\r
+ {\r
+ command_print( cmd_ctx, "flash bank '#%s' is out of bounds", args[0] );\r
+ return ERROR_OK;\r
+ }\r
+\r
+ if( bank->target->state != TARGET_HALTED )\r
+ {\r
+ LOG_ERROR( "Target not halted" );\r
+ return ERROR_TARGET_NOT_HALTED;\r
+ }\r
+\r
+ /* Run BIST over whole flash range */\r
+ if( (status = lpc2900_run_bist128( bank,\r
+ bank->base,\r
+ bank->base + (bank->size - 1),\r
+ &signature)\r
+ ) != ERROR_OK )\r
+ {\r
+ return status;\r
+ }\r
+\r
+ command_print( cmd_ctx, "signature: 0x%8.8" PRIx32\r
+ ":0x%8.8" PRIx32\r
+ ":0x%8.8" PRIx32\r
+ ":0x%8.8" PRIx32,\r
+ signature[3], signature[2], signature[1], signature[0] );\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+/**\r
+ * Store customer info in file.\r
+ *\r
+ * Read customer info from index sector, and store that block of data into\r
+ * a disk file. The format is binary.\r
+ *\r
+ * @param cmd_ctx\r
+ * @param cmd\r
+ * @param args\r
+ * @param argc\r
+ */\r
+static int lpc2900_handle_read_custom_command( struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc )\r
+{\r
+ flash_bank_t *bank;\r
+\r
+\r
+ if( argc < 2 )\r
+ {\r
+ return ERROR_COMMAND_SYNTAX_ERROR;\r
+ }\r
+\r
+ /* Get the bank descriptor */\r
+ bank = get_flash_bank_by_num( strtoul(args[0], NULL, 0) );\r
+ if( !bank )\r
+ {\r
+ command_print( cmd_ctx, "flash bank '#%s' is out of bounds", args[0] );\r
+ return ERROR_OK;\r
+ }\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+ lpc2900_info->risky = 0;\r
+\r
+ /* Get target, and check if it's halted */\r
+ target_t *target = bank->target;\r
+ if( target->state != TARGET_HALTED )\r
+ {\r
+ LOG_ERROR( "Target not halted" );\r
+ return ERROR_TARGET_NOT_HALTED;\r
+ }\r
+\r
+ /* Storage for customer info. Read in two parts */\r
+ uint32_t customer[ ISS_CUSTOMER_NWORDS1 + ISS_CUSTOMER_NWORDS2 ];\r
+\r
+ /* Enable access to index sector */\r
+ target_write_u32( target, FCTR, FCTR_FS_CS | FCTR_FS_WEB | FCTR_FS_ISS );\r
+\r
+ /* Read two parts */\r
+ target_read_memory( target, bank->base+ISS_CUSTOMER_START1, 4,\r
+ ISS_CUSTOMER_NWORDS1,\r
+ (uint8_t *)&customer[0] );\r
+ target_read_memory( target, bank->base+ISS_CUSTOMER_START2, 4,\r
+ ISS_CUSTOMER_NWORDS2,\r
+ (uint8_t *)&customer[ISS_CUSTOMER_NWORDS1] );\r
+\r
+ /* Deactivate access to index sector */\r
+ target_write_u32( target, FCTR, FCTR_FS_CS | FCTR_FS_WEB );\r
+\r
+ /* Try and open the file */\r
+ fileio_t fileio;\r
+ char *filename = args[1];\r
+ int ret = fileio_open( &fileio, filename, FILEIO_WRITE, FILEIO_BINARY );\r
+ if( ret != ERROR_OK )\r
+ {\r
+ LOG_WARNING( "Could not open file %s", filename );\r
+ return ret;\r
+ }\r
+\r
+ uint32_t nwritten;\r
+ ret = fileio_write( &fileio, sizeof(customer),\r
+ (const uint8_t *)customer, &nwritten );\r
+ if( ret != ERROR_OK )\r
+ {\r
+ LOG_ERROR( "Write operation to file %s failed", filename );\r
+ fileio_close( &fileio );\r
+ return ret;\r
+ }\r
+\r
+ fileio_close( &fileio );\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+\r
+/**\r
+ * Enter password to enable potentially dangerous options.\r
+ *\r
+ * @param cmd_ctx\r
+ * @param cmd\r
+ * @param args\r
+ * @param argc\r
+ */\r
+static int lpc2900_handle_password_command(struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc)\r
+{\r
+ flash_bank_t *bank;\r
+\r
+\r
+ if (argc < 2)\r
+ {\r
+ return ERROR_COMMAND_SYNTAX_ERROR;\r
+ }\r
+\r
+ /* Get the bank descriptor */\r
+ bank = get_flash_bank_by_num(strtoul(args[0], NULL, 0));\r
+ if (!bank)\r
+ {\r
+ command_print(cmd_ctx, "flash bank '#%s' is out of bounds", args[0]);\r
+ return ERROR_OK;\r
+ }\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+#define ISS_PASSWORD "I_know_what_I_am_doing"\r
+\r
+ lpc2900_info->risky = !strcmp( args[1], ISS_PASSWORD );\r
+\r
+ if( !lpc2900_info->risky )\r
+ {\r
+ command_print(cmd_ctx, "Wrong password (use '%s')", ISS_PASSWORD);\r
+ return ERROR_COMMAND_ARGUMENT_INVALID;\r
+ }\r
+\r
+ command_print(cmd_ctx,\r
+ "Potentially dangerous operation allowed in next command!");\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+/**\r
+ * Write customer info from file to the index sector.\r
+ *\r
+ * @param cmd_ctx\r
+ * @param cmd\r
+ * @param args\r
+ * @param argc\r
+ */\r
+static int lpc2900_handle_write_custom_command( struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc )\r
+{\r
+ if (argc < 2)\r
+ {\r
+ return ERROR_COMMAND_SYNTAX_ERROR;\r
+ }\r
+\r
+ /* Get the bank descriptor */\r
+ flash_bank_t *bank = get_flash_bank_by_num(strtoul(args[0], NULL, 0));\r
+ if (!bank)\r
+ {\r
+ command_print(cmd_ctx, "flash bank '#%s' is out of bounds", args[0]);\r
+ return ERROR_OK;\r
+ }\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+ /* Check if command execution is allowed. */\r
+ if( !lpc2900_info->risky )\r
+ {\r
+ command_print( cmd_ctx, "Command execution not allowed!" );\r
+ return ERROR_COMMAND_ARGUMENT_INVALID;\r
+ }\r
+ lpc2900_info->risky = 0;\r
+\r
+ /* Get target, and check if it's halted */\r
+ target_t *target = bank->target;\r
+ if (target->state != TARGET_HALTED)\r
+ {\r
+ LOG_ERROR("Target not halted");\r
+ return ERROR_TARGET_NOT_HALTED;\r
+ }\r
+\r
+ /* The image will always start at offset 0 */\r
+ image_t image;\r
+ image.base_address_set = 1;\r
+ image.base_address = 0;\r
+ image.start_address_set = 0;\r
+\r
+ char *filename = args[1];\r
+ char *type = (argc >= 3) ? args[2] : NULL;\r
+ int retval = image_open(&image, filename, type);\r
+ if (retval != ERROR_OK)\r
+ {\r
+ return retval;\r
+ }\r
+\r
+ /* Do a sanity check: The image must be exactly the size of the customer\r
+ programmable area. Any other size is rejected. */\r
+ if( image.num_sections != 1 )\r
+ {\r
+ LOG_ERROR("Only one section allowed in image file.");\r
+ return ERROR_COMMAND_SYNTAX_ERROR;\r
+ }\r
+ if( (image.sections[0].base_address != 0) ||\r
+ (image.sections[0].size != ISS_CUSTOMER_SIZE) )\r
+ {\r
+ LOG_ERROR("Incorrect image file size. Expected %" PRIu32 ", got %" PRIu32,\r
+ ISS_CUSTOMER_SIZE, image.sections[0].size);\r
+ return ERROR_COMMAND_SYNTAX_ERROR;\r
+ }\r
+\r
+ /* Well boys, I reckon this is it... */\r
+\r
+ /* Customer info is split into two blocks in pages 4 and 5. */\r
+ uint8_t page[FLASH_PAGE_SIZE];\r
+\r
+ /* Page 4 */\r
+ uint32_t offset = ISS_CUSTOMER_START1 % FLASH_PAGE_SIZE;\r
+ memset( page, 0xff, FLASH_PAGE_SIZE );\r
+ uint32_t size_read;\r
+ retval = image_read_section( &image, 0, 0,\r
+ ISS_CUSTOMER_SIZE1, &page[offset], &size_read);\r
+ if( retval != ERROR_OK )\r
+ {\r
+ LOG_ERROR("couldn't read from file '%s'", filename);\r
+ image_close(&image);\r
+ return retval;\r
+ }\r
+ if( (retval = lpc2900_write_index_page( bank, 4, &page )) != ERROR_OK )\r
+ {\r
+ image_close(&image);\r
+ return retval;\r
+ }\r
+\r
+ /* Page 5 */\r
+ offset = ISS_CUSTOMER_START2 % FLASH_PAGE_SIZE;\r
+ memset( page, 0xff, FLASH_PAGE_SIZE );\r
+ retval = image_read_section( &image, 0, ISS_CUSTOMER_SIZE1,\r
+ ISS_CUSTOMER_SIZE2, &page[offset], &size_read);\r
+ if( retval != ERROR_OK )\r
+ {\r
+ LOG_ERROR("couldn't read from file '%s'", filename);\r
+ image_close(&image);\r
+ return retval;\r
+ }\r
+ if( (retval = lpc2900_write_index_page( bank, 5, &page )) != ERROR_OK )\r
+ {\r
+ image_close(&image);\r
+ return retval;\r
+ }\r
+\r
+ image_close(&image);\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+/**\r
+ * Activate 'sector security' for a range of sectors.\r
+ *\r
+ * @param cmd_ctx\r
+ * @param cmd\r
+ * @param args\r
+ * @param argc\r
+ */\r
+static int lpc2900_handle_secure_sector_command(struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc)\r
+{\r
+ if (argc < 3)\r
+ {\r
+ return ERROR_COMMAND_SYNTAX_ERROR;\r
+ }\r
+\r
+ /* Get the bank descriptor */\r
+ flash_bank_t *bank = get_flash_bank_by_num(strtoul(args[0], NULL, 0));\r
+ if (!bank)\r
+ {\r
+ command_print(cmd_ctx, "flash bank '#%s' is out of bounds", args[0]);\r
+ return ERROR_OK;\r
+ }\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+ /* Check if command execution is allowed. */\r
+ if( !lpc2900_info->risky )\r
+ {\r
+ command_print( cmd_ctx, "Command execution not allowed! "\r
+ "(use 'password' command first)");\r
+ return ERROR_COMMAND_ARGUMENT_INVALID;\r
+ }\r
+ lpc2900_info->risky = 0;\r
+\r
+ /* Read sector range, and do a sanity check. */\r
+ int first = strtoul(args[1], NULL, 0);\r
+ int last = strtoul(args[2], NULL, 0);\r
+ if( (first >= bank->num_sectors) ||\r
+ (last >= bank->num_sectors) ||\r
+ (first > last) )\r
+ {\r
+ command_print( cmd_ctx, "Illegal sector range" );\r
+ return ERROR_COMMAND_ARGUMENT_INVALID;\r
+ }\r
+\r
+ uint8_t page[FLASH_PAGE_SIZE];\r
+ int sector;\r
+ int retval;\r
+\r
+ /* Sectors in page 6 */\r
+ if( (first <= 4) || (last >= 8) )\r
+ {\r
+ memset( &page, 0xff, FLASH_PAGE_SIZE );\r
+ for( sector = first; sector <= last; sector++ )\r
+ {\r
+ if( sector <= 4 )\r
+ {\r
+ memset( &page[0xB0 + 16*sector], 0, 16 );\r
+ }\r
+ else if( sector >= 8 )\r
+ {\r
+ memset( &page[0x00 + 16*(sector - 8)], 0, 16 );\r
+ }\r
+ }\r
+\r
+ if( (retval = lpc2900_write_index_page( bank, 6, &page )) != ERROR_OK )\r
+ {\r
+ LOG_ERROR("failed to update index sector page 6");\r
+ return retval;\r
+ }\r
+ }\r
+\r
+ /* Sectors in page 7 */\r
+ if( (first <= 7) && (last >= 5) )\r
+ {\r
+ memset( &page, 0xff, FLASH_PAGE_SIZE );\r
+ for( sector = first; sector <= last; sector++ )\r
+ {\r
+ if( (sector >= 5) && (sector <= 7) )\r
+ {\r
+ memset( &page[0x00 + 16*(sector - 5)], 0, 16 );\r
+ }\r
+ }\r
+\r
+ if( (retval = lpc2900_write_index_page( bank, 7, &page )) != ERROR_OK )\r
+ {\r
+ LOG_ERROR("failed to update index sector page 7");\r
+ return retval;\r
+ }\r
+ }\r
+\r
+ command_print( cmd_ctx,\r
+ "Sectors security will become effective after next power cycle");\r
+\r
+ /* Update the sector security status */\r
+ if ( lpc2900_read_security_status(bank) != ERROR_OK )\r
+ {\r
+ LOG_ERROR( "Cannot determine sector security status" );\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+/**\r
+ * Activate JTAG protection.\r
+ *\r
+ * @param cmd_ctx\r
+ * @param cmd\r
+ * @param args\r
+ * @param argc\r
+ */\r
+static int lpc2900_handle_secure_jtag_command(struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc)\r
+{\r
+ if (argc < 1)\r
+ {\r
+ return ERROR_COMMAND_SYNTAX_ERROR;\r
+ }\r
+\r
+ /* Get the bank descriptor */\r
+ flash_bank_t *bank = get_flash_bank_by_num(strtoul(args[0], NULL, 0));\r
+ if (!bank)\r
+ {\r
+ command_print(cmd_ctx, "flash bank '#%s' is out of bounds", args[0]);\r
+ return ERROR_OK;\r
+ }\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+ /* Check if command execution is allowed. */\r
+ if( !lpc2900_info->risky )\r
+ {\r
+ command_print( cmd_ctx, "Command execution not allowed! "\r
+ "(use 'password' command first)");\r
+ return ERROR_COMMAND_ARGUMENT_INVALID;\r
+ }\r
+ lpc2900_info->risky = 0;\r
+\r
+ /* Prepare page */\r
+ uint8_t page[FLASH_PAGE_SIZE];\r
+ memset( &page, 0xff, FLASH_PAGE_SIZE );\r
+\r
+\r
+ /* Insert "soft" protection word */\r
+ page[0x30 + 15] = 0x7F;\r
+ page[0x30 + 11] = 0x7F;\r
+ page[0x30 + 7] = 0x7F;\r
+ page[0x30 + 3] = 0x7F;\r
+\r
+ /* Write to page 5 */\r
+ int retval;\r
+ if( (retval = lpc2900_write_index_page( bank, 5, &page ))\r
+ != ERROR_OK )\r
+ {\r
+ LOG_ERROR("failed to update index sector page 5");\r
+ return retval;\r
+ }\r
+\r
+ LOG_INFO("JTAG security set. Good bye!");\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+/*********************** Flash interface functions **************************/\r
+\r
+\r
+/**\r
+ * Register private command handlers.\r
+ *\r
+ * @param cmd_ctx\r
+ */\r
+static int lpc2900_register_commands(struct command_context_s *cmd_ctx)\r
+{\r
+ command_t *lpc2900_cmd = register_command(cmd_ctx, NULL, "lpc2900",\r
+ NULL, COMMAND_ANY, NULL);\r
+\r
+ register_command(\r
+ cmd_ctx,\r
+ lpc2900_cmd,\r
+ "signature",\r
+ lpc2900_handle_signature_command,\r
+ COMMAND_EXEC,\r
+ "<bank> | "\r
+ "print device signature of flash bank");\r
+\r
+ register_command(\r
+ cmd_ctx,\r
+ lpc2900_cmd,\r
+ "read_custom",\r
+ lpc2900_handle_read_custom_command,\r
+ COMMAND_EXEC,\r
+ "<bank> <filename> | "\r
+ "read customer information from index sector to file");\r
+\r
+ register_command(\r
+ cmd_ctx,\r
+ lpc2900_cmd,\r
+ "password",\r
+ lpc2900_handle_password_command,\r
+ COMMAND_EXEC,\r
+ "<bank> <password> | "\r
+ "enter password to enable 'dangerous' options");\r
+\r
+ register_command(\r
+ cmd_ctx,\r
+ lpc2900_cmd,\r
+ "write_custom",\r
+ lpc2900_handle_write_custom_command,\r
+ COMMAND_EXEC,\r
+ "<bank> <filename> [<type>] | "\r
+ "write customer info from file to index sector");\r
+\r
+ register_command(\r
+ cmd_ctx,\r
+ lpc2900_cmd,\r
+ "secure_sector",\r
+ lpc2900_handle_secure_sector_command,\r
+ COMMAND_EXEC,\r
+ "<bank> <first> <last> | "\r
+ "activate sector security for a range of sectors");\r
+\r
+ register_command(\r
+ cmd_ctx,\r
+ lpc2900_cmd,\r
+ "secure_jtag",\r
+ lpc2900_handle_secure_jtag_command,\r
+ COMMAND_EXEC,\r
+ "<bank> <level> | "\r
+ "activate JTAG security");\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Evaluate flash bank command.\r
+ *\r
+ * Syntax: flash bank lpc2900 0 0 0 0 target# system_base_clock\r
+ *\r
+ * @param cmd_ctx\r
+ * @param cmd\r
+ * @param args\r
+ * @param argc\r
+ * @param bank Pointer to the flash bank descriptor\r
+ */\r
+static int lpc2900_flash_bank_command(struct command_context_s *cmd_ctx,\r
+ char *cmd, char **args, int argc,\r
+ struct flash_bank_s *bank)\r
+{\r
+ lpc2900_flash_bank_t *lpc2900_info;\r
+\r
+ if (argc < 6)\r
+ {\r
+ LOG_WARNING("incomplete flash_bank LPC2900 configuration");\r
+ return ERROR_FLASH_BANK_INVALID;\r
+ }\r
+\r
+ lpc2900_info = malloc(sizeof(lpc2900_flash_bank_t));\r
+ bank->driver_priv = lpc2900_info;\r
+\r
+ /* Get flash clock.\r
+ * Reject it if we can't meet the requirements for program time\r
+ * (if clock too slow), or for erase time (clock too fast).\r
+ */\r
+ lpc2900_info->clk_sys_fmc = strtoul(args[6], NULL, 0) * 1000;\r
+\r
+ uint32_t clock_limit;\r
+ /* Check program time limit */\r
+ clock_limit = 512000000l / FLASH_PROGRAM_TIME;\r
+ if (lpc2900_info->clk_sys_fmc < clock_limit)\r
+ {\r
+ LOG_WARNING("flash clock must be at least %" PRIu32 " kHz",\r
+ (clock_limit / 1000));\r
+ return ERROR_FLASH_BANK_INVALID;\r
+ }\r
+\r
+ /* Check erase time limit */\r
+ clock_limit = (uint32_t)((32767.0 * 512.0 * 1e6) / FLASH_ERASE_TIME);\r
+ if (lpc2900_info->clk_sys_fmc > clock_limit)\r
+ {\r
+ LOG_WARNING("flash clock must be a maximum of %" PRIu32" kHz",\r
+ (clock_limit / 1000));\r
+ return ERROR_FLASH_BANK_INVALID;\r
+ }\r
+\r
+ /* Chip ID will be obtained by probing the device later */\r
+ lpc2900_info->chipid = 0;\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Erase sector(s).\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ * @param first First sector to be erased\r
+ * @param last Last sector (including) to be erased\r
+ */\r
+static int lpc2900_erase(struct flash_bank_s *bank, int first, int last)\r
+{\r
+ uint32_t status;\r
+ int sector;\r
+ int last_unsecured_sector;\r
+ target_t *target = bank->target;\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+\r
+\r
+ status = lpc2900_is_ready(bank);\r
+ if (status != ERROR_OK)\r
+ {\r
+ return status;\r
+ }\r
+\r
+ /* Sanity check on sector range */\r
+ if ((first < 0) || (last < first) || (last >= bank->num_sectors))\r
+ {\r
+ LOG_INFO("Bad sector range");\r
+ return ERROR_FLASH_SECTOR_INVALID;\r
+ }\r
+\r
+ /* Update the info about secured sectors */\r
+ lpc2900_read_security_status( bank );\r
+\r
+ /* The selected sector range might include secured sectors. An attempt\r
+ * to erase such a sector will cause the erase to fail also for unsecured\r
+ * sectors. It is necessary to determine the last unsecured sector now,\r
+ * because we have to treat the last relevant sector in the list in\r
+ * a special way.\r
+ */\r
+ last_unsecured_sector = -1;\r
+ for (sector = first; sector <= last; sector++)\r
+ {\r
+ if ( !bank->sectors[sector].is_protected )\r
+ {\r
+ last_unsecured_sector = sector;\r
+ }\r
+ }\r
+\r
+ /* Exit now, in case of the rare constellation where all sectors in range\r
+ * are secured. This is regarded a success, since erasing/programming of\r
+ * secured sectors shall be handled transparently.\r
+ */\r
+ if ( last_unsecured_sector == -1 )\r
+ {\r
+ return ERROR_OK;\r
+ }\r
+\r
+ /* Enable flash block and set the correct CRA clock of 66 kHz */\r
+ lpc2900_setup(bank);\r
+\r
+ /* Clear END_OF_ERASE interrupt status */\r
+ target_write_u32(target, INT_CLR_STATUS, INTSRC_END_OF_ERASE);\r
+\r
+ /* Set the program/erase timer to FLASH_ERASE_TIME */\r
+ target_write_u32(target, FPTR,\r
+ FPTR_EN_T | lpc2900_calc_tr( lpc2900_info->clk_sys_fmc,\r
+ FLASH_ERASE_TIME ));\r
+\r
+ /* Sectors are marked for erasure, then erased all together */\r
+ for (sector = first; sector <= last_unsecured_sector; sector++)\r
+ {\r
+ /* Only mark sectors that aren't secured. Any attempt to erase a group\r
+ * of sectors will fail if any single one of them is secured!\r
+ */\r
+ if ( !bank->sectors[sector].is_protected )\r
+ {\r
+ /* Unprotect the sector */\r
+ target_write_u32(target, bank->sectors[sector].offset, 0);\r
+ target_write_u32(target, FCTR,\r
+ FCTR_FS_LOADREQ | FCTR_FS_WPB |\r
+ FCTR_FS_WEB | FCTR_FS_WRE | FCTR_FS_CS);\r
+\r
+ /* Mark the sector for erasure. The last sector in the list\r
+ triggers the erasure. */\r
+ target_write_u32(target, bank->sectors[sector].offset, 0);\r
+ if ( sector == last_unsecured_sector )\r
+ {\r
+ target_write_u32(target, FCTR,\r
+ FCTR_FS_PROGREQ | FCTR_FS_WPB | FCTR_FS_CS);\r
+ }\r
+ else\r
+ {\r
+ target_write_u32(target, FCTR,\r
+ FCTR_FS_LOADREQ | FCTR_FS_WPB |\r
+ FCTR_FS_WEB | FCTR_FS_CS);\r
+ }\r
+ }\r
+ }\r
+\r
+ /* Wait for the end of the erase operation. If it's not over after two seconds,\r
+ * something went dreadfully wrong... :-(\r
+ */\r
+ if( lpc2900_wait_status(bank, INTSRC_END_OF_ERASE, 2000) != ERROR_OK )\r
+ {\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* Normal flash operating mode */\r
+ target_write_u32(target, FCTR, FCTR_FS_CS | FCTR_FS_WEB);\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+\r
+static int lpc2900_protect(struct flash_bank_s *bank, int set, int first, int last)\r
+{\r
+ /* This command is not supported.\r
+ * "Protection" in LPC2900 terms is handled transparently. Sectors will\r
+ * automatically be unprotected as needed.\r
+ * Instead we use the concept of sector security. A secured sector is shown\r
+ * as "protected" in OpenOCD. Sector security is a permanent feature, and\r
+ * cannot be disabled once activated.\r
+ */\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Write data to flash.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ * @param buffer Buffer with data\r
+ * @param offset Start address (relative to bank start)\r
+ * @param count Number of bytes to be programmed\r
+ */\r
+static int lpc2900_write(struct flash_bank_s *bank, uint8_t *buffer,\r
+ uint32_t offset, uint32_t count)\r
+{\r
+ uint8_t page[FLASH_PAGE_SIZE];\r
+ uint32_t status;\r
+ uint32_t num_bytes;\r
+ target_t *target = bank->target;\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+ int sector;\r
+ int retval;\r
+\r
+ static const uint32_t write_target_code[] = {\r
+ /* Set auto latch mode: FCTR=CS|WRE|WEB */\r
+ 0xe3a0a007, /* loop mov r10, #0x007 */\r
+ 0xe583a000, /* str r10,[r3,#0] */\r
+\r
+ /* Load complete page into latches */\r
+ 0xe3a06020, /* mov r6,#(512/16) */\r
+ 0xe8b00f00, /* next ldmia r0!,{r8-r11} */\r
+ 0xe8a10f00, /* stmia r1!,{r8-r11} */\r
+ 0xe2566001, /* subs r6,#1 */\r
+ 0x1afffffb, /* bne next */\r
+\r
+ /* Clear END_OF_BURN interrupt status */\r
+ 0xe3a0a002, /* mov r10,#(1 << 1) */\r
+ 0xe583afe8, /* str r10,[r3,#0xfe8] */\r
+\r
+ /* Set the erase time to FLASH_PROGRAM_TIME */\r
+ 0xe5834008, /* str r4,[r3,#8] */\r
+\r
+ /* Trigger flash write\r
+ FCTR = CS | WRE | WPB | PROGREQ */\r
+ 0xe3a0a083, /* mov r10,#0x83 */\r
+ 0xe38aaa01, /* orr r10,#0x1000 */\r
+ 0xe583a000, /* str r10,[r3,#0] */\r
+\r
+ /* Wait for end of burn */\r
+ 0xe593afe0, /* wait ldr r10,[r3,#0xfe0] */\r
+ 0xe21aa002, /* ands r10,#(1 << 1) */\r
+ 0x0afffffc, /* beq wait */\r
+\r
+ /* End? */\r
+ 0xe2522001, /* subs r2,#1 */\r
+ 0x1affffed, /* bne loop */\r
+\r
+ 0xeafffffe /* done b done */\r
+ };\r
+\r
+\r
+ status = lpc2900_is_ready(bank);\r
+ if (status != ERROR_OK)\r
+ {\r
+ return status;\r
+ }\r
+\r
+ /* Enable flash block and set the correct CRA clock of 66 kHz */\r
+ lpc2900_setup(bank);\r
+\r
+ /* Update the info about secured sectors */\r
+ lpc2900_read_security_status( bank );\r
+\r
+ /* Unprotect all involved sectors */\r
+ for (sector = 0; sector < bank->num_sectors; sector++)\r
+ {\r
+ /* Start address in or before this sector? */\r
+ /* End address in or behind this sector? */\r
+ if ( ((bank->base + offset) <\r
+ (bank->sectors[sector].offset + bank->sectors[sector].size)) &&\r
+ ((bank->base + (offset + count - 1)) >= bank->sectors[sector].offset) )\r
+ {\r
+ /* This sector is involved and needs to be unprotected.\r
+ * Don't do it for secured sectors.\r
+ */\r
+ if ( !bank->sectors[sector].is_protected )\r
+ {\r
+ target_write_u32(target, bank->sectors[sector].offset, 0);\r
+ target_write_u32(target, FCTR,\r
+ FCTR_FS_LOADREQ | FCTR_FS_WPB |\r
+ FCTR_FS_WEB | FCTR_FS_WRE | FCTR_FS_CS);\r
+ }\r
+ }\r
+ }\r
+\r
+ /* Set the program/erase time to FLASH_PROGRAM_TIME */\r
+ uint32_t prog_time = FPTR_EN_T | lpc2900_calc_tr( lpc2900_info->clk_sys_fmc,\r
+ FLASH_PROGRAM_TIME );\r
+\r
+ /* If there is a working area of reasonable size, use it to program via\r
+ a target algorithm. If not, fall back to host programming. */\r
+\r
+ /* We need some room for target code. */\r
+ uint32_t target_code_size = sizeof(write_target_code);\r
+\r
+ /* Try working area allocation. Start with a large buffer, and try with\r
+ reduced size if that fails. */\r
+ working_area_t *warea;\r
+ uint32_t buffer_size = lpc2900_info->max_ram_block - 1 * KiB;\r
+ while( (retval = target_alloc_working_area(target,\r
+ buffer_size + target_code_size,\r
+ &warea)) != ERROR_OK )\r
+ {\r
+ /* Try a smaller buffer now, and stop if it's too small. */\r
+ buffer_size -= 1 * KiB;\r
+ if (buffer_size < 2 * KiB)\r
+ {\r
+ LOG_INFO( "no (large enough) working area"\r
+ ", falling back to host mode" );\r
+ warea = NULL;\r
+ break;\r
+ }\r
+ };\r
+\r
+ if( warea )\r
+ {\r
+ reg_param_t reg_params[5];\r
+ armv4_5_algorithm_t armv4_5_info;\r
+\r
+ /* We can use target mode. Download the algorithm. */\r
+ retval = target_write_buffer( target,\r
+ (warea->address)+buffer_size,\r
+ target_code_size,\r
+ (uint8_t *)write_target_code);\r
+ if (retval != ERROR_OK)\r
+ {\r
+ LOG_ERROR("Unable to write block write code to target");\r
+ target_free_all_working_areas(target);\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ init_reg_param(®_params[0], "r0", 32, PARAM_OUT);\r
+ init_reg_param(®_params[1], "r1", 32, PARAM_OUT);\r
+ init_reg_param(®_params[2], "r2", 32, PARAM_OUT);\r
+ init_reg_param(®_params[3], "r3", 32, PARAM_OUT);\r
+ init_reg_param(®_params[4], "r4", 32, PARAM_OUT);\r
+\r
+ /* Write to flash in large blocks */\r
+ while ( count != 0 )\r
+ {\r
+ uint32_t this_npages;\r
+ uint8_t *this_buffer;\r
+ int start_sector = lpc2900_address2sector( bank, offset );\r
+\r
+ /* First page / last page / rest */\r
+ if( offset % FLASH_PAGE_SIZE )\r
+ {\r
+ /* Block doesn't start on page boundary.\r
+ Burn first partial page separately. */\r
+ memset( &page, 0xff, sizeof(page) );\r
+ memcpy( &page[offset % FLASH_PAGE_SIZE],\r
+ buffer,\r
+ FLASH_PAGE_SIZE - (offset % FLASH_PAGE_SIZE) );\r
+ this_npages = 1;\r
+ this_buffer = &page[0];\r
+ count = count + (offset % FLASH_PAGE_SIZE);\r
+ offset = offset - (offset % FLASH_PAGE_SIZE);\r
+ }\r
+ else if( count < FLASH_PAGE_SIZE )\r
+ {\r
+ /* Download last incomplete page separately. */\r
+ memset( &page, 0xff, sizeof(page) );\r
+ memcpy( &page, buffer, count );\r
+ this_npages = 1;\r
+ this_buffer = &page[0];\r
+ count = FLASH_PAGE_SIZE;\r
+ }\r
+ else\r
+ {\r
+ /* Download as many full pages as possible */\r
+ this_npages = (count < buffer_size) ?\r
+ count / FLASH_PAGE_SIZE :\r
+ buffer_size / FLASH_PAGE_SIZE;\r
+ this_buffer = buffer;\r
+\r
+ /* Make sure we stop at the next secured sector */\r
+ int sector = start_sector + 1;\r
+ while( sector < bank->num_sectors )\r
+ {\r
+ /* Secured? */\r
+ if( bank->sectors[sector].is_protected )\r
+ {\r
+ /* Is that next sector within the current block? */\r
+ if( (bank->sectors[sector].offset - bank->base) <\r
+ (offset + (this_npages * FLASH_PAGE_SIZE)) )\r
+ {\r
+ /* Yes! Split the block */\r
+ this_npages =\r
+ (bank->sectors[sector].offset - bank->base - offset)\r
+ / FLASH_PAGE_SIZE;\r
+ break;\r
+ }\r
+ }\r
+\r
+ sector++;\r
+ }\r
+ }\r
+\r
+ /* Skip the current sector if it is secured */\r
+ if( bank->sectors[start_sector].is_protected )\r
+ {\r
+ LOG_DEBUG( "Skip secured sector %" PRIu32, start_sector );\r
+\r
+ /* Stop if this is the last sector */\r
+ if( start_sector == bank->num_sectors - 1 )\r
+ {\r
+ break;\r
+ }\r
+\r
+ /* Skip */\r
+ uint32_t nskip = bank->sectors[start_sector].size -\r
+ (offset % bank->sectors[start_sector].size);\r
+ offset += nskip;\r
+ buffer += nskip;\r
+ count = (count >= nskip) ? (count - nskip) : 0;\r
+ continue;\r
+ }\r
+\r
+ /* Execute buffer download */\r
+ if ((retval = target_write_buffer(target,\r
+ warea->address,\r
+ this_npages * FLASH_PAGE_SIZE,\r
+ this_buffer)) != ERROR_OK)\r
+ {\r
+ LOG_ERROR("Unable to write data to target");\r
+ target_free_all_working_areas(target);\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* Prepare registers */\r
+ buf_set_u32(reg_params[0].value, 0, 32, warea->address);\r
+ buf_set_u32(reg_params[1].value, 0, 32, offset);\r
+ buf_set_u32(reg_params[2].value, 0, 32, this_npages);\r
+ buf_set_u32(reg_params[3].value, 0, 32, FCTR);\r
+ buf_set_u32(reg_params[4].value, 0, 32, FPTR_EN_T | prog_time);\r
+\r
+ /* Execute algorithm, assume breakpoint for last instruction */\r
+ armv4_5_info.common_magic = ARMV4_5_COMMON_MAGIC;\r
+ armv4_5_info.core_mode = ARMV4_5_MODE_SVC;\r
+ armv4_5_info.core_state = ARMV4_5_STATE_ARM;\r
+\r
+ retval = target_run_algorithm(target, 0, NULL, 5, reg_params,\r
+ (warea->address) + buffer_size,\r
+ (warea->address) + buffer_size + target_code_size - 4,\r
+ 10000, /* 10s should be enough for max. 16 KiB of data */\r
+ &armv4_5_info);\r
+\r
+ if (retval != ERROR_OK)\r
+ {\r
+ LOG_ERROR("Execution of flash algorithm failed.");\r
+ target_free_all_working_areas(target);\r
+ retval = ERROR_FLASH_OPERATION_FAILED;\r
+ break;\r
+ }\r
+\r
+ count -= this_npages * FLASH_PAGE_SIZE;\r
+ buffer += this_npages * FLASH_PAGE_SIZE;\r
+ offset += this_npages * FLASH_PAGE_SIZE;\r
+ }\r
+\r
+ /* Free all resources */\r
+ destroy_reg_param(®_params[0]);\r
+ destroy_reg_param(®_params[1]);\r
+ destroy_reg_param(®_params[2]);\r
+ destroy_reg_param(®_params[3]);\r
+ destroy_reg_param(®_params[4]);\r
+ target_free_all_working_areas(target);\r
+ }\r
+ else\r
+ {\r
+ /* Write to flash memory page-wise */\r
+ while ( count != 0 )\r
+ {\r
+ /* How many bytes do we copy this time? */\r
+ num_bytes = (count >= FLASH_PAGE_SIZE) ?\r
+ FLASH_PAGE_SIZE - (offset % FLASH_PAGE_SIZE) :\r
+ count;\r
+\r
+ /* Don't do anything with it if the page is in a secured sector. */\r
+ if ( !bank->sectors[lpc2900_address2sector(bank, offset)].is_protected )\r
+ {\r
+ /* Set latch load mode */\r
+ target_write_u32(target, FCTR,\r
+ FCTR_FS_CS | FCTR_FS_WRE | FCTR_FS_WEB);\r
+\r
+ /* Always clear the buffer (a little overhead, but who cares) */\r
+ memset(page, 0xFF, FLASH_PAGE_SIZE);\r
+\r
+ /* Copy them to the buffer */\r
+ memcpy( &page[offset % FLASH_PAGE_SIZE],\r
+ &buffer[offset % FLASH_PAGE_SIZE],\r
+ num_bytes );\r
+\r
+ /* Write whole page to flash data latches */\r
+ if (target_write_memory(\r
+ target,\r
+ bank->base + (offset - (offset % FLASH_PAGE_SIZE)),\r
+ 4, FLASH_PAGE_SIZE / 4, page) != ERROR_OK)\r
+ {\r
+ LOG_ERROR("Write failed @ 0x%8.8" PRIx32, offset);\r
+ target_write_u32(target, FCTR, FCTR_FS_CS | FCTR_FS_WEB);\r
+\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* Clear END_OF_BURN interrupt status */\r
+ target_write_u32(target, INT_CLR_STATUS, INTSRC_END_OF_BURN);\r
+\r
+ /* Set the programming time */\r
+ target_write_u32(target, FPTR, FPTR_EN_T | prog_time);\r
+\r
+ /* Trigger flash write */\r
+ target_write_u32(target, FCTR,\r
+ FCTR_FS_CS | FCTR_FS_WRE | FCTR_FS_WPB | FCTR_FS_PROGREQ);\r
+\r
+ /* Wait for the end of the write operation. If it's not over\r
+ * after one second, something went dreadfully wrong... :-(\r
+ */\r
+ if (lpc2900_wait_status(bank, INTSRC_END_OF_BURN, 1000) != ERROR_OK)\r
+ {\r
+ LOG_ERROR("Write failed @ 0x%8.8" PRIx32, offset);\r
+ target_write_u32(target, FCTR, FCTR_FS_CS | FCTR_FS_WEB);\r
+\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+ }\r
+\r
+ /* Update pointers and counters */\r
+ offset += num_bytes;\r
+ buffer += num_bytes;\r
+ count -= num_bytes;\r
+ }\r
+\r
+ retval = ERROR_OK;\r
+ }\r
+\r
+ /* Normal flash operating mode */\r
+ target_write_u32(target, FCTR, FCTR_FS_CS | FCTR_FS_WEB);\r
+\r
+ return retval;\r
+}\r
+\r
+\r
+/**\r
+ * Try and identify the device.\r
+ *\r
+ * Determine type number and its memory layout.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ */\r
+static int lpc2900_probe(struct flash_bank_s *bank)\r
+{\r
+ lpc2900_flash_bank_t *lpc2900_info = bank->driver_priv;\r
+ target_t *target = bank->target;\r
+ int i = 0;\r
+ uint32_t offset;\r
+\r
+\r
+ if (target->state != TARGET_HALTED)\r
+ {\r
+ LOG_ERROR("Target not halted");\r
+ return ERROR_TARGET_NOT_HALTED;\r
+ }\r
+\r
+ /* We want to do this only once. Check if we already have a valid CHIPID,\r
+ * because then we will have already successfully probed the device.\r
+ */\r
+ if (lpc2900_info->chipid == EXPECTED_CHIPID)\r
+ {\r
+ return ERROR_OK;\r
+ }\r
+\r
+ /* Probing starts with reading the CHIPID register. We will continue only\r
+ * if this identifies as an LPC2900 device.\r
+ */\r
+ target_read_u32(target, CHIPID, &lpc2900_info->chipid);\r
+\r
+ if (lpc2900_info->chipid != EXPECTED_CHIPID)\r
+ {\r
+ LOG_WARNING("Device is not an LPC29xx");\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* It's an LPC29xx device. Now read the feature register FEAT0...FEAT3. */\r
+ uint32_t feat0, feat1, feat2, feat3;\r
+ target_read_u32(target, FEAT0, &feat0);\r
+ target_read_u32(target, FEAT1, &feat1);\r
+ target_read_u32(target, FEAT2, &feat2);\r
+ target_read_u32(target, FEAT3, &feat3);\r
+\r
+ /* Base address */\r
+ bank->base = 0x20000000;\r
+\r
+ /* Determine flash layout from FEAT2 register */\r
+ uint32_t num_64k_sectors = (feat2 >> 16) & 0xFF;\r
+ uint32_t num_8k_sectors = (feat2 >> 0) & 0xFF;\r
+ bank->num_sectors = num_64k_sectors + num_8k_sectors;\r
+ bank->size = KiB * (64 * num_64k_sectors + 8 * num_8k_sectors);\r
+\r
+ /* Determine maximum contiguous RAM block */\r
+ lpc2900_info->max_ram_block = 16 * KiB;\r
+ if( (feat1 & 0x30) == 0x30 )\r
+ {\r
+ lpc2900_info->max_ram_block = 32 * KiB;\r
+ if( (feat1 & 0x0C) == 0x0C )\r
+ {\r
+ lpc2900_info->max_ram_block = 48 * KiB;\r
+ }\r
+ }\r
+\r
+ /* Determine package code and ITCM size */\r
+ uint32_t package_code = feat0 & 0x0F;\r
+ uint32_t itcm_code = (feat1 >> 16) & 0x1F;\r
+\r
+ /* Determine the exact type number. */\r
+ uint32_t found = 1;\r
+ if ( (package_code == 4) && (itcm_code == 5) )\r
+ {\r
+ /* Old LPC2917 or LPC2919 (non-/01 devices) */\r
+ lpc2900_info->target_name = (bank->size == 768*KiB) ? "LPC2919" : "LPC2917";\r
+ }\r
+ else\r
+ {\r
+ if ( package_code == 2 )\r
+ {\r
+ /* 100-pin package */\r
+ if ( bank->size == 128*KiB )\r
+ {\r
+ lpc2900_info->target_name = "LPC2921";\r
+ }\r
+ else if ( bank->size == 256*KiB )\r
+ {\r
+ lpc2900_info->target_name = "LPC2923";\r
+ }\r
+ else if ( bank->size == 512*KiB )\r
+ {\r
+ lpc2900_info->target_name = "LPC2925";\r
+ }\r
+ else\r
+ {\r
+ found = 0;\r
+ }\r
+ }\r
+ else if ( package_code == 4 )\r
+ {\r
+ /* 144-pin package */\r
+ if ( (bank->size == 512*KiB) && (feat3 == 0xFFFFFCF0) )\r
+ {\r
+ lpc2900_info->target_name = "LPC2917/01";\r
+ }\r
+ else if ( (bank->size == 512*KiB) && (feat3 == 0xFFFFFFF1) )\r
+ {\r
+ lpc2900_info->target_name = "LPC2927";\r
+ }\r
+ else if ( (bank->size == 768*KiB) && (feat3 == 0xFFFFFCF8) )\r
+ {\r
+ lpc2900_info->target_name = "LPC2919/01";\r
+ }\r
+ else if ( (bank->size == 768*KiB) && (feat3 == 0xFFFFFFF9) )\r
+ {\r
+ lpc2900_info->target_name = "LPC2929";\r
+ }\r
+ else\r
+ {\r
+ found = 0;\r
+ }\r
+ }\r
+ else if ( package_code == 5 )\r
+ {\r
+ /* 208-pin package */\r
+ lpc2900_info->target_name = (bank->size == 0) ? "LPC2930" : "LPC2939";\r
+ }\r
+ else\r
+ {\r
+ found = 0;\r
+ }\r
+ }\r
+\r
+ if ( !found )\r
+ {\r
+ LOG_WARNING("Unknown LPC29xx derivative");\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* Show detected device */\r
+ LOG_INFO("Flash bank %" PRIu32\r
+ ": Device %s, %" PRIu32\r
+ " KiB in %" PRIu32 " sectors",\r
+ bank->bank_number,\r
+ lpc2900_info->target_name, bank->size / KiB,\r
+ bank->num_sectors);\r
+\r
+ /* Flashless devices cannot be handled */\r
+ if ( bank->num_sectors == 0 )\r
+ {\r
+ LOG_WARNING("Flashless device cannot be handled");\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ /* Sector layout.\r
+ * These are logical sector numbers. When doing real flash operations,\r
+ * the logical flash number are translated into the physical flash numbers\r
+ * of the device.\r
+ */\r
+ bank->sectors = malloc(sizeof(flash_sector_t) * bank->num_sectors);\r
+\r
+ offset = 0;\r
+ for (i = 0; i < bank->num_sectors; i++)\r
+ {\r
+ bank->sectors[i].offset = offset;\r
+ bank->sectors[i].is_erased = -1;\r
+ bank->sectors[i].is_protected = -1;\r
+\r
+ if ( i <= 7 )\r
+ {\r
+ bank->sectors[i].size = 8 * KiB;\r
+ }\r
+ else if ( i <= 18 )\r
+ {\r
+ bank->sectors[i].size = 64 * KiB;\r
+ }\r
+ else\r
+ {\r
+ /* We shouldn't come here. But there might be a new part out there\r
+ * that has more than 19 sectors. Politely ask for a fix then.\r
+ */\r
+ bank->sectors[i].size = 0;\r
+ LOG_ERROR("Never heard about sector %" PRIu32 " (FIXME please)", i);\r
+ }\r
+\r
+ offset += bank->sectors[i].size;\r
+ }\r
+\r
+ /* Read sector security status */\r
+ if ( lpc2900_read_security_status(bank) != ERROR_OK )\r
+ {\r
+ LOG_ERROR("Cannot determine sector security status");\r
+ return ERROR_FLASH_OPERATION_FAILED;\r
+ }\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Run a blank check for each sector.\r
+ *\r
+ * For speed reasons, the device isn't read word by word.\r
+ * A hash value is calculated by the hardware ("BIST") for each sector.\r
+ * This value is then compared against the known hash of an empty sector.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ */\r
+static int lpc2900_erase_check(struct flash_bank_s *bank)\r
+{\r
+ uint32_t status = lpc2900_is_ready(bank);\r
+ if (status != ERROR_OK)\r
+ {\r
+ LOG_INFO("Processor not halted/not probed");\r
+ return status;\r
+ }\r
+\r
+ /* Use the BIST (Built-In Selft Test) to generate a signature of each flash\r
+ * sector. Compare against the expected signature of an empty sector.\r
+ */\r
+ int sector;\r
+ for ( sector = 0; sector < bank->num_sectors; sector++ )\r
+ {\r
+ uint32_t signature[4];\r
+ if ( (status = lpc2900_run_bist128( bank,\r
+ bank->sectors[sector].offset,\r
+ bank->sectors[sector].offset +\r
+ (bank->sectors[sector].size - 1),\r
+ &signature)) != ERROR_OK )\r
+ {\r
+ return status;\r
+ }\r
+\r
+ /* The expected signatures for an empty sector are different\r
+ * for 8 KiB and 64 KiB sectors.\r
+ */\r
+ if ( bank->sectors[sector].size == 8*KiB )\r
+ {\r
+ bank->sectors[sector].is_erased =\r
+ (signature[3] == 0x01ABAAAA) &&\r
+ (signature[2] == 0xAAAAAAAA) &&\r
+ (signature[1] == 0xAAAAAAAA) &&\r
+ (signature[0] == 0xAAA00AAA);\r
+ }\r
+ if ( bank->sectors[sector].size == 64*KiB )\r
+ {\r
+ bank->sectors[sector].is_erased =\r
+ (signature[3] == 0x11801222) &&\r
+ (signature[2] == 0xB88844FF) &&\r
+ (signature[1] == 0x11A22008) &&\r
+ (signature[0] == 0x2B1BFE44);\r
+ }\r
+ }\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+/**\r
+ * Get protection (sector security) status.\r
+ *\r
+ * Determine the status of "sector security" for each sector.\r
+ * A secured sector is one that can never be erased/programmed again.\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ */\r
+static int lpc2900_protect_check(struct flash_bank_s *bank)\r
+{\r
+ return lpc2900_read_security_status(bank);\r
+}\r
+\r
+\r
+/**\r
+ * Print info about the driver (not the device).\r
+ *\r
+ * @param bank Pointer to the flash bank descriptor\r
+ * @param buf Buffer to take the string\r
+ * @param buf_size Maximum number of characters that the buffer can take\r
+ */\r
+static int lpc2900_info(struct flash_bank_s *bank, char *buf, int buf_size)\r
+{\r
+ snprintf(buf, buf_size, "lpc2900 flash driver");\r
+\r
+ return ERROR_OK;\r
+}\r
+\r
+\r
+flash_driver_t lpc2900_flash =\r
+{\r
+ .name = "lpc2900",\r
+ .register_commands = lpc2900_register_commands,\r
+ .flash_bank_command = lpc2900_flash_bank_command,\r
+ .erase = lpc2900_erase,\r
+ .protect = lpc2900_protect,\r
+ .write = lpc2900_write,\r
+ .probe = lpc2900_probe,\r
+ .auto_probe = lpc2900_probe,\r
+ .erase_check = lpc2900_erase_check,\r
+ .protect_check = lpc2900_protect_check,\r
+ .info = lpc2900_info\r
+};\r