/**********************************************************************
 * Author: Cavium, Inc.
 *
 * Contact: support@cavium.com
 *          Please include "LiquidIO" in the subject.
 *
 * Copyright (c) 2003-2016 Cavium, Inc.
 *
 * This file is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License, Version 2, as
 * published by the Free Software Foundation.
 *
 * This file is distributed in the hope that it will be useful, but
 * AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty
 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or
 * NONINFRINGEMENT.  See the GNU General Public License for more details.
 ***********************************************************************/
#include <linux/pci.h>
#include <linux/netdevice.h>
#include <linux/vmalloc.h>
#include "liquidio_common.h"
#include "octeon_droq.h"
#include "octeon_iq.h"
#include "response_manager.h"
#include "octeon_device.h"
#include "octeon_main.h"
#include "octeon_network.h"
#include "cn66xx_regs.h"
#include "cn66xx_device.h"
#include "cn23xx_pf_device.h"
#include "cn23xx_vf_device.h"

/** Default configuration
 *  for CN66XX OCTEON Models.
 */
static struct octeon_config default_cn66xx_conf = {
        .card_type                              = LIO_210SV,
        .card_name                              = LIO_210SV_NAME,

        /** IQ attributes */
        .iq                                     = {
                .max_iqs                        = CN6XXX_CFG_IO_QUEUES,
                .pending_list_size              =
                        (CN6XXX_MAX_IQ_DESCRIPTORS * CN6XXX_CFG_IO_QUEUES),
                .instr_type                     = OCTEON_64BYTE_INSTR,
                .db_min                         = CN6XXX_DB_MIN,
                .db_timeout                     = CN6XXX_DB_TIMEOUT,
        }
        ,

        /** OQ attributes */
        .oq                                     = {
                .max_oqs                        = CN6XXX_CFG_IO_QUEUES,
                .refill_threshold               = CN6XXX_OQ_REFIL_THRESHOLD,
                .oq_intr_pkt                    = CN6XXX_OQ_INTR_PKT,
                .oq_intr_time                   = CN6XXX_OQ_INTR_TIME,
                .pkts_per_intr                  = CN6XXX_OQ_PKTSPER_INTR,
        }
        ,

        .num_nic_ports                          = DEFAULT_NUM_NIC_PORTS_66XX,
        .num_def_rx_descs                       = CN6XXX_MAX_OQ_DESCRIPTORS,
        .num_def_tx_descs                       = CN6XXX_MAX_IQ_DESCRIPTORS,
        .def_rx_buf_size                        = CN6XXX_OQ_BUF_SIZE,

        /* For ethernet interface 0:  Port cfg Attributes */
        .nic_if_cfg[0] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 0,
        },

        .nic_if_cfg[1] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 1,
        },

        /** Miscellaneous attributes */
        .misc                                   = {
                /* Host driver link query interval */
                .oct_link_query_interval        = 100,

                /* Octeon link query interval */
                .host_link_query_interval       = 500,

                .enable_sli_oq_bp               = 0,

                /* Control queue group */
                .ctrlq_grp                      = 1,
        }
        ,
};

/** Default configuration
 *  for CN68XX OCTEON Model.
 */

static struct octeon_config default_cn68xx_conf = {
        .card_type                              = LIO_410NV,
        .card_name                              = LIO_410NV_NAME,

        /** IQ attributes */
        .iq                                     = {
                .max_iqs                        = CN6XXX_CFG_IO_QUEUES,
                .pending_list_size              =
                        (CN6XXX_MAX_IQ_DESCRIPTORS * CN6XXX_CFG_IO_QUEUES),
                .instr_type                     = OCTEON_64BYTE_INSTR,
                .db_min                         = CN6XXX_DB_MIN,
                .db_timeout                     = CN6XXX_DB_TIMEOUT,
        }
        ,

        /** OQ attributes */
        .oq                                     = {
                .max_oqs                        = CN6XXX_CFG_IO_QUEUES,
                .refill_threshold               = CN6XXX_OQ_REFIL_THRESHOLD,
                .oq_intr_pkt                    = CN6XXX_OQ_INTR_PKT,
                .oq_intr_time                   = CN6XXX_OQ_INTR_TIME,
                .pkts_per_intr                  = CN6XXX_OQ_PKTSPER_INTR,
        }
        ,

        .num_nic_ports                          = DEFAULT_NUM_NIC_PORTS_68XX,
        .num_def_rx_descs                       = CN6XXX_MAX_OQ_DESCRIPTORS,
        .num_def_tx_descs                       = CN6XXX_MAX_IQ_DESCRIPTORS,
        .def_rx_buf_size                        = CN6XXX_OQ_BUF_SIZE,

        .nic_if_cfg[0] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 0,
        },

        .nic_if_cfg[1] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 1,
        },

        .nic_if_cfg[2] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 2,
        },

        .nic_if_cfg[3] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 3,
        },

        /** Miscellaneous attributes */
        .misc                                   = {
                /* Host driver link query interval */
                .oct_link_query_interval        = 100,

                /* Octeon link query interval */
                .host_link_query_interval       = 500,

                .enable_sli_oq_bp               = 0,

                /* Control queue group */
                .ctrlq_grp                      = 1,
        }
        ,
};

/** Default configuration
 *  for CN68XX OCTEON Model.
 */
static struct octeon_config default_cn68xx_210nv_conf = {
        .card_type                              = LIO_210NV,
        .card_name                              = LIO_210NV_NAME,

        /** IQ attributes */

        .iq                                     = {
                .max_iqs                        = CN6XXX_CFG_IO_QUEUES,
                .pending_list_size              =
                        (CN6XXX_MAX_IQ_DESCRIPTORS * CN6XXX_CFG_IO_QUEUES),
                .instr_type                     = OCTEON_64BYTE_INSTR,
                .db_min                         = CN6XXX_DB_MIN,
                .db_timeout                     = CN6XXX_DB_TIMEOUT,
        }
        ,

        /** OQ attributes */
        .oq                                     = {
                .max_oqs                        = CN6XXX_CFG_IO_QUEUES,
                .refill_threshold               = CN6XXX_OQ_REFIL_THRESHOLD,
                .oq_intr_pkt                    = CN6XXX_OQ_INTR_PKT,
                .oq_intr_time                   = CN6XXX_OQ_INTR_TIME,
                .pkts_per_intr                  = CN6XXX_OQ_PKTSPER_INTR,
        }
        ,

        .num_nic_ports                  = DEFAULT_NUM_NIC_PORTS_68XX_210NV,
        .num_def_rx_descs               = CN6XXX_MAX_OQ_DESCRIPTORS,
        .num_def_tx_descs               = CN6XXX_MAX_IQ_DESCRIPTORS,
        .def_rx_buf_size                = CN6XXX_OQ_BUF_SIZE,

        .nic_if_cfg[0] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 0,
        },

        .nic_if_cfg[1] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN6XXX_MAX_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN6XXX_MAX_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN6XXX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 1,
        },

        /** Miscellaneous attributes */
        .misc                                   = {
                /* Host driver link query interval */
                .oct_link_query_interval        = 100,

                /* Octeon link query interval */
                .host_link_query_interval       = 500,

                .enable_sli_oq_bp               = 0,

                /* Control queue group */
                .ctrlq_grp                      = 1,
        }
        ,
};

static struct octeon_config default_cn23xx_conf = {
        .card_type                              = LIO_23XX,
        .card_name                              = LIO_23XX_NAME,
        /** IQ attributes */
        .iq = {
                .max_iqs                = CN23XX_CFG_IO_QUEUES,
                .pending_list_size      = (CN23XX_DEFAULT_IQ_DESCRIPTORS *
                                           CN23XX_CFG_IO_QUEUES),
                .instr_type             = OCTEON_64BYTE_INSTR,
                .db_min                 = CN23XX_DB_MIN,
                .db_timeout             = CN23XX_DB_TIMEOUT,
                .iq_intr_pkt            = CN23XX_DEF_IQ_INTR_THRESHOLD,
        },

        /** OQ attributes */
        .oq = {
                .max_oqs                = CN23XX_CFG_IO_QUEUES,
                .pkts_per_intr  = CN23XX_OQ_PKTSPER_INTR,
                .refill_threshold       = CN23XX_OQ_REFIL_THRESHOLD,
                .oq_intr_pkt    = CN23XX_OQ_INTR_PKT,
                .oq_intr_time   = CN23XX_OQ_INTR_TIME,
        },

        .num_nic_ports                          = DEFAULT_NUM_NIC_PORTS_23XX,
        .num_def_rx_descs                       = CN23XX_DEFAULT_OQ_DESCRIPTORS,
        .num_def_tx_descs                       = CN23XX_DEFAULT_IQ_DESCRIPTORS,
        .def_rx_buf_size                        = CN23XX_OQ_BUF_SIZE,

        /* For ethernet interface 0:  Port cfg Attributes */
        .nic_if_cfg[0] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN23XX_DEFAULT_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN23XX_DEFAULT_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN23XX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 0,
        },

        .nic_if_cfg[1] = {
                /* Max Txqs: Half for each of the two ports :max_iq/2 */
                .max_txqs                       = MAX_TXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_txqs */
                .num_txqs                       = DEF_TXQS_PER_INTF,

                /* Max Rxqs: Half for each of the two ports :max_oq/2  */
                .max_rxqs                       = MAX_RXQS_PER_INTF,

                /* Actual configured value. Range could be: 1...max_rxqs */
                .num_rxqs                       = DEF_RXQS_PER_INTF,

                /* Num of desc for rx rings */
                .num_rx_descs                   = CN23XX_DEFAULT_OQ_DESCRIPTORS,

                /* Num of desc for tx rings */
                .num_tx_descs                   = CN23XX_DEFAULT_IQ_DESCRIPTORS,

                /* SKB size, We need not change buf size even for Jumbo frames.
                 * Octeon can send jumbo frames in 4 consecutive descriptors,
                 */
                .rx_buf_size                    = CN23XX_OQ_BUF_SIZE,

                .base_queue                     = BASE_QUEUE_NOT_REQUESTED,

                .gmx_port_id                    = 1,
        },

        .misc                                   = {
                /* Host driver link query interval */
                .oct_link_query_interval        = 100,

                /* Octeon link query interval */
                .host_link_query_interval       = 500,

                .enable_sli_oq_bp               = 0,

                /* Control queue group */
                .ctrlq_grp                      = 1,
        }
};

static struct octeon_config_ptr {
        u32 conf_type;
} oct_conf_info[MAX_OCTEON_DEVICES] = {
        {
                OCTEON_CONFIG_TYPE_DEFAULT,
        }, {
                OCTEON_CONFIG_TYPE_DEFAULT,
        }, {
                OCTEON_CONFIG_TYPE_DEFAULT,
        }, {
                OCTEON_CONFIG_TYPE_DEFAULT,
        },
};

static char oct_dev_state_str[OCT_DEV_STATES + 1][32] = {
        "BEGIN", "PCI-ENABLE-DONE", "PCI-MAP-DONE", "DISPATCH-INIT-DONE",
        "IQ-INIT-DONE", "SCBUFF-POOL-INIT-DONE", "RESPLIST-INIT-DONE",
        "DROQ-INIT-DONE", "MBOX-SETUP-DONE", "MSIX-ALLOC-VECTOR-DONE",
        "INTR-SET-DONE", "IO-QUEUES-INIT-DONE", "CONSOLE-INIT-DONE",
        "HOST-READY", "CORE-READY", "RUNNING", "IN-RESET",
        "INVALID"
};

static char oct_dev_app_str[CVM_DRV_APP_COUNT + 1][32] = {
        "BASE", "NIC", "UNKNOWN"};

static struct octeon_device *octeon_device[MAX_OCTEON_DEVICES];
static atomic_t adapter_refcounts[MAX_OCTEON_DEVICES];
static atomic_t adapter_fw_states[MAX_OCTEON_DEVICES];

static u32 octeon_device_count;
/* locks device array (i.e. octeon_device[]) */
static DEFINE_SPINLOCK(octeon_devices_lock);

static struct octeon_core_setup core_setup[MAX_OCTEON_DEVICES];

static void oct_set_config_info(int oct_id, int conf_type)
{
        if (conf_type < 0 || conf_type > (NUM_OCTEON_CONFS - 1))
                conf_type = OCTEON_CONFIG_TYPE_DEFAULT;
        oct_conf_info[oct_id].conf_type = conf_type;
}

void octeon_init_device_list(int conf_type)
{
        int i;

        memset(octeon_device, 0, (sizeof(void *) * MAX_OCTEON_DEVICES));
        for (i = 0; i <  MAX_OCTEON_DEVICES; i++)
                oct_set_config_info(i, conf_type);
}

static void *__retrieve_octeon_config_info(struct octeon_device *oct,
                                           u16 card_type)
{
        u32 oct_id = oct->octeon_id;
        void *ret = NULL;

        switch (oct_conf_info[oct_id].conf_type) {
        case OCTEON_CONFIG_TYPE_DEFAULT:
                if (oct->chip_id == OCTEON_CN66XX) {
                        ret = &default_cn66xx_conf;
                } else if ((oct->chip_id == OCTEON_CN68XX) &&
                           (card_type == LIO_210NV)) {
                        ret = &default_cn68xx_210nv_conf;
                } else if ((oct->chip_id == OCTEON_CN68XX) &&
                           (card_type == LIO_410NV)) {
                        ret = &default_cn68xx_conf;
                } else if (oct->chip_id == OCTEON_CN23XX_PF_VID) {
                        ret = &default_cn23xx_conf;
                } else if (oct->chip_id == OCTEON_CN23XX_VF_VID) {
                        ret = &default_cn23xx_conf;
                }
                break;
        default:
                break;
        }
        return ret;
}

static int __verify_octeon_config_info(struct octeon_device *oct, void *conf)
{
        switch (oct->chip_id) {
        case OCTEON_CN66XX:
        case OCTEON_CN68XX:
                return lio_validate_cn6xxx_config_info(oct, conf);
        case OCTEON_CN23XX_PF_VID:
        case OCTEON_CN23XX_VF_VID:
                return 0;
        default:
                break;
        }

        return 1;
}

void *oct_get_config_info(struct octeon_device *oct, u16 card_type)
{
        void *conf = NULL;

        conf = __retrieve_octeon_config_info(oct, card_type);
        if (!conf)
                return NULL;

        if (__verify_octeon_config_info(oct, conf)) {
                dev_err(&oct->pci_dev->dev, "Configuration verification failed\n");
                return NULL;
        }

        return conf;
}

char *lio_get_state_string(atomic_t *state_ptr)
{
        s32 istate = (s32)atomic_read(state_ptr);

        if (istate > OCT_DEV_STATES || istate < 0)
                return oct_dev_state_str[OCT_DEV_STATE_INVALID];
        return oct_dev_state_str[istate];
}

static char *get_oct_app_string(u32 app_mode)
{
        if (app_mode <= CVM_DRV_APP_END)
                return oct_dev_app_str[app_mode - CVM_DRV_APP_START];
        return oct_dev_app_str[CVM_DRV_INVALID_APP - CVM_DRV_APP_START];
}

void octeon_free_device_mem(struct octeon_device *oct)
{
        int i;

        for (i = 0; i < MAX_OCTEON_OUTPUT_QUEUES(oct); i++) {
                if (oct->io_qmask.oq & BIT_ULL(i))
                        vfree(oct->droq[i]);
        }

        for (i = 0; i < MAX_OCTEON_INSTR_QUEUES(oct); i++) {
                if (oct->io_qmask.iq & BIT_ULL(i))
                        vfree(oct->instr_queue[i]);
        }

        i = oct->octeon_id;
        vfree(oct);

        octeon_device[i] = NULL;
        octeon_device_count--;
}

static struct octeon_device *octeon_allocate_device_mem(u32 pci_id,
                                                        u32 priv_size)
{
        struct octeon_device *oct;
        u8 *buf = NULL;
        u32 octdevsize = 0, configsize = 0, size;

        switch (pci_id) {
        case OCTEON_CN68XX:
        case OCTEON_CN66XX:
                configsize = sizeof(struct octeon_cn6xxx);
                break;

        case OCTEON_CN23XX_PF_VID:
                configsize = sizeof(struct octeon_cn23xx_pf);
                break;
        case OCTEON_CN23XX_VF_VID:
                configsize = sizeof(struct octeon_cn23xx_vf);
                break;
        default:
                pr_err("%s: Unknown PCI Device: 0x%x\n",
                       __func__,
                       pci_id);
                return NULL;
        }

        if (configsize & 0x7)
                configsize += (8 - (configsize & 0x7));

        octdevsize = sizeof(struct octeon_device);
        if (octdevsize & 0x7)
                octdevsize += (8 - (octdevsize & 0x7));

        if (priv_size & 0x7)
                priv_size += (8 - (priv_size & 0x7));

        size = octdevsize + priv_size + configsize +
                (sizeof(struct octeon_dispatch) * DISPATCH_LIST_SIZE);

        buf = vzalloc(size);
        if (!buf)
                return NULL;

        oct = (struct octeon_device *)buf;
        oct->priv = (void *)(buf + octdevsize);
        oct->chip = (void *)(buf + octdevsize + priv_size);
        oct->dispatch.dlist = (struct octeon_dispatch *)
                (buf + octdevsize + priv_size + configsize);

        return oct;
}

struct octeon_device *octeon_allocate_device(u32 pci_id,
                                             u32 priv_size)
{
        u32 oct_idx = 0;
        struct octeon_device *oct = NULL;

        spin_lock(&octeon_devices_lock);

        for (oct_idx = 0; oct_idx < MAX_OCTEON_DEVICES; oct_idx++)
                if (!octeon_device[oct_idx])
                        break;

        if (oct_idx < MAX_OCTEON_DEVICES) {
                oct = octeon_allocate_device_mem(pci_id, priv_size);
                if (oct) {
                        octeon_device_count++;
                        octeon_device[oct_idx] = oct;
                }
        }

        spin_unlock(&octeon_devices_lock);
        if (!oct)
                return NULL;

        spin_lock_init(&oct->pci_win_lock);
        spin_lock_init(&oct->mem_access_lock);

        oct->octeon_id = oct_idx;
        snprintf(oct->device_name, sizeof(oct->device_name),
                 "LiquidIO%d", (oct->octeon_id));

        return oct;
}

/** Register a device's bus location at initialization time.
 *  @param octeon_dev - pointer to the octeon device structure.
 *  @param bus        - PCIe bus #
 *  @param dev        - PCIe device #
 *  @param func       - PCIe function #
 *  @param is_pf      - TRUE for PF, FALSE for VF
 *  @return reference count of device's adapter
 */
int octeon_register_device(struct octeon_device *oct,
                           int bus, int dev, int func, int is_pf)
{
        int idx, refcount;

        oct->loc.bus = bus;
        oct->loc.dev = dev;
        oct->loc.func = func;

        oct->adapter_refcount = &adapter_refcounts[oct->octeon_id];
        atomic_set(oct->adapter_refcount, 0);

        /* Like the reference count, the f/w state is shared 'per-adapter' */
        oct->adapter_fw_state = &adapter_fw_states[oct->octeon_id];
        atomic_set(oct->adapter_fw_state, FW_NEEDS_TO_BE_LOADED);

        spin_lock(&octeon_devices_lock);
        for (idx = (int)oct->octeon_id - 1; idx >= 0; idx--) {
                if (!octeon_device[idx]) {
                        dev_err(&oct->pci_dev->dev,
                                "%s: Internal driver error, missing dev",
                                __func__);
                        spin_unlock(&octeon_devices_lock);
                        atomic_inc(oct->adapter_refcount);
                        return 1; /* here, refcount is guaranteed to be 1 */
                }
                /* If another device is at same bus/dev, use its refcounter
                 * (and f/w state variable).
                 */
                if ((octeon_device[idx]->loc.bus == bus) &&
                    (octeon_device[idx]->loc.dev == dev)) {
                        oct->adapter_refcount =
                                octeon_device[idx]->adapter_refcount;
                        oct->adapter_fw_state =
                                octeon_device[idx]->adapter_fw_state;
                        break;
                }
        }
        spin_unlock(&octeon_devices_lock);

        atomic_inc(oct->adapter_refcount);
        refcount = atomic_read(oct->adapter_refcount);

        dev_dbg(&oct->pci_dev->dev, "%s: %02x:%02x:%d refcount %u", __func__,
                oct->loc.bus, oct->loc.dev, oct->loc.func, refcount);

        return refcount;
}

/** Deregister a device at de-initialization time.
 *  @param octeon_dev - pointer to the octeon device structure.
 *  @return reference count of device's adapter
 */
int octeon_deregister_device(struct octeon_device *oct)
{
        int refcount;

        atomic_dec(oct->adapter_refcount);
        refcount = atomic_read(oct->adapter_refcount);

        dev_dbg(&oct->pci_dev->dev, "%s: %04d:%02d:%d refcount %u", __func__,
                oct->loc.bus, oct->loc.dev, oct->loc.func, refcount);

        return refcount;
}

int
octeon_allocate_ioq_vector(struct octeon_device *oct, u32 num_ioqs)
{
        struct octeon_ioq_vector *ioq_vector;
        int cpu_num;
        int size;
        int i;

        size = sizeof(struct octeon_ioq_vector) * num_ioqs;

        oct->ioq_vector = vzalloc(size);
        if (!oct->ioq_vector)
                return -1;
        for (i = 0; i < num_ioqs; i++) {
                ioq_vector              = &oct->ioq_vector[i];
                ioq_vector->oct_dev     = oct;
                ioq_vector->iq_index    = i;
                ioq_vector->droq_index  = i;
                ioq_vector->mbox        = oct->mbox[i];

                cpu_num = i % num_online_cpus();
                cpumask_set_cpu(cpu_num, &ioq_vector->affinity_mask);

                if (oct->chip_id == OCTEON_CN23XX_PF_VID)
                        ioq_vector->ioq_num     = i + oct->sriov_info.pf_srn;
                else
                        ioq_vector->ioq_num     = i;
        }

        return 0;
}

void
octeon_free_ioq_vector(struct octeon_device *oct)
{
        vfree(oct->ioq_vector);
}

/* this function is only for setting up the first queue */
int octeon_setup_instr_queues(struct octeon_device *oct)
{
        u32 num_descs = 0;
        u32 iq_no = 0;
        union oct_txpciq txpciq;
        int numa_node = dev_to_node(&oct->pci_dev->dev);

        if (OCTEON_CN6XXX(oct))
                num_descs =
                        CFG_GET_NUM_DEF_TX_DESCS(CHIP_CONF(oct, cn6xxx));
        else if (OCTEON_CN23XX_PF(oct))
                num_descs = CFG_GET_NUM_DEF_TX_DESCS(CHIP_CONF(oct, cn23xx_pf));
        else if (OCTEON_CN23XX_VF(oct))
                num_descs = CFG_GET_NUM_DEF_TX_DESCS(CHIP_CONF(oct, cn23xx_vf));

        oct->num_iqs = 0;

        oct->instr_queue[0] = vzalloc_node(sizeof(*oct->instr_queue[0]),
                                numa_node);
        if (!oct->instr_queue[0])
                oct->instr_queue[0] =
                        vzalloc(sizeof(struct octeon_instr_queue));
        if (!oct->instr_queue[0])
                return 1;
        memset(oct->instr_queue[0], 0, sizeof(struct octeon_instr_queue));
        oct->instr_queue[0]->q_index = 0;
        oct->instr_queue[0]->app_ctx = (void *)(size_t)0;
        oct->instr_queue[0]->ifidx = 0;
        txpciq.u64 = 0;
        txpciq.s.q_no = iq_no;
        txpciq.s.pkind = oct->pfvf_hsword.pkind;
        txpciq.s.use_qpg = 0;
        txpciq.s.qpg = 0;
        if (octeon_init_instr_queue(oct, txpciq, num_descs)) {
                /* prevent memory leak */
                vfree(oct->instr_queue[0]);
                oct->instr_queue[0] = NULL;
                return 1;
        }

        oct->num_iqs++;
        return 0;
}

int octeon_setup_output_queues(struct octeon_device *oct)
{
        u32 num_descs = 0;
        u32 desc_size = 0;
        u32 oq_no = 0;
        int numa_node = dev_to_node(&oct->pci_dev->dev);

        if (OCTEON_CN6XXX(oct)) {
                num_descs =
                        CFG_GET_NUM_DEF_RX_DESCS(CHIP_CONF(oct, cn6xxx));
                desc_size =
                        CFG_GET_DEF_RX_BUF_SIZE(CHIP_CONF(oct, cn6xxx));
        } else if (OCTEON_CN23XX_PF(oct)) {
                num_descs = CFG_GET_NUM_DEF_RX_DESCS(CHIP_CONF(oct, cn23xx_pf));
                desc_size = CFG_GET_DEF_RX_BUF_SIZE(CHIP_CONF(oct, cn23xx_pf));
        } else if (OCTEON_CN23XX_VF(oct)) {
                num_descs = CFG_GET_NUM_DEF_RX_DESCS(CHIP_CONF(oct, cn23xx_vf));
                desc_size = CFG_GET_DEF_RX_BUF_SIZE(CHIP_CONF(oct, cn23xx_vf));
        }
        oct->num_oqs = 0;
        oct->droq[0] = vzalloc_node(sizeof(*oct->droq[0]), numa_node);
        if (!oct->droq[0])
                oct->droq[0] = vzalloc(sizeof(*oct->droq[0]));
        if (!oct->droq[0])
                return 1;

        if (octeon_init_droq(oct, oq_no, num_descs, desc_size, NULL)) {
                vfree(oct->droq[oq_no]);
                oct->droq[oq_no] = NULL;
                return 1;
        }
        oct->num_oqs++;

        return 0;
}

int octeon_set_io_queues_off(struct octeon_device *oct)
{
        int loop = BUSY_READING_REG_VF_LOOP_COUNT;

        if (OCTEON_CN6XXX(oct)) {
                octeon_write_csr(oct, CN6XXX_SLI_PKT_INSTR_ENB, 0);
                octeon_write_csr(oct, CN6XXX_SLI_PKT_OUT_ENB, 0);
        } else if (oct->chip_id == OCTEON_CN23XX_VF_VID) {
                u32 q_no;

                /* IOQs will already be in reset.
                 * If RST bit is set, wait for quiet bit to be set.
                 * Once quiet bit is set, clear the RST bit.
                 */
                for (q_no = 0; q_no < oct->sriov_info.rings_per_vf; q_no++) {
                        u64 reg_val = octeon_read_csr64(
                                oct, CN23XX_VF_SLI_IQ_PKT_CONTROL64(q_no));

                        while ((reg_val & CN23XX_PKT_INPUT_CTL_RST) &&
                               !(reg_val &  CN23XX_PKT_INPUT_CTL_QUIET) &&
                               loop) {
                                reg_val = octeon_read_csr64(
                                        oct, CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
                                loop--;
                        }
                        if (!loop) {
                                dev_err(&oct->pci_dev->dev,
                                        "clearing the reset reg failed or setting the quiet reg failed for qno: %u\n",
                                        q_no);
                                return -1;
                        }

                        reg_val = reg_val & ~CN23XX_PKT_INPUT_CTL_RST;
                        octeon_write_csr64(oct,
                                           CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
                                           reg_val);

                        reg_val = octeon_read_csr64(
                                        oct, CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
                        if (reg_val & CN23XX_PKT_INPUT_CTL_RST) {
                                dev_err(&oct->pci_dev->dev,
                                        "unable to reset qno %u\n", q_no);
                                return -1;
                        }
                }
        }
        return 0;
}

void octeon_set_droq_pkt_op(struct octeon_device *oct,
                            u32 q_no,
                            u32 enable)
{
        u32 reg_val = 0;

        /* Disable the i/p and o/p queues for this Octeon. */
        if (OCTEON_CN6XXX(oct)) {

                reg_val = octeon_read_csr(oct, CN6XXX_SLI_PKT_OUT_ENB);

                if (enable)
                        reg_val = reg_val | (1 << q_no);
                else
                        reg_val = reg_val & (~(1 << q_no));

                octeon_write_csr(oct, CN6XXX_SLI_PKT_OUT_ENB, reg_val);
        }
}

int octeon_init_dispatch_list(struct octeon_device *oct)
{
        u32 i;

        oct->dispatch.count = 0;

        for (i = 0; i < DISPATCH_LIST_SIZE; i++) {
                oct->dispatch.dlist[i].opcode = 0;
                INIT_LIST_HEAD(&oct->dispatch.dlist[i].list);
        }

        for (i = 0; i <= REQTYPE_LAST; i++)
                octeon_register_reqtype_free_fn(oct, i, NULL);

        spin_lock_init(&oct->dispatch.lock);

        return 0;
}

void octeon_delete_dispatch_list(struct octeon_device *oct)
{
        u32 i;
        struct list_head freelist, *temp, *tmp2;

        INIT_LIST_HEAD(&freelist);

        spin_lock_bh(&oct->dispatch.lock);

        for (i = 0; i < DISPATCH_LIST_SIZE; i++) {
                struct list_head *dispatch;

                dispatch = &oct->dispatch.dlist[i].list;
                while (dispatch->next != dispatch) {
                        temp = dispatch->next;
                        list_move_tail(temp, &freelist);
                }

                oct->dispatch.dlist[i].opcode = 0;
        }

        oct->dispatch.count = 0;

        spin_unlock_bh(&oct->dispatch.lock);

        list_for_each_safe(temp, tmp2, &freelist) {
                list_del(temp);
                kfree(temp);
        }
}

octeon_dispatch_fn_t
octeon_get_dispatch(struct octeon_device *octeon_dev, u16 opcode,
                    u16 subcode)
{
        u32 idx;
        struct list_head *dispatch;
        octeon_dispatch_fn_t fn = NULL;
        u16 combined_opcode = OPCODE_SUBCODE(opcode, subcode);

        idx = combined_opcode & OCTEON_OPCODE_MASK;

        spin_lock_bh(&octeon_dev->dispatch.lock);

        if (octeon_dev->dispatch.count == 0) {
                spin_unlock_bh(&octeon_dev->dispatch.lock);
                return NULL;
        }

        if (!(octeon_dev->dispatch.dlist[idx].opcode)) {
                spin_unlock_bh(&octeon_dev->dispatch.lock);
                return NULL;
        }

        if (octeon_dev->dispatch.dlist[idx].opcode == combined_opcode) {
                fn = octeon_dev->dispatch.dlist[idx].dispatch_fn;
        } else {
                list_for_each(dispatch,
                              &octeon_dev->dispatch.dlist[idx].list) {
                        if (((struct octeon_dispatch *)dispatch)->opcode ==
                            combined_opcode) {
                                fn = ((struct octeon_dispatch *)
                                      dispatch)->dispatch_fn;
                                break;
                        }
                }
        }

        spin_unlock_bh(&octeon_dev->dispatch.lock);
        return fn;
}

/* octeon_register_dispatch_fn
 * Parameters:
 *   octeon_id - id of the octeon device.
 *   opcode    - opcode for which driver should call the registered function
 *   subcode   - subcode for which driver should call the registered function
 *   fn        - The function to call when a packet with "opcode" arrives in
 *                octeon output queues.
 *   fn_arg    - The argument to be passed when calling function "fn".
 * Description:
 *   Registers a function and its argument to be called when a packet
 *   arrives in Octeon output queues with "opcode".
 * Returns:
 *   Success: 0
 *   Failure: 1
 * Locks:
 *   No locks are held.
 */
int
octeon_register_dispatch_fn(struct octeon_device *oct,
                            u16 opcode,
                            u16 subcode,
                            octeon_dispatch_fn_t fn, void *fn_arg)
{
        u32 idx;
        octeon_dispatch_fn_t pfn;
        u16 combined_opcode = OPCODE_SUBCODE(opcode, subcode);

        idx = combined_opcode & OCTEON_OPCODE_MASK;

        spin_lock_bh(&oct->dispatch.lock);
        /* Add dispatch function to first level of lookup table */
        if (oct->dispatch.dlist[idx].opcode == 0) {
                oct->dispatch.dlist[idx].opcode = combined_opcode;
                oct->dispatch.dlist[idx].dispatch_fn = fn;
                oct->dispatch.dlist[idx].arg = fn_arg;
                oct->dispatch.count++;
                spin_unlock_bh(&oct->dispatch.lock);
                return 0;
        }

        spin_unlock_bh(&oct->dispatch.lock);

        /* Check if there was a function already registered for this
         * opcode/subcode.
         */
        pfn = octeon_get_dispatch(oct, opcode, subcode);
        if (!pfn) {
                struct octeon_dispatch *dispatch;

                dev_dbg(&oct->pci_dev->dev,
                        "Adding opcode to dispatch list linked list\n");
                dispatch = kmalloc(sizeof(*dispatch), GFP_KERNEL);
                if (!dispatch)
                        return 1;

                dispatch->opcode = combined_opcode;
                dispatch->dispatch_fn = fn;
                dispatch->arg = fn_arg;

                /* Add dispatch function to linked list of fn ptrs
                 * at the hashed index.
                 */
                spin_lock_bh(&oct->dispatch.lock);
                list_add(&dispatch->list, &oct->dispatch.dlist[idx].list);
                oct->dispatch.count++;
                spin_unlock_bh(&oct->dispatch.lock);

        } else {
                if (pfn == fn &&
                    octeon_get_dispatch_arg(oct, opcode, subcode) == fn_arg)
                        return 0;

                dev_err(&oct->pci_dev->dev,
                        "Found previously registered dispatch fn for opcode/subcode: %x/%x\n",
                        opcode, subcode);
                return 1;
        }

        return 0;
}

int octeon_core_drv_init(struct octeon_recv_info *recv_info, void *buf)
{
        u32 i;
        char app_name[16];
        struct octeon_device *oct = (struct octeon_device *)buf;
        struct octeon_recv_pkt *recv_pkt = recv_info->recv_pkt;
        struct octeon_core_setup *cs = NULL;
        u32 num_nic_ports = 0;

        if (OCTEON_CN6XXX(oct))
                num_nic_ports =
                        CFG_GET_NUM_NIC_PORTS(CHIP_CONF(oct, cn6xxx));
        else if (OCTEON_CN23XX_PF(oct))
                num_nic_ports =
                        CFG_GET_NUM_NIC_PORTS(CHIP_CONF(oct, cn23xx_pf));

        if (atomic_read(&oct->status) >= OCT_DEV_RUNNING) {
                dev_err(&oct->pci_dev->dev, "Received CORE OK when device state is 0x%x\n",
                        atomic_read(&oct->status));
                goto core_drv_init_err;
        }

        strncpy(app_name,
                get_oct_app_string(
                (u32)recv_pkt->rh.r_core_drv_init.app_mode),
                sizeof(app_name) - 1);
        oct->app_mode = (u32)recv_pkt->rh.r_core_drv_init.app_mode;
        if (recv_pkt->rh.r_core_drv_init.app_mode == CVM_DRV_NIC_APP) {
                oct->fw_info.max_nic_ports =
                        (u32)recv_pkt->rh.r_core_drv_init.max_nic_ports;
                oct->fw_info.num_gmx_ports =
                        (u32)recv_pkt->rh.r_core_drv_init.num_gmx_ports;
        }

        if (oct->fw_info.max_nic_ports < num_nic_ports) {
                dev_err(&oct->pci_dev->dev,
                        "Config has more ports than firmware allows (%d > %d).\n",
                        num_nic_ports, oct->fw_info.max_nic_ports);
                goto core_drv_init_err;
        }
        oct->fw_info.app_cap_flags = recv_pkt->rh.r_core_drv_init.app_cap_flags;
        oct->fw_info.app_mode = (u32)recv_pkt->rh.r_core_drv_init.app_mode;
        oct->pfvf_hsword.app_mode = (u32)recv_pkt->rh.r_core_drv_init.app_mode;

        oct->pfvf_hsword.pkind = recv_pkt->rh.r_core_drv_init.pkind;

        for (i = 0; i < oct->num_iqs; i++)
                oct->instr_queue[i]->txpciq.s.pkind = oct->pfvf_hsword.pkind;

        atomic_set(&oct->status, OCT_DEV_CORE_OK);

        cs = &core_setup[oct->octeon_id];

        if (recv_pkt->buffer_size[0] != (sizeof(*cs) + OCT_DROQ_INFO_SIZE)) {
                dev_dbg(&oct->pci_dev->dev, "Core setup bytes expected %u found %d\n",
                        (u32)sizeof(*cs),
                        recv_pkt->buffer_size[0]);
        }

        memcpy(cs, get_rbd(
               recv_pkt->buffer_ptr[0]) + OCT_DROQ_INFO_SIZE, sizeof(*cs));

        strncpy(oct->boardinfo.name, cs->boardname, OCT_BOARD_NAME);
        strncpy(oct->boardinfo.serial_number, cs->board_serial_number,
                OCT_SERIAL_LEN);

        octeon_swap_8B_data((u64 *)cs, (sizeof(*cs) >> 3));

        oct->boardinfo.major = cs->board_rev_major;
        oct->boardinfo.minor = cs->board_rev_minor;

        dev_info(&oct->pci_dev->dev,
                 "Running %s (%llu Hz)\n",
                 app_name, CVM_CAST64(cs->corefreq));

core_drv_init_err:
        for (i = 0; i < recv_pkt->buffer_count; i++)
                recv_buffer_free(recv_pkt->buffer_ptr[i]);
        octeon_free_recv_info(recv_info);
        return 0;
}

int octeon_get_tx_qsize(struct octeon_device *oct, u32 q_no)

{
        if (oct && (q_no < MAX_OCTEON_INSTR_QUEUES(oct)) &&
            (oct->io_qmask.iq & BIT_ULL(q_no)))
                return oct->instr_queue[q_no]->max_count;

        return -1;
}

int octeon_get_rx_qsize(struct octeon_device *oct, u32 q_no)
{
        if (oct && (q_no < MAX_OCTEON_OUTPUT_QUEUES(oct)) &&
            (oct->io_qmask.oq & BIT_ULL(q_no)))
                return oct->droq[q_no]->max_count;
        return -1;
}

/* Retruns the host firmware handshake OCTEON specific configuration */
struct octeon_config *octeon_get_conf(struct octeon_device *oct)
{
        struct octeon_config *default_oct_conf = NULL;

        /* check the OCTEON Device model & return the corresponding octeon
         * configuration
         */

        if (OCTEON_CN6XXX(oct)) {
                default_oct_conf =
                        (struct octeon_config *)(CHIP_CONF(oct, cn6xxx));
        } else if (OCTEON_CN23XX_PF(oct)) {
                default_oct_conf = (struct octeon_config *)
                        (CHIP_CONF(oct, cn23xx_pf));
        } else if (OCTEON_CN23XX_VF(oct)) {
                default_oct_conf = (struct octeon_config *)
                        (CHIP_CONF(oct, cn23xx_vf));
        }
        return default_oct_conf;
}

/* scratch register address is same in all the OCT-II and CN70XX models */
#define CNXX_SLI_SCRATCH1   0x3C0

/* Get the octeon device pointer.
 *  @param octeon_id  - The id for which the octeon device pointer is required.
 *  @return Success: Octeon device pointer.
 *  @return Failure: NULL.
 */
struct octeon_device *lio_get_device(u32 octeon_id)
{
        if (octeon_id >= MAX_OCTEON_DEVICES)
                return NULL;
        else
                return octeon_device[octeon_id];
}

u64 lio_pci_readq(struct octeon_device *oct, u64 addr)
{
        u64 val64;
        unsigned long flags;
        u32 addrhi;

        spin_lock_irqsave(&oct->pci_win_lock, flags);

        /* The windowed read happens when the LSB of the addr is written.
         * So write MSB first
         */
        addrhi = (addr >> 32);
        if ((oct->chip_id == OCTEON_CN66XX) ||
            (oct->chip_id == OCTEON_CN68XX) ||
            (oct->chip_id == OCTEON_CN23XX_PF_VID))
                addrhi |= 0x00060000;
        writel(addrhi, oct->reg_list.pci_win_rd_addr_hi);

        /* Read back to preserve ordering of writes */
        readl(oct->reg_list.pci_win_rd_addr_hi);

        writel(addr & 0xffffffff, oct->reg_list.pci_win_rd_addr_lo);
        readl(oct->reg_list.pci_win_rd_addr_lo);

        val64 = readq(oct->reg_list.pci_win_rd_data);

        spin_unlock_irqrestore(&oct->pci_win_lock, flags);

        return val64;
}

void lio_pci_writeq(struct octeon_device *oct,
                    u64 val,
                    u64 addr)
{
        unsigned long flags;

        spin_lock_irqsave(&oct->pci_win_lock, flags);

        writeq(addr, oct->reg_list.pci_win_wr_addr);

        /* The write happens when the LSB is written. So write MSB first. */
        writel(val >> 32, oct->reg_list.pci_win_wr_data_hi);
        /* Read the MSB to ensure ordering of writes. */
        readl(oct->reg_list.pci_win_wr_data_hi);

        writel(val & 0xffffffff, oct->reg_list.pci_win_wr_data_lo);

        spin_unlock_irqrestore(&oct->pci_win_lock, flags);
}

int octeon_mem_access_ok(struct octeon_device *oct)
{
        u64 access_okay = 0;
        u64 lmc0_reset_ctl;

        /* Check to make sure a DDR interface is enabled */
        if (OCTEON_CN23XX_PF(oct)) {
                lmc0_reset_ctl = lio_pci_readq(oct, CN23XX_LMC0_RESET_CTL);
                access_okay =
                        (lmc0_reset_ctl & CN23XX_LMC0_RESET_CTL_DDR3RST_MASK);
        } else {
                lmc0_reset_ctl = lio_pci_readq(oct, CN6XXX_LMC0_RESET_CTL);
                access_okay =
                        (lmc0_reset_ctl & CN6XXX_LMC0_RESET_CTL_DDR3RST_MASK);
        }

        return access_okay ? 0 : 1;
}

int octeon_wait_for_ddr_init(struct octeon_device *oct, u32 *timeout)
{
        int ret = 1;
        u32 ms;

        if (!timeout)
                return ret;

        for (ms = 0; (ret != 0) && ((*timeout == 0) || (ms <= *timeout));
             ms += HZ / 10) {
                ret = octeon_mem_access_ok(oct);

                /* wait 100 ms */
                if (ret)
                        schedule_timeout_uninterruptible(HZ / 10);
        }

        return ret;
}

/* Get the octeon id assigned to the octeon device passed as argument.
 *  This function is exported to other modules.
 *  @param dev - octeon device pointer passed as a void *.
 *  @return octeon device id
 */
int lio_get_device_id(void *dev)
{
        struct octeon_device *octeon_dev = (struct octeon_device *)dev;
        u32 i;

        for (i = 0; i < MAX_OCTEON_DEVICES; i++)
                if (octeon_device[i] == octeon_dev)
                        return octeon_dev->octeon_id;
        return -1;
}

void lio_enable_irq(struct octeon_droq *droq, struct octeon_instr_queue *iq)
{
        u64 instr_cnt;
        u32 pkts_pend;
        struct octeon_device *oct = NULL;

        /* the whole thing needs to be atomic, ideally */
        if (droq) {
                pkts_pend = (u32)atomic_read(&droq->pkts_pending);
                writel(droq->pkt_count - pkts_pend, droq->pkts_sent_reg);
                droq->pkt_count = pkts_pend;
                oct = droq->oct_dev;
        }
        if (iq) {
                spin_lock_bh(&iq->lock);
                writel(iq->pkts_processed, iq->inst_cnt_reg);
                iq->pkt_in_done -= iq->pkts_processed;
                iq->pkts_processed = 0;
                /* this write needs to be flushed before we release the lock */
                spin_unlock_bh(&iq->lock);
                oct = iq->oct_dev;
        }
        /*write resend. Writing RESEND in SLI_PKTX_CNTS should be enough
         *to trigger tx interrupts as well, if they are pending.
         */
        if (oct && (OCTEON_CN23XX_PF(oct) || OCTEON_CN23XX_VF(oct))) {
                if (droq)
                        writeq(CN23XX_INTR_RESEND, droq->pkts_sent_reg);
                /*we race with firmrware here. read and write the IN_DONE_CNTS*/
                else if (iq) {
                        instr_cnt =  readq(iq->inst_cnt_reg);
                        writeq(((instr_cnt & 0xFFFFFFFF00000000ULL) |
                                CN23XX_INTR_RESEND),
                               iq->inst_cnt_reg);
                }
        }
}