drivers/scsi/qla4xxx/ql4_bsg.c

   1 /*
   2  * QLogic iSCSI HBA Driver
   3  * Copyright (c) 2011 QLogic Corporation
   4  *
   5  * See LICENSE.qla4xxx for copyright and licensing details.
   6  */
   7
   8 #include "ql4_def.h"
   9 #include "ql4_glbl.h"
  10 #include "ql4_bsg.h"
  11
  12 static int
  13 qla4xxx_read_flash(struct bsg_job *bsg_job)
  14 {
  15         struct Scsi_Host *host = iscsi_job_to_shost(bsg_job);
  16         struct scsi_qla_host *ha = to_qla_host(host);
  17         struct iscsi_bsg_reply *bsg_reply = bsg_job->reply;
  18         struct iscsi_bsg_request *bsg_req = bsg_job->request;
  19         uint32_t offset = 0;
  20         uint32_t length = 0;
  21         dma_addr_t flash_dma;
  22         uint8_t *flash = NULL;
  23         int rval = -EINVAL;
  24
  25         bsg_reply->reply_payload_rcv_len = 0;
  26
  27         if (unlikely(pci_channel_offline(ha->pdev)))
  28                 goto leave;
  29
  30         if (ql4xxx_reset_active(ha)) {
  31                 ql4_printk(KERN_ERR, ha, "%s: reset active\n", __func__);
  32                 rval = -EBUSY;
  33                 goto leave;
  34         }
  35
  36         if (ha->flash_state != QLFLASH_WAITING) {
  37                 ql4_printk(KERN_ERR, ha, "%s: another flash operation "
  38                            "active\n", __func__);
  39                 rval = -EBUSY;
  40                 goto leave;
  41         }
  42
  43         ha->flash_state = QLFLASH_READING;
  44         offset = bsg_req->rqst_data.h_vendor.vendor_cmd[1];
  45         length = bsg_job->reply_payload.payload_len;
  46
  47         flash = dma_alloc_coherent(&ha->pdev->dev, length, &flash_dma,
  48                                    GFP_KERNEL);
  49         if (!flash) {
  50                 ql4_printk(KERN_ERR, ha, "%s: dma alloc failed for flash "
  51                            "data\n", __func__);
  52                 rval = -ENOMEM;
  53                 goto leave;
  54         }
  55
  56         rval = qla4xxx_get_flash(ha, flash_dma, offset, length);
  57         if (rval) {
  58                 ql4_printk(KERN_ERR, ha, "%s: get flash failed\n", __func__);
  59                 bsg_reply->result = DID_ERROR << 16;
  60                 rval = -EIO;
  61         } else {
  62                 bsg_reply->reply_payload_rcv_len =
  63                         sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
  64                                             bsg_job->reply_payload.sg_cnt,
  65                                             flash, length);
  66                 bsg_reply->result = DID_OK << 16;
  67         }
  68
  69         bsg_job_done(bsg_job, bsg_reply->result,
  70                      bsg_reply->reply_payload_rcv_len);
  71         dma_free_coherent(&ha->pdev->dev, length, flash, flash_dma);
  72 leave:
  73         ha->flash_state = QLFLASH_WAITING;
  74         return rval;
  75 }
  76
  77 static int
  78 qla4xxx_update_flash(struct bsg_job *bsg_job)
  79 {
  80         struct Scsi_Host *host = iscsi_job_to_shost(bsg_job);
  81         struct scsi_qla_host *ha = to_qla_host(host);
  82         struct iscsi_bsg_reply *bsg_reply = bsg_job->reply;
  83         struct iscsi_bsg_request *bsg_req = bsg_job->request;
  84         uint32_t length = 0;
  85         uint32_t offset = 0;
  86         uint32_t options = 0;
  87         dma_addr_t flash_dma;
  88         uint8_t *flash = NULL;
  89         int rval = -EINVAL;
  90
  91         bsg_reply->reply_payload_rcv_len = 0;
  92
  93         if (unlikely(pci_channel_offline(ha->pdev)))
  94                 goto leave;
  95
  96         if (ql4xxx_reset_active(ha)) {
  97                 ql4_printk(KERN_ERR, ha, "%s: reset active\n", __func__);
  98                 rval = -EBUSY;
  99                 goto leave;
 100         }
 101
 102         if (ha->flash_state != QLFLASH_WAITING) {
 103                 ql4_printk(KERN_ERR, ha, "%s: another flash operation "
 104                            "active\n", __func__);
 105                 rval = -EBUSY;
 106                 goto leave;
 107         }
 108
 109         ha->flash_state = QLFLASH_WRITING;
 110         length = bsg_job->request_payload.payload_len;
 111         offset = bsg_req->rqst_data.h_vendor.vendor_cmd[1];
 112         options = bsg_req->rqst_data.h_vendor.vendor_cmd[2];
 113
 114         flash = dma_alloc_coherent(&ha->pdev->dev, length, &flash_dma,
 115                                    GFP_KERNEL);
 116         if (!flash) {
 117                 ql4_printk(KERN_ERR, ha, "%s: dma alloc failed for flash "
 118                            "data\n", __func__);
 119                 rval = -ENOMEM;
 120                 goto leave;
 121         }
 122
 123         sg_copy_to_buffer(bsg_job->request_payload.sg_list,
 124                           bsg_job->request_payload.sg_cnt, flash, length);
 125
 126         rval = qla4xxx_set_flash(ha, flash_dma, offset, length, options);
 127         if (rval) {
 128                 ql4_printk(KERN_ERR, ha, "%s: set flash failed\n", __func__);
 129                 bsg_reply->result = DID_ERROR << 16;
 130                 rval = -EIO;
 131         } else
 132                 bsg_reply->result = DID_OK << 16;
 133
 134         bsg_job_done(bsg_job, bsg_reply->result,
 135                      bsg_reply->reply_payload_rcv_len);
 136         dma_free_coherent(&ha->pdev->dev, length, flash, flash_dma);
 137 leave:
 138         ha->flash_state = QLFLASH_WAITING;
 139         return rval;
 140 }
 141
 142 static int
 143 qla4xxx_get_acb_state(struct bsg_job *bsg_job)
 144 {
 145         struct Scsi_Host *host = iscsi_job_to_shost(bsg_job);
 146         struct scsi_qla_host *ha = to_qla_host(host);
 147         struct iscsi_bsg_request *bsg_req = bsg_job->request;
 148         struct iscsi_bsg_reply *bsg_reply = bsg_job->reply;
 149         uint32_t status[MBOX_REG_COUNT];
 150         uint32_t acb_idx;
 151         uint32_t ip_idx;
 152         int rval = -EINVAL;
 153
 154         bsg_reply->reply_payload_rcv_len = 0;
 155
 156         if (unlikely(pci_channel_offline(ha->pdev)))
 157                 goto leave;
 158
 159         /* Only 4022 and above adapters are supported */
 160         if (is_qla4010(ha))
 161                 goto leave;
 162
 163         if (ql4xxx_reset_active(ha)) {
 164                 ql4_printk(KERN_ERR, ha, "%s: reset active\n", __func__);
 165                 rval = -EBUSY;
 166                 goto leave;
 167         }
 168
 169         if (bsg_job->reply_payload.payload_len < sizeof(status)) {
 170                 ql4_printk(KERN_ERR, ha, "%s: invalid payload len %d\n",
 171                            __func__, bsg_job->reply_payload.payload_len);
 172                 rval = -EINVAL;
 173                 goto leave;
 174         }
 175
 176         acb_idx = bsg_req->rqst_data.h_vendor.vendor_cmd[1];
 177         ip_idx = bsg_req->rqst_data.h_vendor.vendor_cmd[2];
 178
 179         rval = qla4xxx_get_ip_state(ha, acb_idx, ip_idx, status);
 180         if (rval) {
 181                 ql4_printk(KERN_ERR, ha, "%s: get ip state failed\n",
 182                            __func__);
 183                 bsg_reply->result = DID_ERROR << 16;
 184                 rval = -EIO;
 185         } else {
 186                 bsg_reply->reply_payload_rcv_len =
 187                         sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
 188                                             bsg_job->reply_payload.sg_cnt,
 189                                             status, sizeof(status));
 190                 bsg_reply->result = DID_OK << 16;
 191         }
 192
 193         bsg_job_done(bsg_job, bsg_reply->result,
 194                      bsg_reply->reply_payload_rcv_len);
 195 leave:
 196         return rval;
 197 }
 198
 199 static int
 200 qla4xxx_read_nvram(struct bsg_job *bsg_job)
 201 {
 202         struct Scsi_Host *host = iscsi_job_to_shost(bsg_job);
 203         struct scsi_qla_host *ha = to_qla_host(host);
 204         struct iscsi_bsg_request *bsg_req = bsg_job->request;
 205         struct iscsi_bsg_reply *bsg_reply = bsg_job->reply;
 206         uint32_t offset = 0;
 207         uint32_t len = 0;
 208         uint32_t total_len = 0;
 209         dma_addr_t nvram_dma;
 210         uint8_t *nvram = NULL;
 211         int rval = -EINVAL;
 212
 213         bsg_reply->reply_payload_rcv_len = 0;
 214
 215         if (unlikely(pci_channel_offline(ha->pdev)))
 216                 goto leave;
 217
 218         /* Only 40xx adapters are supported */
 219         if (!(is_qla4010(ha) || is_qla4022(ha) || is_qla4032(ha)))
 220                 goto leave;
 221
 222         if (ql4xxx_reset_active(ha)) {
 223                 ql4_printk(KERN_ERR, ha, "%s: reset active\n", __func__);
 224                 rval = -EBUSY;
 225                 goto leave;
 226         }
 227
 228         offset = bsg_req->rqst_data.h_vendor.vendor_cmd[1];
 229         len = bsg_job->reply_payload.payload_len;
 230         total_len = offset + len;
 231
 232         /* total len should not be greater than max NVRAM size */
 233         if ((is_qla4010(ha) && total_len > QL4010_NVRAM_SIZE) ||
 234             ((is_qla4022(ha) || is_qla4032(ha)) &&
 235              total_len > QL40X2_NVRAM_SIZE)) {
 236                 ql4_printk(KERN_ERR, ha, "%s: offset+len greater than max"
 237                            " nvram size, offset=%d len=%d\n",
 238                            __func__, offset, len);
 239                 goto leave;
 240         }
 241
 242         nvram = dma_alloc_coherent(&ha->pdev->dev, len, &nvram_dma,
 243                                    GFP_KERNEL);
 244         if (!nvram) {
 245                 ql4_printk(KERN_ERR, ha, "%s: dma alloc failed for nvram "
 246                            "data\n", __func__);
 247                 rval = -ENOMEM;
 248                 goto leave;
 249         }
 250
 251         rval = qla4xxx_get_nvram(ha, nvram_dma, offset, len);
 252         if (rval) {
 253                 ql4_printk(KERN_ERR, ha, "%s: get nvram failed\n", __func__);
 254                 bsg_reply->result = DID_ERROR << 16;
 255                 rval = -EIO;
 256         } else {
 257                 bsg_reply->reply_payload_rcv_len =
 258                         sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
 259                                             bsg_job->reply_payload.sg_cnt,
 260                                             nvram, len);
 261                 bsg_reply->result = DID_OK << 16;
 262         }
 263
 264         bsg_job_done(bsg_job, bsg_reply->result,
 265                      bsg_reply->reply_payload_rcv_len);
 266         dma_free_coherent(&ha->pdev->dev, len, nvram, nvram_dma);
 267 leave:
 268         return rval;
 269 }
 270
 271 static int
 272 qla4xxx_update_nvram(struct bsg_job *bsg_job)
 273 {
 274         struct Scsi_Host *host = iscsi_job_to_shost(bsg_job);
 275         struct scsi_qla_host *ha = to_qla_host(host);
 276         struct iscsi_bsg_request *bsg_req = bsg_job->request;
 277         struct iscsi_bsg_reply *bsg_reply = bsg_job->reply;
 278         uint32_t offset = 0;
 279         uint32_t len = 0;
 280         uint32_t total_len = 0;
 281         dma_addr_t nvram_dma;
 282         uint8_t *nvram = NULL;
 283         int rval = -EINVAL;
 284
 285         bsg_reply->reply_payload_rcv_len = 0;
 286
 287         if (unlikely(pci_channel_offline(ha->pdev)))
 288                 goto leave;
 289
 290         if (!(is_qla4010(ha) || is_qla4022(ha) || is_qla4032(ha)))
 291                 goto leave;
 292
 293         if (ql4xxx_reset_active(ha)) {
 294                 ql4_printk(KERN_ERR, ha, "%s: reset active\n", __func__);
 295                 rval = -EBUSY;
 296                 goto leave;
 297         }
 298
 299         offset = bsg_req->rqst_data.h_vendor.vendor_cmd[1];
 300         len = bsg_job->request_payload.payload_len;
 301         total_len = offset + len;
 302
 303         /* total len should not be greater than max NVRAM size */
 304         if ((is_qla4010(ha) && total_len > QL4010_NVRAM_SIZE) ||
 305             ((is_qla4022(ha) || is_qla4032(ha)) &&
 306              total_len > QL40X2_NVRAM_SIZE)) {
 307                 ql4_printk(KERN_ERR, ha, "%s: offset+len greater than max"
 308                            " nvram size, offset=%d len=%d\n",
 309                            __func__, offset, len);
 310                 goto leave;
 311         }
 312
 313         nvram = dma_alloc_coherent(&ha->pdev->dev, len, &nvram_dma,
 314                                    GFP_KERNEL);
 315         if (!nvram) {
 316                 ql4_printk(KERN_ERR, ha, "%s: dma alloc failed for flash "
 317                            "data\n", __func__);
 318                 rval = -ENOMEM;
 319                 goto leave;
 320         }
 321
 322         sg_copy_to_buffer(bsg_job->request_payload.sg_list,
 323                           bsg_job->request_payload.sg_cnt, nvram, len);
 324
 325         rval = qla4xxx_set_nvram(ha, nvram_dma, offset, len);
 326         if (rval) {
 327                 ql4_printk(KERN_ERR, ha, "%s: set nvram failed\n", __func__);
 328                 bsg_reply->result = DID_ERROR << 16;
 329                 rval = -EIO;
 330         } else
 331                 bsg_reply->result = DID_OK << 16;
 332
 333         bsg_job_done(bsg_job, bsg_reply->result,
 334                      bsg_reply->reply_payload_rcv_len);
 335         dma_free_coherent(&ha->pdev->dev, len, nvram, nvram_dma);
 336 leave:
 337         return rval;
 338 }
 339
 340 /**
 341  * qla4xxx_process_vendor_specific - handle vendor specific bsg request
 342  * @job: iscsi_bsg_job to handle
 343  **/
 344 int qla4xxx_process_vendor_specific(struct bsg_job *bsg_job)
 345 {
 346         struct iscsi_bsg_reply *bsg_reply = bsg_job->reply;
 347         struct iscsi_bsg_request *bsg_req = bsg_job->request;
 348         struct Scsi_Host *host = iscsi_job_to_shost(bsg_job);
 349         struct scsi_qla_host *ha = to_qla_host(host);
 350
 351         switch (bsg_req->rqst_data.h_vendor.vendor_cmd[0]) {
 352         case QLISCSI_VND_READ_FLASH:
 353                 return qla4xxx_read_flash(bsg_job);
 354
 355         case QLISCSI_VND_UPDATE_FLASH:
 356                 return qla4xxx_update_flash(bsg_job);
 357
 358         case QLISCSI_VND_GET_ACB_STATE:
 359                 return qla4xxx_get_acb_state(bsg_job);
 360
 361         case QLISCSI_VND_READ_NVRAM:
 362                 return qla4xxx_read_nvram(bsg_job);
 363
 364         case QLISCSI_VND_UPDATE_NVRAM:
 365                 return qla4xxx_update_nvram(bsg_job);
 366
 367         default:
 368                 ql4_printk(KERN_ERR, ha, "%s: invalid BSG vendor command: "
 369                            "0x%x\n", __func__, bsg_req->msgcode);
 370                 bsg_reply->result = (DID_ERROR << 16);
 371                 bsg_reply->reply_payload_rcv_len = 0;
 372                 bsg_job_done(bsg_job, bsg_reply->result,
 373                              bsg_reply->reply_payload_rcv_len);
 374                 return -ENOSYS;
 375         }
 376 }
 377
 378 /**
 379  * qla4xxx_bsg_request - handle bsg request from ISCSI transport
 380  * @job: iscsi_bsg_job to handle
 381  */
 382 int qla4xxx_bsg_request(struct bsg_job *bsg_job)
 383 {
 384         struct iscsi_bsg_request *bsg_req = bsg_job->request;
 385         struct Scsi_Host *host = iscsi_job_to_shost(bsg_job);
 386         struct scsi_qla_host *ha = to_qla_host(host);
 387
 388         switch (bsg_req->msgcode) {
 389         case ISCSI_BSG_HST_VENDOR:
 390                 return qla4xxx_process_vendor_specific(bsg_job);
 391
 392         default:
 393                 ql4_printk(KERN_ERR, ha, "%s: invalid BSG command: 0x%x\n",
 394                            __func__, bsg_req->msgcode);
 395         }
 396
 397         return -ENOSYS;
 398 }