linux-imx

/*

 * This file is part of the Emulex Linux Device Driver for Enterprise iSCSI

 * Host Bus Adapters. Refer to the README file included with this package

 * for driver version and adapter compatibility.

 *

 * Copyright (c) 2018 Broadcom. All Rights Reserved.

 * The term “Broadcom” refers to Broadcom Inc. and/or its subsidiaries.

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of version 2 of the GNU General Public License as published

 * by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful. ALL EXPRESS

 * OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES, INCLUDING ANY

 * IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE,

 * OR NON-INFRINGEMENT, ARE DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH

 * DISCLAIMERS ARE HELD TO BE LEGALLY INVALID.

 * See the GNU General Public License for more details, a copy of which

 * can be found in the file COPYING included with this package.

 *

 * Contact Information:

 * linux-drivers@broadcom.com

 *

 */

​

#include <linux/bsg-lib.h>

#include <scsi/scsi_transport_iscsi.h>

#include <scsi/scsi_bsg_iscsi.h>

#include "be_mgmt.h"

#include "be_iscsi.h"

#include "be_main.h"

​

unsigned int mgmt_vendor_specific_fw_cmd(struct be_ctrl_info *ctrl,

                     struct beiscsi_hba *phba,

                     struct bsg_job *job,

                     struct be_dma_mem *nonemb_cmd)

{

    struct be_mcc_wrb *wrb;

    struct be_sge *mcc_sge;

    unsigned int tag = 0;

    struct iscsi_bsg_request *bsg_req = job->request;

    struct be_bsg_vendor_cmd *req = nonemb_cmd->va;

    unsigned short region, sector_size, sector, offset;

​

    nonemb_cmd->size = job->request_payload.payload_len;

    memset(nonemb_cmd->va, 0, nonemb_cmd->size);

    region =  bsg_req->rqst_data.h_vendor.vendor_cmd[1];

    sector_size =  bsg_req->rqst_data.h_vendor.vendor_cmd[2];

    sector =  bsg_req->rqst_data.h_vendor.vendor_cmd[3];

    offset =  bsg_req->rqst_data.h_vendor.vendor_cmd[4];

    req->region = region;

    req->sector = sector;

    req->offset = offset;

​

    if (mutex_lock_interruptible(&ctrl->mbox_lock))

        return 0;

    switch (bsg_req->rqst_data.h_vendor.vendor_cmd[0]) {

    case BEISCSI_WRITE_FLASH:

        offset = sector * sector_size + offset;

        be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ISCSI,

                   OPCODE_COMMON_WRITE_FLASH, sizeof(*req));

        sg_copy_to_buffer(job->request_payload.sg_list,

                  job->request_payload.sg_cnt,

                  nonemb_cmd->va + offset, job->request_len);

        break;

    case BEISCSI_READ_FLASH:

        be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ISCSI,

               OPCODE_COMMON_READ_FLASH, sizeof(*req));

        break;

    default:

        beiscsi_log(phba, KERN_WARNING, BEISCSI_LOG_CONFIG,

                "BG_%d : Unsupported cmd = 0x%x\n\n",

                bsg_req->rqst_data.h_vendor.vendor_cmd[0]);

​

        mutex_unlock(&ctrl->mbox_lock);

        return -EPERM;

    }

​

    wrb = alloc_mcc_wrb(phba, &tag);

    if (!wrb) {

        mutex_unlock(&ctrl->mbox_lock);

        return 0;

    }

​

    mcc_sge = nonembedded_sgl(wrb);

    be_wrb_hdr_prepare(wrb, nonemb_cmd->size, false,

               job->request_payload.sg_cnt);

    mcc_sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma));

    mcc_sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF);

    mcc_sge->len = cpu_to_le32(nonemb_cmd->size);

​

    be_mcc_notify(phba, tag);