CVM_CAST64(octeon_read_csr64(oct, CN23XX_SLI_PKT_CNT_INT)));
 }
 
+static int cn23xx_pf_soft_reset(struct octeon_device *oct)
+{
+       octeon_write_csr64(oct, CN23XX_WIN_WR_MASK_REG, 0xFF);
+
+       dev_dbg(&oct->pci_dev->dev, "OCTEON[%d]: BIST enabled for CN23XX soft reset\n",
+               oct->octeon_id);
+
+       octeon_write_csr64(oct, CN23XX_SLI_SCRATCH1, 0x1234ULL);
+
+       /* Initiate chip-wide soft reset */
+       lio_pci_readq(oct, CN23XX_RST_SOFT_RST);
+       lio_pci_writeq(oct, 1, CN23XX_RST_SOFT_RST);
+
+       /* Wait for 100ms as Octeon resets. */
+       mdelay(100);
+
+       if (octeon_read_csr64(oct, CN23XX_SLI_SCRATCH1) == 0x1234ULL) {
+               dev_err(&oct->pci_dev->dev, "OCTEON[%d]: Soft reset failed\n",
+                       oct->octeon_id);
+               return 1;
+       }
+
+       dev_dbg(&oct->pci_dev->dev, "OCTEON[%d]: Reset completed\n",
+               oct->octeon_id);
+
+       /* restore the  reset value*/
+       octeon_write_csr64(oct, CN23XX_WIN_WR_MASK_REG, 0xFF);
+
+       return 0;
+}
+
 static void cn23xx_enable_error_reporting(struct octeon_device *oct)
 {
        u32 regval;
        oct->fn_list.process_interrupt_regs = cn23xx_interrupt_handler;
        oct->fn_list.msix_interrupt_handler = cn23xx_pf_msix_interrupt_handler;
 
+       oct->fn_list.soft_reset = cn23xx_pf_soft_reset;
        oct->fn_list.setup_device_regs = cn23xx_setup_pf_device_regs;
 
        oct->fn_list.enable_interrupt = cn23xx_enable_pf_interrupt;
                CVM_CAST64(octeon_read_csr64(
                        oct, CN23XX_SLI_S2M_PORTX_CTL(oct->pcie_port))));
 }
+
+int cn23xx_fw_loaded(struct octeon_device *oct)
+{
+       u64 val;
+
+       val = octeon_read_csr64(oct, CN23XX_SLI_SCRATCH1);
+       return (val >> 1) & 1ULL;
+}
 
 
                /* fallthrough */
        case OCT_DEV_PCI_MAP_DONE:
-
                /* Soft reset the octeon device before exiting */
-               oct->fn_list.soft_reset(oct);
+               if ((!OCTEON_CN23XX_PF(oct)) || !oct->octeon_id)
+                       oct->fn_list.soft_reset(oct);
 
                octeon_unmap_pci_barx(oct, 0);
                octeon_unmap_pci_barx(oct, 1);
 static int octeon_device_init(struct octeon_device *octeon_dev)
 {
        int j, ret;
+       int fw_loaded = 0;
        char bootcmd[] = "\n";
        struct octeon_device_priv *oct_priv =
                (struct octeon_device_priv *)octeon_dev->priv;
 
        octeon_dev->app_mode = CVM_DRV_INVALID_APP;
 
-       /* Do a soft reset of the Octeon device. */
-       if (octeon_dev->fn_list.soft_reset(octeon_dev))
+       if (OCTEON_CN23XX_PF(octeon_dev)) {
+               if (!cn23xx_fw_loaded(octeon_dev)) {
+                       fw_loaded = 0;
+                       /* Do a soft reset of the Octeon device. */
+                       if (octeon_dev->fn_list.soft_reset(octeon_dev))
+                               return 1;
+                       /* things might have changed */
+                       if (!cn23xx_fw_loaded(octeon_dev))
+                               fw_loaded = 0;
+                       else
+                               fw_loaded = 1;
+               } else {
+                       fw_loaded = 1;
+               }
+       } else if (octeon_dev->fn_list.soft_reset(octeon_dev)) {
                return 1;
+       }
 
        /* Initialize the dispatch mechanism used to push packets arriving on
         * Octeon Output queues.
 
        atomic_set(&octeon_dev->status, OCT_DEV_IO_QUEUES_DONE);
 
-       dev_dbg(&octeon_dev->pci_dev->dev, "Waiting for DDR initialization...\n");
-
-       if (ddr_timeout == 0)
-               dev_info(&octeon_dev->pci_dev->dev, "WAITING. Set ddr_timeout to non-zero value to proceed with initialization.\n");
+       if ((!OCTEON_CN23XX_PF(octeon_dev)) || !fw_loaded) {
+               dev_dbg(&octeon_dev->pci_dev->dev, "Waiting for DDR initialization...\n");
+               if (!ddr_timeout) {
+                       dev_info(&octeon_dev->pci_dev->dev,
+                                "WAITING. Set ddr_timeout to non-zero value to proceed with initialization.\n");
+               }
 
-       schedule_timeout_uninterruptible(HZ * LIO_RESET_SECS);
+               schedule_timeout_uninterruptible(HZ * LIO_RESET_SECS);
 
-       /* Wait for the octeon to initialize DDR after the soft-reset. */
-       while (ddr_timeout == 0) {
-               set_current_state(TASK_INTERRUPTIBLE);
-               if (schedule_timeout(HZ / 10)) {
-                       /* user probably pressed Control-C */
+               /* Wait for the octeon to initialize DDR after the soft-reset.*/
+               while (!ddr_timeout) {
+                       set_current_state(TASK_INTERRUPTIBLE);
+                       if (schedule_timeout(HZ / 10)) {
+                               /* user probably pressed Control-C */
+                               return 1;
+                       }
+               }
+               ret = octeon_wait_for_ddr_init(octeon_dev, &ddr_timeout);
+               if (ret) {
+                       dev_err(&octeon_dev->pci_dev->dev,
+                               "DDR not initialized. Please confirm that board is configured to boot from Flash, ret: %d\n",
+                               ret);
                        return 1;
                }
-       }
-       ret = octeon_wait_for_ddr_init(octeon_dev, &ddr_timeout);
-       if (ret) {
-               dev_err(&octeon_dev->pci_dev->dev,
-                       "DDR not initialized. Please confirm that board is configured to boot from Flash, ret: %d\n",
-                       ret);
-               return 1;
-       }
 
-       if (octeon_wait_for_bootloader(octeon_dev, 1000) != 0) {
-               dev_err(&octeon_dev->pci_dev->dev, "Board not responding\n");
-               return 1;
-       }
+               if (octeon_wait_for_bootloader(octeon_dev, 1000)) {
+                       dev_err(&octeon_dev->pci_dev->dev, "Board not responding\n");
+                       return 1;
+               }
 
-       /* Divert uboot to take commands from host instead. */
-       ret = octeon_console_send_cmd(octeon_dev, bootcmd, 50);
+               /* Divert uboot to take commands from host instead. */
+               ret = octeon_console_send_cmd(octeon_dev, bootcmd, 50);
 
-       dev_dbg(&octeon_dev->pci_dev->dev, "Initializing consoles\n");
-       ret = octeon_init_consoles(octeon_dev);
-       if (ret) {
-               dev_err(&octeon_dev->pci_dev->dev, "Could not access board consoles\n");
-               return 1;
-       }
-       ret = octeon_add_console(octeon_dev, 0);
-       if (ret) {
-               dev_err(&octeon_dev->pci_dev->dev, "Could not access board console\n");
-               return 1;
-       }
+               dev_dbg(&octeon_dev->pci_dev->dev, "Initializing consoles\n");
+               ret = octeon_init_consoles(octeon_dev);
+               if (ret) {
+                       dev_err(&octeon_dev->pci_dev->dev, "Could not access board consoles\n");
+                       return 1;
+               }
+               ret = octeon_add_console(octeon_dev, 0);
+               if (ret) {
+                       dev_err(&octeon_dev->pci_dev->dev, "Could not access board console\n");
+                       return 1;
+               }
 
-       atomic_set(&octeon_dev->status, OCT_DEV_CONSOLE_INIT_DONE);
+               atomic_set(&octeon_dev->status, OCT_DEV_CONSOLE_INIT_DONE);
 
-       dev_dbg(&octeon_dev->pci_dev->dev, "Loading firmware\n");
-       ret = load_firmware(octeon_dev);
-       if (ret) {
-               dev_err(&octeon_dev->pci_dev->dev, "Could not load firmware to board\n");
-               return 1;
+               dev_dbg(&octeon_dev->pci_dev->dev, "Loading firmware\n");
+               ret = load_firmware(octeon_dev);
+               if (ret) {
+                       dev_err(&octeon_dev->pci_dev->dev, "Could not load firmware to board\n");
+                       return 1;
+               }
+               /* set bit 1 of SLI_SCRATCH_1 to indicate that firmware is
+                * loaded
+                */
+               if (OCTEON_CN23XX_PF(octeon_dev))
+                       octeon_write_csr64(octeon_dev, CN23XX_SLI_SCRATCH1,
+                                          2ULL);
        }
 
        handshake[octeon_dev->octeon_id].init_ok = 1;
                       octeon_dev->droq[j]->pkts_credit_reg);
 
        /* Packets can start arriving on the output queues from this point. */
-
        return 0;
 }