add support for secondary FW

software/sys_controller/inc/firmware.h

@@ -45,7 +45,14 @@ typedef struct {
 } __attribute__((packed)) fw_hdr;
 
 typedef struct {
-    uint32_t unused[29];
+    uint32_t sm_cur_state[4];
+    uint32_t force_early_confdone[4];
+    uint32_t wdog_timeout[4];
+    uint32_t wdog_enable[4];
+    uint32_t image_addr[4];
+    uint32_t force_int_osc[4];
+    uint32_t reg_trig_cnd[4];
+    uint32_t reset_timer;
     uint32_t reconfig_start;
 } rem_update_regs;
 
@@ -53,8 +60,8 @@ typedef struct {
     volatile rem_update_regs *regs;
 } rem_update_dev;
 
+int fw_init_secondary();
 int fw_update();
-
+void fw_update_commit(uint32_t* cluster_idx, uint8_t* databuf, uint32_t bytes_to_copy, uint16_t fs_csize, uint16_t fs_startsec, uint32_t flash_addr);
-void fw_update_commit(uint32_t* cluster_idx, uint8_t* databuf, uint32_t bytes_to_copy, uint16_t fs_csize, uint16_t fs_startsec);
 
 #endif

software/sys_controller/src/firmware.c

@@ -34,6 +34,10 @@
 #include "file.h"
 #include "altera_avalon_pio_regs.h"
 
+#define SECONDARY_FW_ADDR 0x00080000
+#define FW_FINGERPRINT 0xEFEFEF56
+#define FW_FINGERPRINT_OFFSET 0x20
+
 extern char menu_row1[LCD_ROW_LEN+1], menu_row2[LCD_ROW_LEN+1];
 extern alt_u16 rc_keymap[REMOTE_MAX_KEYS];
 extern SD_DEV sdcard_dev;
@@ -41,6 +45,23 @@ extern alt_u32 sys_ctrl;
 extern flash_ctrl_dev flashctrl_dev;
 extern rem_update_dev rem_reconfig_dev;
 
+int fw_init_secondary() {
+    uint32_t fingerprint = *(uint32_t*)(INTEL_GENERIC_SERIAL_FLASH_INTERFACE_TOP_0_AVL_MEM_BASE + SECONDARY_FW_ADDR + FW_FINGERPRINT_OFFSET);
+
+    if (fingerprint != FW_FINGERPRINT) {
+        printf("Invalid FW fingerprint (0x%.8x instead of 0x%.8x)\n", fingerprint, FW_FINGERPRINT);
+        return -1;
+    }
+
+    rem_reconfig_dev.regs->image_addr[0] = SECONDARY_FW_ADDR;
+    rem_reconfig_dev.regs->wdog_enable[0] = 0;
+    rem_reconfig_dev.regs->reconfig_start = 1;
+
+    while (1) {}
+
+    return 0;
+}
+
 //int fw_update(char *dirname, char *filename) {
 int fw_update() {
     FIL fw_file;
@@ -53,6 +74,7 @@ int fw_update() {
     uint32_t cluster_idx[100]; // enough for >=4kB cluster size
     uint8_t databuf[SD_BLK_SIZE]; // temp buffer for data
     uint16_t fs_csize, fs_startsec, cl_iter, cl_soffs;
+    uint32_t flash_addr;
 
     if (!sdcard_dev.mount) {
         retval = file_mount();
@@ -79,12 +101,15 @@ int fw_update() {
 
         hdr_len = bswap32(hdr.hdr_len);
 
-        if (strncmp(hdr.fw_key, "OSSC", 4) || (hdr_len < 26 || hdr_len > 508)) {
+        if (!(!strncmp(hdr.fw_key, "OSSC", 4) || !strncmp(hdr.fw_key, "OSS2", 4)) || (hdr_len < 26 || hdr_len > 508)) {
             printf("Invalid FW header\n");
             retval = -4;
             goto close_file;
         }
 
+        // Set target flash address
+        flash_addr = hdr.fw_key[3] == 'C' ? 0x00000000 : SECONDARY_FW_ADDR;
+
         crcval = crc32((unsigned char *)&hdr, hdr_len, 1);
         hdr.hdr_len = bswap32(hdr.hdr_len);
         hdr.data_len = bswap32(hdr.data_len);
@@ -105,7 +130,7 @@ int fw_update() {
             goto close_file;
         }
 
-        sniprintf(menu_row1, LCD_ROW_LEN+1, "v%u.%u%s%s", hdr.version_major, hdr.version_minor, hdr.version_suffix[0] ? "-" : "", hdr.version_suffix);
+        sniprintf(menu_row1, LCD_ROW_LEN+1, "v%u.%u%s%s%s", hdr.version_major, hdr.version_minor, hdr.version_suffix[0] ? "-" : "", hdr.version_suffix, (hdr.fw_key[3] == 'C') ? "" : " (sec)" );
         sniprintf(menu_row2, LCD_ROW_LEN+1, "Update? 1=Y, 2=N");
         ui_disp_menu(1);
 
@@ -184,7 +209,7 @@ int fw_update() {
         usleep(10000);
 
         // No return from here
-        fw_update_commit(cluster_idx, databuf, hdr.data_len, fs_csize, fs_startsec);
+        fw_update_commit(cluster_idx, databuf, hdr.data_len, fs_csize, fs_startsec, flash_addr);
         return 0;
     } else {
         printf("FW file not found\n");
@@ -199,7 +224,7 @@ close_file:
 }
 
 // commit FW update. Do not call functions located in flash during update
-void __attribute__((noinline, flatten, noreturn, __section__(".text_bram"))) fw_update_commit(uint32_t* cluster_idx, uint8_t* databuf, uint32_t bytes_to_copy, uint16_t fs_csize, uint16_t fs_startsec) {
+void __attribute__((noinline, flatten, noreturn, __section__(".text_bram"))) fw_update_commit(uint32_t* cluster_idx, uint8_t* databuf, uint32_t bytes_to_copy, uint16_t fs_csize, uint16_t fs_startsec, uint32_t flash_addr) {
     int i, sectors;
     SDRESULTS res;
     uint16_t cl_iter, cl_soffs;
@@ -209,9 +234,9 @@ void __attribute__((noinline, flatten, noreturn, __section__(".text_bram"))) fw_
     flash_write_protect(&flashctrl_dev, 0);
 
     // Erase sectors
-    addr = 0;
+    addr = flash_addr;
     sectors = (bytes_to_copy/FLASH_SECTOR_SIZE) + ((bytes_to_copy % FLASH_SECTOR_SIZE) != 0);
-    data_to = (uint32_t*)(INTEL_GENERIC_SERIAL_FLASH_INTERFACE_TOP_0_AVL_MEM_BASE);
+    data_to = (uint32_t*)(INTEL_GENERIC_SERIAL_FLASH_INTERFACE_TOP_0_AVL_MEM_BASE + flash_addr);
 
     for (i=0; i<sectors; i++) {
         flash_sector_erase(&flashctrl_dev, addr);

software/sys_controller/src/menu.c

@@ -262,6 +262,7 @@ MENU(menu_settings, P99_PROTECT({ \
     //{ LNG("<Import sett.  >","<ｾｯﾃｲﾖﾐｺﾐ      >"), OPT_FUNC_CALL,        { .fun = { import_userdata, NULL } } },
     //{ LNG("<Export sett.  >","<ｾｯﾃｲｶｷｺﾐ      >"), OPT_FUNC_CALL,        { .fun = { export_userdata, NULL } } },
     { LNG("<Fw. update    >","<ﾌｧｰﾑｳｪｱｱｯﾌﾟﾃﾞｰﾄ>"), OPT_FUNC_CALL,        { .fun = { fw_update, NULL } } },
+    { "<Launch 2nd FW >",                        OPT_FUNC_CALL,        { .fun = { fw_init_secondary, NULL } } },
 }))
 
 

sys.qsys

@@ -625,7 +625,7 @@
   <parameter name="GUI_config_device" value="EPCS16" />
   <parameter name="check_app_pof" value="false" />
   <parameter name="check_avalon_interface" value="true" />
-  <parameter name="m_support_write_config_check" value="false" />
+  <parameter name="m_support_write_config_check" value="true" />
   <parameter name="operation_mode" value="REMOTE" />
  </module>
  <module name="sc_config_0" kind="sc_config" version="1.0" enabled="1" />