From b4b2f17bcee46f1b14c90a2aa7430814857c96a9 Mon Sep 17 00:00:00 2001
From: nyatla <nyatla@47198e57-cb75-475f-84c4-a814cd6f29e0>
Date: Mon, 17 Oct 2011 15:02:54 +0000
Subject: [PATCH] git-svn-id: http://svn.osdn.jp/svnroot/mimic/trunk@42
 47198e57-cb75-475f-84c4-a814cd6f29e0

---
 lib/src/flash/NyLPC_cOnchipFlashWriter.c | 126 +++++++++++++++++++++++++++++++
 lib/src/flash/NyLPC_cOnchipFlashWriter.h |  22 ++++++
 2 files changed, 148 insertions(+)
 create mode 100644 lib/src/flash/NyLPC_cOnchipFlashWriter.c
 create mode 100644 lib/src/flash/NyLPC_cOnchipFlashWriter.h

diff --git a/lib/src/flash/NyLPC_cOnchipFlashWriter.c b/lib/src/flash/NyLPC_cOnchipFlashWriter.c
new file mode 100644
index 0000000..e6aa014
--- /dev/null
+++ b/lib/src/flash/NyLPC_cOnchipFlashWriter.c
@@ -0,0 +1,126 @@
+#include "../driver/flash/LPC17xx_IAP.h"
+#include "NyLPC_cOnchipFlashWriter.h"
+
+void NyLPC_cOnchipFlashWriter_initialize(NyLPC_TcFlashWriter_t* i_inst)
+{
+	(void)i_inst;
+}
+
+/**
+ * アドレスi_destに、i_srcの内容を書き込みます。
+ * 書き込みは、FlashROMがイレース済なものとして実行します。書込み範囲以外のデータは、変更されません。
+ * 既に書込み済みのデータがある場合(0xFFFFFFFF以外)は、期待した結果が得られないので、注意してください。
+ * この関数は、IAPインタフェイス経由で256バイト単位でデータを書き込みます。
+ * IAPは0x1000000から32バイトをワークエリアとして使用します。
+ * 関数はワークエリアの待避と復帰を行いますが、安全の為、使用前にRTOSを一旦停止させてください。
+ */
+NyLPC_TBool NyLPC_cOnchipFlashWriter_write(NyLPC_TcFlashWriter_t* i_inst,void* i_dest,const void* i_src,NyLPC_TUInt32 i_size)
+{
+	NyLPC_TUInt32 size;
+	const void* src;
+	NyLPC_TUInt32 snum;
+	void* fblock_addr;
+	void* dest_addr;
+	NyLPC_TUInt32 wsize;
+	NyLPC_TUInt16 s_padding;
+	NyLPC_TUInt16 free_size;
+	if(i_size%4!=0){
+		NyLPC_OnErrorGoto(Error);
+	}
+	if(((NyLPC_TUInt32)i_dest)%4!=0){
+		NyLPC_OnErrorGoto(Error);
+	}
+	size=i_size;
+	src=i_src;
+	dest_addr=i_dest;
+	for(;size>0;){
+		//開始位置の端数を調べる
+		s_padding=((NyLPC_TUInt32)dest_addr)%256;
+		//書き込みアドレス取得
+		fblock_addr=dest_addr-s_padding;
+		//書込み可能サイズを計算
+		free_size=256-s_padding;
+		//書込みサイズを決定
+		wsize=free_size>size?size:free_size;
+		//Flashから一時RAMへ前方パディングを読む
+		if(s_padding>0){
+			memcpy(i_inst->_work,fblock_addr,s_padding);
+		}
+		//書き込むデータを一時RAMへ書き込む
+		memcpy(i_inst->_work+s_padding,src,wsize);
+		//後半
+		if(256-(wsize+s_padding)>0){
+			memcpy(i_inst->_work+s_padding+wsize,fblock_addr+(wsize+s_padding),256-(wsize+s_padding));
+		}
+
+		//Flashへ書込み
+		//開始セクタ
+		if(!LPC17xx_IAP_addr2Sector(fblock_addr,&snum)){
+			NyLPC_OnErrorGoto(Error);
+		}
+		//IAPのprepareコマンド
+
+		if(LPC17xx_IAP_CMD_SUCCESS!=LPC17xx_IAP_prepare(snum,snum)){
+			NyLPC_OnErrorGoto(Error);
+		}
+		//IAPのwriteコマンド
+		if(LPC17xx_IAP_CMD_SUCCESS!=LPC17xx_IAP_copyRam2Flash(fblock_addr,i_inst->_work,256,configCPU_CLOCK_HZ/1000)){
+			NyLPC_OnErrorGoto(Error);
+		}
+		dest_addr+=wsize;
+		src+=wsize;
+		size-=wsize;
+	}
+	return NyLPC_TBool_TRUE;
+Error:
+	return NyLPC_TBool_FALSE;
+}
+
+/**
+ * セクタ+オフセット形式で、データを書き込みます。
+ */
+NyLPC_TBool NyLPC_cOnchipFlashWriter_writeSector(NyLPC_TcFlashWriter_t* i_inst,NyLPC_TUInt16 i_sector,NyLPC_TUInt32 i_offset,const void* i_src,NyLPC_TUInt32 i_size)
+{
+	void* addr;
+	(void)i_inst;
+	if(!LPC17xx_IAP_sector2Addr(i_sector,&addr)){
+		return NyLPC_TBool_FALSE;
+	}
+	addr=(void*)((NyLPC_TUInt32)addr+i_offset);
+	return NyLPC_cOnchipFlashWriter_write(i_inst,addr,i_src,i_size);
+
+}
+/**
+ * FlashRomのセクタ番号Nにイレースを実行します。
+ */
+NyLPC_TBool NyLPC_cOnchipFlashWriter_elase(NyLPC_TcFlashWriter_t* i_inst,NyLPC_TUInt16 i_sector)
+{
+	(void)i_inst;
+	if(LPC17xx_IAP_CMD_SUCCESS!=LPC17xx_IAP_prepare(i_sector,i_sector)){
+		return NyLPC_TBool_FALSE;
+	}
+	return LPC17xx_IAP_erase(i_sector,i_sector)==LPC17xx_IAP_CMD_SUCCESS;
+}
+
+
+#ifdef TEST
+#include "stdio.h"
+unsigned long buf[128]={0x1,0x2,0x03,0x04,0x05};
+#define MIMIC_CONFIG_ADDR ((long*)(0x00018000+1280))
+void setup(void)
+{
+	NyLPC_TcFlashWriter_t writer;
+	NyLPC_cFlashWriter_initialize(&writer);
+	unsigned long p;
+	NyLPC_cFlashWriter_elase(&writer,29);
+//	NyLPC_cFlashWriter_write(&writer,MIMIC_CONFIG_ADDR-8,buf,5*4);
+	NyLPC_cFlashWriter_finalize(&writer);
+	return;
+}
+void loop(void)
+{
+	//Implementation
+	//ここにメインタスクを書きます。
+	for(;;){}
+}
+#endif
diff --git a/lib/src/flash/NyLPC_cOnchipFlashWriter.h b/lib/src/flash/NyLPC_cOnchipFlashWriter.h
new file mode 100644
index 0000000..944e2cf
--- /dev/null
+++ b/lib/src/flash/NyLPC_cOnchipFlashWriter.h
@@ -0,0 +1,22 @@
+#ifndef cOnchipFlashWriter_h
+#define cOnchipFlashWriter_h
+
+
+#include "NyLPC_stdlib.h"
+typedef struct NyLPC_TcFlashWriter NyLPC_TcFlashWriter_t;
+
+struct NyLPC_TcFlashWriter
+{
+	NyLPC_TUInt8 _work[256];
+};
+
+void NyLPC_cOnchipFlashWriter_initialize(NyLPC_TcFlashWriter_t* i_inst);
+
+#define NyLPC_cOnchipFlashWriter_finalize(i)
+
+NyLPC_TBool NyLPC_cOnchipFlashWriter_write(NyLPC_TcFlashWriter_t* i_inst,void* i_dest,const void* i_src,NyLPC_TUInt32 i_size);
+NyLPC_TBool NyLPC_cOnchipFlashWriter_writeSector(NyLPC_TcFlashWriter_t* i_inst,NyLPC_TUInt16 i_sector,NyLPC_TUInt32 i_offset,const void* i_src,NyLPC_TUInt32 i_size);
+NyLPC_TBool NyLPC_cOnchipFlashWriter_elase(NyLPC_TcFlashWriter_t* i_inst,NyLPC_TUInt16 i_sector);
+
+
+#endif
-- 
2.11.0