[PATCH] cfi_flash: support of u32 cmd
Teresa Gámez
t.gamez at phytec.de
Wed Aug 24 04:56:15 EDT 2011
Some NOR flash chips have commands with length greater than the maximum
value size of uchar.
Based on an U-Boot Patch by Vasiliy Leoenenko <vasiliy.leonenko at mail.ru>
Only tested with little endian on an intel cfi_flash.
Signed-off-by: Teresa Gámez <t.gamez at phytec.de>
---
drivers/nor/cfi_flash.c | 38 +++++++++++++++++++++++++++++---------
drivers/nor/cfi_flash.h | 11 +++++++----
drivers/nor/cfi_flash_amd.c | 8 ++++----
drivers/nor/cfi_flash_intel.c | 2 +-
4 files changed, 41 insertions(+), 18 deletions(-)
diff --git a/drivers/nor/cfi_flash.c b/drivers/nor/cfi_flash.c
index 461b0e6..489c15d 100644
--- a/drivers/nor/cfi_flash.c
+++ b/drivers/nor/cfi_flash.c
@@ -820,20 +820,38 @@ int flash_generic_status_check (struct flash_info *info, flash_sect_t sector,
/*
* make a proper sized command based on the port and chip widths
*/
-void flash_make_cmd(struct flash_info *info, u8 cmd, cfiword_t *cmdbuf)
+void flash_make_cmd(struct flash_info *info, u32 cmd, cfiword_t *cmdbuf)
{
- cfiword_t result = 0;
- int i = info->portwidth / info->chipwidth;
+ int i;
+ int cp_offset;
+ int cword_offset;
+ uchar val;
+ uchar *cp;
+#if __BYTE_ORDER == __LITTLE_ENDIAN
+ u32 cmd_le = cpu_to_le32(cmd);
+#endif
+
+ *cmdbuf = 0;
+ cp = (uchar *)cmdbuf;
- while (i--)
- result = (result << (8 * info->chipwidth)) | cmd;
- *cmdbuf = result;
+ for (i = info->portwidth; i > 0; i--) {
+ cword_offset = (info->portwidth-i) % info->chipwidth;
+#if __BYTE_ORDER == __LITTLE_ENDIAN
+ cp_offset = info->portwidth - i;
+ val = *((uchar *)&cmd_le + cword_offset);
+#else
+ cp_offset = i - 1;
+ val = *((uchar *)&cmd + sizeof(u32) - cword_offset - 1);
+#endif
+ cp[cp_offset] = (cword_offset >= sizeof(u32)) ? 0x00 : val;
+ }
}
/*
* Write a proper sized command to the correct address
*/
-void flash_write_cmd (struct flash_info *info, flash_sect_t sect, uint offset, uchar cmd)
+void flash_write_cmd(struct flash_info *info, flash_sect_t sect,
+ uint offset, u32 cmd)
{
uchar *addr;
@@ -845,7 +863,8 @@ void flash_write_cmd (struct flash_info *info, flash_sect_t sect, uint offset, u
flash_write_word(info, cword, addr);
}
-int flash_isequal (struct flash_info *info, flash_sect_t sect, uint offset, uchar cmd)
+int flash_isequal(struct flash_info *info, flash_sect_t sect,
+ uint offset, u32 cmd)
{
void *addr;
cfiword_t cword;
@@ -882,7 +901,8 @@ int flash_isequal (struct flash_info *info, flash_sect_t sect, uint offset, ucha
return retval;
}
-int flash_isset (struct flash_info *info, flash_sect_t sect, uint offset, uchar cmd)
+int flash_isset(struct flash_info *info, flash_sect_t sect,
+ uint offset, u32 cmd)
{
void *addr = flash_make_addr (info, sect, offset);
cfiword_t cword;
diff --git a/drivers/nor/cfi_flash.h b/drivers/nor/cfi_flash.h
index 9098021..32dcc8c 100644
--- a/drivers/nor/cfi_flash.h
+++ b/drivers/nor/cfi_flash.h
@@ -231,16 +231,19 @@ extern struct cfi_cmd_set cfi_cmd_set_amd;
#define CFI_FLASH_SHIFT_WIDTH 3
/* Prototypes */
-int flash_isset (struct flash_info *info, flash_sect_t sect, uint offset, uchar cmd);
-void flash_write_cmd (struct flash_info *info, flash_sect_t sect, uint offset, uchar cmd);
+int flash_isset(struct flash_info *info, flash_sect_t sect,
+ uint offset, u32 cmd);
+void flash_write_cmd(struct flash_info *info, flash_sect_t sect,
+ uint offset, u32 cmd);
flash_sect_t find_sector (struct flash_info *info, ulong addr);
int flash_status_check (struct flash_info *info, flash_sect_t sector,
uint64_t tout, char *prompt);
int flash_generic_status_check (struct flash_info *info, flash_sect_t sector,
uint64_t tout, char *prompt);
-int flash_isequal (struct flash_info *info, flash_sect_t sect, uint offset, uchar cmd);
-void flash_make_cmd(struct flash_info *info, uchar cmd, cfiword_t *cmdbuf);
+int flash_isequal(struct flash_info *info, flash_sect_t sect,
+ uint offset, u32 cmd);
+void flash_make_cmd(struct flash_info *info, u32 cmd, cfiword_t *cmdbuf);
static inline void flash_write8(u8 value, void *addr)
{
diff --git a/drivers/nor/cfi_flash_amd.c b/drivers/nor/cfi_flash_amd.c
index b1d7070..45c59b9 100644
--- a/drivers/nor/cfi_flash_amd.c
+++ b/drivers/nor/cfi_flash_amd.c
@@ -142,28 +142,28 @@ static int amd_flash_write_cfibuffer (struct flash_info *info, ulong dest, const
if (bankwidth_is_1(info)) {
cnt = len;
- flash_write_cmd (info, sector, 0, (uchar) cnt - 1);
+ flash_write_cmd(info, sector, 0, (u32)cnt - 1);
while (cnt-- > 0) {
flash_write8(flash_read8(src), dst);
src += 1, dst += 1;
}
} else if (bankwidth_is_2(info)) {
cnt = len >> 1;
- flash_write_cmd (info, sector, 0, (uchar) cnt - 1);
+ flash_write_cmd(info, sector, 0, (u32)cnt - 1);
while (cnt-- > 0) {
flash_write16(flash_read16(src), dst);
src += 2, dst += 2;
}
} else if (bankwidth_is_4(info)) {
cnt = len >> 2;
- flash_write_cmd (info, sector, 0, (uchar) cnt - 1);
+ flash_write_cmd(info, sector, 0, (u32)cnt - 1);
while (cnt-- > 0) {
flash_write32(flash_read32(src), dst);
src += 4, dst += 4;
}
} else if (bankwidth_is_8(info)) {
cnt = len >> 3;
- flash_write_cmd (info, sector, 0, (uchar) cnt - 1);
+ flash_write_cmd(info, sector, 0, (u32)cnt - 1);
while (cnt-- > 0) {
flash_write64(flash_read64(src), dst);
src += 8, dst += 8;
diff --git a/drivers/nor/cfi_flash_intel.c b/drivers/nor/cfi_flash_intel.c
index c3cbad5..6318cfe 100644
--- a/drivers/nor/cfi_flash_intel.c
+++ b/drivers/nor/cfi_flash_intel.c
@@ -70,7 +70,7 @@ static int intel_flash_write_cfibuffer (struct flash_info *info, ulong dest, con
/* reduce the number of loops by the width of the port */
cnt = len >> (info->portwidth - 1);
- flash_write_cmd (info, sector, 0, (uchar) cnt - 1);
+ flash_write_cmd(info, sector, 0, (u32)cnt - 1);
while (cnt-- > 0) {
if (bankwidth_is_1(info)) {
flash_write8(flash_read8(src), dst);
--
1.7.0.4
More information about the barebox
mailing list