kinetis flash: use longword write when writing into pflash

Check whether the destination is in the program flash or NVM regions,
in the former case, use the normal longword mechanism, not the fast NVM
write.

Change-Id: I7366b7c8919928ee690252df83b99701776aee82
Signed-off-by: Tomas Frydrych <tomas@sleepfive.com>
Reviewed-on: http://openocd.zylin.com/194
Tested-by: jenkins
Reviewed-by: Spencer Oliver <spen@spen-soft.co.uk>

src/flash/nor/kinetis.c

@@ -1,7 +1,10 @@
 /***************************************************************************
- *   Copyright (C) 2011 by Mathias Kuester                                  *
+ *   Copyright (C) 2011 by Mathias Kuester                                 *
  *   kesmtp@freenet.de                                                     *
  *                                                                         *
+ *   Copyright (C) 2011 sleep(5) ltd                                       *
+ *   tomas@sleepfive.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     *
@@ -24,6 +27,10 @@
 #include "imp.h"
 #include "helper/binarybuffer.h"
 
+struct kinetis_flash_bank {
+	uint32_t nvm_start;
+};
+
 static int kinetis_get_master_bank(struct flash_bank *bank,
 				   struct flash_bank **master_bank)
 {
@@ -60,6 +67,8 @@ static int kinetis_update_bank_info(struct flash_bank *bank)
 
 FLASH_BANK_COMMAND_HANDLER(kinetis_flash_bank_command)
 {
+	struct kinetis_flash_bank *bank_info;
+
 	if (CMD_ARGC < 6) {
 		LOG_ERROR("incomplete flash_bank kinetis configuration %d",
 			  CMD_ARGC);
@@ -68,6 +77,12 @@ FLASH_BANK_COMMAND_HANDLER(kinetis_flash_bank_command)
 
 	LOG_INFO("add flash_bank kinetis %s", bank->name);
 
+	bank_info = malloc(sizeof(struct kinetis_flash_bank));
+
+	memset(bank_info, 0, sizeof(struct kinetis_flash_bank));
+
+	bank->driver_priv = bank_info;
+
 	return ERROR_OK;
 }
 
@@ -264,9 +279,11 @@ static int kinetis_write(struct flash_bank *bank, uint8_t * buffer,
 			 uint32_t offset, uint32_t count)
 {
 	struct flash_bank *master_bank;
-	unsigned int i, result, fallback = 0;
+	unsigned int i, result, fallback = 0, nvm = 0;
 	uint8_t buf[8];
 	uint32_t wc, w0 = 0, w1 = 0, w2 = 0;
+	struct kinetis_flash_bank * kbank = (struct kinetis_flash_bank *)
+		bank->driver_priv;
 
 	if (bank->target->state != TARGET_HALTED) {
 		LOG_ERROR("Target not halted");
@@ -279,31 +296,48 @@ static int kinetis_write(struct flash_bank *bank, uint8_t * buffer,
 		return result;
 	}
 
-	/* make flex ram available */
+	if (offset >= kbank->nvm_start)
-	w0 = (0x81 << 24) | 0x00ff0000;
+		nvm = 1;
 
-	result = kinetis_ftfl_command(bank, w0, w1, w2);
+	if (!nvm && (offset + count) > kbank->nvm_start) {
-
+		/* we could flash this in two goes, but if the segment
-	if (result != ERROR_OK) {
+		   spans across the pflash/nvm boundary, something is probably
-		return ERROR_FLASH_OPERATION_FAILED;
+		   not right.
+		*/
+		LOG_ERROR("Segment spans NVM boundary");
+		return ERROR_FLASH_DST_OUT_OF_BANK;
 	}
 
-	/* check if ram ready */
+	if (nvm) {
-	result = target_read_memory(bank->target, 0x40020001, 1, 1, buf);
+		LOG_DEBUG("flash write into NVM @%08X", offset);
 
-	if (result != ERROR_OK) {
+		/* make flex ram available */
-		return result;
+		w0 = (0x81 << 24) | 0x00ff0000;
-	}
 
-	if (!(buf[0] & (1 << 1))) {
+		result = kinetis_ftfl_command(bank, w0, w1, w2);
-		/* fallback to longword write */
+
+		if (result != ERROR_OK)
+			return ERROR_FLASH_OPERATION_FAILED;
+
+		/* check if ram ready */
+		result = target_read_memory(bank->target, 0x40020001, 1, 1, buf);
+
+		if (result != ERROR_OK)
+			return result;
+
+		if (!(buf[0] & (1 << 1))) {
+			/* fallback to longword write */
+			fallback = 1;
+
+		       LOG_WARNING("ram not ready, fallback to slow longword write (FCNFG: %02X)",
+				   buf[0]);
+		}
+	} else {
+		LOG_DEBUG("flash write into PFLASH @08%X", offset);
 		fallback = 1;
-
-		LOG_WARNING
-		    ("ram not ready, fallback to slow longword write (FCNFG: %02X)",
-		     buf[0]);
 	}
 
+
 	/* program section command */
 	if (fallback == 0) {
 		for (i = 0; i < count; i += (2 * 1024)) {
@@ -364,7 +398,7 @@ static int kinetis_probe(struct flash_bank *bank)
 	int result, i;
 	uint8_t buf[4];
 	uint32_t sim_sdid, sim_fcfg1, sim_fcfg2, offset = 0;
-	uint32_t nvm_size, pf_size, flash_size, ee_size;
+	uint32_t nvm_size, pf_size, ee_size;
 
 	if (bank->target->state != TARGET_HALTED) {
 		LOG_ERROR("Target not halted");
@@ -425,9 +459,6 @@ static int kinetis_probe(struct flash_bank *bank)
 		break;
 	}
 
-	/* pf_size is the total size */
-	flash_size = pf_size - nvm_size;
-
 	switch ((sim_fcfg1 >> 16) & 0x0f) {
 	case 0x02:
 		ee_size = 4 * 1024;
@@ -458,11 +489,14 @@ static int kinetis_probe(struct flash_bank *bank)
 		break;
 	}
 
+	((struct kinetis_flash_bank *) bank->driver_priv)->nvm_start =
+		pf_size - nvm_size;
+
 	LOG_DEBUG("NVM: %d PF: %d EE: %d BL1: %d", nvm_size, pf_size, ee_size,
 		  (sim_fcfg2 >> 23) & 1);
 
-	if (flash_size != bank->size) {
+	if (pf_size != bank->size) {
-		LOG_WARNING("flash size is different %d != %d", flash_size,
+		LOG_WARNING("flash size is different %d != %d", pf_size,
 			    bank->size);
 	}