AWR1843BOOST: MCU stuck in ROM bootloader

/**************************************************************************
 *************************** Include Files ********************************
 **************************************************************************/

/* Standard Include Files. */
#include <stdint.h>
#include <stdlib.h>
#include <stddef.h>
#include <string.h>
#include <stdio.h>

/* BIOS/XDC Include Files. */
#include <xdc/std.h>
#include <xdc/cfg/global.h>
#include <xdc/runtime/IHeap.h>
#include <xdc/runtime/System.h>
#include <xdc/runtime/Error.h>
#include <xdc/runtime/Memory.h>
#include <ti/sysbios/BIOS.h>
#include <ti/sysbios/knl/Task.h>
#include <ti/sysbios/knl/Event.h>
#include <ti/sysbios/knl/Semaphore.h>
#include <ti/sysbios/knl/Clock.h>
#include <ti/sysbios/heaps/HeapBuf.h>
#include <ti/sysbios/heaps/HeapMem.h>
#include <ti/sysbios/knl/Event.h>
#include <ti/sysbios/family/arm/v7a/Pmu.h>

/* mmWave SK Include Files: */
#include <ti/common/sys_common.h>
#include <ti/drivers/pinmux/pinmux.h>
#include <ti/drivers/osal/HwiP.h>
#include <ti/drivers/esm/esm.h>

/* SOC register file */
#include <ti/drivers/soc/soc.h>
#include <ti/drivers/qspiflash/qspiflash.h>
#include <ti/drivers/qspi/qspi.h>
#include <ti/drivers/pinmux/pinmux.h>
#include <ti/drivers/soc/include/soc_internal.h>

SOC_Handle      socHandle;

void Test_resetTask(UArg arg0, UArg arg1)
{
    /* Reset MCU after 10ms */
    Task_sleep(10);
    SOC_DriverMCB* socMcb = (SOC_DriverMCB*)socHandle;
    socMcb->ptrTopRCMRegs->SOFTSYSRST = 0xADu;
}

void Test_initTask(UArg arg0, UArg arg1)
{
    int32_t             retVal = 0;
    Task_Params         taskParams;
    QSPI_Params         qSPIParams;
    QSPI_Handle         qSPIHandle;
    QSPIFlash_Handle    qSPIFlashHandle;

    QSPI_init();
    QSPIFlash_init();
    QSPI_Params_init(&qSPIParams);

    qSPIParams.qspiClk = 200 * 1000000U;
    qSPIParams.clkMode = QSPI_CLOCK_MODE_0;
    qSPIParams.bitRate = 40 * 1000000U;
    qSPIHandle = QSPI_open(&qSPIParams, &retVal);
    qSPIFlashHandle = QSPIFlash_open(qSPIHandle, &retVal);

    /* Create a backgroud task to reset MCU after 10ms */
    Task_Params_init(&taskParams);
    taskParams.stackSize = 4*1024;
    Task_create(Test_resetTask, &taskParams, NULL);

    /* Make QSPIFlash into WIP state, QSPIFlash will take about 500ms to erase a 64kB block */
    char wrBuff[512] = "abcdefghijklmnopqrstuvwxyz1234567890";
    QSPIFlash_blockErase(qSPIFlashHandle, 0x1E0000U);
    QSPIFlash_singleWrite(qSPIFlashHandle, 0x1E0000U, sizeof(wrBuff), wrBuff);

    /* After reset, MCU will be stuck in ROM bootloader */
}


/**
 *  @b Description
 *  @n
 *      Entry point into the test code.
 *
 *  @retval
 *      Not Applicable.
 */
int main (void)
{
    Task_Params     taskParams;
    int32_t         errCode;
    SOC_Cfg         socCfg;

    /* Initialize the ESM: Dont clear errors as TI RTOS does it */
    ESM_init(0U);

    /* Initialize the SOC confiugration: */
    memset ((void *)&socCfg, 0, sizeof(SOC_Cfg));

    /* Populate the SOC configuration: */
    socCfg.clockCfg = SOC_SysClock_INIT;

    /* Initialize the SOC Module: This is done as soon as the application is started
     * to ensure that the MPU is correctly configured. */
    socHandle = SOC_init (&socCfg, &errCode);
    if (socHandle == NULL)
    {
        System_printf ("Error: SOC Module Initialization failed [Error code %d]\n", errCode);
        return -1;
    }

    /* Debug Message: */
    System_printf ("**********************************\n");
    System_printf ("Debug: Mss Test Application Start \n");
    System_printf ("**********************************\n");

    /* Setup the PINMUX to bring out the QSPI */
    Pinmux_Set_OverrideCtrl(SOC_XWR18XX_PINR12_PADAP, PINMUX_OUTEN_RETAIN_HW_CTRL, PINMUX_INPEN_RETAIN_HW_CTRL);
    Pinmux_Set_FuncSel(SOC_XWR18XX_PINR12_PADAP, SOC_XWR18XX_PINR12_PADAP_QSPI_CLK);
    
    Pinmux_Set_OverrideCtrl(SOC_XWR18XX_PINP11_PADAQ, PINMUX_OUTEN_RETAIN_HW_CTRL, PINMUX_INPEN_RETAIN_HW_CTRL);
    Pinmux_Set_FuncSel(SOC_XWR18XX_PINP11_PADAQ, SOC_XWR18XX_PINP11_PADAQ_QSPI_CSN);
    
    Pinmux_Set_OverrideCtrl(SOC_XWR18XX_PINR13_PADAL, PINMUX_OUTEN_RETAIN_HW_CTRL, PINMUX_INPEN_RETAIN_HW_CTRL);
    Pinmux_Set_FuncSel(SOC_XWR18XX_PINR13_PADAL, SOC_XWR18XX_PINR13_PADAL_QSPI_D0);
    
    Pinmux_Set_OverrideCtrl(SOC_XWR18XX_PINN12_PADAM, PINMUX_OUTEN_RETAIN_HW_CTRL, PINMUX_INPEN_RETAIN_HW_CTRL);
    Pinmux_Set_FuncSel(SOC_XWR18XX_PINN12_PADAM, SOC_XWR18XX_PINN12_PADAM_QSPI_D1);
    
    Pinmux_Set_OverrideCtrl(SOC_XWR18XX_PINR14_PADAN, PINMUX_OUTEN_RETAIN_HW_CTRL, PINMUX_INPEN_RETAIN_HW_CTRL);
    Pinmux_Set_FuncSel(SOC_XWR18XX_PINR14_PADAN, SOC_XWR18XX_PINR14_PADAN_QSPI_D2);
    
    Pinmux_Set_OverrideCtrl(SOC_XWR18XX_PINP12_PADAO, PINMUX_OUTEN_RETAIN_HW_CTRL, PINMUX_INPEN_RETAIN_HW_CTRL);
    Pinmux_Set_FuncSel(SOC_XWR18XX_PINP12_PADAO, SOC_XWR18XX_PINP12_PADAO_QSPI_D3);

    /* Initialize the Task Parameters. */
    Task_Params_init(&taskParams);
    taskParams.stackSize = 6*1024;
    Task_create(Test_initTask, &taskParams, NULL);

    /* Start BIOS */
    BIOS_start();
Exit:
    return 0;
}