1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright(c) 2007 Intel Corporation. All rights reserved.
- *
- * Maintained at www.Open-FCoE.org
- */
- /*
- * PORT LOCKING NOTES
- *
- * These comments only apply to the 'port code' which consists of the lport,
- * disc and rport blocks.
- *
- * MOTIVATION
- *
- * The lport, disc and rport blocks all have mutexes that are used to protect
- * those objects. The main motivation for these locks is to prevent from
- * having an lport reset just before we send a frame. In that scenario the
- * lport's FID would get set to zero and then we'd send a frame with an
- * invalid SID. We also need to ensure that states don't change unexpectedly
- * while processing another state.
- *
- * HIERARCHY
- *
- * The following hierarchy defines the locking rules. A greater lock
- * may be held before acquiring a lesser lock, but a lesser lock should never
- * be held while attempting to acquire a greater lock. Here is the hierarchy-
- *
- * lport > disc, lport > rport, disc > rport
- *
- * CALLBACKS
- *
- * The callbacks cause complications with this scheme. There is a callback
- * from the rport (to either lport or disc) and a callback from disc
- * (to the lport).
- *
- * As rports exit the rport state machine a callback is made to the owner of
- * the rport to notify success or failure. Since the callback is likely to
- * cause the lport or disc to grab its lock we cannot hold the rport lock
- * while making the callback. To ensure that the rport is not free'd while
- * processing the callback the rport callbacks are serialized through a
- * single-threaded workqueue. An rport would never be free'd while in a
- * callback handler because no other rport work in this queue can be executed
- * at the same time.
- *
- * When discovery succeeds or fails a callback is made to the lport as
- * notification. Currently, successful discovery causes the lport to take no
- * action. A failure will cause the lport to reset. There is likely a circular
- * locking problem with this implementation.
- */
- /*
- * LPORT LOCKING
- *
- * The critical sections protected by the lport's mutex are quite broad and
- * may be improved upon in the future. The lport code and its locking doesn't
- * influence the I/O path, so excessive locking doesn't penalize I/O
- * performance.
- *
- * The strategy is to lock whenever processing a request or response. Note
- * that every _enter_* function corresponds to a state change. They generally
- * change the lports state and then send a request out on the wire. We lock
- * before calling any of these functions to protect that state change. This
- * means that the entry points into the lport block manage the locks while
- * the state machine can transition between states (i.e. _enter_* functions)
- * while always staying protected.
- *
- * When handling responses we also hold the lport mutex broadly. When the
- * lport receives the response frame it locks the mutex and then calls the
- * appropriate handler for the particuar response. Generally a response will
- * trigger a state change and so the lock must already be held.
- *
- * Retries also have to consider the locking. The retries occur from a work
- * context and the work function will lock the lport and then retry the state
- * (i.e. _enter_* function).
- */
- #include <linux/timer.h>
- #include <linux/delay.h>
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <asm/unaligned.h>
- #include <scsi/fc/fc_gs.h>
- #include <scsi/libfc.h>
- #include <linux/scatterlist.h>
- #include "fc_encode.h"
- #include "fc_libfc.h"
- /* Fabric IDs to use for point-to-point mode, chosen on whims. */
- #define FC_LOCAL_PTP_FID_LO 0x010101
- #define FC_LOCAL_PTP_FID_HI 0x010102
- #define DNS_DELAY 3 /* Discovery delay after RSCN (in seconds)*/
- #define MAX_CT_PAYLOAD 2048
- #define DISCOVERED_PORTS 4
- #define NUMBER_OF_PORTS 1
- static void fc_lport_error(struct fc_lport *, struct fc_frame *);
- static void fc_lport_enter_reset(struct fc_lport *);
- static void fc_lport_enter_flogi(struct fc_lport *);
- static void fc_lport_enter_dns(struct fc_lport *);
- static void fc_lport_enter_ns(struct fc_lport *, enum fc_lport_state);
- static void fc_lport_enter_scr(struct fc_lport *);
- static void fc_lport_enter_ready(struct fc_lport *);
- static void fc_lport_enter_logo(struct fc_lport *);
- static void fc_lport_enter_fdmi(struct fc_lport *lport);
- static void fc_lport_enter_ms(struct fc_lport *, enum fc_lport_state);
- static const char *fc_lport_state_names[] = {
- [LPORT_ST_DISABLED] = "disabled",
- [LPORT_ST_FLOGI] = "FLOGI",
- [LPORT_ST_DNS] = "dNS",
- [LPORT_ST_RNN_ID] = "RNN_ID",
- [LPORT_ST_RSNN_NN] = "RSNN_NN",
- [LPORT_ST_RSPN_ID] = "RSPN_ID",
- [LPORT_ST_RFT_ID] = "RFT_ID",
- [LPORT_ST_RFF_ID] = "RFF_ID",
- [LPORT_ST_FDMI] = "FDMI",
- [LPORT_ST_RHBA] = "RHBA",
- [LPORT_ST_RPA] = "RPA",
- [LPORT_ST_DHBA] = "DHBA",
- [LPORT_ST_DPRT] = "DPRT",
- [LPORT_ST_SCR] = "SCR",
- [LPORT_ST_READY] = "Ready",
- [LPORT_ST_LOGO] = "LOGO",
- [LPORT_ST_RESET] = "reset",
- };
- /**
- * struct fc_bsg_info - FC Passthrough managemet structure
- * @job: The passthrough job
- * @lport: The local port to pass through a command
- * @rsp_code: The expected response code
- * @sg: job->reply_payload.sg_list
- * @nents: job->reply_payload.sg_cnt
- * @offset: The offset into the response data
- */
- struct fc_bsg_info {
- struct bsg_job *job;
- struct fc_lport *lport;
- u16 rsp_code;
- struct scatterlist *sg;
- u32 nents;
- size_t offset;
- };
- /**
- * fc_frame_drop() - Dummy frame handler
- * @lport: The local port the frame was received on
- * @fp: The received frame
- */
- static int fc_frame_drop(struct fc_lport *lport, struct fc_frame *fp)
- {
- fc_frame_free(fp);
- return 0;
- }
- /**
- * fc_lport_rport_callback() - Event handler for rport events
- * @lport: The lport which is receiving the event
- * @rdata: private remote port data
- * @event: The event that occurred
- *
- * Locking Note: The rport lock should not be held when calling
- * this function.
- */
- static void fc_lport_rport_callback(struct fc_lport *lport,
- struct fc_rport_priv *rdata,
- enum fc_rport_event event)
- {
- FC_LPORT_DBG(lport, "Received a %d event for port (%6.6x)\n", event,
- rdata->ids.port_id);
- mutex_lock(&lport->lp_mutex);
- switch (event) {
- case RPORT_EV_READY:
- if (lport->state == LPORT_ST_DNS) {
- lport->dns_rdata = rdata;
- fc_lport_enter_ns(lport, LPORT_ST_RNN_ID);
- } else if (lport->state == LPORT_ST_FDMI) {
- lport->ms_rdata = rdata;
- fc_lport_enter_ms(lport, LPORT_ST_DHBA);
- } else {
- FC_LPORT_DBG(lport, "Received an READY event "
- "on port (%6.6x) for the directory "
- "server, but the lport is not "
- "in the DNS or FDMI state, it's in the "
- "%d state", rdata->ids.port_id,
- lport->state);
- fc_rport_logoff(rdata);
- }
- break;
- case RPORT_EV_LOGO:
- case RPORT_EV_FAILED:
- case RPORT_EV_STOP:
- if (rdata->ids.port_id == FC_FID_DIR_SERV)
- lport->dns_rdata = NULL;
- else if (rdata->ids.port_id == FC_FID_MGMT_SERV)
- lport->ms_rdata = NULL;
- break;
- case RPORT_EV_NONE:
- break;
- }
- mutex_unlock(&lport->lp_mutex);
- }
- /**
- * fc_lport_state() - Return a string which represents the lport's state
- * @lport: The lport whose state is to converted to a string
- */
- static const char *fc_lport_state(struct fc_lport *lport)
- {
- const char *cp;
- cp = fc_lport_state_names[lport->state];
- if (!cp)
- cp = "unknown";
- return cp;
- }
- /**
- * fc_lport_ptp_setup() - Create an rport for point-to-point mode
- * @lport: The lport to attach the ptp rport to
- * @remote_fid: The FID of the ptp rport
- * @remote_wwpn: The WWPN of the ptp rport
- * @remote_wwnn: The WWNN of the ptp rport
- */
- static void fc_lport_ptp_setup(struct fc_lport *lport,
- u32 remote_fid, u64 remote_wwpn,
- u64 remote_wwnn)
- {
- lockdep_assert_held(&lport->lp_mutex);
- if (lport->ptp_rdata) {
- fc_rport_logoff(lport->ptp_rdata);
- kref_put(&lport->ptp_rdata->kref, fc_rport_destroy);
- }
- mutex_lock(&lport->disc.disc_mutex);
- lport->ptp_rdata = fc_rport_create(lport, remote_fid);
- if (!lport->ptp_rdata) {
- printk(KERN_WARNING "libfc: Failed to setup lport 0x%x\n",
- lport->port_id);
- mutex_unlock(&lport->disc.disc_mutex);
- return;
- }
- kref_get(&lport->ptp_rdata->kref);
- lport->ptp_rdata->ids.port_name = remote_wwpn;
- lport->ptp_rdata->ids.node_name = remote_wwnn;
- mutex_unlock(&lport->disc.disc_mutex);
- fc_rport_login(lport->ptp_rdata);
- fc_lport_enter_ready(lport);
- }
- /**
- * fc_get_host_port_state() - Return the port state of the given Scsi_Host
- * @shost: The SCSI host whose port state is to be determined
- */
- void fc_get_host_port_state(struct Scsi_Host *shost)
- {
- struct fc_lport *lport = shost_priv(shost);
- mutex_lock(&lport->lp_mutex);
- if (!lport->link_up)
- fc_host_port_state(shost) = FC_PORTSTATE_LINKDOWN;
- else
- switch (lport->state) {
- case LPORT_ST_READY:
- fc_host_port_state(shost) = FC_PORTSTATE_ONLINE;
- break;
- default:
- fc_host_port_state(shost) = FC_PORTSTATE_OFFLINE;
- }
- mutex_unlock(&lport->lp_mutex);
- }
- EXPORT_SYMBOL(fc_get_host_port_state);
- /**
- * fc_get_host_speed() - Return the speed of the given Scsi_Host
- * @shost: The SCSI host whose port speed is to be determined
- */
- void fc_get_host_speed(struct Scsi_Host *shost)
- {
- struct fc_lport *lport = shost_priv(shost);
- fc_host_speed(shost) = lport->link_speed;
- }
- EXPORT_SYMBOL(fc_get_host_speed);
- /**
- * fc_get_host_stats() - Return the Scsi_Host's statistics
- * @shost: The SCSI host whose statistics are to be returned
- */
- struct fc_host_statistics *fc_get_host_stats(struct Scsi_Host *shost)
- {
- struct fc_host_statistics *fc_stats;
- struct fc_lport *lport = shost_priv(shost);
- unsigned int cpu;
- u64 fcp_in_bytes = 0;
- u64 fcp_out_bytes = 0;
- fc_stats = &lport->host_stats;
- memset(fc_stats, 0, sizeof(struct fc_host_statistics));
- fc_stats->seconds_since_last_reset = (jiffies - lport->boot_time) / HZ;
- for_each_possible_cpu(cpu) {
- struct fc_stats *stats;
- stats = per_cpu_ptr(lport->stats, cpu);
- fc_stats->tx_frames += READ_ONCE(stats->TxFrames);
- fc_stats->tx_words += READ_ONCE(stats->TxWords);
- fc_stats->rx_frames += READ_ONCE(stats->RxFrames);
- fc_stats->rx_words += READ_ONCE(stats->RxWords);
- fc_stats->error_frames += READ_ONCE(stats->ErrorFrames);
- fc_stats->invalid_crc_count += READ_ONCE(stats->InvalidCRCCount);
- fc_stats->fcp_input_requests += READ_ONCE(stats->InputRequests);
- fc_stats->fcp_output_requests += READ_ONCE(stats->OutputRequests);
- fc_stats->fcp_control_requests += READ_ONCE(stats->ControlRequests);
- fcp_in_bytes += READ_ONCE(stats->InputBytes);
- fcp_out_bytes += READ_ONCE(stats->OutputBytes);
- fc_stats->fcp_packet_alloc_failures += READ_ONCE(stats->FcpPktAllocFails);
- fc_stats->fcp_packet_aborts += READ_ONCE(stats->FcpPktAborts);
- fc_stats->fcp_frame_alloc_failures += READ_ONCE(stats->FcpFrameAllocFails);
- fc_stats->link_failure_count += READ_ONCE(stats->LinkFailureCount);
- }
- fc_stats->fcp_input_megabytes = div_u64(fcp_in_bytes, 1000000);
- fc_stats->fcp_output_megabytes = div_u64(fcp_out_bytes, 1000000);
- fc_stats->lip_count = -1;
- fc_stats->nos_count = -1;
- fc_stats->loss_of_sync_count = -1;
- fc_stats->loss_of_signal_count = -1;
- fc_stats->prim_seq_protocol_err_count = -1;
- fc_stats->dumped_frames = -1;
- /* update exches stats */
- fc_exch_update_stats(lport);
- return fc_stats;
- }
- EXPORT_SYMBOL(fc_get_host_stats);
- /**
- * fc_lport_flogi_fill() - Fill in FLOGI command for request
- * @lport: The local port the FLOGI is for
- * @flogi: The FLOGI command
- * @op: The opcode
- */
- static void fc_lport_flogi_fill(struct fc_lport *lport,
- struct fc_els_flogi *flogi,
- unsigned int op)
- {
- struct fc_els_csp *sp;
- struct fc_els_cssp *cp;
- memset(flogi, 0, sizeof(*flogi));
- flogi->fl_cmd = (u8) op;
- put_unaligned_be64(lport->wwpn, &flogi->fl_wwpn);
- put_unaligned_be64(lport->wwnn, &flogi->fl_wwnn);
- sp = &flogi->fl_csp;
- sp->sp_hi_ver = 0x20;
- sp->sp_lo_ver = 0x20;
- sp->sp_bb_cred = htons(10); /* this gets set by gateway */
- sp->sp_bb_data = htons((u16) lport->mfs);
- cp = &flogi->fl_cssp[3 - 1]; /* class 3 parameters */
- cp->cp_class = htons(FC_CPC_VALID | FC_CPC_SEQ);
- if (op != ELS_FLOGI) {
- sp->sp_features = htons(FC_SP_FT_CIRO);
- sp->sp_tot_seq = htons(255); /* seq. we accept */
- sp->sp_rel_off = htons(0x1f);
- sp->sp_e_d_tov = htonl(lport->e_d_tov);
- cp->cp_rdfs = htons((u16) lport->mfs);
- cp->cp_con_seq = htons(255);
- cp->cp_open_seq = 1;
- }
- }
- /**
- * fc_lport_add_fc4_type() - Add a supported FC-4 type to a local port
- * @lport: The local port to add a new FC-4 type to
- * @type: The new FC-4 type
- */
- static void fc_lport_add_fc4_type(struct fc_lport *lport, enum fc_fh_type type)
- {
- __be32 *mp;
- mp = &lport->fcts.ff_type_map[type / FC_NS_BPW];
- *mp = htonl(ntohl(*mp) | 1UL << (type % FC_NS_BPW));
- }
- /**
- * fc_lport_recv_rlir_req() - Handle received Registered Link Incident Report.
- * @lport: Fibre Channel local port receiving the RLIR
- * @fp: The RLIR request frame
- */
- static void fc_lport_recv_rlir_req(struct fc_lport *lport, struct fc_frame *fp)
- {
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Received RLIR request while in state %s\n",
- fc_lport_state(lport));
- fc_seq_els_rsp_send(fp, ELS_LS_ACC, NULL);
- fc_frame_free(fp);
- }
- /**
- * fc_lport_recv_echo_req() - Handle received ECHO request
- * @lport: The local port receiving the ECHO
- * @in_fp: ECHO request frame
- */
- static void fc_lport_recv_echo_req(struct fc_lport *lport,
- struct fc_frame *in_fp)
- {
- struct fc_frame *fp;
- unsigned int len;
- void *pp;
- void *dp;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Received ECHO request while in state %s\n",
- fc_lport_state(lport));
- len = fr_len(in_fp) - sizeof(struct fc_frame_header);
- pp = fc_frame_payload_get(in_fp, len);
- if (len < sizeof(__be32))
- len = sizeof(__be32);
- fp = fc_frame_alloc(lport, len);
- if (fp) {
- dp = fc_frame_payload_get(fp, len);
- memcpy(dp, pp, len);
- *((__be32 *)dp) = htonl(ELS_LS_ACC << 24);
- fc_fill_reply_hdr(fp, in_fp, FC_RCTL_ELS_REP, 0);
- lport->tt.frame_send(lport, fp);
- }
- fc_frame_free(in_fp);
- }
- /**
- * fc_lport_recv_rnid_req() - Handle received Request Node ID data request
- * @lport: The local port receiving the RNID
- * @in_fp: The RNID request frame
- */
- static void fc_lport_recv_rnid_req(struct fc_lport *lport,
- struct fc_frame *in_fp)
- {
- struct fc_frame *fp;
- struct fc_els_rnid *req;
- struct {
- struct fc_els_rnid_resp rnid;
- struct fc_els_rnid_cid cid;
- struct fc_els_rnid_gen gen;
- } *rp;
- struct fc_seq_els_data rjt_data;
- u8 fmt;
- size_t len;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Received RNID request while in state %s\n",
- fc_lport_state(lport));
- req = fc_frame_payload_get(in_fp, sizeof(*req));
- if (!req) {
- rjt_data.reason = ELS_RJT_LOGIC;
- rjt_data.explan = ELS_EXPL_NONE;
- fc_seq_els_rsp_send(in_fp, ELS_LS_RJT, &rjt_data);
- } else {
- fmt = req->rnid_fmt;
- len = sizeof(*rp);
- if (fmt != ELS_RNIDF_GEN ||
- ntohl(lport->rnid_gen.rnid_atype) == 0) {
- fmt = ELS_RNIDF_NONE; /* nothing to provide */
- len -= sizeof(rp->gen);
- }
- fp = fc_frame_alloc(lport, len);
- if (fp) {
- rp = fc_frame_payload_get(fp, len);
- memset(rp, 0, len);
- rp->rnid.rnid_cmd = ELS_LS_ACC;
- rp->rnid.rnid_fmt = fmt;
- rp->rnid.rnid_cid_len = sizeof(rp->cid);
- rp->cid.rnid_wwpn = htonll(lport->wwpn);
- rp->cid.rnid_wwnn = htonll(lport->wwnn);
- if (fmt == ELS_RNIDF_GEN) {
- rp->rnid.rnid_sid_len = sizeof(rp->gen);
- memcpy(&rp->gen, &lport->rnid_gen,
- sizeof(rp->gen));
- }
- fc_fill_reply_hdr(fp, in_fp, FC_RCTL_ELS_REP, 0);
- lport->tt.frame_send(lport, fp);
- }
- }
- fc_frame_free(in_fp);
- }
- /**
- * fc_lport_recv_logo_req() - Handle received fabric LOGO request
- * @lport: The local port receiving the LOGO
- * @fp: The LOGO request frame
- */
- static void fc_lport_recv_logo_req(struct fc_lport *lport, struct fc_frame *fp)
- {
- lockdep_assert_held(&lport->lp_mutex);
- fc_seq_els_rsp_send(fp, ELS_LS_ACC, NULL);
- fc_lport_enter_reset(lport);
- fc_frame_free(fp);
- }
- /**
- * fc_fabric_login() - Start the lport state machine
- * @lport: The local port that should log into the fabric
- *
- * Locking Note: This function should not be called
- * with the lport lock held.
- */
- int fc_fabric_login(struct fc_lport *lport)
- {
- int rc = -1;
- mutex_lock(&lport->lp_mutex);
- if (lport->state == LPORT_ST_DISABLED ||
- lport->state == LPORT_ST_LOGO) {
- fc_lport_state_enter(lport, LPORT_ST_RESET);
- fc_lport_enter_reset(lport);
- rc = 0;
- }
- mutex_unlock(&lport->lp_mutex);
- return rc;
- }
- EXPORT_SYMBOL(fc_fabric_login);
- /**
- * __fc_linkup() - Handler for transport linkup events
- * @lport: The lport whose link is up
- */
- void __fc_linkup(struct fc_lport *lport)
- {
- lockdep_assert_held(&lport->lp_mutex);
- if (!lport->link_up) {
- lport->link_up = 1;
- if (lport->state == LPORT_ST_RESET)
- fc_lport_enter_flogi(lport);
- }
- }
- /**
- * fc_linkup() - Handler for transport linkup events
- * @lport: The local port whose link is up
- */
- void fc_linkup(struct fc_lport *lport)
- {
- printk(KERN_INFO "host%d: libfc: Link up on port (%6.6x)\n",
- lport->host->host_no, lport->port_id);
- mutex_lock(&lport->lp_mutex);
- __fc_linkup(lport);
- mutex_unlock(&lport->lp_mutex);
- }
- EXPORT_SYMBOL(fc_linkup);
- /**
- * __fc_linkdown() - Handler for transport linkdown events
- * @lport: The lport whose link is down
- */
- void __fc_linkdown(struct fc_lport *lport)
- {
- lockdep_assert_held(&lport->lp_mutex);
- if (lport->link_up) {
- lport->link_up = 0;
- fc_lport_enter_reset(lport);
- lport->tt.fcp_cleanup(lport);
- }
- }
- /**
- * fc_linkdown() - Handler for transport linkdown events
- * @lport: The local port whose link is down
- */
- void fc_linkdown(struct fc_lport *lport)
- {
- printk(KERN_INFO "host%d: libfc: Link down on port (%6.6x)\n",
- lport->host->host_no, lport->port_id);
- mutex_lock(&lport->lp_mutex);
- __fc_linkdown(lport);
- mutex_unlock(&lport->lp_mutex);
- }
- EXPORT_SYMBOL(fc_linkdown);
- /**
- * fc_fabric_logoff() - Logout of the fabric
- * @lport: The local port to logoff the fabric
- *
- * Return value:
- * 0 for success, -1 for failure
- */
- int fc_fabric_logoff(struct fc_lport *lport)
- {
- lport->tt.disc_stop_final(lport);
- mutex_lock(&lport->lp_mutex);
- if (lport->dns_rdata)
- fc_rport_logoff(lport->dns_rdata);
- mutex_unlock(&lport->lp_mutex);
- fc_rport_flush_queue();
- mutex_lock(&lport->lp_mutex);
- fc_lport_enter_logo(lport);
- mutex_unlock(&lport->lp_mutex);
- cancel_delayed_work_sync(&lport->retry_work);
- return 0;
- }
- EXPORT_SYMBOL(fc_fabric_logoff);
- /**
- * fc_lport_destroy() - Unregister a fc_lport
- * @lport: The local port to unregister
- *
- * Note:
- * exit routine for fc_lport instance
- * clean-up all the allocated memory
- * and free up other system resources.
- *
- */
- int fc_lport_destroy(struct fc_lport *lport)
- {
- mutex_lock(&lport->lp_mutex);
- lport->state = LPORT_ST_DISABLED;
- lport->link_up = 0;
- lport->tt.frame_send = fc_frame_drop;
- mutex_unlock(&lport->lp_mutex);
- lport->tt.fcp_abort_io(lport);
- lport->tt.disc_stop_final(lport);
- lport->tt.exch_mgr_reset(lport, 0, 0);
- cancel_delayed_work_sync(&lport->retry_work);
- fc_fc4_del_lport(lport);
- return 0;
- }
- EXPORT_SYMBOL(fc_lport_destroy);
- /**
- * fc_set_mfs() - Set the maximum frame size for a local port
- * @lport: The local port to set the MFS for
- * @mfs: The new MFS
- */
- int fc_set_mfs(struct fc_lport *lport, u32 mfs)
- {
- unsigned int old_mfs;
- int rc = -EINVAL;
- mutex_lock(&lport->lp_mutex);
- old_mfs = lport->mfs;
- if (mfs >= FC_MIN_MAX_FRAME) {
- mfs &= ~3;
- if (mfs > FC_MAX_FRAME)
- mfs = FC_MAX_FRAME;
- mfs -= sizeof(struct fc_frame_header);
- lport->mfs = mfs;
- rc = 0;
- }
- if (!rc && mfs < old_mfs)
- fc_lport_enter_reset(lport);
- mutex_unlock(&lport->lp_mutex);
- return rc;
- }
- EXPORT_SYMBOL(fc_set_mfs);
- /**
- * fc_lport_disc_callback() - Callback for discovery events
- * @lport: The local port receiving the event
- * @event: The discovery event
- */
- static void fc_lport_disc_callback(struct fc_lport *lport,
- enum fc_disc_event event)
- {
- switch (event) {
- case DISC_EV_SUCCESS:
- FC_LPORT_DBG(lport, "Discovery succeeded\n");
- break;
- case DISC_EV_FAILED:
- printk(KERN_ERR "host%d: libfc: "
- "Discovery failed for port (%6.6x)\n",
- lport->host->host_no, lport->port_id);
- mutex_lock(&lport->lp_mutex);
- fc_lport_enter_reset(lport);
- mutex_unlock(&lport->lp_mutex);
- break;
- case DISC_EV_NONE:
- WARN_ON(1);
- break;
- }
- }
- /**
- * fc_lport_enter_ready() - Enter the ready state and start discovery
- * @lport: The local port that is ready
- */
- static void fc_lport_enter_ready(struct fc_lport *lport)
- {
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered READY from state %s\n",
- fc_lport_state(lport));
- fc_lport_state_enter(lport, LPORT_ST_READY);
- if (lport->vport)
- fc_vport_set_state(lport->vport, FC_VPORT_ACTIVE);
- fc_vports_linkchange(lport);
- if (!lport->ptp_rdata)
- lport->tt.disc_start(fc_lport_disc_callback, lport);
- }
- /**
- * fc_lport_set_port_id() - set the local port Port ID
- * @lport: The local port which will have its Port ID set.
- * @port_id: The new port ID.
- * @fp: The frame containing the incoming request, or NULL.
- */
- static void fc_lport_set_port_id(struct fc_lport *lport, u32 port_id,
- struct fc_frame *fp)
- {
- lockdep_assert_held(&lport->lp_mutex);
- if (port_id)
- printk(KERN_INFO "host%d: Assigned Port ID %6.6x\n",
- lport->host->host_no, port_id);
- lport->port_id = port_id;
- /* Update the fc_host */
- fc_host_port_id(lport->host) = port_id;
- if (lport->tt.lport_set_port_id)
- lport->tt.lport_set_port_id(lport, port_id, fp);
- }
- /**
- * fc_lport_set_local_id() - set the local port Port ID for point-to-multipoint
- * @lport: The local port which will have its Port ID set.
- * @port_id: The new port ID.
- *
- * Called by the lower-level driver when transport sets the local port_id.
- * This is used in VN_port to VN_port mode for FCoE, and causes FLOGI and
- * discovery to be skipped.
- */
- void fc_lport_set_local_id(struct fc_lport *lport, u32 port_id)
- {
- mutex_lock(&lport->lp_mutex);
- fc_lport_set_port_id(lport, port_id, NULL);
- switch (lport->state) {
- case LPORT_ST_RESET:
- case LPORT_ST_FLOGI:
- if (port_id)
- fc_lport_enter_ready(lport);
- break;
- default:
- break;
- }
- mutex_unlock(&lport->lp_mutex);
- }
- EXPORT_SYMBOL(fc_lport_set_local_id);
- /**
- * fc_lport_recv_flogi_req() - Receive a FLOGI request
- * @lport: The local port that received the request
- * @rx_fp: The FLOGI frame
- *
- * A received FLOGI request indicates a point-to-point connection.
- * Accept it with the common service parameters indicating our N port.
- * Set up to do a PLOGI if we have the higher-number WWPN.
- */
- static void fc_lport_recv_flogi_req(struct fc_lport *lport,
- struct fc_frame *rx_fp)
- {
- struct fc_frame *fp;
- struct fc_frame_header *fh;
- struct fc_els_flogi *flp;
- struct fc_els_flogi *new_flp;
- u64 remote_wwpn;
- u32 remote_fid;
- u32 local_fid;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Received FLOGI request while in state %s\n",
- fc_lport_state(lport));
- remote_fid = fc_frame_sid(rx_fp);
- flp = fc_frame_payload_get(rx_fp, sizeof(*flp));
- if (!flp)
- goto out;
- remote_wwpn = get_unaligned_be64(&flp->fl_wwpn);
- if (remote_wwpn == lport->wwpn) {
- printk(KERN_WARNING "host%d: libfc: Received FLOGI from port "
- "with same WWPN %16.16llx\n",
- lport->host->host_no, remote_wwpn);
- goto out;
- }
- FC_LPORT_DBG(lport, "FLOGI from port WWPN %16.16llx\n", remote_wwpn);
- /*
- * XXX what is the right thing to do for FIDs?
- * The originator might expect our S_ID to be 0xfffffe.
- * But if so, both of us could end up with the same FID.
- */
- local_fid = FC_LOCAL_PTP_FID_LO;
- if (remote_wwpn < lport->wwpn) {
- local_fid = FC_LOCAL_PTP_FID_HI;
- if (!remote_fid || remote_fid == local_fid)
- remote_fid = FC_LOCAL_PTP_FID_LO;
- } else if (!remote_fid) {
- remote_fid = FC_LOCAL_PTP_FID_HI;
- }
- fc_lport_set_port_id(lport, local_fid, rx_fp);
- fp = fc_frame_alloc(lport, sizeof(*flp));
- if (fp) {
- new_flp = fc_frame_payload_get(fp, sizeof(*flp));
- fc_lport_flogi_fill(lport, new_flp, ELS_FLOGI);
- new_flp->fl_cmd = (u8) ELS_LS_ACC;
- /*
- * Send the response. If this fails, the originator should
- * repeat the sequence.
- */
- fc_fill_reply_hdr(fp, rx_fp, FC_RCTL_ELS_REP, 0);
- fh = fc_frame_header_get(fp);
- hton24(fh->fh_s_id, local_fid);
- hton24(fh->fh_d_id, remote_fid);
- lport->tt.frame_send(lport, fp);
- } else {
- fc_lport_error(lport, fp);
- }
- fc_lport_ptp_setup(lport, remote_fid, remote_wwpn,
- get_unaligned_be64(&flp->fl_wwnn));
- out:
- fc_frame_free(rx_fp);
- }
- /**
- * fc_lport_recv_els_req() - The generic lport ELS request handler
- * @lport: The local port that received the request
- * @fp: The request frame
- *
- * This function will see if the lport handles the request or
- * if an rport should handle the request.
- *
- * Locking Note: This function should not be called with the lport
- * lock held because it will grab the lock.
- */
- static void fc_lport_recv_els_req(struct fc_lport *lport,
- struct fc_frame *fp)
- {
- mutex_lock(&lport->lp_mutex);
- /*
- * Handle special ELS cases like FLOGI, LOGO, and
- * RSCN here. These don't require a session.
- * Even if we had a session, it might not be ready.
- */
- if (!lport->link_up)
- fc_frame_free(fp);
- else {
- /*
- * Check opcode.
- */
- switch (fc_frame_payload_op(fp)) {
- case ELS_FLOGI:
- if (!lport->point_to_multipoint)
- fc_lport_recv_flogi_req(lport, fp);
- else
- fc_rport_recv_req(lport, fp);
- break;
- case ELS_LOGO:
- if (fc_frame_sid(fp) == FC_FID_FLOGI)
- fc_lport_recv_logo_req(lport, fp);
- else
- fc_rport_recv_req(lport, fp);
- break;
- case ELS_RSCN:
- lport->tt.disc_recv_req(lport, fp);
- break;
- case ELS_ECHO:
- fc_lport_recv_echo_req(lport, fp);
- break;
- case ELS_RLIR:
- fc_lport_recv_rlir_req(lport, fp);
- break;
- case ELS_RNID:
- fc_lport_recv_rnid_req(lport, fp);
- break;
- default:
- fc_rport_recv_req(lport, fp);
- break;
- }
- }
- mutex_unlock(&lport->lp_mutex);
- }
- static int fc_lport_els_prli(struct fc_rport_priv *rdata, u32 spp_len,
- const struct fc_els_spp *spp_in,
- struct fc_els_spp *spp_out)
- {
- return FC_SPP_RESP_INVL;
- }
- struct fc4_prov fc_lport_els_prov = {
- .prli = fc_lport_els_prli,
- .recv = fc_lport_recv_els_req,
- };
- /**
- * fc_lport_recv() - The generic lport request handler
- * @lport: The lport that received the request
- * @fp: The frame the request is in
- *
- * Locking Note: This function should not be called with the lport
- * lock held because it may grab the lock.
- */
- void fc_lport_recv(struct fc_lport *lport, struct fc_frame *fp)
- {
- struct fc_frame_header *fh = fc_frame_header_get(fp);
- struct fc_seq *sp = fr_seq(fp);
- struct fc4_prov *prov;
- /*
- * Use RCU read lock and module_lock to be sure module doesn't
- * deregister and get unloaded while we're calling it.
- * try_module_get() is inlined and accepts a NULL parameter.
- * Only ELSes and FCP target ops should come through here.
- * The locking is unfortunate, and a better scheme is being sought.
- */
- rcu_read_lock();
- if (fh->fh_type >= FC_FC4_PROV_SIZE)
- goto drop;
- prov = rcu_dereference(fc_passive_prov[fh->fh_type]);
- if (!prov || !try_module_get(prov->module))
- goto drop;
- rcu_read_unlock();
- prov->recv(lport, fp);
- module_put(prov->module);
- return;
- drop:
- rcu_read_unlock();
- FC_LPORT_DBG(lport, "dropping unexpected frame type %x\n", fh->fh_type);
- fc_frame_free(fp);
- if (sp)
- fc_exch_done(sp);
- }
- EXPORT_SYMBOL(fc_lport_recv);
- /**
- * fc_lport_reset() - Reset a local port
- * @lport: The local port which should be reset
- *
- * Locking Note: This functions should not be called with the
- * lport lock held.
- */
- int fc_lport_reset(struct fc_lport *lport)
- {
- cancel_delayed_work_sync(&lport->retry_work);
- mutex_lock(&lport->lp_mutex);
- fc_lport_enter_reset(lport);
- mutex_unlock(&lport->lp_mutex);
- return 0;
- }
- EXPORT_SYMBOL(fc_lport_reset);
- /**
- * fc_lport_reset_locked() - Reset the local port w/ the lport lock held
- * @lport: The local port to be reset
- */
- static void fc_lport_reset_locked(struct fc_lport *lport)
- {
- lockdep_assert_held(&lport->lp_mutex);
- if (lport->dns_rdata) {
- fc_rport_logoff(lport->dns_rdata);
- lport->dns_rdata = NULL;
- }
- if (lport->ptp_rdata) {
- fc_rport_logoff(lport->ptp_rdata);
- kref_put(&lport->ptp_rdata->kref, fc_rport_destroy);
- lport->ptp_rdata = NULL;
- }
- lport->tt.disc_stop(lport);
- lport->tt.exch_mgr_reset(lport, 0, 0);
- fc_host_fabric_name(lport->host) = 0;
- if (lport->port_id && (!lport->point_to_multipoint || !lport->link_up))
- fc_lport_set_port_id(lport, 0, NULL);
- }
- /**
- * fc_lport_enter_reset() - Reset the local port
- * @lport: The local port to be reset
- */
- static void fc_lport_enter_reset(struct fc_lport *lport)
- {
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered RESET state from %s state\n",
- fc_lport_state(lport));
- if (lport->state == LPORT_ST_DISABLED || lport->state == LPORT_ST_LOGO)
- return;
- if (lport->vport) {
- if (lport->link_up)
- fc_vport_set_state(lport->vport, FC_VPORT_INITIALIZING);
- else
- fc_vport_set_state(lport->vport, FC_VPORT_LINKDOWN);
- }
- fc_lport_state_enter(lport, LPORT_ST_RESET);
- fc_host_post_event(lport->host, fc_get_event_number(),
- FCH_EVT_LIPRESET, 0);
- fc_vports_linkchange(lport);
- fc_lport_reset_locked(lport);
- if (lport->link_up)
- fc_lport_enter_flogi(lport);
- }
- /**
- * fc_lport_enter_disabled() - Disable the local port
- * @lport: The local port to be reset
- */
- static void fc_lport_enter_disabled(struct fc_lport *lport)
- {
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered disabled state from %s state\n",
- fc_lport_state(lport));
- fc_lport_state_enter(lport, LPORT_ST_DISABLED);
- fc_vports_linkchange(lport);
- fc_lport_reset_locked(lport);
- }
- /**
- * fc_lport_error() - Handler for any errors
- * @lport: The local port that the error was on
- * @fp: The error code encoded in a frame pointer
- *
- * If the error was caused by a resource allocation failure
- * then wait for half a second and retry, otherwise retry
- * after the e_d_tov time.
- */
- static void fc_lport_error(struct fc_lport *lport, struct fc_frame *fp)
- {
- unsigned long delay = 0;
- FC_LPORT_DBG(lport, "Error %ld in state %s, retries %d\n",
- IS_ERR(fp) ? -PTR_ERR(fp) : 0, fc_lport_state(lport),
- lport->retry_count);
- if (PTR_ERR(fp) == -FC_EX_CLOSED)
- return;
- /*
- * Memory allocation failure, or the exchange timed out
- * or we received LS_RJT.
- * Retry after delay
- */
- if (lport->retry_count < lport->max_retry_count) {
- lport->retry_count++;
- if (!fp)
- delay = msecs_to_jiffies(500);
- else
- delay = msecs_to_jiffies(lport->e_d_tov);
- schedule_delayed_work(&lport->retry_work, delay);
- } else
- fc_lport_enter_reset(lport);
- }
- /**
- * fc_lport_ns_resp() - Handle response to a name server
- * registration exchange
- * @sp: current sequence in exchange
- * @fp: response frame
- * @lp_arg: Fibre Channel host port instance
- *
- * Locking Note: This function will be called without the lport lock
- * held, but it will lock, call an _enter_* function or fc_lport_error()
- * and then unlock the lport.
- */
- static void fc_lport_ns_resp(struct fc_seq *sp, struct fc_frame *fp,
- void *lp_arg)
- {
- struct fc_lport *lport = lp_arg;
- struct fc_frame_header *fh;
- struct fc_ct_hdr *ct;
- FC_LPORT_DBG(lport, "Received a ns %s\n", fc_els_resp_type(fp));
- if (fp == ERR_PTR(-FC_EX_CLOSED))
- return;
- mutex_lock(&lport->lp_mutex);
- if (lport->state < LPORT_ST_RNN_ID || lport->state > LPORT_ST_RFF_ID) {
- FC_LPORT_DBG(lport, "Received a name server response, "
- "but in state %s\n", fc_lport_state(lport));
- if (IS_ERR(fp))
- goto err;
- goto out;
- }
- if (IS_ERR(fp)) {
- fc_lport_error(lport, fp);
- goto err;
- }
- fh = fc_frame_header_get(fp);
- ct = fc_frame_payload_get(fp, sizeof(*ct));
- if (fh && ct && fh->fh_type == FC_TYPE_CT &&
- ct->ct_fs_type == FC_FST_DIR &&
- ct->ct_fs_subtype == FC_NS_SUBTYPE &&
- ntohs(ct->ct_cmd) == FC_FS_ACC)
- switch (lport->state) {
- case LPORT_ST_RNN_ID:
- fc_lport_enter_ns(lport, LPORT_ST_RSNN_NN);
- break;
- case LPORT_ST_RSNN_NN:
- fc_lport_enter_ns(lport, LPORT_ST_RSPN_ID);
- break;
- case LPORT_ST_RSPN_ID:
- fc_lport_enter_ns(lport, LPORT_ST_RFT_ID);
- break;
- case LPORT_ST_RFT_ID:
- fc_lport_enter_ns(lport, LPORT_ST_RFF_ID);
- break;
- case LPORT_ST_RFF_ID:
- if (lport->fdmi_enabled)
- fc_lport_enter_fdmi(lport);
- else
- fc_lport_enter_scr(lport);
- break;
- default:
- /* should have already been caught by state checks */
- break;
- }
- else
- fc_lport_error(lport, fp);
- out:
- fc_frame_free(fp);
- err:
- mutex_unlock(&lport->lp_mutex);
- }
- /**
- * fc_lport_ms_resp() - Handle response to a management server
- * exchange
- * @sp: current sequence in exchange
- * @fp: response frame
- * @lp_arg: Fibre Channel host port instance
- *
- * Locking Note: This function will be called without the lport lock
- * held, but it will lock, call an _enter_* function or fc_lport_error()
- * and then unlock the lport.
- */
- static void fc_lport_ms_resp(struct fc_seq *sp, struct fc_frame *fp,
- void *lp_arg)
- {
- struct fc_lport *lport = lp_arg;
- struct fc_frame_header *fh;
- struct fc_ct_hdr *ct;
- struct fc_host_attrs *fc_host = shost_to_fc_host(lport->host);
- FC_LPORT_DBG(lport, "Received a ms %s\n", fc_els_resp_type(fp));
- if (fp == ERR_PTR(-FC_EX_CLOSED))
- return;
- mutex_lock(&lport->lp_mutex);
- if (lport->state < LPORT_ST_RHBA || lport->state > LPORT_ST_DPRT) {
- FC_LPORT_DBG(lport, "Received a management server response, "
- "but in state %s\n", fc_lport_state(lport));
- if (IS_ERR(fp))
- goto err;
- goto out;
- }
- if (IS_ERR(fp)) {
- fc_lport_error(lport, fp);
- goto err;
- }
- fh = fc_frame_header_get(fp);
- ct = fc_frame_payload_get(fp, sizeof(*ct));
- if (fh && ct && fh->fh_type == FC_TYPE_CT &&
- ct->ct_fs_type == FC_FST_MGMT &&
- ct->ct_fs_subtype == FC_FDMI_SUBTYPE) {
- FC_LPORT_DBG(lport, "Received a management server response, "
- "reason=%d explain=%d\n",
- ct->ct_reason,
- ct->ct_explan);
- switch (lport->state) {
- case LPORT_ST_RHBA:
- if ((ntohs(ct->ct_cmd) == FC_FS_RJT) && fc_host->fdmi_version == FDMI_V2) {
- FC_LPORT_DBG(lport, "Error for FDMI-V2, fall back to FDMI-V1\n");
- fc_host->fdmi_version = FDMI_V1;
- fc_lport_enter_ms(lport, LPORT_ST_RHBA);
- } else if (ntohs(ct->ct_cmd) == FC_FS_ACC)
- fc_lport_enter_ms(lport, LPORT_ST_RPA);
- else /* Error Skip RPA */
- fc_lport_enter_scr(lport);
- break;
- case LPORT_ST_RPA:
- fc_lport_enter_scr(lport);
- break;
- case LPORT_ST_DPRT:
- fc_lport_enter_ms(lport, LPORT_ST_RHBA);
- break;
- case LPORT_ST_DHBA:
- fc_lport_enter_ms(lport, LPORT_ST_DPRT);
- break;
- default:
- /* should have already been caught by state checks */
- break;
- }
- } else {
- /* Invalid Frame? */
- fc_lport_error(lport, fp);
- }
- out:
- fc_frame_free(fp);
- err:
- mutex_unlock(&lport->lp_mutex);
- }
- /**
- * fc_lport_scr_resp() - Handle response to State Change Register (SCR) request
- * @sp: current sequence in SCR exchange
- * @fp: response frame
- * @lp_arg: Fibre Channel lport port instance that sent the registration request
- *
- * Locking Note: This function will be called without the lport lock
- * held, but it will lock, call an _enter_* function or fc_lport_error
- * and then unlock the lport.
- */
- static void fc_lport_scr_resp(struct fc_seq *sp, struct fc_frame *fp,
- void *lp_arg)
- {
- struct fc_lport *lport = lp_arg;
- u8 op;
- FC_LPORT_DBG(lport, "Received a SCR %s\n", fc_els_resp_type(fp));
- if (fp == ERR_PTR(-FC_EX_CLOSED))
- return;
- mutex_lock(&lport->lp_mutex);
- if (lport->state != LPORT_ST_SCR) {
- FC_LPORT_DBG(lport, "Received a SCR response, but in state "
- "%s\n", fc_lport_state(lport));
- if (IS_ERR(fp))
- goto err;
- goto out;
- }
- if (IS_ERR(fp)) {
- fc_lport_error(lport, fp);
- goto err;
- }
- op = fc_frame_payload_op(fp);
- if (op == ELS_LS_ACC)
- fc_lport_enter_ready(lport);
- else
- fc_lport_error(lport, fp);
- out:
- fc_frame_free(fp);
- err:
- mutex_unlock(&lport->lp_mutex);
- }
- /**
- * fc_lport_enter_scr() - Send a SCR (State Change Register) request
- * @lport: The local port to register for state changes
- */
- static void fc_lport_enter_scr(struct fc_lport *lport)
- {
- struct fc_frame *fp;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered SCR state from %s state\n",
- fc_lport_state(lport));
- fc_lport_state_enter(lport, LPORT_ST_SCR);
- fp = fc_frame_alloc(lport, sizeof(struct fc_els_scr));
- if (!fp) {
- fc_lport_error(lport, fp);
- return;
- }
- if (!lport->tt.elsct_send(lport, FC_FID_FCTRL, fp, ELS_SCR,
- fc_lport_scr_resp, lport,
- 2 * lport->r_a_tov))
- fc_lport_error(lport, NULL);
- }
- /**
- * fc_lport_enter_ns() - register some object with the name server
- * @lport: Fibre Channel local port to register
- * @state: Local port state
- */
- static void fc_lport_enter_ns(struct fc_lport *lport, enum fc_lport_state state)
- {
- struct fc_frame *fp;
- enum fc_ns_req cmd;
- int size = sizeof(struct fc_ct_hdr);
- size_t len;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered %s state from %s state\n",
- fc_lport_state_names[state],
- fc_lport_state(lport));
- fc_lport_state_enter(lport, state);
- switch (state) {
- case LPORT_ST_RNN_ID:
- cmd = FC_NS_RNN_ID;
- size += sizeof(struct fc_ns_rn_id);
- break;
- case LPORT_ST_RSNN_NN:
- len = strnlen(fc_host_symbolic_name(lport->host), 255);
- /* if there is no symbolic name, skip to RFT_ID */
- if (!len)
- return fc_lport_enter_ns(lport, LPORT_ST_RFT_ID);
- cmd = FC_NS_RSNN_NN;
- size += sizeof(struct fc_ns_rsnn) + len;
- break;
- case LPORT_ST_RSPN_ID:
- len = strnlen(fc_host_symbolic_name(lport->host), 255);
- /* if there is no symbolic name, skip to RFT_ID */
- if (!len)
- return fc_lport_enter_ns(lport, LPORT_ST_RFT_ID);
- cmd = FC_NS_RSPN_ID;
- size += sizeof(struct fc_ns_rspn) + len;
- break;
- case LPORT_ST_RFT_ID:
- cmd = FC_NS_RFT_ID;
- size += sizeof(struct fc_ns_rft);
- break;
- case LPORT_ST_RFF_ID:
- cmd = FC_NS_RFF_ID;
- size += sizeof(struct fc_ns_rff_id);
- break;
- default:
- fc_lport_error(lport, NULL);
- return;
- }
- fp = fc_frame_alloc(lport, size);
- if (!fp) {
- fc_lport_error(lport, fp);
- return;
- }
- if (!lport->tt.elsct_send(lport, FC_FID_DIR_SERV, fp, cmd,
- fc_lport_ns_resp,
- lport, 3 * lport->r_a_tov))
- fc_lport_error(lport, fp);
- }
- static struct fc_rport_operations fc_lport_rport_ops = {
- .event_callback = fc_lport_rport_callback,
- };
- /**
- * fc_lport_enter_dns() - Create a fc_rport for the name server
- * @lport: The local port requesting a remote port for the name server
- */
- static void fc_lport_enter_dns(struct fc_lport *lport)
- {
- struct fc_rport_priv *rdata;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered DNS state from %s state\n",
- fc_lport_state(lport));
- fc_lport_state_enter(lport, LPORT_ST_DNS);
- mutex_lock(&lport->disc.disc_mutex);
- rdata = fc_rport_create(lport, FC_FID_DIR_SERV);
- mutex_unlock(&lport->disc.disc_mutex);
- if (!rdata)
- goto err;
- rdata->ops = &fc_lport_rport_ops;
- fc_rport_login(rdata);
- return;
- err:
- fc_lport_error(lport, NULL);
- }
- /**
- * fc_lport_enter_ms() - management server commands
- * @lport: Fibre Channel local port to register
- * @state: Local port state
- */
- static void fc_lport_enter_ms(struct fc_lport *lport, enum fc_lport_state state)
- {
- struct fc_frame *fp;
- enum fc_fdmi_req cmd;
- int size = sizeof(struct fc_ct_hdr);
- size_t len;
- int numattrs;
- struct fc_host_attrs *fc_host = shost_to_fc_host(lport->host);
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered %s state from %s state\n",
- fc_lport_state_names[state],
- fc_lport_state(lport));
- fc_lport_state_enter(lport, state);
- switch (state) {
- case LPORT_ST_RHBA:
- cmd = FC_FDMI_RHBA;
- /* Number of HBA Attributes */
- numattrs = 11;
- len = sizeof(struct fc_fdmi_rhba);
- len -= sizeof(struct fc_fdmi_attr_entry);
- len += FC_FDMI_HBA_ATTR_NODENAME_LEN;
- len += FC_FDMI_HBA_ATTR_MANUFACTURER_LEN;
- len += FC_FDMI_HBA_ATTR_SERIALNUMBER_LEN;
- len += FC_FDMI_HBA_ATTR_MODEL_LEN;
- len += FC_FDMI_HBA_ATTR_MODELDESCR_LEN;
- len += FC_FDMI_HBA_ATTR_HARDWAREVERSION_LEN;
- len += FC_FDMI_HBA_ATTR_DRIVERVERSION_LEN;
- len += FC_FDMI_HBA_ATTR_OPTIONROMVERSION_LEN;
- len += FC_FDMI_HBA_ATTR_FIRMWAREVERSION_LEN;
- len += FC_FDMI_HBA_ATTR_OSNAMEVERSION_LEN;
- len += FC_FDMI_HBA_ATTR_MAXCTPAYLOAD_LEN;
- if (fc_host->fdmi_version == FDMI_V2) {
- numattrs += 7;
- len += FC_FDMI_HBA_ATTR_NODESYMBLNAME_LEN;
- len += FC_FDMI_HBA_ATTR_VENDORSPECIFICINFO_LEN;
- len += FC_FDMI_HBA_ATTR_NUMBEROFPORTS_LEN;
- len += FC_FDMI_HBA_ATTR_FABRICNAME_LEN;
- len += FC_FDMI_HBA_ATTR_BIOSVERSION_LEN;
- len += FC_FDMI_HBA_ATTR_BIOSSTATE_LEN;
- len += FC_FDMI_HBA_ATTR_VENDORIDENTIFIER_LEN;
- }
- len += (numattrs * FC_FDMI_ATTR_ENTRY_HEADER_LEN);
- size += len;
- break;
- case LPORT_ST_RPA:
- cmd = FC_FDMI_RPA;
- /* Number of Port Attributes */
- numattrs = 6;
- len = sizeof(struct fc_fdmi_rpa);
- len -= sizeof(struct fc_fdmi_attr_entry);
- len += FC_FDMI_PORT_ATTR_FC4TYPES_LEN;
- len += FC_FDMI_PORT_ATTR_SUPPORTEDSPEED_LEN;
- len += FC_FDMI_PORT_ATTR_CURRENTPORTSPEED_LEN;
- len += FC_FDMI_PORT_ATTR_MAXFRAMESIZE_LEN;
- len += FC_FDMI_PORT_ATTR_OSDEVICENAME_LEN;
- len += FC_FDMI_PORT_ATTR_HOSTNAME_LEN;
- if (fc_host->fdmi_version == FDMI_V2) {
- numattrs += 10;
- len += FC_FDMI_PORT_ATTR_NODENAME_LEN;
- len += FC_FDMI_PORT_ATTR_PORTNAME_LEN;
- len += FC_FDMI_PORT_ATTR_SYMBOLICNAME_LEN;
- len += FC_FDMI_PORT_ATTR_PORTTYPE_LEN;
- len += FC_FDMI_PORT_ATTR_SUPPORTEDCLASSSRVC_LEN;
- len += FC_FDMI_PORT_ATTR_FABRICNAME_LEN;
- len += FC_FDMI_PORT_ATTR_CURRENTFC4TYPE_LEN;
- len += FC_FDMI_PORT_ATTR_PORTSTATE_LEN;
- len += FC_FDMI_PORT_ATTR_DISCOVEREDPORTS_LEN;
- len += FC_FDMI_PORT_ATTR_PORTID_LEN;
- }
- len += (numattrs * FC_FDMI_ATTR_ENTRY_HEADER_LEN);
- size += len;
- break;
- case LPORT_ST_DPRT:
- cmd = FC_FDMI_DPRT;
- len = sizeof(struct fc_fdmi_dprt);
- size += len;
- break;
- case LPORT_ST_DHBA:
- cmd = FC_FDMI_DHBA;
- len = sizeof(struct fc_fdmi_dhba);
- size += len;
- break;
- default:
- fc_lport_error(lport, NULL);
- return;
- }
- FC_LPORT_DBG(lport, "Cmd=0x%x Len %d size %d\n",
- cmd, (int)len, size);
- fp = fc_frame_alloc(lport, size);
- if (!fp) {
- fc_lport_error(lport, fp);
- return;
- }
- if (!lport->tt.elsct_send(lport, FC_FID_MGMT_SERV, fp, cmd,
- fc_lport_ms_resp,
- lport, 3 * lport->r_a_tov))
- fc_lport_error(lport, fp);
- }
- /**
- * fc_lport_enter_fdmi() - Create a fc_rport for the management server
- * @lport: The local port requesting a remote port for the management server
- */
- static void fc_lport_enter_fdmi(struct fc_lport *lport)
- {
- struct fc_rport_priv *rdata;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered FDMI state from %s state\n",
- fc_lport_state(lport));
- fc_lport_state_enter(lport, LPORT_ST_FDMI);
- mutex_lock(&lport->disc.disc_mutex);
- rdata = fc_rport_create(lport, FC_FID_MGMT_SERV);
- mutex_unlock(&lport->disc.disc_mutex);
- if (!rdata)
- goto err;
- rdata->ops = &fc_lport_rport_ops;
- fc_rport_login(rdata);
- return;
- err:
- fc_lport_error(lport, NULL);
- }
- /**
- * fc_lport_timeout() - Handler for the retry_work timer
- * @work: The work struct of the local port
- */
- static void fc_lport_timeout(struct work_struct *work)
- {
- struct fc_lport *lport =
- container_of(work, struct fc_lport,
- retry_work.work);
- struct fc_host_attrs *fc_host = shost_to_fc_host(lport->host);
- mutex_lock(&lport->lp_mutex);
- switch (lport->state) {
- case LPORT_ST_DISABLED:
- break;
- case LPORT_ST_READY:
- break;
- case LPORT_ST_RESET:
- break;
- case LPORT_ST_FLOGI:
- fc_lport_enter_flogi(lport);
- break;
- case LPORT_ST_DNS:
- fc_lport_enter_dns(lport);
- break;
- case LPORT_ST_RNN_ID:
- case LPORT_ST_RSNN_NN:
- case LPORT_ST_RSPN_ID:
- case LPORT_ST_RFT_ID:
- case LPORT_ST_RFF_ID:
- fc_lport_enter_ns(lport, lport->state);
- break;
- case LPORT_ST_FDMI:
- fc_lport_enter_fdmi(lport);
- break;
- case LPORT_ST_RHBA:
- if (fc_host->fdmi_version == FDMI_V2) {
- FC_LPORT_DBG(lport, "timeout for FDMI-V2 RHBA,fall back to FDMI-V1\n");
- fc_host->fdmi_version = FDMI_V1;
- fc_lport_enter_ms(lport, LPORT_ST_RHBA);
- break;
- }
- fallthrough;
- case LPORT_ST_RPA:
- case LPORT_ST_DHBA:
- case LPORT_ST_DPRT:
- FC_LPORT_DBG(lport, "Skipping lport state %s to SCR\n",
- fc_lport_state(lport));
- fallthrough;
- case LPORT_ST_SCR:
- fc_lport_enter_scr(lport);
- break;
- case LPORT_ST_LOGO:
- fc_lport_enter_logo(lport);
- break;
- }
- mutex_unlock(&lport->lp_mutex);
- }
- /**
- * fc_lport_logo_resp() - Handle response to LOGO request
- * @sp: The sequence that the LOGO was on
- * @fp: The LOGO frame
- * @lp_arg: The lport port that received the LOGO request
- *
- * Locking Note: This function will be called without the lport lock
- * held, but it will lock, call an _enter_* function or fc_lport_error()
- * and then unlock the lport.
- */
- void fc_lport_logo_resp(struct fc_seq *sp, struct fc_frame *fp,
- void *lp_arg)
- {
- struct fc_lport *lport = lp_arg;
- u8 op;
- FC_LPORT_DBG(lport, "Received a LOGO %s\n", fc_els_resp_type(fp));
- if (fp == ERR_PTR(-FC_EX_CLOSED))
- return;
- mutex_lock(&lport->lp_mutex);
- if (lport->state != LPORT_ST_LOGO) {
- FC_LPORT_DBG(lport, "Received a LOGO response, but in state "
- "%s\n", fc_lport_state(lport));
- if (IS_ERR(fp))
- goto err;
- goto out;
- }
- if (IS_ERR(fp)) {
- fc_lport_error(lport, fp);
- goto err;
- }
- op = fc_frame_payload_op(fp);
- if (op == ELS_LS_ACC)
- fc_lport_enter_disabled(lport);
- else
- fc_lport_error(lport, fp);
- out:
- fc_frame_free(fp);
- err:
- mutex_unlock(&lport->lp_mutex);
- }
- EXPORT_SYMBOL(fc_lport_logo_resp);
- /**
- * fc_lport_enter_logo() - Logout of the fabric
- * @lport: The local port to be logged out
- */
- static void fc_lport_enter_logo(struct fc_lport *lport)
- {
- struct fc_frame *fp;
- struct fc_els_logo *logo;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered LOGO state from %s state\n",
- fc_lport_state(lport));
- fc_lport_state_enter(lport, LPORT_ST_LOGO);
- fc_vports_linkchange(lport);
- fp = fc_frame_alloc(lport, sizeof(*logo));
- if (!fp) {
- fc_lport_error(lport, fp);
- return;
- }
- if (!lport->tt.elsct_send(lport, FC_FID_FLOGI, fp, ELS_LOGO,
- fc_lport_logo_resp, lport,
- 2 * lport->r_a_tov))
- fc_lport_error(lport, NULL);
- }
- /**
- * fc_lport_flogi_resp() - Handle response to FLOGI request
- * @sp: The sequence that the FLOGI was on
- * @fp: The FLOGI response frame
- * @lp_arg: The lport port that received the FLOGI response
- *
- * Locking Note: This function will be called without the lport lock
- * held, but it will lock, call an _enter_* function or fc_lport_error()
- * and then unlock the lport.
- */
- void fc_lport_flogi_resp(struct fc_seq *sp, struct fc_frame *fp,
- void *lp_arg)
- {
- struct fc_lport *lport = lp_arg;
- struct fc_frame_header *fh;
- struct fc_els_flogi *flp;
- u32 did;
- u16 csp_flags;
- unsigned int r_a_tov;
- unsigned int e_d_tov;
- u16 mfs;
- FC_LPORT_DBG(lport, "Received a FLOGI %s\n", fc_els_resp_type(fp));
- if (fp == ERR_PTR(-FC_EX_CLOSED))
- return;
- mutex_lock(&lport->lp_mutex);
- if (lport->state != LPORT_ST_FLOGI) {
- FC_LPORT_DBG(lport, "Received a FLOGI response, but in state "
- "%s\n", fc_lport_state(lport));
- if (IS_ERR(fp))
- goto err;
- goto out;
- }
- if (IS_ERR(fp)) {
- fc_lport_error(lport, fp);
- goto err;
- }
- fh = fc_frame_header_get(fp);
- did = fc_frame_did(fp);
- if (fh->fh_r_ctl != FC_RCTL_ELS_REP || did == 0 ||
- fc_frame_payload_op(fp) != ELS_LS_ACC) {
- FC_LPORT_DBG(lport, "FLOGI not accepted or bad response\n");
- fc_lport_error(lport, fp);
- goto out;
- }
- flp = fc_frame_payload_get(fp, sizeof(*flp));
- if (!flp) {
- FC_LPORT_DBG(lport, "FLOGI bad response\n");
- fc_lport_error(lport, fp);
- goto out;
- }
- mfs = ntohs(flp->fl_csp.sp_bb_data) &
- FC_SP_BB_DATA_MASK;
- if (mfs < FC_SP_MIN_MAX_PAYLOAD || mfs > FC_SP_MAX_MAX_PAYLOAD) {
- FC_LPORT_DBG(lport, "FLOGI bad mfs:%hu response, "
- "lport->mfs:%u\n", mfs, lport->mfs);
- fc_lport_error(lport, fp);
- goto out;
- }
- if (mfs <= lport->mfs) {
- lport->mfs = mfs;
- fc_host_maxframe_size(lport->host) = mfs;
- }
- csp_flags = ntohs(flp->fl_csp.sp_features);
- r_a_tov = ntohl(flp->fl_csp.sp_r_a_tov);
- e_d_tov = ntohl(flp->fl_csp.sp_e_d_tov);
- if (csp_flags & FC_SP_FT_EDTR)
- e_d_tov /= 1000000;
- lport->npiv_enabled = !!(csp_flags & FC_SP_FT_NPIV_ACC);
- if ((csp_flags & FC_SP_FT_FPORT) == 0) {
- if (e_d_tov > lport->e_d_tov)
- lport->e_d_tov = e_d_tov;
- lport->r_a_tov = 2 * lport->e_d_tov;
- fc_lport_set_port_id(lport, did, fp);
- printk(KERN_INFO "host%d: libfc: "
- "Port (%6.6x) entered "
- "point-to-point mode\n",
- lport->host->host_no, did);
- fc_lport_ptp_setup(lport, fc_frame_sid(fp),
- get_unaligned_be64(
- &flp->fl_wwpn),
- get_unaligned_be64(
- &flp->fl_wwnn));
- } else {
- if (e_d_tov > lport->e_d_tov)
- lport->e_d_tov = e_d_tov;
- if (r_a_tov > lport->r_a_tov)
- lport->r_a_tov = r_a_tov;
- fc_host_fabric_name(lport->host) =
- get_unaligned_be64(&flp->fl_wwnn);
- fc_lport_set_port_id(lport, did, fp);
- fc_lport_enter_dns(lport);
- }
- out:
- fc_frame_free(fp);
- err:
- mutex_unlock(&lport->lp_mutex);
- }
- EXPORT_SYMBOL(fc_lport_flogi_resp);
- /**
- * fc_lport_enter_flogi() - Send a FLOGI request to the fabric manager
- * @lport: Fibre Channel local port to be logged in to the fabric
- */
- static void fc_lport_enter_flogi(struct fc_lport *lport)
- {
- struct fc_frame *fp;
- lockdep_assert_held(&lport->lp_mutex);
- FC_LPORT_DBG(lport, "Entered FLOGI state from %s state\n",
- fc_lport_state(lport));
- fc_lport_state_enter(lport, LPORT_ST_FLOGI);
- if (lport->point_to_multipoint) {
- if (lport->port_id)
- fc_lport_enter_ready(lport);
- return;
- }
- fp = fc_frame_alloc(lport, sizeof(struct fc_els_flogi));
- if (!fp)
- return fc_lport_error(lport, fp);
- if (!lport->tt.elsct_send(lport, FC_FID_FLOGI, fp,
- lport->vport ? ELS_FDISC : ELS_FLOGI,
- fc_lport_flogi_resp, lport,
- lport->vport ? 2 * lport->r_a_tov :
- lport->e_d_tov))
- fc_lport_error(lport, NULL);
- }
- /**
- * fc_lport_config() - Configure a fc_lport
- * @lport: The local port to be configured
- */
- int fc_lport_config(struct fc_lport *lport)
- {
- INIT_DELAYED_WORK(&lport->retry_work, fc_lport_timeout);
- mutex_init(&lport->lp_mutex);
- fc_lport_state_enter(lport, LPORT_ST_DISABLED);
- fc_lport_add_fc4_type(lport, FC_TYPE_FCP);
- fc_lport_add_fc4_type(lport, FC_TYPE_CT);
- fc_fc4_conf_lport_params(lport, FC_TYPE_FCP);
- return 0;
- }
- EXPORT_SYMBOL(fc_lport_config);
- /**
- * fc_lport_init() - Initialize the lport layer for a local port
- * @lport: The local port to initialize the exchange layer for
- */
- int fc_lport_init(struct fc_lport *lport)
- {
- struct fc_host_attrs *fc_host;
- fc_host = shost_to_fc_host(lport->host);
- /* Set FDMI version to FDMI-2 specification*/
- fc_host->fdmi_version = FDMI_V2;
- fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
- fc_host_node_name(lport->host) = lport->wwnn;
- fc_host_port_name(lport->host) = lport->wwpn;
- fc_host_supported_classes(lport->host) = FC_COS_CLASS3;
- memset(fc_host_supported_fc4s(lport->host), 0,
- sizeof(fc_host_supported_fc4s(lport->host)));
- fc_host_supported_fc4s(lport->host)[2] = 1;
- fc_host_supported_fc4s(lport->host)[7] = 1;
- fc_host_num_discovered_ports(lport->host) = 4;
- /* This value is also unchanging */
- memset(fc_host_active_fc4s(lport->host), 0,
- sizeof(fc_host_active_fc4s(lport->host)));
- fc_host_active_fc4s(lport->host)[2] = 1;
- fc_host_active_fc4s(lport->host)[7] = 1;
- fc_host_maxframe_size(lport->host) = lport->mfs;
- fc_host_supported_speeds(lport->host) = 0;
- if (lport->link_supported_speeds & FC_PORTSPEED_1GBIT)
- fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_1GBIT;
- if (lport->link_supported_speeds & FC_PORTSPEED_10GBIT)
- fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_10GBIT;
- if (lport->link_supported_speeds & FC_PORTSPEED_40GBIT)
- fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_40GBIT;
- if (lport->link_supported_speeds & FC_PORTSPEED_100GBIT)
- fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_100GBIT;
- if (lport->link_supported_speeds & FC_PORTSPEED_25GBIT)
- fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_25GBIT;
- if (lport->link_supported_speeds & FC_PORTSPEED_50GBIT)
- fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_50GBIT;
- if (lport->link_supported_speeds & FC_PORTSPEED_100GBIT)
- fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_100GBIT;
- fc_fc4_add_lport(lport);
- fc_host_num_discovered_ports(lport->host) = DISCOVERED_PORTS;
- fc_host_port_state(lport->host) = FC_PORTSTATE_ONLINE;
- fc_host_max_ct_payload(lport->host) = MAX_CT_PAYLOAD;
- fc_host_num_ports(lport->host) = NUMBER_OF_PORTS;
- fc_host_bootbios_state(lport->host) = 0X00000000;
- snprintf(fc_host_bootbios_version(lport->host),
- FC_SYMBOLIC_NAME_SIZE, "%s", "Unknown");
- return 0;
- }
- EXPORT_SYMBOL(fc_lport_init);
- /**
- * fc_lport_bsg_resp() - The common response handler for FC Passthrough requests
- * @sp: The sequence for the FC Passthrough response
- * @fp: The response frame
- * @info_arg: The BSG info that the response is for
- */
- static void fc_lport_bsg_resp(struct fc_seq *sp, struct fc_frame *fp,
- void *info_arg)
- {
- struct fc_bsg_info *info = info_arg;
- struct bsg_job *job = info->job;
- struct fc_bsg_reply *bsg_reply = job->reply;
- struct fc_lport *lport = info->lport;
- struct fc_frame_header *fh;
- size_t len;
- void *buf;
- if (IS_ERR(fp)) {
- bsg_reply->result = (PTR_ERR(fp) == -FC_EX_CLOSED) ?
- -ECONNABORTED : -ETIMEDOUT;
- job->reply_len = sizeof(uint32_t);
- bsg_job_done(job, bsg_reply->result,
- bsg_reply->reply_payload_rcv_len);
- kfree(info);
- return;
- }
- mutex_lock(&lport->lp_mutex);
- fh = fc_frame_header_get(fp);
- len = fr_len(fp) - sizeof(*fh);
- buf = fc_frame_payload_get(fp, 0);
- if (fr_sof(fp) == FC_SOF_I3 && !ntohs(fh->fh_seq_cnt)) {
- /* Get the response code from the first frame payload */
- unsigned short cmd = (info->rsp_code == FC_FS_ACC) ?
- ntohs(((struct fc_ct_hdr *)buf)->ct_cmd) :
- (unsigned short)fc_frame_payload_op(fp);
- /* Save the reply status of the job */
- bsg_reply->reply_data.ctels_reply.status =
- (cmd == info->rsp_code) ?
- FC_CTELS_STATUS_OK : FC_CTELS_STATUS_REJECT;
- }
- bsg_reply->reply_payload_rcv_len +=
- fc_copy_buffer_to_sglist(buf, len, info->sg, &info->nents,
- &info->offset, NULL);
- if (fr_eof(fp) == FC_EOF_T &&
- (ntoh24(fh->fh_f_ctl) & (FC_FC_LAST_SEQ | FC_FC_END_SEQ)) ==
- (FC_FC_LAST_SEQ | FC_FC_END_SEQ)) {
- if (bsg_reply->reply_payload_rcv_len >
- job->reply_payload.payload_len)
- bsg_reply->reply_payload_rcv_len =
- job->reply_payload.payload_len;
- bsg_reply->result = 0;
- bsg_job_done(job, bsg_reply->result,
- bsg_reply->reply_payload_rcv_len);
- kfree(info);
- }
- fc_frame_free(fp);
- mutex_unlock(&lport->lp_mutex);
- }
- /**
- * fc_lport_els_request() - Send ELS passthrough request
- * @job: The BSG Passthrough job
- * @lport: The local port sending the request
- * @did: The destination port id
- * @tov: The timeout period (in ms)
- */
- static int fc_lport_els_request(struct bsg_job *job,
- struct fc_lport *lport,
- u32 did, u32 tov)
- {
- struct fc_bsg_info *info;
- struct fc_frame *fp;
- struct fc_frame_header *fh;
- char *pp;
- int len;
- lockdep_assert_held(&lport->lp_mutex);
- fp = fc_frame_alloc(lport, job->request_payload.payload_len);
- if (!fp)
- return -ENOMEM;
- len = job->request_payload.payload_len;
- pp = fc_frame_payload_get(fp, len);
- sg_copy_to_buffer(job->request_payload.sg_list,
- job->request_payload.sg_cnt,
- pp, len);
- fh = fc_frame_header_get(fp);
- fh->fh_r_ctl = FC_RCTL_ELS_REQ;
- hton24(fh->fh_d_id, did);
- hton24(fh->fh_s_id, lport->port_id);
- fh->fh_type = FC_TYPE_ELS;
- hton24(fh->fh_f_ctl, FC_FCTL_REQ);
- fh->fh_cs_ctl = 0;
- fh->fh_df_ctl = 0;
- fh->fh_parm_offset = 0;
- info = kzalloc(sizeof(struct fc_bsg_info), GFP_KERNEL);
- if (!info) {
- fc_frame_free(fp);
- return -ENOMEM;
- }
- info->job = job;
- info->lport = lport;
- info->rsp_code = ELS_LS_ACC;
- info->nents = job->reply_payload.sg_cnt;
- info->sg = job->reply_payload.sg_list;
- if (!fc_exch_seq_send(lport, fp, fc_lport_bsg_resp,
- NULL, info, tov)) {
- kfree(info);
- return -ECOMM;
- }
- return 0;
- }
- /**
- * fc_lport_ct_request() - Send CT Passthrough request
- * @job: The BSG Passthrough job
- * @lport: The local port sending the request
- * @did: The destination FC-ID
- * @tov: The timeout period to wait for the response
- */
- static int fc_lport_ct_request(struct bsg_job *job,
- struct fc_lport *lport, u32 did, u32 tov)
- {
- struct fc_bsg_info *info;
- struct fc_frame *fp;
- struct fc_frame_header *fh;
- struct fc_ct_req *ct;
- size_t len;
- lockdep_assert_held(&lport->lp_mutex);
- fp = fc_frame_alloc(lport, sizeof(struct fc_ct_hdr) +
- job->request_payload.payload_len);
- if (!fp)
- return -ENOMEM;
- len = job->request_payload.payload_len;
- ct = fc_frame_payload_get(fp, len);
- sg_copy_to_buffer(job->request_payload.sg_list,
- job->request_payload.sg_cnt,
- ct, len);
- fh = fc_frame_header_get(fp);
- fh->fh_r_ctl = FC_RCTL_DD_UNSOL_CTL;
- hton24(fh->fh_d_id, did);
- hton24(fh->fh_s_id, lport->port_id);
- fh->fh_type = FC_TYPE_CT;
- hton24(fh->fh_f_ctl, FC_FCTL_REQ);
- fh->fh_cs_ctl = 0;
- fh->fh_df_ctl = 0;
- fh->fh_parm_offset = 0;
- info = kzalloc(sizeof(struct fc_bsg_info), GFP_KERNEL);
- if (!info) {
- fc_frame_free(fp);
- return -ENOMEM;
- }
- info->job = job;
- info->lport = lport;
- info->rsp_code = FC_FS_ACC;
- info->nents = job->reply_payload.sg_cnt;
- info->sg = job->reply_payload.sg_list;
- if (!fc_exch_seq_send(lport, fp, fc_lport_bsg_resp,
- NULL, info, tov)) {
- kfree(info);
- return -ECOMM;
- }
- return 0;
- }
- /**
- * fc_lport_bsg_request() - The common entry point for sending
- * FC Passthrough requests
- * @job: The BSG passthrough job
- */
- int fc_lport_bsg_request(struct bsg_job *job)
- {
- struct fc_bsg_request *bsg_request = job->request;
- struct fc_bsg_reply *bsg_reply = job->reply;
- struct Scsi_Host *shost = fc_bsg_to_shost(job);
- struct fc_lport *lport = shost_priv(shost);
- struct fc_rport *rport;
- struct fc_rport_priv *rdata;
- int rc = -EINVAL;
- u32 did, tov;
- bsg_reply->reply_payload_rcv_len = 0;
- mutex_lock(&lport->lp_mutex);
- switch (bsg_request->msgcode) {
- case FC_BSG_RPT_ELS:
- rport = fc_bsg_to_rport(job);
- if (!rport)
- break;
- rdata = rport->dd_data;
- rc = fc_lport_els_request(job, lport, rport->port_id,
- rdata->e_d_tov);
- break;
- case FC_BSG_RPT_CT:
- rport = fc_bsg_to_rport(job);
- if (!rport)
- break;
- rdata = rport->dd_data;
- rc = fc_lport_ct_request(job, lport, rport->port_id,
- rdata->e_d_tov);
- break;
- case FC_BSG_HST_CT:
- did = ntoh24(bsg_request->rqst_data.h_ct.port_id);
- if (did == FC_FID_DIR_SERV) {
- rdata = lport->dns_rdata;
- if (!rdata)
- break;
- tov = rdata->e_d_tov;
- } else {
- rdata = fc_rport_lookup(lport, did);
- if (!rdata)
- break;
- tov = rdata->e_d_tov;
- kref_put(&rdata->kref, fc_rport_destroy);
- }
- rc = fc_lport_ct_request(job, lport, did, tov);
- break;
- case FC_BSG_HST_ELS_NOLOGIN:
- did = ntoh24(bsg_request->rqst_data.h_els.port_id);
- rc = fc_lport_els_request(job, lport, did, lport->e_d_tov);
- break;
- }
- mutex_unlock(&lport->lp_mutex);
- return rc;
- }
- EXPORT_SYMBOL(fc_lport_bsg_request);
|