linux-imx

/*

 * QLogic Fibre Channel HBA Driver

 * Copyright (c)  2003-2014 QLogic Corporation

 *

 * See LICENSE.qla2xxx for copyright and licensing details.

 */

#include "qla_def.h"

​

#include <linux/delay.h>

#include <linux/slab.h>

#include <linux/vmalloc.h>

#include <linux/uaccess.h>

​

/*

 * NVRAM support routines

 */

​

/**

 * qla2x00_lock_nvram_access() -

 * @ha: HA context

 */

static void

qla2x00_lock_nvram_access(struct qla_hw_data *ha)

{

    uint16_t data;

    struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;

​

    if (!IS_QLA2100(ha) && !IS_QLA2200(ha) && !IS_QLA2300(ha)) {

        data = RD_REG_WORD(&reg->nvram);

        while (data & NVR_BUSY) {

            udelay(100);

            data = RD_REG_WORD(&reg->nvram);

        }

​

        /* Lock resource */

        WRT_REG_WORD(&reg->u.isp2300.host_semaphore, 0x1);

        RD_REG_WORD(&reg->u.isp2300.host_semaphore);

        udelay(5);

        data = RD_REG_WORD(&reg->u.isp2300.host_semaphore);

        while ((data & BIT_0) == 0) {

            /* Lock failed */

            udelay(100);

            WRT_REG_WORD(&reg->u.isp2300.host_semaphore, 0x1);

            RD_REG_WORD(&reg->u.isp2300.host_semaphore);

            udelay(5);

            data = RD_REG_WORD(&reg->u.isp2300.host_semaphore);

        }

    }

}

​

/**

 * qla2x00_unlock_nvram_access() -

 * @ha: HA context

 */

static void

qla2x00_unlock_nvram_access(struct qla_hw_data *ha)

{

    struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;

​

    if (!IS_QLA2100(ha) && !IS_QLA2200(ha) && !IS_QLA2300(ha)) {

        WRT_REG_WORD(&reg->u.isp2300.host_semaphore, 0);

        RD_REG_WORD(&reg->u.isp2300.host_semaphore);

    }

}

​

/**

 * qla2x00_nv_write() - Prepare for NVRAM read/write operation.

 * @ha: HA context

 * @data: Serial interface selector

 */

static void

qla2x00_nv_write(struct qla_hw_data *ha, uint16_t data)

{

    struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;

​

    WRT_REG_WORD(&reg->nvram, data | NVR_SELECT | NVR_WRT_ENABLE);

    RD_REG_WORD(&reg->nvram);       /* PCI Posting. */

    NVRAM_DELAY();

    WRT_REG_WORD(&reg->nvram, data | NVR_SELECT | NVR_CLOCK |

        NVR_WRT_ENABLE);

    RD_REG_WORD(&reg->nvram);       /* PCI Posting. */

    NVRAM_DELAY();

    WRT_REG_WORD(&reg->nvram, data | NVR_SELECT | NVR_WRT_ENABLE);

    RD_REG_WORD(&reg->nvram);       /* PCI Posting. */

    NVRAM_DELAY();

}

​

/**

 * qla2x00_nvram_request() - Sends read command to NVRAM and gets data from

 *  NVRAM.

 * @ha: HA context

 * @nv_cmd: NVRAM command