CFIの情報を元に、搭載フラッシュメモリの判別を行う処理を追加しました。

--- a/src/target/driver/flash_core.c
+++ b/src/target/driver/flash_core.c
@@ -23,6 +23,50 @@ flash_eb eb;
 
 static flash_protect *protect_table = 0;
 
+#define flash_read(addr)         cpu_to_le16(read16((addr)))
+#define flash_write(addr, b)     write16((addr), cpu_to_le16((b)))
+
+static int qry_present(const u32 base)
+{
+       u8 offs, v;
+       u8 qry[] = "QRY";
+
+       for (offs = 0; offs < 3; offs++) {
+               v = flash_read(base + ((0x10 + offs)<<1));
+               if ( v != *(qry + offs))
+                       return 0;
+       }
+       return 1; // "QRY" found
+}
+
+int flash_get_cfi_vendor_spec(const u32 base_addr)
+{
+       int type;
+       u32 base;
+       u16 primary_spec = 0;
+
+       base = (base_addr & FLASH_BASE_MASK);
+       flash_write(base, 0xF0);
+       flash_write(base, 0xFF);
+       flash_write(base, 0x98);
+
+       if (!qry_present(base))
+               flash_write(base + (0x555 << 1), 0x98);
+       primary_spec = flash_read(base + (0x13 << 1));
+       switch (primary_spec){
+       case 0x0001:
+               type = FLASH_TYPE_INTEL;
+               break;
+       case 0x0002:
+               type = FLASH_TYPE_AMD;
+               break;
+       default:
+               type = -1;
+               break;
+       }
+       return type;
+}
+
 int flash_initialize(const int type, const u32 base_addr)
 {
        memzero(&fops, sizeof(flash_ops));
@@ -77,6 +121,16 @@ int flash_initialize(const int type, const u32 base_addr)
        return 0;
 }
 
+int flash_initialize_cfi(const u32 base_addr)
+{
+       int type;
+
+       type = flash_get_cfi_vendor_spec(base_addr);
+       if (type < 0)
+               return -1;
+       return flash_initialize(type, base_addr);
+}
+
 int flash_register_protect_table(flash_protect *table)
 {
        protect_table = table;

新フラッシュメモリのbuffer programに対応しました。

--- a/src/target/driver/flash_amd.c
+++ b/src/target/driver/flash_amd.c
@@ -21,8 +21,21 @@
 
 static flash_cfi cfi_info;
 
+#define AMD_CMD_UNLOCK_START           0xAA
+#define AMD_CMD_UNLOCK_ACK             0x55
+#define AMD_CMD_WRITE_TO_BUFFER                0x25
+#define AMD_CMD_WRITE_BUFFER_CONFIRM   0x29
+#define AMD_BUFFER_PROGRAM_ALIGNED_MASK (0xf)
+
+#define FORCE_WORD_PROGRAM (0)
 #define FLASH_TIMEOUT 400000000
 
+#define min(x, y) ({                 \
+       typeof(x) _min1 = (x);        \
+       typeof(y) _min2 = (y);        \
+       (void) (&_min1 == &_min2);    \
+       _min1 < _min2 ? _min1 : _min2;})
+
 #define flash_read(addr)         read16(addr)
 #define flash_write(addr, b)     write16((addr), (b))
 
@@ -73,6 +86,12 @@ static int flash_status_full_check(addr_t addr, unsigned short value1, unsigned
        return (status1 != value1 || status2 != value2) ? -1 : 0;
 }
 
+static void flash_amd_unlock_seq(addr_t base)
+{
+       flash_write_cmd(base + (0x555 << 1), AMD_CMD_UNLOCK_START);
+       flash_write_cmd(base + (0x2AA << 1), AMD_CMD_UNLOCK_ACK);
+}
+
 /*
  * Program the contents of the download buffer to flash at the given
  * address.  Size is also specified; we shouldn't have to track usage
@@ -86,7 +105,7 @@ static int flash_status_full_check(addr_t addr, unsigned short value1, unsigned
  * them because in the context of this command they signify bugs, and
  * we want to be extra careful when writing flash.
  */
-int flash_amd_program(const u32 from, const u32 to, const u32 size)
+static int flash_amd_word_program(const u32 from, const u32 to, const u32 size)
 {
        int status;
        unsigned int loop;
@@ -121,6 +140,53 @@ int flash_amd_program(const u32 from, const u32 to, const u32 size)
        return status;
 }
 
+static int flash_amd_buffer_program(const u32 from, const u32 to, const u32 size)
+{
+       u32 base;
+       u32 addr;
+       u32 end;
+       u32 data;
+       size_t max_program_size;
+
+       if (from & UNALIGNED_MASK) return -H_EALIGN;
+       if (to & UNALIGNED_MASK) return -H_EALIGN;
+       if (cfi_info.max_buf_write_size < 2) return -H_ENOCMD;
+
+       base = (to & FLASH_BASE_MASK);
+       addr = to;
+       end  = to + size;
+       data = from;
+       max_program_size = 1 << cfi_info.max_buf_write_size;
+
+       while (addr < end) {
+               u32 block_start = addr & ~(max_program_size - 1);
+               /* We must not cross write block boundaries */
+               u32 next_boundary = (addr + max_program_size) & ~(max_program_size - 1);
+               u32 program_end = min(end, next_boundary);
+
+               flash_amd_unlock_seq(base);
+               flash_write_cmd(block_start, AMD_CMD_WRITE_TO_BUFFER);
+               flash_write_cmd(block_start, ((program_end - addr) >> 1) - 1);
+
+               /* program flash memory par 16 bits word */
+               for (; addr < program_end; addr+=2, data+=2) {
+                       flash_write(addr, *((u16 *)data));
+               }
+
+               flash_write_cmd(block_start, AMD_CMD_WRITE_BUFFER_CONFIRM);
+               flash_status_wait(addr - 2, *((u16 *)(data - 2)));
+       }
+       return 0;
+}
+
+int flash_amd_program(const u32 from, const u32 to, const u32 size)
+{
+       if (FORCE_WORD_PROGRAM)
+               return flash_amd_word_program(from, to, size);
+       else
+               return flash_amd_buffer_program(from, to, size);
+}
+

新フラッシュメモリ適用品で、強制的に従来品のフラッシュメモリで動作するコンフィギュレーション "FORCE_MTDPARTS4x0" を追加しました。

"FORCE_MTDPARTS4x0"はデフォルト無効です。

	Linux カーネルが"FORCE_MTDPARTS4x0"に対応していないため、このコンフィギュレーションは現時点で使用することができません。

--- a/src/target/armadillo4x0/Kconfig
+++ b/src/target/armadillo4x0/Kconfig
@@ -0,0 +1,7 @@
+#
+# src/target/armadillo4x0/Kconfig
+#
+
+if PLATFORM_ARMADILLO4X0
+
+endif # PLATFORM_ARMADILLO4X0

新フラッシュメモリを動作させるために、"CONFIG_FLASH_AMD"を有効化しています。

--- a/configs/armadillo_4x0_defconfig
+++ b/configs/armadillo_4x0_defconfig
@@ -74,7 +74,7 @@ CONFIG_CONSOLE_TTYMXC1=y
 CONFIG_DEFAULT_CONSOLE="ttymxc1"
 CONFIG_STANDARD_CONSOLE="ttymxc1"
 CONFIG_FLASH=y
-# CONFIG_FLASH_AMD is not set
+CONFIG_FLASH_AMD=y
 CONFIG_FLASH_INTEL=y
 # CONFIG_FLASH_SPI is not set
 CONFIG_ETHERNET=y

新フラッシュメモリを動作させるために、"CONFIG_FLASH_AMD"を有効化しています。

--- a/configs/armadillo4x0_boot_defconfig
+++ b/configs/armadillo4x0_boot_defconfig
@@ -76,7 +76,7 @@ CONFIG_DEFAULT_CONSOLE="ttymxc1"
CONFIG_STANDARD_CONSOLE="ttymxc1"
CONFIG_TTYMXC1_DTR_DSR_DCD_RI_MX25=y
CONFIG_FLASH=y
-# CONFIG_FLASH_AMD is not set
+CONFIG_FLASH_AMD=y
CONFIG_FLASH_INTEL=y
# CONFIG_FLASH_SPI is not set
CONFIG_ETHERNET=y

新フラッシュメモリ適用品を表すBoard type ”BOARD_TYPE_ARMADILLO411と ”BOARD_TYPE_ARMADILLO441" を追加しました。なお、従来品のBoard typeは"BOARD_TYPE_ARMADILLO410" または "BOARD_TYPE_ARMADILLO440"となります。

Board typeはArmadilloに搭載したEEPROM内に書き込まれており、Hermit-At内でEEPROMをReadしBoard typeの判別を行います。

--- a/src/target/armadillo4x0/board.h
+++ b/src/target/armadillo4x0/board.h
@@ -39,6 +39,8 @@ struct board_private {
#define BOARD_TYPE_ARMADILLO410                0x0410
#define BOARD_TYPE_ARMADILLO420                0x0420
#define BOARD_TYPE_ARMADILLO440                0x0440
+#define BOARD_TYPE_ARMADILLO411                0x0411
+#define BOARD_TYPE_ARMADILLO441                0x0441
#define BOARD_TYPE_ARMADILLO460                0x0460
u16 hardware;   /* Hardware ID */
};

新フラッシュメモリ適用品を表すmachine_nr ”MACH_ARMADILLO411"と ”MACH_ARMADILLO441" を追加しました。なお、従来品のmachine_nrは"MACH_ARMADILLO410" または "MACH_ARMADILLO440" となります。

Hermit-At内でEEPROMに書き込まれているBoard typeを判別し、それに対応したmachine_nrの設定を行います。machine_nrはARM LinuxのATAGという仕組みを利用し、Linux カーネル側に伝えられます。Linux カーネルはこのmachine_nrを元に、製品の種類を判別します。

--- a/include/target/machine.h
+++ b/include/target/machine.h
@@ -12,6 +12,8 @@
#define MACH_ARMADILLO440      (2374)
#define MACH_ARMADILLO460      (3270)
#define MACH_ARMADILLO410      (4636)
+#define MACH_ARMADILLO441      (5135)
+#define MACH_ARMADILLO411      (5136)
#define MACH_ARMADILLO800EVA   (3863)
#define MACH_ARMADILLO810      (4115)
#define MACH_ARMADILLO840      (4264)

EEPROM内に記載されているボード情報から、machine_nrを登録します。

machine_nrの値に応じて、新フラッシュメモリ適用品のフラッシュメモリメモリマップを使用するか、従来品のフラッシュメモリメモリマップを使用するかを判別します。

コンフィギュレーション"CONFIG_FORCE_MTDPARTS4x0"を設定した場合は、machine_nrの値に関係なく、従来品のフラッシュメモリメモリマップで動作します。新フラッシュメモリ適用品で従来品のメモリマップを利用した場合、setenvよって記録されたデータ構造が32kByteまで到達した時点でbootloader領域が消去されるので、試験目的以外ので利用は避ける事をお勧めします。

--- a/src/target/armadillo4x0/board.c
 +++ b/src/target/armadillo4x0/board.c
 @@ -27,11 +27,18 @@
 #include < mx25_esdhc.h >
 #include "board.h"

 +#if defined(CONFIG_FORCE_MTDPARTS4x0)
 +int force_mtdparts4x0 = 1;
 +#else
 +int force_mtdparts4x0 = 0;
 +#endif
 +
 char target_name[256];
 char *target_profile = target_name;

 static struct board_private board_priv;
 static struct memory_device mdev_param;
 +static struct memory_map armadillo4x1_memory_map;

 #define FLASH_ADDR(offset) (FLASH_START + (offset))
 #define RAM_ADDR(offset) (DRAM_START + (offset))
 @@ -371,6 +378,12 @@ static void armadillo4x0_setup_private_data(struct platform_info *pinfo)
 case BOARD_TYPE_ARMADILLO460:
 pinfo->machine_nr = MACH_ARMADILLO460;
 break;
 +case BOARD_TYPE_ARMADILLO411:
 +pinfo->machine_nr = MACH_ARMADILLO411;
 +break;
 +case BOARD_TYPE_ARMADILLO441:
 +pinfo->machine_nr = MACH_ARMADILLO441;
 +break;
 case BOARD_TYPE_ARMADILLO420:
 /* FALL THROUGH */
 default:
 @@ -566,14 +579,27 @@ static void armadillo4x0_setup_flash(struct platform_info *pinfo)
 {
 int val;

 -flash_initialize(FLASH_TYPE_INTEL, FLASH_START);
 +if ((pinfo->machine_nr == MACH_ARMADILLO411 ||
 +     pinfo->machine_nr == MACH_ARMADILLO441) &&
 +    !force_mtdparts4x0)
 +pinfo->map = &armadillo4x1_memory_map;
 +
 +flash_initialize_cfi(FLASH_START);

 val = flash_get_size(FLASH_START);
 pinfo->map->flash.size = 1 << val;
 -hsprintf(pinfo->default_mtdparts,
 - "armadillo4x0-nor:%p(all)ro,0x20000@0(bootloader)ro,"
 - "0x400000(kernel),%p(userland),-(config)",
 - pinfo->map->flash.size, pinfo->map->flash.size - 0x520000);
 +if ((pinfo->machine_nr == MACH_ARMADILLO411 ||
 +     pinfo->machine_nr == MACH_ARMADILLO441) &&
 +    !force_mtdparts4x0)
 +hsprintf(pinfo->default_mtdparts,
 + "armadillo4x0-nor:%p(all)ro,0x40000@0(bootloader)ro,"
 + "0x400000(kernel),%p(userland),-(config)",
 + pinfo->map->flash.size, pinfo->map->flash.size - 0x540000);
 +else
 +hsprintf(pinfo->default_mtdparts,
 + "armadillo4x0-nor:%p(all)ro,0x20000@0(bootloader)ro,"
 + "0x400000(kernel),%p(userland),-(config)",
 + pinfo->map->flash.size, pinfo->map->flash.size - 0x520000);
 }

 static void armadillo4x0_setup_map(struct platform_info *pinfo)
 @@ -655,9 +681,11 @@ static void armadillo4x0_rev_fixup(struct platform_info *pinfo)
 *   Rev.B 0x02xx
 *   Rev.C 0x03xx
 */
 -if (pinfo->system_rev < 0x0300) {
 -memcpy(& mmcsd1_pwren_pin[0], &mmcsd1_pwren_pin_revb[0],
 -       sizeof(struct iomux_info));
 +if (pinfo->machine_nr != MACH_ARMADILLO411 &&
 +    pinfo->machine_nr != MACH_ARMADILLO441) {
 +if (pinfo->system_rev < 0x0300)
 +    memcpy(&mmcsd1_pwren_pin[0], &mmcsd1_pwren_pin_revb[0],
 +   sizeof(struct iomux_info));
 }
 }

 @@ -727,6 +755,25 @@ static struct memory_map armadillo4x0_memory_map = {
 .free= { RAM_ADDR(0x03000000), 0x01000000 },
 };

 +static struct memory_map armadillo4x1_memory_map = {
 +.flash= { FLASH_ADDR(0x00000000), 0},
 +.param= { FLASH_ADDR(0x00020000), 0x00008000 },
 +
 +/* default memory map: RAM = 64MB, (FLA = 16MB) */
 +.ram= { RAM_ADDR(0x00000000), 0 },
 +.boot_param= { RAM_ADDR(0x00000100), 0x00000f00 },
 +.mmu_table= { RAM_ADDR(0x00004000), 0x00004000 },
 +.kernel= { RAM_ADDR(0x00008000), 0x007f8000 },
 +/*.hermit= { RAM_ADDR(0x00800000), 0x00300000 }, */
 +/*.fec_desc= { RAM_ADDR(0x00b00000), 0x00100000 }, */
 +.gunzip= { RAM_ADDR(0x00c00000), 0x00100000 },
 +/*.stack(irq)= { RAM_ADDR(0x00d00000), 0x00100000 }, */
 +/*.stack(svc)= { RAM_ADDR(0x00e00000), 0x00100000 }, */
 +/*.vector= { RAM_ADDR(0x00f00000), 0x00100000 }, */
 +.initrd= { RAM_ADDR(0x01000000), 0x02000000 },
 +.free= { RAM_ADDR(0x03000000), 0x01000000 },
 +};
 +
 static void armadillo4x0_init(void)
 {
 struct platform_info *pinfo = &platform_info;
 @@ -750,8 +797,14 @@ static void armadillo4x0_init(void)

 update_target_profile();

 -memdev_add(flash, &mdev_param,
 -   "hermit/param", FLASH_ADDR(0x00018000), 0x00008000);
 +if ((pinfo->machine_nr == MACH_ARMADILLO411 ||
 +     pinfo->machine_nr == MACH_ARMADILLO441) &&
 +    !force_mtdparts4x0)
 +memdev_add(flash, &mdev_param,
 +   "hermit/param", FLASH_ADDR(0x00020000), 0x00008000);
 +else
 +memdev_add(flash, &mdev_param,
 +   "hermit/param", FLASH_ADDR(0x00018000), 0x00008000);
 }
 arch_initcall(armadillo4x0_init);

新フラッシュメモリを動作させるために、コンフィギュレーション"CONFIG_MTD_CFI_AMDSTD"を有効化しました。

--- a/arch/arm/configs/armadillo4x0_defconfig
+++ b/arch/arm/configs/armadillo4x0_defconfig
@@ -99,6 +99,7 @@ CONFIG_MTD_RO_IF=y
CONFIG_MTD_BLOCK=y
CONFIG_MTD_CFI=y
CONFIG_MTD_CFI_INTELEXT=y
+CONFIG_MTD_CFI_AMDSTD=y
CONFIG_MTD_PHYSMAP=y
CONFIG_BLK_DEV_LOOP=y
CONFIG_BLK_DEV_RAM=y
        

新フラッシュメモリ適用品を表すmach-types ”ARMADILLO411"と "ARMADILLO441" を追加しました。なお、従来品のmach-typesは従来品は"ARMADILLO410" または "ARMADILLO440" となります。

この情報は、bootloaderからARM LinuxのATAGという仕組みを利用し、Linux カーネルに伝えられます。

-- a/arch/arm/tools/mach-types
+++ b/arch/arm/tools/mach-types
@@ -1010,3 +1010,5 @@ eukrea_cpuimx28sd MACH_EUKREA_CPUIMX28SD  EUKREA_CPUIMX28SD       4573
domotab                        MACH_DOMOTAB            DOMOTAB                 4574
pfla03                 MACH_PFLA03             PFLA03                  4575
armadillo410           MACH_ARMADILLO410       ARMADILLO410            4636
+armadillo441           MACH_ARMADILLO441       ARMADILLO441            5135
+armadillo411           MACH_ARMADILLO411       ARMADILLO411            5136
        

__machine_arch_type(mach-types)の値に応じて、新フラッシュメモリ適用品のフラッシュメモリメモリマップを使用するか、従来品のフラッシュメモリメモリマップを使用するかを判別します。

--- a/arch/arm/mach-imx/mach-armadillo4x0.c
+++ b/arch/arm/mach-imx/mach-armadillo4x0.c
@@ -417,6 +417,30 @@ static struct mtd_partition armadillo4x0_nor_flash_partitions_32m[] = {
},
};

+static struct mtd_partition armadillo4x1_nor_flash_partitions_32m[] = {
+{
+.name= "nor.bootloader",
+.offset= 0x00000000,
+.size= 2 * SZ_128K,
+.mask_flags= MTD_WRITEABLE,
+}, {
+.name= "nor.kernel",
+.offset= MTDPART_OFS_APPEND,
+.size= 32 * SZ_128K,
+.mask_flags= 0,
+}, {
+.name= "nor.userland",
+.offset= MTDPART_OFS_APPEND,
+.size= 214 * SZ_128K,
+.mask_flags= 0,
+}, {
+.name= "nor.config",
+.offset= MTDPART_OFS_APPEND,
+.size= 8 * SZ_128K,
+.mask_flags= 0,
+},
+};
+
static const struct physmap_flash_data
armadillo4x0_nor_flash_pdata_16m __initconst = {
.width= 2,
@@ -431,6 +455,13 @@ static const struct physmap_flash_data
.nr_parts= ARRAY_SIZE(armadillo4x0_nor_flash_partitions_32m),
};

+static const struct physmap_flash_data
+armadillo4x1_nor_flash_pdata_32m __initconst = {
+.width= 2,
+.parts= armadillo4x1_nor_flash_partitions_32m,
+.nr_parts= ARRAY_SIZE(armadillo4x1_nor_flash_partitions_32m),
+};
+
static const struct resource
armadillo4x0_nor_flash_resource __initconst = {
.flags= IORESOURCE_MEM,
@@ -502,7 +533,10 @@ static void __init armadillo420_init_mtd(void)
#if defined(CONFIG_MACH_ARMADILLO440) || defined(CONFIG_MACH_ARMADILLO410)
static void __init armadillo440_init_mtd(void)
{
-armadillo4x0_init_mtd(armadillo4x0_nor_flash_pdata_32m);
+if (machine_is_armadillo441() || machine_is_armadillo411())
+armadillo4x0_init_mtd(armadillo4x1_nor_flash_pdata_32m);
+else
+armadillo4x0_init_mtd(armadillo4x0_nor_flash_pdata_32m);
}
#endif

@@ -584,6 +618,18 @@ MACHINE_START(ARMADILLO410, "Armadillo-410")
.init_machine= armadillo440_init,
.restart= mxc_restart,
MACHINE_END
+
+MACHINE_START(ARMADILLO411, "Armadillo-410")
+/* Maintainer: Atmark Techno, Inc.  */
+.atag_offset= 0x100,
+.map_io= mx25_map_io,
+.init_early= imx25_init_early,
+.init_irq= mx25_init_irq,
+.handle_irq= imx25_handle_irq,
+.init_time= armadillo4x0_timer_init,
+.init_machine= armadillo440_init,
+.restart= mxc_restart,
+MACHINE_END
#endif

#if defined(CONFIG_MACH_ARMADILLO420)
@@ -612,4 +658,16 @@ MACHINE_START(ARMADILLO440, "Armadillo-440")
.init_machine= armadillo440_init,
.restart= mxc_restart,
MACHINE_END
+
+MACHINE_START(ARMADILLO441, "Armadillo-440")
+/* Maintainer: Atmark Techno, Inc.  */
+.atag_offset= 0x100,
+.map_io= mx25_map_io,
+.init_early= imx25_init_early,
+.init_irq= mx25_init_irq,
+.handle_irq= imx25_handle_irq,
+.init_time= armadillo4x0_timer_init,
+.init_machine= armadillo440_init,
+.restart= mxc_restart,
+MACHINE_END
#endif