123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274 |
- /*
- * 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/kthread.h>
- #include <linux/vmalloc.h>
- #include <linux/delay.h>
- /* BSG support for ELS/CT pass through */
- void
- qla2x00_bsg_job_done(void *data, void *ptr, int res)
- {
- srb_t *sp = (srb_t *)ptr;
- struct scsi_qla_host *vha = (scsi_qla_host_t *)data;
- struct fc_bsg_job *bsg_job = sp->u.bsg_job;
- bsg_job->reply->result = res;
- bsg_job->job_done(bsg_job);
- sp->free(vha, sp);
- }
- void
- qla2x00_bsg_sp_free(void *data, void *ptr)
- {
- srb_t *sp = (srb_t *)ptr;
- struct scsi_qla_host *vha = sp->fcport->vha;
- struct fc_bsg_job *bsg_job = sp->u.bsg_job;
- struct qla_hw_data *ha = vha->hw;
- struct qla_mt_iocb_rqst_fx00 *piocb_rqst;
- if (sp->type == SRB_FXIOCB_BCMD) {
- piocb_rqst = (struct qla_mt_iocb_rqst_fx00 *)
- &bsg_job->request->rqst_data.h_vendor.vendor_cmd[1];
- if (piocb_rqst->flags & SRB_FXDISC_REQ_DMA_VALID)
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (piocb_rqst->flags & SRB_FXDISC_RESP_DMA_VALID)
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- } else {
- dma_unmap_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- dma_unmap_sg(&ha->pdev->dev, bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- }
- if (sp->type == SRB_CT_CMD ||
- sp->type == SRB_FXIOCB_BCMD ||
- sp->type == SRB_ELS_CMD_HST)
- kfree(sp->fcport);
- qla2x00_rel_sp(vha, sp);
- }
- int
- qla24xx_fcp_prio_cfg_valid(scsi_qla_host_t *vha,
- struct qla_fcp_prio_cfg *pri_cfg, uint8_t flag)
- {
- int i, ret, num_valid;
- uint8_t *bcode;
- struct qla_fcp_prio_entry *pri_entry;
- uint32_t *bcode_val_ptr, bcode_val;
- ret = 1;
- num_valid = 0;
- bcode = (uint8_t *)pri_cfg;
- bcode_val_ptr = (uint32_t *)pri_cfg;
- bcode_val = (uint32_t)(*bcode_val_ptr);
- if (bcode_val == 0xFFFFFFFF) {
- /* No FCP Priority config data in flash */
- ql_dbg(ql_dbg_user, vha, 0x7051,
- "No FCP Priority config data.\n");
- return 0;
- }
- if (bcode[0] != 'H' || bcode[1] != 'Q' || bcode[2] != 'O' ||
- bcode[3] != 'S') {
- /* Invalid FCP priority data header*/
- ql_dbg(ql_dbg_user, vha, 0x7052,
- "Invalid FCP Priority data header. bcode=0x%x.\n",
- bcode_val);
- return 0;
- }
- if (flag != 1)
- return ret;
- pri_entry = &pri_cfg->entry[0];
- for (i = 0; i < pri_cfg->num_entries; i++) {
- if (pri_entry->flags & FCP_PRIO_ENTRY_TAG_VALID)
- num_valid++;
- pri_entry++;
- }
- if (num_valid == 0) {
- /* No valid FCP priority data entries */
- ql_dbg(ql_dbg_user, vha, 0x7053,
- "No valid FCP Priority data entries.\n");
- ret = 0;
- } else {
- /* FCP priority data is valid */
- ql_dbg(ql_dbg_user, vha, 0x7054,
- "Valid FCP priority data. num entries = %d.\n",
- num_valid);
- }
- return ret;
- }
- static int
- qla24xx_proc_fcp_prio_cfg_cmd(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int ret = 0;
- uint32_t len;
- uint32_t oper;
- if (!(IS_QLA24XX_TYPE(ha) || IS_QLA25XX(ha) || IS_P3P_TYPE(ha))) {
- ret = -EINVAL;
- goto exit_fcp_prio_cfg;
- }
- /* Get the sub command */
- oper = bsg_job->request->rqst_data.h_vendor.vendor_cmd[1];
- /* Only set config is allowed if config memory is not allocated */
- if (!ha->fcp_prio_cfg && (oper != QLFC_FCP_PRIO_SET_CONFIG)) {
- ret = -EINVAL;
- goto exit_fcp_prio_cfg;
- }
- switch (oper) {
- case QLFC_FCP_PRIO_DISABLE:
- if (ha->flags.fcp_prio_enabled) {
- ha->flags.fcp_prio_enabled = 0;
- ha->fcp_prio_cfg->attributes &=
- ~FCP_PRIO_ATTR_ENABLE;
- qla24xx_update_all_fcp_prio(vha);
- bsg_job->reply->result = DID_OK;
- } else {
- ret = -EINVAL;
- bsg_job->reply->result = (DID_ERROR << 16);
- goto exit_fcp_prio_cfg;
- }
- break;
- case QLFC_FCP_PRIO_ENABLE:
- if (!ha->flags.fcp_prio_enabled) {
- if (ha->fcp_prio_cfg) {
- ha->flags.fcp_prio_enabled = 1;
- ha->fcp_prio_cfg->attributes |=
- FCP_PRIO_ATTR_ENABLE;
- qla24xx_update_all_fcp_prio(vha);
- bsg_job->reply->result = DID_OK;
- } else {
- ret = -EINVAL;
- bsg_job->reply->result = (DID_ERROR << 16);
- goto exit_fcp_prio_cfg;
- }
- }
- break;
- case QLFC_FCP_PRIO_GET_CONFIG:
- len = bsg_job->reply_payload.payload_len;
- if (!len || len > FCP_PRIO_CFG_SIZE) {
- ret = -EINVAL;
- bsg_job->reply->result = (DID_ERROR << 16);
- goto exit_fcp_prio_cfg;
- }
- bsg_job->reply->result = DID_OK;
- bsg_job->reply->reply_payload_rcv_len =
- sg_copy_from_buffer(
- bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, ha->fcp_prio_cfg,
- len);
- break;
- case QLFC_FCP_PRIO_SET_CONFIG:
- len = bsg_job->request_payload.payload_len;
- if (!len || len > FCP_PRIO_CFG_SIZE) {
- bsg_job->reply->result = (DID_ERROR << 16);
- ret = -EINVAL;
- goto exit_fcp_prio_cfg;
- }
- if (!ha->fcp_prio_cfg) {
- ha->fcp_prio_cfg = vmalloc(FCP_PRIO_CFG_SIZE);
- if (!ha->fcp_prio_cfg) {
- ql_log(ql_log_warn, vha, 0x7050,
- "Unable to allocate memory for fcp prio "
- "config data (%x).\n", FCP_PRIO_CFG_SIZE);
- bsg_job->reply->result = (DID_ERROR << 16);
- ret = -ENOMEM;
- goto exit_fcp_prio_cfg;
- }
- }
- memset(ha->fcp_prio_cfg, 0, FCP_PRIO_CFG_SIZE);
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, ha->fcp_prio_cfg,
- FCP_PRIO_CFG_SIZE);
- /* validate fcp priority data */
- if (!qla24xx_fcp_prio_cfg_valid(vha,
- (struct qla_fcp_prio_cfg *) ha->fcp_prio_cfg, 1)) {
- bsg_job->reply->result = (DID_ERROR << 16);
- ret = -EINVAL;
- /* If buffer was invalidatic int
- * fcp_prio_cfg is of no use
- */
- vfree(ha->fcp_prio_cfg);
- ha->fcp_prio_cfg = NULL;
- goto exit_fcp_prio_cfg;
- }
- ha->flags.fcp_prio_enabled = 0;
- if (ha->fcp_prio_cfg->attributes & FCP_PRIO_ATTR_ENABLE)
- ha->flags.fcp_prio_enabled = 1;
- qla24xx_update_all_fcp_prio(vha);
- bsg_job->reply->result = DID_OK;
- break;
- default:
- ret = -EINVAL;
- break;
- }
- exit_fcp_prio_cfg:
- if (!ret)
- bsg_job->job_done(bsg_job);
- return ret;
- }
- static int
- qla2x00_process_els(struct fc_bsg_job *bsg_job)
- {
- struct fc_rport *rport;
- fc_port_t *fcport = NULL;
- struct Scsi_Host *host;
- scsi_qla_host_t *vha;
- struct qla_hw_data *ha;
- srb_t *sp;
- const char *type;
- int req_sg_cnt, rsp_sg_cnt;
- int rval = (DRIVER_ERROR << 16);
- uint16_t nextlid = 0;
- if (bsg_job->request->msgcode == FC_BSG_RPT_ELS) {
- rport = bsg_job->rport;
- fcport = *(fc_port_t **) rport->dd_data;
- host = rport_to_shost(rport);
- vha = shost_priv(host);
- ha = vha->hw;
- type = "FC_BSG_RPT_ELS";
- } else {
- host = bsg_job->shost;
- vha = shost_priv(host);
- ha = vha->hw;
- type = "FC_BSG_HST_ELS_NOLOGIN";
- }
- if (!vha->flags.online) {
- ql_log(ql_log_warn, vha, 0x7005, "Host not online.\n");
- rval = -EIO;
- goto done;
- }
- /* pass through is supported only for ISP 4Gb or higher */
- if (!IS_FWI2_CAPABLE(ha)) {
- ql_dbg(ql_dbg_user, vha, 0x7001,
- "ELS passthru not supported for ISP23xx based adapters.\n");
- rval = -EPERM;
- goto done;
- }
- /* Multiple SG's are not supported for ELS requests */
- if (bsg_job->request_payload.sg_cnt > 1 ||
- bsg_job->reply_payload.sg_cnt > 1) {
- ql_dbg(ql_dbg_user, vha, 0x7002,
- "Multiple SG's are not suppored for ELS requests, "
- "request_sg_cnt=%x reply_sg_cnt=%x.\n",
- bsg_job->request_payload.sg_cnt,
- bsg_job->reply_payload.sg_cnt);
- rval = -EPERM;
- goto done;
- }
- /* ELS request for rport */
- if (bsg_job->request->msgcode == FC_BSG_RPT_ELS) {
- /* make sure the rport is logged in,
- * if not perform fabric login
- */
- if (qla2x00_fabric_login(vha, fcport, &nextlid)) {
- ql_dbg(ql_dbg_user, vha, 0x7003,
- "Failed to login port %06X for ELS passthru.\n",
- fcport->d_id.b24);
- rval = -EIO;
- goto done;
- }
- } else {
- /* Allocate a dummy fcport structure, since functions
- * preparing the IOCB and mailbox command retrieves port
- * specific information from fcport structure. For Host based
- * ELS commands there will be no fcport structure allocated
- */
- fcport = qla2x00_alloc_fcport(vha, GFP_KERNEL);
- if (!fcport) {
- rval = -ENOMEM;
- goto done;
- }
- /* Initialize all required fields of fcport */
- fcport->vha = vha;
- fcport->d_id.b.al_pa =
- bsg_job->request->rqst_data.h_els.port_id[0];
- fcport->d_id.b.area =
- bsg_job->request->rqst_data.h_els.port_id[1];
- fcport->d_id.b.domain =
- bsg_job->request->rqst_data.h_els.port_id[2];
- fcport->loop_id =
- (fcport->d_id.b.al_pa == 0xFD) ?
- NPH_FABRIC_CONTROLLER : NPH_F_PORT;
- }
- req_sg_cnt =
- dma_map_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (!req_sg_cnt) {
- rval = -ENOMEM;
- goto done_free_fcport;
- }
- rsp_sg_cnt = dma_map_sg(&ha->pdev->dev, bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- if (!rsp_sg_cnt) {
- rval = -ENOMEM;
- goto done_free_fcport;
- }
- if ((req_sg_cnt != bsg_job->request_payload.sg_cnt) ||
- (rsp_sg_cnt != bsg_job->reply_payload.sg_cnt)) {
- ql_log(ql_log_warn, vha, 0x7008,
- "dma mapping resulted in different sg counts, "
- "request_sg_cnt: %x dma_request_sg_cnt:%x reply_sg_cnt:%x "
- "dma_reply_sg_cnt:%x.\n", bsg_job->request_payload.sg_cnt,
- req_sg_cnt, bsg_job->reply_payload.sg_cnt, rsp_sg_cnt);
- rval = -EAGAIN;
- goto done_unmap_sg;
- }
- /* Alloc SRB structure */
- sp = qla2x00_get_sp(vha, fcport, GFP_KERNEL);
- if (!sp) {
- rval = -ENOMEM;
- goto done_unmap_sg;
- }
- sp->type =
- (bsg_job->request->msgcode == FC_BSG_RPT_ELS ?
- SRB_ELS_CMD_RPT : SRB_ELS_CMD_HST);
- sp->name =
- (bsg_job->request->msgcode == FC_BSG_RPT_ELS ?
- "bsg_els_rpt" : "bsg_els_hst");
- sp->u.bsg_job = bsg_job;
- sp->free = qla2x00_bsg_sp_free;
- sp->done = qla2x00_bsg_job_done;
- ql_dbg(ql_dbg_user, vha, 0x700a,
- "bsg rqst type: %s els type: %x - loop-id=%x "
- "portid=%-2x%02x%02x.\n", type,
- bsg_job->request->rqst_data.h_els.command_code, fcport->loop_id,
- fcport->d_id.b.domain, fcport->d_id.b.area, fcport->d_id.b.al_pa);
- rval = qla2x00_start_sp(sp);
- if (rval != QLA_SUCCESS) {
- ql_log(ql_log_warn, vha, 0x700e,
- "qla2x00_start_sp failed = %d\n", rval);
- qla2x00_rel_sp(vha, sp);
- rval = -EIO;
- goto done_unmap_sg;
- }
- return rval;
- done_unmap_sg:
- dma_unmap_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- dma_unmap_sg(&ha->pdev->dev, bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- goto done_free_fcport;
- done_free_fcport:
- if (bsg_job->request->msgcode == FC_BSG_RPT_ELS)
- kfree(fcport);
- done:
- return rval;
- }
- static inline uint16_t
- qla24xx_calc_ct_iocbs(uint16_t dsds)
- {
- uint16_t iocbs;
- iocbs = 1;
- if (dsds > 2) {
- iocbs += (dsds - 2) / 5;
- if ((dsds - 2) % 5)
- iocbs++;
- }
- return iocbs;
- }
- static int
- qla2x00_process_ct(struct fc_bsg_job *bsg_job)
- {
- srb_t *sp;
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = (DRIVER_ERROR << 16);
- int req_sg_cnt, rsp_sg_cnt;
- uint16_t loop_id;
- struct fc_port *fcport;
- char *type = "FC_BSG_HST_CT";
- req_sg_cnt =
- dma_map_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (!req_sg_cnt) {
- ql_log(ql_log_warn, vha, 0x700f,
- "dma_map_sg return %d for request\n", req_sg_cnt);
- rval = -ENOMEM;
- goto done;
- }
- rsp_sg_cnt = dma_map_sg(&ha->pdev->dev, bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- if (!rsp_sg_cnt) {
- ql_log(ql_log_warn, vha, 0x7010,
- "dma_map_sg return %d for reply\n", rsp_sg_cnt);
- rval = -ENOMEM;
- goto done;
- }
- if ((req_sg_cnt != bsg_job->request_payload.sg_cnt) ||
- (rsp_sg_cnt != bsg_job->reply_payload.sg_cnt)) {
- ql_log(ql_log_warn, vha, 0x7011,
- "request_sg_cnt: %x dma_request_sg_cnt: %x reply_sg_cnt:%x "
- "dma_reply_sg_cnt: %x\n", bsg_job->request_payload.sg_cnt,
- req_sg_cnt, bsg_job->reply_payload.sg_cnt, rsp_sg_cnt);
- rval = -EAGAIN;
- goto done_unmap_sg;
- }
- if (!vha->flags.online) {
- ql_log(ql_log_warn, vha, 0x7012,
- "Host is not online.\n");
- rval = -EIO;
- goto done_unmap_sg;
- }
- loop_id =
- (bsg_job->request->rqst_data.h_ct.preamble_word1 & 0xFF000000)
- >> 24;
- switch (loop_id) {
- case 0xFC:
- loop_id = cpu_to_le16(NPH_SNS);
- break;
- case 0xFA:
- loop_id = vha->mgmt_svr_loop_id;
- break;
- default:
- ql_dbg(ql_dbg_user, vha, 0x7013,
- "Unknown loop id: %x.\n", loop_id);
- rval = -EINVAL;
- goto done_unmap_sg;
- }
- /* Allocate a dummy fcport structure, since functions preparing the
- * IOCB and mailbox command retrieves port specific information
- * from fcport structure. For Host based ELS commands there will be
- * no fcport structure allocated
- */
- fcport = qla2x00_alloc_fcport(vha, GFP_KERNEL);
- if (!fcport) {
- ql_log(ql_log_warn, vha, 0x7014,
- "Failed to allocate fcport.\n");
- rval = -ENOMEM;
- goto done_unmap_sg;
- }
- /* Initialize all required fields of fcport */
- fcport->vha = vha;
- fcport->d_id.b.al_pa = bsg_job->request->rqst_data.h_ct.port_id[0];
- fcport->d_id.b.area = bsg_job->request->rqst_data.h_ct.port_id[1];
- fcport->d_id.b.domain = bsg_job->request->rqst_data.h_ct.port_id[2];
- fcport->loop_id = loop_id;
- /* Alloc SRB structure */
- sp = qla2x00_get_sp(vha, fcport, GFP_KERNEL);
- if (!sp) {
- ql_log(ql_log_warn, vha, 0x7015,
- "qla2x00_get_sp failed.\n");
- rval = -ENOMEM;
- goto done_free_fcport;
- }
- sp->type = SRB_CT_CMD;
- sp->name = "bsg_ct";
- sp->iocbs = qla24xx_calc_ct_iocbs(req_sg_cnt + rsp_sg_cnt);
- sp->u.bsg_job = bsg_job;
- sp->free = qla2x00_bsg_sp_free;
- sp->done = qla2x00_bsg_job_done;
- ql_dbg(ql_dbg_user, vha, 0x7016,
- "bsg rqst type: %s else type: %x - "
- "loop-id=%x portid=%02x%02x%02x.\n", type,
- (bsg_job->request->rqst_data.h_ct.preamble_word2 >> 16),
- fcport->loop_id, fcport->d_id.b.domain, fcport->d_id.b.area,
- fcport->d_id.b.al_pa);
- rval = qla2x00_start_sp(sp);
- if (rval != QLA_SUCCESS) {
- ql_log(ql_log_warn, vha, 0x7017,
- "qla2x00_start_sp failed=%d.\n", rval);
- qla2x00_rel_sp(vha, sp);
- rval = -EIO;
- goto done_free_fcport;
- }
- return rval;
- done_free_fcport:
- kfree(fcport);
- done_unmap_sg:
- dma_unmap_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- dma_unmap_sg(&ha->pdev->dev, bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- done:
- return rval;
- }
- /* Disable loopback mode */
- static inline int
- qla81xx_reset_loopback_mode(scsi_qla_host_t *vha, uint16_t *config,
- int wait, int wait2)
- {
- int ret = 0;
- int rval = 0;
- uint16_t new_config[4];
- struct qla_hw_data *ha = vha->hw;
- if (!IS_QLA81XX(ha) && !IS_QLA8031(ha) && !IS_QLA8044(ha))
- goto done_reset_internal;
- memset(new_config, 0 , sizeof(new_config));
- if ((config[0] & INTERNAL_LOOPBACK_MASK) >> 1 ==
- ENABLE_INTERNAL_LOOPBACK ||
- (config[0] & INTERNAL_LOOPBACK_MASK) >> 1 ==
- ENABLE_EXTERNAL_LOOPBACK) {
- new_config[0] = config[0] & ~INTERNAL_LOOPBACK_MASK;
- ql_dbg(ql_dbg_user, vha, 0x70bf, "new_config[0]=%02x\n",
- (new_config[0] & INTERNAL_LOOPBACK_MASK));
- memcpy(&new_config[1], &config[1], sizeof(uint16_t) * 3) ;
- ha->notify_dcbx_comp = wait;
- ha->notify_lb_portup_comp = wait2;
- ret = qla81xx_set_port_config(vha, new_config);
- if (ret != QLA_SUCCESS) {
- ql_log(ql_log_warn, vha, 0x7025,
- "Set port config failed.\n");
- ha->notify_dcbx_comp = 0;
- ha->notify_lb_portup_comp = 0;
- rval = -EINVAL;
- goto done_reset_internal;
- }
- /* Wait for DCBX complete event */
- if (wait && !wait_for_completion_timeout(&ha->dcbx_comp,
- (DCBX_COMP_TIMEOUT * HZ))) {
- ql_dbg(ql_dbg_user, vha, 0x7026,
- "DCBX completion not received.\n");
- ha->notify_dcbx_comp = 0;
- ha->notify_lb_portup_comp = 0;
- rval = -EINVAL;
- goto done_reset_internal;
- } else
- ql_dbg(ql_dbg_user, vha, 0x7027,
- "DCBX completion received.\n");
- if (wait2 &&
- !wait_for_completion_timeout(&ha->lb_portup_comp,
- (LB_PORTUP_COMP_TIMEOUT * HZ))) {
- ql_dbg(ql_dbg_user, vha, 0x70c5,
- "Port up completion not received.\n");
- ha->notify_lb_portup_comp = 0;
- rval = -EINVAL;
- goto done_reset_internal;
- } else
- ql_dbg(ql_dbg_user, vha, 0x70c6,
- "Port up completion received.\n");
- ha->notify_dcbx_comp = 0;
- ha->notify_lb_portup_comp = 0;
- }
- done_reset_internal:
- return rval;
- }
- /*
- * Set the port configuration to enable the internal or external loopback
- * depending on the loopback mode.
- */
- static inline int
- qla81xx_set_loopback_mode(scsi_qla_host_t *vha, uint16_t *config,
- uint16_t *new_config, uint16_t mode)
- {
- int ret = 0;
- int rval = 0;
- unsigned long rem_tmo = 0, current_tmo = 0;
- struct qla_hw_data *ha = vha->hw;
- if (!IS_QLA81XX(ha) && !IS_QLA8031(ha) && !IS_QLA8044(ha))
- goto done_set_internal;
- if (mode == INTERNAL_LOOPBACK)
- new_config[0] = config[0] | (ENABLE_INTERNAL_LOOPBACK << 1);
- else if (mode == EXTERNAL_LOOPBACK)
- new_config[0] = config[0] | (ENABLE_EXTERNAL_LOOPBACK << 1);
- ql_dbg(ql_dbg_user, vha, 0x70be,
- "new_config[0]=%02x\n", (new_config[0] & INTERNAL_LOOPBACK_MASK));
- memcpy(&new_config[1], &config[1], sizeof(uint16_t) * 3);
- ha->notify_dcbx_comp = 1;
- ret = qla81xx_set_port_config(vha, new_config);
- if (ret != QLA_SUCCESS) {
- ql_log(ql_log_warn, vha, 0x7021,
- "set port config failed.\n");
- ha->notify_dcbx_comp = 0;
- rval = -EINVAL;
- goto done_set_internal;
- }
- /* Wait for DCBX complete event */
- current_tmo = DCBX_COMP_TIMEOUT * HZ;
- while (1) {
- rem_tmo = wait_for_completion_timeout(&ha->dcbx_comp,
- current_tmo);
- if (!ha->idc_extend_tmo || rem_tmo) {
- ha->idc_extend_tmo = 0;
- break;
- }
- current_tmo = ha->idc_extend_tmo * HZ;
- ha->idc_extend_tmo = 0;
- }
- if (!rem_tmo) {
- ql_dbg(ql_dbg_user, vha, 0x7022,
- "DCBX completion not received.\n");
- ret = qla81xx_reset_loopback_mode(vha, new_config, 0, 0);
- /*
- * If the reset of the loopback mode doesn't work take a FCoE
- * dump and reset the chip.
- */
- if (ret) {
- ha->isp_ops->fw_dump(vha, 0);
- set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
- }
- rval = -EINVAL;
- } else {
- if (ha->flags.idc_compl_status) {
- ql_dbg(ql_dbg_user, vha, 0x70c3,
- "Bad status in IDC Completion AEN\n");
- rval = -EINVAL;
- ha->flags.idc_compl_status = 0;
- } else
- ql_dbg(ql_dbg_user, vha, 0x7023,
- "DCBX completion received.\n");
- }
- ha->notify_dcbx_comp = 0;
- ha->idc_extend_tmo = 0;
- done_set_internal:
- return rval;
- }
- static int
- qla2x00_process_loopback(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval;
- uint8_t command_sent;
- char *type;
- struct msg_echo_lb elreq;
- uint16_t response[MAILBOX_REGISTER_COUNT];
- uint16_t config[4], new_config[4];
- uint8_t *fw_sts_ptr;
- uint8_t *req_data = NULL;
- dma_addr_t req_data_dma;
- uint32_t req_data_len;
- uint8_t *rsp_data = NULL;
- dma_addr_t rsp_data_dma;
- uint32_t rsp_data_len;
- if (!vha->flags.online) {
- ql_log(ql_log_warn, vha, 0x7019, "Host is not online.\n");
- return -EIO;
- }
- elreq.req_sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list, bsg_job->request_payload.sg_cnt,
- DMA_TO_DEVICE);
- if (!elreq.req_sg_cnt) {
- ql_log(ql_log_warn, vha, 0x701a,
- "dma_map_sg returned %d for request.\n", elreq.req_sg_cnt);
- return -ENOMEM;
- }
- elreq.rsp_sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list, bsg_job->reply_payload.sg_cnt,
- DMA_FROM_DEVICE);
- if (!elreq.rsp_sg_cnt) {
- ql_log(ql_log_warn, vha, 0x701b,
- "dma_map_sg returned %d for reply.\n", elreq.rsp_sg_cnt);
- rval = -ENOMEM;
- goto done_unmap_req_sg;
- }
- if ((elreq.req_sg_cnt != bsg_job->request_payload.sg_cnt) ||
- (elreq.rsp_sg_cnt != bsg_job->reply_payload.sg_cnt)) {
- ql_log(ql_log_warn, vha, 0x701c,
- "dma mapping resulted in different sg counts, "
- "request_sg_cnt: %x dma_request_sg_cnt: %x "
- "reply_sg_cnt: %x dma_reply_sg_cnt: %x.\n",
- bsg_job->request_payload.sg_cnt, elreq.req_sg_cnt,
- bsg_job->reply_payload.sg_cnt, elreq.rsp_sg_cnt);
- rval = -EAGAIN;
- goto done_unmap_sg;
- }
- req_data_len = rsp_data_len = bsg_job->request_payload.payload_len;
- req_data = dma_alloc_coherent(&ha->pdev->dev, req_data_len,
- &req_data_dma, GFP_KERNEL);
- if (!req_data) {
- ql_log(ql_log_warn, vha, 0x701d,
- "dma alloc failed for req_data.\n");
- rval = -ENOMEM;
- goto done_unmap_sg;
- }
- rsp_data = dma_alloc_coherent(&ha->pdev->dev, rsp_data_len,
- &rsp_data_dma, GFP_KERNEL);
- if (!rsp_data) {
- ql_log(ql_log_warn, vha, 0x7004,
- "dma alloc failed for rsp_data.\n");
- rval = -ENOMEM;
- goto done_free_dma_req;
- }
- /* Copy the request buffer in req_data now */
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, req_data, req_data_len);
- elreq.send_dma = req_data_dma;
- elreq.rcv_dma = rsp_data_dma;
- elreq.transfer_size = req_data_len;
- elreq.options = bsg_job->request->rqst_data.h_vendor.vendor_cmd[1];
- elreq.iteration_count =
- bsg_job->request->rqst_data.h_vendor.vendor_cmd[2];
- if (atomic_read(&vha->loop_state) == LOOP_READY &&
- (ha->current_topology == ISP_CFG_F ||
- ((IS_QLA81XX(ha) || IS_QLA8031(ha) || IS_QLA8044(ha)) &&
- le32_to_cpu(*(uint32_t *)req_data) == ELS_OPCODE_BYTE
- && req_data_len == MAX_ELS_FRAME_PAYLOAD)) &&
- elreq.options == EXTERNAL_LOOPBACK) {
- type = "FC_BSG_HST_VENDOR_ECHO_DIAG";
- ql_dbg(ql_dbg_user, vha, 0x701e,
- "BSG request type: %s.\n", type);
- command_sent = INT_DEF_LB_ECHO_CMD;
- rval = qla2x00_echo_test(vha, &elreq, response);
- } else {
- if (IS_QLA81XX(ha) || IS_QLA8031(ha) || IS_QLA8044(ha)) {
- memset(config, 0, sizeof(config));
- memset(new_config, 0, sizeof(new_config));
- if (qla81xx_get_port_config(vha, config)) {
- ql_log(ql_log_warn, vha, 0x701f,
- "Get port config failed.\n");
- rval = -EPERM;
- goto done_free_dma_rsp;
- }
- if ((config[0] & INTERNAL_LOOPBACK_MASK) != 0) {
- ql_dbg(ql_dbg_user, vha, 0x70c4,
- "Loopback operation already in "
- "progress.\n");
- rval = -EAGAIN;
- goto done_free_dma_rsp;
- }
- ql_dbg(ql_dbg_user, vha, 0x70c0,
- "elreq.options=%04x\n", elreq.options);
- if (elreq.options == EXTERNAL_LOOPBACK)
- if (IS_QLA8031(ha) || IS_QLA8044(ha))
- rval = qla81xx_set_loopback_mode(vha,
- config, new_config, elreq.options);
- else
- rval = qla81xx_reset_loopback_mode(vha,
- config, 1, 0);
- else
- rval = qla81xx_set_loopback_mode(vha, config,
- new_config, elreq.options);
- if (rval) {
- rval = -EPERM;
- goto done_free_dma_rsp;
- }
- type = "FC_BSG_HST_VENDOR_LOOPBACK";
- ql_dbg(ql_dbg_user, vha, 0x7028,
- "BSG request type: %s.\n", type);
- command_sent = INT_DEF_LB_LOOPBACK_CMD;
- rval = qla2x00_loopback_test(vha, &elreq, response);
- if (response[0] == MBS_COMMAND_ERROR &&
- response[1] == MBS_LB_RESET) {
- ql_log(ql_log_warn, vha, 0x7029,
- "MBX command error, Aborting ISP.\n");
- set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
- qla2xxx_wake_dpc(vha);
- qla2x00_wait_for_chip_reset(vha);
- /* Also reset the MPI */
- if (IS_QLA81XX(ha)) {
- if (qla81xx_restart_mpi_firmware(vha) !=
- QLA_SUCCESS) {
- ql_log(ql_log_warn, vha, 0x702a,
- "MPI reset failed.\n");
- }
- }
- rval = -EIO;
- goto done_free_dma_rsp;
- }
- if (new_config[0]) {
- int ret;
- /* Revert back to original port config
- * Also clear internal loopback
- */
- ret = qla81xx_reset_loopback_mode(vha,
- new_config, 0, 1);
- if (ret) {
- /*
- * If the reset of the loopback mode
- * doesn't work take FCoE dump and then
- * reset the chip.
- */
- ha->isp_ops->fw_dump(vha, 0);
- set_bit(ISP_ABORT_NEEDED,
- &vha->dpc_flags);
- }
- }
- } else {
- type = "FC_BSG_HST_VENDOR_LOOPBACK";
- ql_dbg(ql_dbg_user, vha, 0x702b,
- "BSG request type: %s.\n", type);
- command_sent = INT_DEF_LB_LOOPBACK_CMD;
- rval = qla2x00_loopback_test(vha, &elreq, response);
- }
- }
- if (rval) {
- ql_log(ql_log_warn, vha, 0x702c,
- "Vendor request %s failed.\n", type);
- rval = 0;
- bsg_job->reply->result = (DID_ERROR << 16);
- bsg_job->reply->reply_payload_rcv_len = 0;
- } else {
- ql_dbg(ql_dbg_user, vha, 0x702d,
- "Vendor request %s completed.\n", type);
- bsg_job->reply->result = (DID_OK << 16);
- sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, rsp_data,
- rsp_data_len);
- }
- bsg_job->reply_len = sizeof(struct fc_bsg_reply) +
- sizeof(response) + sizeof(uint8_t);
- fw_sts_ptr = ((uint8_t *)bsg_job->req->sense) +
- sizeof(struct fc_bsg_reply);
- memcpy(fw_sts_ptr, response, sizeof(response));
- fw_sts_ptr += sizeof(response);
- *fw_sts_ptr = command_sent;
- done_free_dma_rsp:
- dma_free_coherent(&ha->pdev->dev, rsp_data_len,
- rsp_data, rsp_data_dma);
- done_free_dma_req:
- dma_free_coherent(&ha->pdev->dev, req_data_len,
- req_data, req_data_dma);
- done_unmap_sg:
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- done_unmap_req_sg:
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (!rval)
- bsg_job->job_done(bsg_job);
- return rval;
- }
- static int
- qla84xx_reset(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- uint32_t flag;
- if (!IS_QLA84XX(ha)) {
- ql_dbg(ql_dbg_user, vha, 0x702f, "Not 84xx, exiting.\n");
- return -EINVAL;
- }
- flag = bsg_job->request->rqst_data.h_vendor.vendor_cmd[1];
- rval = qla84xx_reset_chip(vha, flag == A84_ISSUE_RESET_DIAG_FW);
- if (rval) {
- ql_log(ql_log_warn, vha, 0x7030,
- "Vendor request 84xx reset failed.\n");
- rval = (DID_ERROR << 16);
- } else {
- ql_dbg(ql_dbg_user, vha, 0x7031,
- "Vendor request 84xx reset completed.\n");
- bsg_job->reply->result = DID_OK;
- bsg_job->job_done(bsg_job);
- }
- return rval;
- }
- static int
- qla84xx_updatefw(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- struct verify_chip_entry_84xx *mn = NULL;
- dma_addr_t mn_dma, fw_dma;
- void *fw_buf = NULL;
- int rval = 0;
- uint32_t sg_cnt;
- uint32_t data_len;
- uint16_t options;
- uint32_t flag;
- uint32_t fw_ver;
- if (!IS_QLA84XX(ha)) {
- ql_dbg(ql_dbg_user, vha, 0x7032,
- "Not 84xx, exiting.\n");
- return -EINVAL;
- }
- sg_cnt = dma_map_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (!sg_cnt) {
- ql_log(ql_log_warn, vha, 0x7033,
- "dma_map_sg returned %d for request.\n", sg_cnt);
- return -ENOMEM;
- }
- if (sg_cnt != bsg_job->request_payload.sg_cnt) {
- ql_log(ql_log_warn, vha, 0x7034,
- "DMA mapping resulted in different sg counts, "
- "request_sg_cnt: %x dma_request_sg_cnt: %x.\n",
- bsg_job->request_payload.sg_cnt, sg_cnt);
- rval = -EAGAIN;
- goto done_unmap_sg;
- }
- data_len = bsg_job->request_payload.payload_len;
- fw_buf = dma_alloc_coherent(&ha->pdev->dev, data_len,
- &fw_dma, GFP_KERNEL);
- if (!fw_buf) {
- ql_log(ql_log_warn, vha, 0x7035,
- "DMA alloc failed for fw_buf.\n");
- rval = -ENOMEM;
- goto done_unmap_sg;
- }
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, fw_buf, data_len);
- mn = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &mn_dma);
- if (!mn) {
- ql_log(ql_log_warn, vha, 0x7036,
- "DMA alloc failed for fw buffer.\n");
- rval = -ENOMEM;
- goto done_free_fw_buf;
- }
- flag = bsg_job->request->rqst_data.h_vendor.vendor_cmd[1];
- fw_ver = le32_to_cpu(*((uint32_t *)((uint32_t *)fw_buf + 2)));
- memset(mn, 0, sizeof(struct access_chip_84xx));
- mn->entry_type = VERIFY_CHIP_IOCB_TYPE;
- mn->entry_count = 1;
- options = VCO_FORCE_UPDATE | VCO_END_OF_DATA;
- if (flag == A84_ISSUE_UPDATE_DIAGFW_CMD)
- options |= VCO_DIAG_FW;
- mn->options = cpu_to_le16(options);
- mn->fw_ver = cpu_to_le32(fw_ver);
- mn->fw_size = cpu_to_le32(data_len);
- mn->fw_seq_size = cpu_to_le32(data_len);
- mn->dseg_address[0] = cpu_to_le32(LSD(fw_dma));
- mn->dseg_address[1] = cpu_to_le32(MSD(fw_dma));
- mn->dseg_length = cpu_to_le32(data_len);
- mn->data_seg_cnt = cpu_to_le16(1);
- rval = qla2x00_issue_iocb_timeout(vha, mn, mn_dma, 0, 120);
- if (rval) {
- ql_log(ql_log_warn, vha, 0x7037,
- "Vendor request 84xx updatefw failed.\n");
- rval = (DID_ERROR << 16);
- } else {
- ql_dbg(ql_dbg_user, vha, 0x7038,
- "Vendor request 84xx updatefw completed.\n");
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->result = DID_OK;
- }
- dma_pool_free(ha->s_dma_pool, mn, mn_dma);
- done_free_fw_buf:
- dma_free_coherent(&ha->pdev->dev, data_len, fw_buf, fw_dma);
- done_unmap_sg:
- dma_unmap_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (!rval)
- bsg_job->job_done(bsg_job);
- return rval;
- }
- static int
- qla84xx_mgmt_cmd(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- struct access_chip_84xx *mn = NULL;
- dma_addr_t mn_dma, mgmt_dma;
- void *mgmt_b = NULL;
- int rval = 0;
- struct qla_bsg_a84_mgmt *ql84_mgmt;
- uint32_t sg_cnt;
- uint32_t data_len = 0;
- uint32_t dma_direction = DMA_NONE;
- if (!IS_QLA84XX(ha)) {
- ql_log(ql_log_warn, vha, 0x703a,
- "Not 84xx, exiting.\n");
- return -EINVAL;
- }
- mn = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &mn_dma);
- if (!mn) {
- ql_log(ql_log_warn, vha, 0x703c,
- "DMA alloc failed for fw buffer.\n");
- return -ENOMEM;
- }
- memset(mn, 0, sizeof(struct access_chip_84xx));
- mn->entry_type = ACCESS_CHIP_IOCB_TYPE;
- mn->entry_count = 1;
- ql84_mgmt = (void *)bsg_job->request + sizeof(struct fc_bsg_request);
- switch (ql84_mgmt->mgmt.cmd) {
- case QLA84_MGMT_READ_MEM:
- case QLA84_MGMT_GET_INFO:
- sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- if (!sg_cnt) {
- ql_log(ql_log_warn, vha, 0x703d,
- "dma_map_sg returned %d for reply.\n", sg_cnt);
- rval = -ENOMEM;
- goto exit_mgmt;
- }
- dma_direction = DMA_FROM_DEVICE;
- if (sg_cnt != bsg_job->reply_payload.sg_cnt) {
- ql_log(ql_log_warn, vha, 0x703e,
- "DMA mapping resulted in different sg counts, "
- "reply_sg_cnt: %x dma_reply_sg_cnt: %x.\n",
- bsg_job->reply_payload.sg_cnt, sg_cnt);
- rval = -EAGAIN;
- goto done_unmap_sg;
- }
- data_len = bsg_job->reply_payload.payload_len;
- mgmt_b = dma_alloc_coherent(&ha->pdev->dev, data_len,
- &mgmt_dma, GFP_KERNEL);
- if (!mgmt_b) {
- ql_log(ql_log_warn, vha, 0x703f,
- "DMA alloc failed for mgmt_b.\n");
- rval = -ENOMEM;
- goto done_unmap_sg;
- }
- if (ql84_mgmt->mgmt.cmd == QLA84_MGMT_READ_MEM) {
- mn->options = cpu_to_le16(ACO_DUMP_MEMORY);
- mn->parameter1 =
- cpu_to_le32(
- ql84_mgmt->mgmt.mgmtp.u.mem.start_addr);
- } else if (ql84_mgmt->mgmt.cmd == QLA84_MGMT_GET_INFO) {
- mn->options = cpu_to_le16(ACO_REQUEST_INFO);
- mn->parameter1 =
- cpu_to_le32(ql84_mgmt->mgmt.mgmtp.u.info.type);
- mn->parameter2 =
- cpu_to_le32(
- ql84_mgmt->mgmt.mgmtp.u.info.context);
- }
- break;
- case QLA84_MGMT_WRITE_MEM:
- sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (!sg_cnt) {
- ql_log(ql_log_warn, vha, 0x7040,
- "dma_map_sg returned %d.\n", sg_cnt);
- rval = -ENOMEM;
- goto exit_mgmt;
- }
- dma_direction = DMA_TO_DEVICE;
- if (sg_cnt != bsg_job->request_payload.sg_cnt) {
- ql_log(ql_log_warn, vha, 0x7041,
- "DMA mapping resulted in different sg counts, "
- "request_sg_cnt: %x dma_request_sg_cnt: %x.\n",
- bsg_job->request_payload.sg_cnt, sg_cnt);
- rval = -EAGAIN;
- goto done_unmap_sg;
- }
- data_len = bsg_job->request_payload.payload_len;
- mgmt_b = dma_alloc_coherent(&ha->pdev->dev, data_len,
- &mgmt_dma, GFP_KERNEL);
- if (!mgmt_b) {
- ql_log(ql_log_warn, vha, 0x7042,
- "DMA alloc failed for mgmt_b.\n");
- rval = -ENOMEM;
- goto done_unmap_sg;
- }
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, mgmt_b, data_len);
- mn->options = cpu_to_le16(ACO_LOAD_MEMORY);
- mn->parameter1 =
- cpu_to_le32(ql84_mgmt->mgmt.mgmtp.u.mem.start_addr);
- break;
- case QLA84_MGMT_CHNG_CONFIG:
- mn->options = cpu_to_le16(ACO_CHANGE_CONFIG_PARAM);
- mn->parameter1 =
- cpu_to_le32(ql84_mgmt->mgmt.mgmtp.u.config.id);
- mn->parameter2 =
- cpu_to_le32(ql84_mgmt->mgmt.mgmtp.u.config.param0);
- mn->parameter3 =
- cpu_to_le32(ql84_mgmt->mgmt.mgmtp.u.config.param1);
- break;
- default:
- rval = -EIO;
- goto exit_mgmt;
- }
- if (ql84_mgmt->mgmt.cmd != QLA84_MGMT_CHNG_CONFIG) {
- mn->total_byte_cnt = cpu_to_le32(ql84_mgmt->mgmt.len);
- mn->dseg_count = cpu_to_le16(1);
- mn->dseg_address[0] = cpu_to_le32(LSD(mgmt_dma));
- mn->dseg_address[1] = cpu_to_le32(MSD(mgmt_dma));
- mn->dseg_length = cpu_to_le32(ql84_mgmt->mgmt.len);
- }
- rval = qla2x00_issue_iocb(vha, mn, mn_dma, 0);
- if (rval) {
- ql_log(ql_log_warn, vha, 0x7043,
- "Vendor request 84xx mgmt failed.\n");
- rval = (DID_ERROR << 16);
- } else {
- ql_dbg(ql_dbg_user, vha, 0x7044,
- "Vendor request 84xx mgmt completed.\n");
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->result = DID_OK;
- if ((ql84_mgmt->mgmt.cmd == QLA84_MGMT_READ_MEM) ||
- (ql84_mgmt->mgmt.cmd == QLA84_MGMT_GET_INFO)) {
- bsg_job->reply->reply_payload_rcv_len =
- bsg_job->reply_payload.payload_len;
- sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, mgmt_b,
- data_len);
- }
- }
- done_unmap_sg:
- if (mgmt_b)
- dma_free_coherent(&ha->pdev->dev, data_len, mgmt_b, mgmt_dma);
- if (dma_direction == DMA_TO_DEVICE)
- dma_unmap_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- else if (dma_direction == DMA_FROM_DEVICE)
- dma_unmap_sg(&ha->pdev->dev, bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- exit_mgmt:
- dma_pool_free(ha->s_dma_pool, mn, mn_dma);
- if (!rval)
- bsg_job->job_done(bsg_job);
- return rval;
- }
- static int
- qla24xx_iidma(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- int rval = 0;
- struct qla_port_param *port_param = NULL;
- fc_port_t *fcport = NULL;
- int found = 0;
- uint16_t mb[MAILBOX_REGISTER_COUNT];
- uint8_t *rsp_ptr = NULL;
- if (!IS_IIDMA_CAPABLE(vha->hw)) {
- ql_log(ql_log_info, vha, 0x7046, "iiDMA not supported.\n");
- return -EINVAL;
- }
- port_param = (void *)bsg_job->request + sizeof(struct fc_bsg_request);
- if (port_param->fc_scsi_addr.dest_type != EXT_DEF_TYPE_WWPN) {
- ql_log(ql_log_warn, vha, 0x7048,
- "Invalid destination type.\n");
- return -EINVAL;
- }
- list_for_each_entry(fcport, &vha->vp_fcports, list) {
- if (fcport->port_type != FCT_TARGET)
- continue;
- if (memcmp(port_param->fc_scsi_addr.dest_addr.wwpn,
- fcport->port_name, sizeof(fcport->port_name)))
- continue;
- found = 1;
- break;
- }
- if (!found) {
- ql_log(ql_log_warn, vha, 0x7049,
- "Failed to find port.\n");
- return -EINVAL;
- }
- if (atomic_read(&fcport->state) != FCS_ONLINE) {
- ql_log(ql_log_warn, vha, 0x704a,
- "Port is not online.\n");
- return -EINVAL;
- }
- if (fcport->flags & FCF_LOGIN_NEEDED) {
- ql_log(ql_log_warn, vha, 0x704b,
- "Remote port not logged in flags = 0x%x.\n", fcport->flags);
- return -EINVAL;
- }
- if (port_param->mode)
- rval = qla2x00_set_idma_speed(vha, fcport->loop_id,
- port_param->speed, mb);
- else
- rval = qla2x00_get_idma_speed(vha, fcport->loop_id,
- &port_param->speed, mb);
- if (rval) {
- ql_log(ql_log_warn, vha, 0x704c,
- "iIDMA cmd failed for %8phN -- "
- "%04x %x %04x %04x.\n", fcport->port_name,
- rval, fcport->fp_speed, mb[0], mb[1]);
- rval = (DID_ERROR << 16);
- } else {
- if (!port_param->mode) {
- bsg_job->reply_len = sizeof(struct fc_bsg_reply) +
- sizeof(struct qla_port_param);
- rsp_ptr = ((uint8_t *)bsg_job->reply) +
- sizeof(struct fc_bsg_reply);
- memcpy(rsp_ptr, port_param,
- sizeof(struct qla_port_param));
- }
- bsg_job->reply->result = DID_OK;
- bsg_job->job_done(bsg_job);
- }
- return rval;
- }
- static int
- qla2x00_optrom_setup(struct fc_bsg_job *bsg_job, scsi_qla_host_t *vha,
- uint8_t is_update)
- {
- uint32_t start = 0;
- int valid = 0;
- struct qla_hw_data *ha = vha->hw;
- if (unlikely(pci_channel_offline(ha->pdev)))
- return -EINVAL;
- start = bsg_job->request->rqst_data.h_vendor.vendor_cmd[1];
- if (start > ha->optrom_size) {
- ql_log(ql_log_warn, vha, 0x7055,
- "start %d > optrom_size %d.\n", start, ha->optrom_size);
- return -EINVAL;
- }
- if (ha->optrom_state != QLA_SWAITING) {
- ql_log(ql_log_info, vha, 0x7056,
- "optrom_state %d.\n", ha->optrom_state);
- return -EBUSY;
- }
- ha->optrom_region_start = start;
- ql_dbg(ql_dbg_user, vha, 0x7057, "is_update=%d.\n", is_update);
- if (is_update) {
- if (ha->optrom_size == OPTROM_SIZE_2300 && start == 0)
- valid = 1;
- else if (start == (ha->flt_region_boot * 4) ||
- start == (ha->flt_region_fw * 4))
- valid = 1;
- else if (IS_QLA24XX_TYPE(ha) || IS_QLA25XX(ha) ||
- IS_CNA_CAPABLE(ha) || IS_QLA2031(ha) || IS_QLA27XX(ha))
- valid = 1;
- if (!valid) {
- ql_log(ql_log_warn, vha, 0x7058,
- "Invalid start region 0x%x/0x%x.\n", start,
- bsg_job->request_payload.payload_len);
- return -EINVAL;
- }
- ha->optrom_region_size = start +
- bsg_job->request_payload.payload_len > ha->optrom_size ?
- ha->optrom_size - start :
- bsg_job->request_payload.payload_len;
- ha->optrom_state = QLA_SWRITING;
- } else {
- ha->optrom_region_size = start +
- bsg_job->reply_payload.payload_len > ha->optrom_size ?
- ha->optrom_size - start :
- bsg_job->reply_payload.payload_len;
- ha->optrom_state = QLA_SREADING;
- }
- ha->optrom_buffer = vmalloc(ha->optrom_region_size);
- if (!ha->optrom_buffer) {
- ql_log(ql_log_warn, vha, 0x7059,
- "Read: Unable to allocate memory for optrom retrieval "
- "(%x)\n", ha->optrom_region_size);
- ha->optrom_state = QLA_SWAITING;
- return -ENOMEM;
- }
- memset(ha->optrom_buffer, 0, ha->optrom_region_size);
- return 0;
- }
- static int
- qla2x00_read_optrom(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- if (ha->flags.nic_core_reset_hdlr_active)
- return -EBUSY;
- mutex_lock(&ha->optrom_mutex);
- rval = qla2x00_optrom_setup(bsg_job, vha, 0);
- if (rval) {
- mutex_unlock(&ha->optrom_mutex);
- return rval;
- }
- ha->isp_ops->read_optrom(vha, ha->optrom_buffer,
- ha->optrom_region_start, ha->optrom_region_size);
- sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, ha->optrom_buffer,
- ha->optrom_region_size);
- bsg_job->reply->reply_payload_rcv_len = ha->optrom_region_size;
- bsg_job->reply->result = DID_OK;
- vfree(ha->optrom_buffer);
- ha->optrom_buffer = NULL;
- ha->optrom_state = QLA_SWAITING;
- mutex_unlock(&ha->optrom_mutex);
- bsg_job->job_done(bsg_job);
- return rval;
- }
- static int
- qla2x00_update_optrom(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- mutex_lock(&ha->optrom_mutex);
- rval = qla2x00_optrom_setup(bsg_job, vha, 1);
- if (rval) {
- mutex_unlock(&ha->optrom_mutex);
- return rval;
- }
- /* Set the isp82xx_no_md_cap not to capture minidump */
- ha->flags.isp82xx_no_md_cap = 1;
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, ha->optrom_buffer,
- ha->optrom_region_size);
- ha->isp_ops->write_optrom(vha, ha->optrom_buffer,
- ha->optrom_region_start, ha->optrom_region_size);
- bsg_job->reply->result = DID_OK;
- vfree(ha->optrom_buffer);
- ha->optrom_buffer = NULL;
- ha->optrom_state = QLA_SWAITING;
- mutex_unlock(&ha->optrom_mutex);
- bsg_job->job_done(bsg_job);
- return rval;
- }
- static int
- qla2x00_update_fru_versions(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- uint8_t bsg[DMA_POOL_SIZE];
- struct qla_image_version_list *list = (void *)bsg;
- struct qla_image_version *image;
- uint32_t count;
- dma_addr_t sfp_dma;
- void *sfp = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &sfp_dma);
- if (!sfp) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_NO_MEMORY;
- goto done;
- }
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, list, sizeof(bsg));
- image = list->version;
- count = list->count;
- while (count--) {
- memcpy(sfp, &image->field_info, sizeof(image->field_info));
- rval = qla2x00_write_sfp(vha, sfp_dma, sfp,
- image->field_address.device, image->field_address.offset,
- sizeof(image->field_info), image->field_address.option);
- if (rval) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_MAILBOX;
- goto dealloc;
- }
- image++;
- }
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] = 0;
- dealloc:
- dma_pool_free(ha->s_dma_pool, sfp, sfp_dma);
- done:
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->result = DID_OK << 16;
- bsg_job->job_done(bsg_job);
- return 0;
- }
- static int
- qla2x00_read_fru_status(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- uint8_t bsg[DMA_POOL_SIZE];
- struct qla_status_reg *sr = (void *)bsg;
- dma_addr_t sfp_dma;
- uint8_t *sfp = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &sfp_dma);
- if (!sfp) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_NO_MEMORY;
- goto done;
- }
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, sr, sizeof(*sr));
- rval = qla2x00_read_sfp(vha, sfp_dma, sfp,
- sr->field_address.device, sr->field_address.offset,
- sizeof(sr->status_reg), sr->field_address.option);
- sr->status_reg = *sfp;
- if (rval) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_MAILBOX;
- goto dealloc;
- }
- sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, sr, sizeof(*sr));
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] = 0;
- dealloc:
- dma_pool_free(ha->s_dma_pool, sfp, sfp_dma);
- done:
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->reply_payload_rcv_len = sizeof(*sr);
- bsg_job->reply->result = DID_OK << 16;
- bsg_job->job_done(bsg_job);
- return 0;
- }
- static int
- qla2x00_write_fru_status(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- uint8_t bsg[DMA_POOL_SIZE];
- struct qla_status_reg *sr = (void *)bsg;
- dma_addr_t sfp_dma;
- uint8_t *sfp = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &sfp_dma);
- if (!sfp) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_NO_MEMORY;
- goto done;
- }
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, sr, sizeof(*sr));
- *sfp = sr->status_reg;
- rval = qla2x00_write_sfp(vha, sfp_dma, sfp,
- sr->field_address.device, sr->field_address.offset,
- sizeof(sr->status_reg), sr->field_address.option);
- if (rval) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_MAILBOX;
- goto dealloc;
- }
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] = 0;
- dealloc:
- dma_pool_free(ha->s_dma_pool, sfp, sfp_dma);
- done:
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->result = DID_OK << 16;
- bsg_job->job_done(bsg_job);
- return 0;
- }
- static int
- qla2x00_write_i2c(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- uint8_t bsg[DMA_POOL_SIZE];
- struct qla_i2c_access *i2c = (void *)bsg;
- dma_addr_t sfp_dma;
- uint8_t *sfp = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &sfp_dma);
- if (!sfp) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_NO_MEMORY;
- goto done;
- }
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, i2c, sizeof(*i2c));
- memcpy(sfp, i2c->buffer, i2c->length);
- rval = qla2x00_write_sfp(vha, sfp_dma, sfp,
- i2c->device, i2c->offset, i2c->length, i2c->option);
- if (rval) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_MAILBOX;
- goto dealloc;
- }
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] = 0;
- dealloc:
- dma_pool_free(ha->s_dma_pool, sfp, sfp_dma);
- done:
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->result = DID_OK << 16;
- bsg_job->job_done(bsg_job);
- return 0;
- }
- static int
- qla2x00_read_i2c(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = 0;
- uint8_t bsg[DMA_POOL_SIZE];
- struct qla_i2c_access *i2c = (void *)bsg;
- dma_addr_t sfp_dma;
- uint8_t *sfp = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &sfp_dma);
- if (!sfp) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_NO_MEMORY;
- goto done;
- }
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, i2c, sizeof(*i2c));
- rval = qla2x00_read_sfp(vha, sfp_dma, sfp,
- i2c->device, i2c->offset, i2c->length, i2c->option);
- if (rval) {
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- EXT_STATUS_MAILBOX;
- goto dealloc;
- }
- memcpy(i2c->buffer, sfp, i2c->length);
- sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, i2c, sizeof(*i2c));
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] = 0;
- dealloc:
- dma_pool_free(ha->s_dma_pool, sfp, sfp_dma);
- done:
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->reply_payload_rcv_len = sizeof(*i2c);
- bsg_job->reply->result = DID_OK << 16;
- bsg_job->job_done(bsg_job);
- return 0;
- }
- static int
- qla24xx_process_bidir_cmd(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- uint32_t rval = EXT_STATUS_OK;
- uint16_t req_sg_cnt = 0;
- uint16_t rsp_sg_cnt = 0;
- uint16_t nextlid = 0;
- uint32_t tot_dsds;
- srb_t *sp = NULL;
- uint32_t req_data_len = 0;
- uint32_t rsp_data_len = 0;
- /* Check the type of the adapter */
- if (!IS_BIDI_CAPABLE(ha)) {
- ql_log(ql_log_warn, vha, 0x70a0,
- "This adapter is not supported\n");
- rval = EXT_STATUS_NOT_SUPPORTED;
- goto done;
- }
- if (test_bit(ISP_ABORT_NEEDED, &vha->dpc_flags) ||
- test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags) ||
- test_bit(ISP_ABORT_RETRY, &vha->dpc_flags)) {
- rval = EXT_STATUS_BUSY;
- goto done;
- }
- /* Check if host is online */
- if (!vha->flags.online) {
- ql_log(ql_log_warn, vha, 0x70a1,
- "Host is not online\n");
- rval = EXT_STATUS_DEVICE_OFFLINE;
- goto done;
- }
- /* Check if cable is plugged in or not */
- if (vha->device_flags & DFLG_NO_CABLE) {
- ql_log(ql_log_warn, vha, 0x70a2,
- "Cable is unplugged...\n");
- rval = EXT_STATUS_INVALID_CFG;
- goto done;
- }
- /* Check if the switch is connected or not */
- if (ha->current_topology != ISP_CFG_F) {
- ql_log(ql_log_warn, vha, 0x70a3,
- "Host is not connected to the switch\n");
- rval = EXT_STATUS_INVALID_CFG;
- goto done;
- }
- /* Check if operating mode is P2P */
- if (ha->operating_mode != P2P) {
- ql_log(ql_log_warn, vha, 0x70a4,
- "Host is operating mode is not P2p\n");
- rval = EXT_STATUS_INVALID_CFG;
- goto done;
- }
- mutex_lock(&ha->selflogin_lock);
- if (vha->self_login_loop_id == 0) {
- /* Initialize all required fields of fcport */
- vha->bidir_fcport.vha = vha;
- vha->bidir_fcport.d_id.b.al_pa = vha->d_id.b.al_pa;
- vha->bidir_fcport.d_id.b.area = vha->d_id.b.area;
- vha->bidir_fcport.d_id.b.domain = vha->d_id.b.domain;
- vha->bidir_fcport.loop_id = vha->loop_id;
- if (qla2x00_fabric_login(vha, &(vha->bidir_fcport), &nextlid)) {
- ql_log(ql_log_warn, vha, 0x70a7,
- "Failed to login port %06X for bidirectional IOCB\n",
- vha->bidir_fcport.d_id.b24);
- mutex_unlock(&ha->selflogin_lock);
- rval = EXT_STATUS_MAILBOX;
- goto done;
- }
- vha->self_login_loop_id = nextlid - 1;
- }
- /* Assign the self login loop id to fcport */
- mutex_unlock(&ha->selflogin_lock);
- vha->bidir_fcport.loop_id = vha->self_login_loop_id;
- req_sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt,
- DMA_TO_DEVICE);
- if (!req_sg_cnt) {
- rval = EXT_STATUS_NO_MEMORY;
- goto done;
- }
- rsp_sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list, bsg_job->reply_payload.sg_cnt,
- DMA_FROM_DEVICE);
- if (!rsp_sg_cnt) {
- rval = EXT_STATUS_NO_MEMORY;
- goto done_unmap_req_sg;
- }
- if ((req_sg_cnt != bsg_job->request_payload.sg_cnt) ||
- (rsp_sg_cnt != bsg_job->reply_payload.sg_cnt)) {
- ql_dbg(ql_dbg_user, vha, 0x70a9,
- "Dma mapping resulted in different sg counts "
- "[request_sg_cnt: %x dma_request_sg_cnt: %x reply_sg_cnt: "
- "%x dma_reply_sg_cnt: %x]\n",
- bsg_job->request_payload.sg_cnt, req_sg_cnt,
- bsg_job->reply_payload.sg_cnt, rsp_sg_cnt);
- rval = EXT_STATUS_NO_MEMORY;
- goto done_unmap_sg;
- }
- if (req_data_len != rsp_data_len) {
- rval = EXT_STATUS_BUSY;
- ql_log(ql_log_warn, vha, 0x70aa,
- "req_data_len != rsp_data_len\n");
- goto done_unmap_sg;
- }
- req_data_len = bsg_job->request_payload.payload_len;
- rsp_data_len = bsg_job->reply_payload.payload_len;
- /* Alloc SRB structure */
- sp = qla2x00_get_sp(vha, &(vha->bidir_fcport), GFP_KERNEL);
- if (!sp) {
- ql_dbg(ql_dbg_user, vha, 0x70ac,
- "Alloc SRB structure failed\n");
- rval = EXT_STATUS_NO_MEMORY;
- goto done_unmap_sg;
- }
- /*Populate srb->ctx with bidir ctx*/
- sp->u.bsg_job = bsg_job;
- sp->free = qla2x00_bsg_sp_free;
- sp->type = SRB_BIDI_CMD;
- sp->done = qla2x00_bsg_job_done;
- /* Add the read and write sg count */
- tot_dsds = rsp_sg_cnt + req_sg_cnt;
- rval = qla2x00_start_bidir(sp, vha, tot_dsds);
- if (rval != EXT_STATUS_OK)
- goto done_free_srb;
- /* the bsg request will be completed in the interrupt handler */
- return rval;
- done_free_srb:
- mempool_free(sp, ha->srb_mempool);
- done_unmap_sg:
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- done_unmap_req_sg:
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- done:
- /* Return an error vendor specific response
- * and complete the bsg request
- */
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] = rval;
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->reply_payload_rcv_len = 0;
- bsg_job->reply->result = (DID_OK) << 16;
- bsg_job->job_done(bsg_job);
- /* Always return success, vendor rsp carries correct status */
- return 0;
- }
- static int
- qlafx00_mgmt_cmd(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- struct qla_hw_data *ha = vha->hw;
- int rval = (DRIVER_ERROR << 16);
- struct qla_mt_iocb_rqst_fx00 *piocb_rqst;
- srb_t *sp;
- int req_sg_cnt = 0, rsp_sg_cnt = 0;
- struct fc_port *fcport;
- char *type = "FC_BSG_HST_FX_MGMT";
- /* Copy the IOCB specific information */
- piocb_rqst = (struct qla_mt_iocb_rqst_fx00 *)
- &bsg_job->request->rqst_data.h_vendor.vendor_cmd[1];
- /* Dump the vendor information */
- ql_dump_buffer(ql_dbg_user + ql_dbg_verbose , vha, 0x70cf,
- (uint8_t *)piocb_rqst, sizeof(struct qla_mt_iocb_rqst_fx00));
- if (!vha->flags.online) {
- ql_log(ql_log_warn, vha, 0x70d0,
- "Host is not online.\n");
- rval = -EIO;
- goto done;
- }
- if (piocb_rqst->flags & SRB_FXDISC_REQ_DMA_VALID) {
- req_sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- if (!req_sg_cnt) {
- ql_log(ql_log_warn, vha, 0x70c7,
- "dma_map_sg return %d for request\n", req_sg_cnt);
- rval = -ENOMEM;
- goto done;
- }
- }
- if (piocb_rqst->flags & SRB_FXDISC_RESP_DMA_VALID) {
- rsp_sg_cnt = dma_map_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- if (!rsp_sg_cnt) {
- ql_log(ql_log_warn, vha, 0x70c8,
- "dma_map_sg return %d for reply\n", rsp_sg_cnt);
- rval = -ENOMEM;
- goto done_unmap_req_sg;
- }
- }
- ql_dbg(ql_dbg_user, vha, 0x70c9,
- "request_sg_cnt: %x dma_request_sg_cnt: %x reply_sg_cnt:%x "
- "dma_reply_sg_cnt: %x\n", bsg_job->request_payload.sg_cnt,
- req_sg_cnt, bsg_job->reply_payload.sg_cnt, rsp_sg_cnt);
- /* Allocate a dummy fcport structure, since functions preparing the
- * IOCB and mailbox command retrieves port specific information
- * from fcport structure. For Host based ELS commands there will be
- * no fcport structure allocated
- */
- fcport = qla2x00_alloc_fcport(vha, GFP_KERNEL);
- if (!fcport) {
- ql_log(ql_log_warn, vha, 0x70ca,
- "Failed to allocate fcport.\n");
- rval = -ENOMEM;
- goto done_unmap_rsp_sg;
- }
- /* Alloc SRB structure */
- sp = qla2x00_get_sp(vha, fcport, GFP_KERNEL);
- if (!sp) {
- ql_log(ql_log_warn, vha, 0x70cb,
- "qla2x00_get_sp failed.\n");
- rval = -ENOMEM;
- goto done_free_fcport;
- }
- /* Initialize all required fields of fcport */
- fcport->vha = vha;
- fcport->loop_id = piocb_rqst->dataword;
- sp->type = SRB_FXIOCB_BCMD;
- sp->name = "bsg_fx_mgmt";
- sp->iocbs = qla24xx_calc_ct_iocbs(req_sg_cnt + rsp_sg_cnt);
- sp->u.bsg_job = bsg_job;
- sp->free = qla2x00_bsg_sp_free;
- sp->done = qla2x00_bsg_job_done;
- ql_dbg(ql_dbg_user, vha, 0x70cc,
- "bsg rqst type: %s fx_mgmt_type: %x id=%x\n",
- type, piocb_rqst->func_type, fcport->loop_id);
- rval = qla2x00_start_sp(sp);
- if (rval != QLA_SUCCESS) {
- ql_log(ql_log_warn, vha, 0x70cd,
- "qla2x00_start_sp failed=%d.\n", rval);
- mempool_free(sp, ha->srb_mempool);
- rval = -EIO;
- goto done_free_fcport;
- }
- return rval;
- done_free_fcport:
- kfree(fcport);
- done_unmap_rsp_sg:
- if (piocb_rqst->flags & SRB_FXDISC_RESP_DMA_VALID)
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
- done_unmap_req_sg:
- if (piocb_rqst->flags & SRB_FXDISC_REQ_DMA_VALID)
- dma_unmap_sg(&ha->pdev->dev,
- bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
- done:
- return rval;
- }
- static int
- qla26xx_serdes_op(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- int rval = 0;
- struct qla_serdes_reg sr;
- memset(&sr, 0, sizeof(sr));
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, &sr, sizeof(sr));
- switch (sr.cmd) {
- case INT_SC_SERDES_WRITE_REG:
- rval = qla2x00_write_serdes_word(vha, sr.addr, sr.val);
- bsg_job->reply->reply_payload_rcv_len = 0;
- break;
- case INT_SC_SERDES_READ_REG:
- rval = qla2x00_read_serdes_word(vha, sr.addr, &sr.val);
- sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, &sr, sizeof(sr));
- bsg_job->reply->reply_payload_rcv_len = sizeof(sr);
- break;
- default:
- ql_dbg(ql_dbg_user, vha, 0x708c,
- "Unknown serdes cmd %x.\n", sr.cmd);
- rval = -EINVAL;
- break;
- }
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- rval ? EXT_STATUS_MAILBOX : 0;
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->result = DID_OK << 16;
- bsg_job->job_done(bsg_job);
- return 0;
- }
- static int
- qla8044_serdes_op(struct fc_bsg_job *bsg_job)
- {
- struct Scsi_Host *host = bsg_job->shost;
- scsi_qla_host_t *vha = shost_priv(host);
- int rval = 0;
- struct qla_serdes_reg_ex sr;
- memset(&sr, 0, sizeof(sr));
- sg_copy_to_buffer(bsg_job->request_payload.sg_list,
- bsg_job->request_payload.sg_cnt, &sr, sizeof(sr));
- switch (sr.cmd) {
- case INT_SC_SERDES_WRITE_REG:
- rval = qla8044_write_serdes_word(vha, sr.addr, sr.val);
- bsg_job->reply->reply_payload_rcv_len = 0;
- break;
- case INT_SC_SERDES_READ_REG:
- rval = qla8044_read_serdes_word(vha, sr.addr, &sr.val);
- sg_copy_from_buffer(bsg_job->reply_payload.sg_list,
- bsg_job->reply_payload.sg_cnt, &sr, sizeof(sr));
- bsg_job->reply->reply_payload_rcv_len = sizeof(sr);
- break;
- default:
- ql_dbg(ql_dbg_user, vha, 0x70cf,
- "Unknown serdes cmd %x.\n", sr.cmd);
- rval = -EINVAL;
- break;
- }
- bsg_job->reply->reply_data.vendor_reply.vendor_rsp[0] =
- rval ? EXT_STATUS_MAILBOX : 0;
- bsg_job->reply_len = sizeof(struct fc_bsg_reply);
- bsg_job->reply->result = DID_OK << 16;
- bsg_job->job_done(bsg_job);
- return 0;
- }
- static int
- qla2x00_process_vendor_specific(struct fc_bsg_job *bsg_job)
- {
- switch (bsg_job->request->rqst_data.h_vendor.vendor_cmd[0]) {
- case QL_VND_LOOPBACK:
- return qla2x00_process_loopback(bsg_job);
- case QL_VND_A84_RESET:
- return qla84xx_reset(bsg_job);
- case QL_VND_A84_UPDATE_FW:
- return qla84xx_updatefw(bsg_job);
- case QL_VND_A84_MGMT_CMD:
- return qla84xx_mgmt_cmd(bsg_job);
- case QL_VND_IIDMA:
- return qla24xx_iidma(bsg_job);
- case QL_VND_FCP_PRIO_CFG_CMD:
- return qla24xx_proc_fcp_prio_cfg_cmd(bsg_job);
- case QL_VND_READ_FLASH:
- return qla2x00_read_optrom(bsg_job);
- case QL_VND_UPDATE_FLASH:
- return qla2x00_update_optrom(bsg_job);
- case QL_VND_SET_FRU_VERSION:
- return qla2x00_update_fru_versions(bsg_job);
- case QL_VND_READ_FRU_STATUS:
- return qla2x00_read_fru_status(bsg_job);
- case QL_VND_WRITE_FRU_STATUS:
- return qla2x00_write_fru_status(bsg_job);
- case QL_VND_WRITE_I2C:
- return qla2x00_write_i2c(bsg_job);
- case QL_VND_READ_I2C:
- return qla2x00_read_i2c(bsg_job);
- case QL_VND_DIAG_IO_CMD:
- return qla24xx_process_bidir_cmd(bsg_job);
- case QL_VND_FX00_MGMT_CMD:
- return qlafx00_mgmt_cmd(bsg_job);
- case QL_VND_SERDES_OP:
- return qla26xx_serdes_op(bsg_job);
- case QL_VND_SERDES_OP_EX:
- return qla8044_serdes_op(bsg_job);
- default:
- return -ENOSYS;
- }
- }
- int
- qla24xx_bsg_request(struct fc_bsg_job *bsg_job)
- {
- int ret = -EINVAL;
- struct fc_rport *rport;
- struct Scsi_Host *host;
- scsi_qla_host_t *vha;
- /* In case no data transferred. */
- bsg_job->reply->reply_payload_rcv_len = 0;
- if (bsg_job->request->msgcode == FC_BSG_RPT_ELS) {
- rport = bsg_job->rport;
- host = rport_to_shost(rport);
- vha = shost_priv(host);
- } else {
- host = bsg_job->shost;
- vha = shost_priv(host);
- }
- if (qla2x00_reset_active(vha)) {
- ql_dbg(ql_dbg_user, vha, 0x709f,
- "BSG: ISP abort active/needed -- cmd=%d.\n",
- bsg_job->request->msgcode);
- return -EBUSY;
- }
- ql_dbg(ql_dbg_user, vha, 0x7000,
- "Entered %s msgcode=0x%x.\n", __func__, bsg_job->request->msgcode);
- switch (bsg_job->request->msgcode) {
- case FC_BSG_RPT_ELS:
- case FC_BSG_HST_ELS_NOLOGIN:
- ret = qla2x00_process_els(bsg_job);
- break;
- case FC_BSG_HST_CT:
- ret = qla2x00_process_ct(bsg_job);
- break;
- case FC_BSG_HST_VENDOR:
- ret = qla2x00_process_vendor_specific(bsg_job);
- break;
- case FC_BSG_HST_ADD_RPORT:
- case FC_BSG_HST_DEL_RPORT:
- case FC_BSG_RPT_CT:
- default:
- ql_log(ql_log_warn, vha, 0x705a, "Unsupported BSG request.\n");
- break;
- }
- return ret;
- }
- int
- qla24xx_bsg_timeout(struct fc_bsg_job *bsg_job)
- {
- scsi_qla_host_t *vha = shost_priv(bsg_job->shost);
- struct qla_hw_data *ha = vha->hw;
- srb_t *sp;
- int cnt, que;
- unsigned long flags;
- struct req_que *req;
- /* find the bsg job from the active list of commands */
- spin_lock_irqsave(&ha->hardware_lock, flags);
- for (que = 0; que < ha->max_req_queues; que++) {
- req = ha->req_q_map[que];
- if (!req)
- continue;
- for (cnt = 1; cnt < req->num_outstanding_cmds; cnt++) {
- sp = req->outstanding_cmds[cnt];
- if (sp) {
- if (((sp->type == SRB_CT_CMD) ||
- (sp->type == SRB_ELS_CMD_HST) ||
- (sp->type == SRB_FXIOCB_BCMD))
- && (sp->u.bsg_job == bsg_job)) {
- req->outstanding_cmds[cnt] = NULL;
- spin_unlock_irqrestore(&ha->hardware_lock, flags);
- if (ha->isp_ops->abort_command(sp)) {
- ql_log(ql_log_warn, vha, 0x7089,
- "mbx abort_command "
- "failed.\n");
- bsg_job->req->errors =
- bsg_job->reply->result = -EIO;
- } else {
- ql_dbg(ql_dbg_user, vha, 0x708a,
- "mbx abort_command "
- "success.\n");
- bsg_job->req->errors =
- bsg_job->reply->result = 0;
- }
- spin_lock_irqsave(&ha->hardware_lock, flags);
- goto done;
- }
- }
- }
- }
- spin_unlock_irqrestore(&ha->hardware_lock, flags);
- ql_log(ql_log_info, vha, 0x708b, "SRB not found to abort.\n");
- bsg_job->req->errors = bsg_job->reply->result = -ENXIO;
- return 0;
- done:
- spin_unlock_irqrestore(&ha->hardware_lock, flags);
- sp->free(vha, sp);
- return 0;
- }
|