1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382 |
- /*
- * linux/drivers/message/fusion/mptsas.c
- * For use with LSI PCI chip/adapter(s)
- * running LSI Fusion MPT (Message Passing Technology) firmware.
- *
- * Copyright (c) 1999-2007 LSI Corporation
- * (mailto:DL-MPTFusionLinux@lsi.com)
- */
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /*
- This program is free software; you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation; version 2 of the License.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- NO WARRANTY
- THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
- CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
- LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
- MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
- solely responsible for determining the appropriateness of using and
- distributing the Program and assumes all risks associated with its
- exercise of rights under this Agreement, including but not limited to
- the risks and costs of program errors, damage to or loss of data,
- programs or equipment, and unavailability or interruption of operations.
- DISCLAIMER OF LIABILITY
- NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
- DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
- ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
- TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
- USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
- HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
- You should have received a copy of the GNU General Public License
- along with this program; if not, write to the Free Software
- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
- */
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- #include <linux/module.h>
- #include <linux/kernel.h>
- #include <linux/init.h>
- #include <linux/errno.h>
- #include <linux/jiffies.h>
- #include <linux/workqueue.h>
- #include <linux/delay.h> /* for mdelay */
- #include <scsi/scsi.h>
- #include <scsi/scsi_cmnd.h>
- #include <scsi/scsi_device.h>
- #include <scsi/scsi_host.h>
- #include <scsi/scsi_transport_sas.h>
- #include <scsi/scsi_dbg.h>
- #include "mptbase.h"
- #include "mptscsih.h"
- #include "mptsas.h"
- #define my_NAME "Fusion MPT SAS Host driver"
- #define my_VERSION MPT_LINUX_VERSION_COMMON
- #define MYNAM "mptsas"
- /*
- * Reserved channel for integrated raid
- */
- #define MPTSAS_RAID_CHANNEL 1
- MODULE_AUTHOR(MODULEAUTHOR);
- MODULE_DESCRIPTION(my_NAME);
- MODULE_LICENSE("GPL");
- MODULE_VERSION(my_VERSION);
- static int mpt_pt_clear;
- module_param(mpt_pt_clear, int, 0);
- MODULE_PARM_DESC(mpt_pt_clear,
- " Clear persistency table: enable=1 "
- "(default=MPTSCSIH_PT_CLEAR=0)");
- /* scsi-mid layer global parmeter is max_report_luns, which is 511 */
- #define MPTSAS_MAX_LUN (16895)
- static int max_lun = MPTSAS_MAX_LUN;
- module_param(max_lun, int, 0);
- MODULE_PARM_DESC(max_lun, " max lun, default=16895 ");
- static u8 mptsasDoneCtx = MPT_MAX_PROTOCOL_DRIVERS;
- static u8 mptsasTaskCtx = MPT_MAX_PROTOCOL_DRIVERS;
- static u8 mptsasInternalCtx = MPT_MAX_PROTOCOL_DRIVERS; /* Used only for internal commands */
- static u8 mptsasMgmtCtx = MPT_MAX_PROTOCOL_DRIVERS;
- static void mptsas_hotplug_work(struct work_struct *work);
- static void mptsas_print_phy_data(MPT_ADAPTER *ioc,
- MPI_SAS_IO_UNIT0_PHY_DATA *phy_data)
- {
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "---- IO UNIT PAGE 0 ------------\n", ioc->name));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
- ioc->name, le16_to_cpu(phy_data->AttachedDeviceHandle)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Controller Handle=0x%X\n",
- ioc->name, le16_to_cpu(phy_data->ControllerDevHandle)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port=0x%X\n",
- ioc->name, phy_data->Port));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port Flags=0x%X\n",
- ioc->name, phy_data->PortFlags));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Flags=0x%X\n",
- ioc->name, phy_data->PhyFlags));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
- ioc->name, phy_data->NegotiatedLinkRate));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "Controller PHY Device Info=0x%X\n", ioc->name,
- le32_to_cpu(phy_data->ControllerPhyDeviceInfo)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "DiscoveryStatus=0x%X\n\n",
- ioc->name, le32_to_cpu(phy_data->DiscoveryStatus)));
- }
- static void mptsas_print_phy_pg0(MPT_ADAPTER *ioc, SasPhyPage0_t *pg0)
- {
- __le64 sas_address;
- memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "---- SAS PHY PAGE 0 ------------\n", ioc->name));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "Attached Device Handle=0x%X\n", ioc->name,
- le16_to_cpu(pg0->AttachedDevHandle)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
- ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "Attached PHY Identifier=0x%X\n", ioc->name,
- pg0->AttachedPhyIdentifier));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Attached Device Info=0x%X\n",
- ioc->name, le32_to_cpu(pg0->AttachedDeviceInfo)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
- ioc->name, pg0->ProgrammedLinkRate));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Change Count=0x%X\n",
- ioc->name, pg0->ChangeCount));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Info=0x%X\n\n",
- ioc->name, le32_to_cpu(pg0->PhyInfo)));
- }
- static void mptsas_print_phy_pg1(MPT_ADAPTER *ioc, SasPhyPage1_t *pg1)
- {
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "---- SAS PHY PAGE 1 ------------\n", ioc->name));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Invalid Dword Count=0x%x\n",
- ioc->name, pg1->InvalidDwordCount));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "Running Disparity Error Count=0x%x\n", ioc->name,
- pg1->RunningDisparityErrorCount));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "Loss Dword Synch Count=0x%x\n", ioc->name,
- pg1->LossDwordSynchCount));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "PHY Reset Problem Count=0x%x\n\n", ioc->name,
- pg1->PhyResetProblemCount));
- }
- static void mptsas_print_device_pg0(MPT_ADAPTER *ioc, SasDevicePage0_t *pg0)
- {
- __le64 sas_address;
- memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "---- SAS DEVICE PAGE 0 ---------\n", ioc->name));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
- ioc->name, le16_to_cpu(pg0->DevHandle)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Handle=0x%X\n",
- ioc->name, le16_to_cpu(pg0->ParentDevHandle)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Enclosure Handle=0x%X\n",
- ioc->name, le16_to_cpu(pg0->EnclosureHandle)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Slot=0x%X\n",
- ioc->name, le16_to_cpu(pg0->Slot)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
- ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Target ID=0x%X\n",
- ioc->name, pg0->TargetID));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Bus=0x%X\n",
- ioc->name, pg0->Bus));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Phy Num=0x%X\n",
- ioc->name, pg0->PhyNum));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Access Status=0x%X\n",
- ioc->name, le16_to_cpu(pg0->AccessStatus)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Device Info=0x%X\n",
- ioc->name, le32_to_cpu(pg0->DeviceInfo)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Flags=0x%X\n",
- ioc->name, le16_to_cpu(pg0->Flags)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n\n",
- ioc->name, pg0->PhysicalPort));
- }
- static void mptsas_print_expander_pg1(MPT_ADAPTER *ioc, SasExpanderPage1_t *pg1)
- {
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "---- SAS EXPANDER PAGE 1 ------------\n", ioc->name));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n",
- ioc->name, pg1->PhysicalPort));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Identifier=0x%X\n",
- ioc->name, pg1->PhyIdentifier));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
- ioc->name, pg1->NegotiatedLinkRate));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
- ioc->name, pg1->ProgrammedLinkRate));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Hardware Link Rate=0x%X\n",
- ioc->name, pg1->HwLinkRate));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Owner Device Handle=0x%X\n",
- ioc->name, le16_to_cpu(pg1->OwnerDevHandle)));
- dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "Attached Device Handle=0x%X\n\n", ioc->name,
- le16_to_cpu(pg1->AttachedDevHandle)));
- }
- static inline MPT_ADAPTER *phy_to_ioc(struct sas_phy *phy)
- {
- struct Scsi_Host *shost = dev_to_shost(phy->dev.parent);
- return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
- }
- static inline MPT_ADAPTER *rphy_to_ioc(struct sas_rphy *rphy)
- {
- struct Scsi_Host *shost = dev_to_shost(rphy->dev.parent->parent);
- return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
- }
- /*
- * mptsas_find_portinfo_by_handle
- *
- * This function should be called with the sas_topology_mutex already held
- */
- static struct mptsas_portinfo *
- mptsas_find_portinfo_by_handle(MPT_ADAPTER *ioc, u16 handle)
- {
- struct mptsas_portinfo *port_info, *rc=NULL;
- int i;
- list_for_each_entry(port_info, &ioc->sas_topology, list)
- for (i = 0; i < port_info->num_phys; i++)
- if (port_info->phy_info[i].identify.handle == handle) {
- rc = port_info;
- goto out;
- }
- out:
- return rc;
- }
- /*
- * Returns true if there is a scsi end device
- */
- static inline int
- mptsas_is_end_device(struct mptsas_devinfo * attached)
- {
- if ((attached->sas_address) &&
- (attached->device_info &
- MPI_SAS_DEVICE_INFO_END_DEVICE) &&
- ((attached->device_info &
- MPI_SAS_DEVICE_INFO_SSP_TARGET) |
- (attached->device_info &
- MPI_SAS_DEVICE_INFO_STP_TARGET) |
- (attached->device_info &
- MPI_SAS_DEVICE_INFO_SATA_DEVICE)))
- return 1;
- else
- return 0;
- }
- /* no mutex */
- static void
- mptsas_port_delete(MPT_ADAPTER *ioc, struct mptsas_portinfo_details * port_details)
- {
- struct mptsas_portinfo *port_info;
- struct mptsas_phyinfo *phy_info;
- u8 i;
- if (!port_details)
- return;
- port_info = port_details->port_info;
- phy_info = port_info->phy_info;
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: [%p]: num_phys=%02d "
- "bitmask=0x%016llX\n", ioc->name, __FUNCTION__, port_details,
- port_details->num_phys, (unsigned long long)
- port_details->phy_bitmask));
- for (i = 0; i < port_info->num_phys; i++, phy_info++) {
- if(phy_info->port_details != port_details)
- continue;
- memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
- phy_info->port_details = NULL;
- }
- kfree(port_details);
- }
- static inline struct sas_rphy *
- mptsas_get_rphy(struct mptsas_phyinfo *phy_info)
- {
- if (phy_info->port_details)
- return phy_info->port_details->rphy;
- else
- return NULL;
- }
- static inline void
- mptsas_set_rphy(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_rphy *rphy)
- {
- if (phy_info->port_details) {
- phy_info->port_details->rphy = rphy;
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "sas_rphy_add: rphy=%p\n",
- ioc->name, rphy));
- }
- if (rphy) {
- dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
- &rphy->dev, MYIOC_s_FMT "add:", ioc->name));
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "rphy=%p release=%p\n",
- ioc->name, rphy, rphy->dev.release));
- }
- }
- static inline struct sas_port *
- mptsas_get_port(struct mptsas_phyinfo *phy_info)
- {
- if (phy_info->port_details)
- return phy_info->port_details->port;
- else
- return NULL;
- }
- static inline void
- mptsas_set_port(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_port *port)
- {
- if (phy_info->port_details)
- phy_info->port_details->port = port;
- if (port) {
- dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
- &port->dev, MYIOC_s_FMT "add:", ioc->name));
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "port=%p release=%p\n",
- ioc->name, port, port->dev.release));
- }
- }
- static inline struct scsi_target *
- mptsas_get_starget(struct mptsas_phyinfo *phy_info)
- {
- if (phy_info->port_details)
- return phy_info->port_details->starget;
- else
- return NULL;
- }
- static inline void
- mptsas_set_starget(struct mptsas_phyinfo *phy_info, struct scsi_target *
- starget)
- {
- if (phy_info->port_details)
- phy_info->port_details->starget = starget;
- }
- /*
- * mptsas_setup_wide_ports
- *
- * Updates for new and existing narrow/wide port configuration
- * in the sas_topology
- */
- static void
- mptsas_setup_wide_ports(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
- {
- struct mptsas_portinfo_details * port_details;
- struct mptsas_phyinfo *phy_info, *phy_info_cmp;
- u64 sas_address;
- int i, j;
- mutex_lock(&ioc->sas_topology_mutex);
- phy_info = port_info->phy_info;
- for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
- if (phy_info->attached.handle)
- continue;
- port_details = phy_info->port_details;
- if (!port_details)
- continue;
- if (port_details->num_phys < 2)
- continue;
- /*
- * Removing a phy from a port, letting the last
- * phy be removed by firmware events.
- */
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "%s: [%p]: deleting phy = %d\n",
- ioc->name, __FUNCTION__, port_details, i));
- port_details->num_phys--;
- port_details->phy_bitmask &= ~ (1 << phy_info->phy_id);
- memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
- sas_port_delete_phy(port_details->port, phy_info->phy);
- phy_info->port_details = NULL;
- }
- /*
- * Populate and refresh the tree
- */
- phy_info = port_info->phy_info;
- for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
- sas_address = phy_info->attached.sas_address;
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "phy_id=%d sas_address=0x%018llX\n",
- ioc->name, i, (unsigned long long)sas_address));
- if (!sas_address)
- continue;
- port_details = phy_info->port_details;
- /*
- * Forming a port
- */
- if (!port_details) {
- port_details = kzalloc(sizeof(*port_details),
- GFP_KERNEL);
- if (!port_details)
- goto out;
- port_details->num_phys = 1;
- port_details->port_info = port_info;
- if (phy_info->phy_id < 64 )
- port_details->phy_bitmask |=
- (1 << phy_info->phy_id);
- phy_info->sas_port_add_phy=1;
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tForming port\n\t\t"
- "phy_id=%d sas_address=0x%018llX\n",
- ioc->name, i, (unsigned long long)sas_address));
- phy_info->port_details = port_details;
- }
- if (i == port_info->num_phys - 1)
- continue;
- phy_info_cmp = &port_info->phy_info[i + 1];
- for (j = i + 1 ; j < port_info->num_phys ; j++,
- phy_info_cmp++) {
- if (!phy_info_cmp->attached.sas_address)
- continue;
- if (sas_address != phy_info_cmp->attached.sas_address)
- continue;
- if (phy_info_cmp->port_details == port_details )
- continue;
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "\t\tphy_id=%d sas_address=0x%018llX\n",
- ioc->name, j, (unsigned long long)
- phy_info_cmp->attached.sas_address));
- if (phy_info_cmp->port_details) {
- port_details->rphy =
- mptsas_get_rphy(phy_info_cmp);
- port_details->port =
- mptsas_get_port(phy_info_cmp);
- port_details->starget =
- mptsas_get_starget(phy_info_cmp);
- port_details->num_phys =
- phy_info_cmp->port_details->num_phys;
- if (!phy_info_cmp->port_details->num_phys)
- kfree(phy_info_cmp->port_details);
- } else
- phy_info_cmp->sas_port_add_phy=1;
- /*
- * Adding a phy to a port
- */
- phy_info_cmp->port_details = port_details;
- if (phy_info_cmp->phy_id < 64 )
- port_details->phy_bitmask |=
- (1 << phy_info_cmp->phy_id);
- port_details->num_phys++;
- }
- }
- out:
- for (i = 0; i < port_info->num_phys; i++) {
- port_details = port_info->phy_info[i].port_details;
- if (!port_details)
- continue;
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "%s: [%p]: phy_id=%02d num_phys=%02d "
- "bitmask=0x%016llX\n", ioc->name, __FUNCTION__,
- port_details, i, port_details->num_phys,
- (unsigned long long)port_details->phy_bitmask));
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tport = %p rphy=%p\n",
- ioc->name, port_details->port, port_details->rphy));
- }
- dsaswideprintk(ioc, printk("\n"));
- mutex_unlock(&ioc->sas_topology_mutex);
- }
- /**
- * csmisas_find_vtarget
- *
- * @ioc
- * @volume_id
- * @volume_bus
- *
- **/
- static VirtTarget *
- mptsas_find_vtarget(MPT_ADAPTER *ioc, u8 channel, u8 id)
- {
- struct scsi_device *sdev;
- VirtDevice *vdevice;
- VirtTarget *vtarget = NULL;
- shost_for_each_device(sdev, ioc->sh) {
- if ((vdevice = sdev->hostdata) == NULL)
- continue;
- if (vdevice->vtarget->id == id &&
- vdevice->vtarget->channel == channel)
- vtarget = vdevice->vtarget;
- }
- return vtarget;
- }
- /**
- * mptsas_target_reset
- *
- * Issues TARGET_RESET to end device using handshaking method
- *
- * @ioc
- * @channel
- * @id
- *
- * Returns (1) success
- * (0) failure
- *
- **/
- static int
- mptsas_target_reset(MPT_ADAPTER *ioc, u8 channel, u8 id)
- {
- MPT_FRAME_HDR *mf;
- SCSITaskMgmt_t *pScsiTm;
- if ((mf = mpt_get_msg_frame(ioc->TaskCtx, ioc)) == NULL) {
- dfailprintk(ioc, printk(MYIOC_s_WARN_FMT "%s, no msg frames @%d!!\n",
- ioc->name,__FUNCTION__, __LINE__));
- return 0;
- }
- /* Format the Request
- */
- pScsiTm = (SCSITaskMgmt_t *) mf;
- memset (pScsiTm, 0, sizeof(SCSITaskMgmt_t));
- pScsiTm->TargetID = id;
- pScsiTm->Bus = channel;
- pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
- pScsiTm->TaskType = MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET;
- pScsiTm->MsgFlags = MPI_SCSITASKMGMT_MSGFLAGS_LIPRESET_RESET_OPTION;
- DBG_DUMP_TM_REQUEST_FRAME(ioc, (u32 *)mf);
- mpt_put_msg_frame_hi_pri(ioc->TaskCtx, ioc, mf);
- return 1;
- }
- /**
- * mptsas_target_reset_queue
- *
- * Receive request for TARGET_RESET after recieving an firmware
- * event NOT_RESPONDING_EVENT, then put command in link list
- * and queue if task_queue already in use.
- *
- * @ioc
- * @sas_event_data
- *
- **/
- static void
- mptsas_target_reset_queue(MPT_ADAPTER *ioc,
- EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data)
- {
- MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
- VirtTarget *vtarget = NULL;
- struct mptsas_target_reset_event *target_reset_list;
- u8 id, channel;
- id = sas_event_data->TargetID;
- channel = sas_event_data->Bus;
- if (!(vtarget = mptsas_find_vtarget(ioc, channel, id)))
- return;
- vtarget->deleted = 1; /* block IO */
- target_reset_list = kzalloc(sizeof(*target_reset_list),
- GFP_ATOMIC);
- if (!target_reset_list) {
- dfailprintk(ioc, printk(MYIOC_s_WARN_FMT "%s, failed to allocate mem @%d..!!\n",
- ioc->name,__FUNCTION__, __LINE__));
- return;
- }
- memcpy(&target_reset_list->sas_event_data, sas_event_data,
- sizeof(*sas_event_data));
- list_add_tail(&target_reset_list->list, &hd->target_reset_list);
- if (hd->resetPending)
- return;
- if (mptsas_target_reset(ioc, channel, id)) {
- target_reset_list->target_reset_issued = 1;
- hd->resetPending = 1;
- }
- }
- /**
- * mptsas_dev_reset_complete
- *
- * Completion for TARGET_RESET after NOT_RESPONDING_EVENT,
- * enable work queue to finish off removing device from upper layers.
- * then send next TARGET_RESET in the queue.
- *
- * @ioc
- *
- **/
- static void
- mptsas_dev_reset_complete(MPT_ADAPTER *ioc)
- {
- MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
- struct list_head *head = &hd->target_reset_list;
- struct mptsas_target_reset_event *target_reset_list;
- struct mptsas_hotplug_event *ev;
- EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data;
- u8 id, channel;
- __le64 sas_address;
- if (list_empty(head))
- return;
- target_reset_list = list_entry(head->next, struct mptsas_target_reset_event, list);
- sas_event_data = &target_reset_list->sas_event_data;
- id = sas_event_data->TargetID;
- channel = sas_event_data->Bus;
- hd->resetPending = 0;
- /*
- * retry target reset
- */
- if (!target_reset_list->target_reset_issued) {
- if (mptsas_target_reset(ioc, channel, id)) {
- target_reset_list->target_reset_issued = 1;
- hd->resetPending = 1;
- }
- return;
- }
- /*
- * enable work queue to remove device from upper layers
- */
- list_del(&target_reset_list->list);
- ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
- if (!ev) {
- dfailprintk(ioc, printk(MYIOC_s_WARN_FMT "%s, failed to allocate mem @%d..!!\n",
- ioc->name,__FUNCTION__, __LINE__));
- return;
- }
- INIT_WORK(&ev->work, mptsas_hotplug_work);
- ev->ioc = ioc;
- ev->handle = le16_to_cpu(sas_event_data->DevHandle);
- ev->parent_handle =
- le16_to_cpu(sas_event_data->ParentDevHandle);
- ev->channel = channel;
- ev->id =id;
- ev->phy_id = sas_event_data->PhyNum;
- memcpy(&sas_address, &sas_event_data->SASAddress,
- sizeof(__le64));
- ev->sas_address = le64_to_cpu(sas_address);
- ev->device_info = le32_to_cpu(sas_event_data->DeviceInfo);
- ev->event_type = MPTSAS_DEL_DEVICE;
- schedule_work(&ev->work);
- kfree(target_reset_list);
- /*
- * issue target reset to next device in the queue
- */
- head = &hd->target_reset_list;
- if (list_empty(head))
- return;
- target_reset_list = list_entry(head->next, struct mptsas_target_reset_event,
- list);
- sas_event_data = &target_reset_list->sas_event_data;
- id = sas_event_data->TargetID;
- channel = sas_event_data->Bus;
- if (mptsas_target_reset(ioc, channel, id)) {
- target_reset_list->target_reset_issued = 1;
- hd->resetPending = 1;
- }
- }
- /**
- * mptsas_taskmgmt_complete
- *
- * @ioc
- * @mf
- * @mr
- *
- **/
- static int
- mptsas_taskmgmt_complete(MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf, MPT_FRAME_HDR *mr)
- {
- mptsas_dev_reset_complete(ioc);
- return mptscsih_taskmgmt_complete(ioc, mf, mr);
- }
- /**
- * mptscsih_ioc_reset
- *
- * @ioc
- * @reset_phase
- *
- **/
- static int
- mptsas_ioc_reset(MPT_ADAPTER *ioc, int reset_phase)
- {
- MPT_SCSI_HOST *hd;
- struct mptsas_target_reset_event *target_reset_list, *n;
- int rc;
- rc = mptscsih_ioc_reset(ioc, reset_phase);
- if (ioc->bus_type != SAS)
- goto out;
- if (reset_phase != MPT_IOC_POST_RESET)
- goto out;
- if (!ioc->sh || !ioc->sh->hostdata)
- goto out;
- hd = shost_priv(ioc->sh);
- if (!hd->ioc)
- goto out;
- if (list_empty(&hd->target_reset_list))
- goto out;
- /* flush the target_reset_list */
- list_for_each_entry_safe(target_reset_list, n,
- &hd->target_reset_list, list) {
- list_del(&target_reset_list->list);
- kfree(target_reset_list);
- }
- out:
- return rc;
- }
- static int
- mptsas_sas_enclosure_pg0(MPT_ADAPTER *ioc, struct mptsas_enclosure *enclosure,
- u32 form, u32 form_specific)
- {
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasEnclosurePage0_t *buffer;
- dma_addr_t dma_handle;
- int error;
- __le64 le_identifier;
- memset(&hdr, 0, sizeof(hdr));
- hdr.PageVersion = MPI_SASENCLOSURE0_PAGEVERSION;
- hdr.PageNumber = 0;
- hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_ENCLOSURE;
- cfg.cfghdr.ehdr = &hdr;
- cfg.physAddr = -1;
- cfg.pageAddr = form + form_specific;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- cfg.dir = 0; /* read */
- cfg.timeout = 10;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out;
- if (!hdr.ExtPageLength) {
- error = -ENXIO;
- goto out;
- }
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer) {
- error = -ENOMEM;
- goto out;
- }
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- /* save config data */
- memcpy(&le_identifier, &buffer->EnclosureLogicalID, sizeof(__le64));
- enclosure->enclosure_logical_id = le64_to_cpu(le_identifier);
- enclosure->enclosure_handle = le16_to_cpu(buffer->EnclosureHandle);
- enclosure->flags = le16_to_cpu(buffer->Flags);
- enclosure->num_slot = le16_to_cpu(buffer->NumSlots);
- enclosure->start_slot = le16_to_cpu(buffer->StartSlot);
- enclosure->start_id = buffer->StartTargetID;
- enclosure->start_channel = buffer->StartBus;
- enclosure->sep_id = buffer->SEPTargetID;
- enclosure->sep_channel = buffer->SEPBus;
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- out:
- return error;
- }
- static int
- mptsas_slave_configure(struct scsi_device *sdev)
- {
- if (sdev->channel == MPTSAS_RAID_CHANNEL)
- goto out;
- sas_read_port_mode_page(sdev);
- out:
- return mptscsih_slave_configure(sdev);
- }
- static int
- mptsas_target_alloc(struct scsi_target *starget)
- {
- struct Scsi_Host *host = dev_to_shost(&starget->dev);
- MPT_SCSI_HOST *hd = shost_priv(host);
- VirtTarget *vtarget;
- u8 id, channel;
- struct sas_rphy *rphy;
- struct mptsas_portinfo *p;
- int i;
- MPT_ADAPTER *ioc = hd->ioc;
- vtarget = kzalloc(sizeof(VirtTarget), GFP_KERNEL);
- if (!vtarget)
- return -ENOMEM;
- vtarget->starget = starget;
- vtarget->ioc_id = ioc->id;
- vtarget->tflags = MPT_TARGET_FLAGS_Q_YES;
- id = starget->id;
- channel = 0;
- /*
- * RAID volumes placed beyond the last expected port.
- */
- if (starget->channel == MPTSAS_RAID_CHANNEL) {
- for (i=0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++)
- if (id == ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID)
- channel = ioc->raid_data.pIocPg2->RaidVolume[i].VolumeBus;
- goto out;
- }
- rphy = dev_to_rphy(starget->dev.parent);
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(p, &ioc->sas_topology, list) {
- for (i = 0; i < p->num_phys; i++) {
- if (p->phy_info[i].attached.sas_address !=
- rphy->identify.sas_address)
- continue;
- id = p->phy_info[i].attached.id;
- channel = p->phy_info[i].attached.channel;
- mptsas_set_starget(&p->phy_info[i], starget);
- /*
- * Exposing hidden raid components
- */
- if (mptscsih_is_phys_disk(ioc, channel, id)) {
- id = mptscsih_raid_id_to_num(ioc,
- channel, id);
- vtarget->tflags |=
- MPT_TARGET_FLAGS_RAID_COMPONENT;
- p->phy_info[i].attached.phys_disk_num = id;
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- goto out;
- }
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- kfree(vtarget);
- return -ENXIO;
- out:
- vtarget->id = id;
- vtarget->channel = channel;
- starget->hostdata = vtarget;
- return 0;
- }
- static void
- mptsas_target_destroy(struct scsi_target *starget)
- {
- struct Scsi_Host *host = dev_to_shost(&starget->dev);
- MPT_SCSI_HOST *hd = shost_priv(host);
- struct sas_rphy *rphy;
- struct mptsas_portinfo *p;
- int i;
- MPT_ADAPTER *ioc = hd->ioc;
- if (!starget->hostdata)
- return;
- if (starget->channel == MPTSAS_RAID_CHANNEL)
- goto out;
- rphy = dev_to_rphy(starget->dev.parent);
- list_for_each_entry(p, &ioc->sas_topology, list) {
- for (i = 0; i < p->num_phys; i++) {
- if (p->phy_info[i].attached.sas_address !=
- rphy->identify.sas_address)
- continue;
- mptsas_set_starget(&p->phy_info[i], NULL);
- goto out;
- }
- }
- out:
- kfree(starget->hostdata);
- starget->hostdata = NULL;
- }
- static int
- mptsas_slave_alloc(struct scsi_device *sdev)
- {
- struct Scsi_Host *host = sdev->host;
- MPT_SCSI_HOST *hd = shost_priv(host);
- struct sas_rphy *rphy;
- struct mptsas_portinfo *p;
- VirtDevice *vdevice;
- struct scsi_target *starget;
- int i;
- MPT_ADAPTER *ioc = hd->ioc;
- vdevice = kzalloc(sizeof(VirtDevice), GFP_KERNEL);
- if (!vdevice) {
- printk(MYIOC_s_ERR_FMT "slave_alloc kzalloc(%zd) FAILED!\n",
- ioc->name, sizeof(VirtDevice));
- return -ENOMEM;
- }
- starget = scsi_target(sdev);
- vdevice->vtarget = starget->hostdata;
- if (sdev->channel == MPTSAS_RAID_CHANNEL)
- goto out;
- rphy = dev_to_rphy(sdev->sdev_target->dev.parent);
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(p, &ioc->sas_topology, list) {
- for (i = 0; i < p->num_phys; i++) {
- if (p->phy_info[i].attached.sas_address !=
- rphy->identify.sas_address)
- continue;
- vdevice->lun = sdev->lun;
- /*
- * Exposing hidden raid components
- */
- if (mptscsih_is_phys_disk(ioc,
- p->phy_info[i].attached.channel,
- p->phy_info[i].attached.id))
- sdev->no_uld_attach = 1;
- mutex_unlock(&ioc->sas_topology_mutex);
- goto out;
- }
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- kfree(vdevice);
- return -ENXIO;
- out:
- vdevice->vtarget->num_luns++;
- sdev->hostdata = vdevice;
- return 0;
- }
- static int
- mptsas_qcmd(struct scsi_cmnd *SCpnt, void (*done)(struct scsi_cmnd *))
- {
- VirtDevice *vdevice = SCpnt->device->hostdata;
- if (!vdevice || !vdevice->vtarget || vdevice->vtarget->deleted) {
- SCpnt->result = DID_NO_CONNECT << 16;
- done(SCpnt);
- return 0;
- }
- // scsi_print_command(SCpnt);
- return mptscsih_qcmd(SCpnt,done);
- }
- static struct scsi_host_template mptsas_driver_template = {
- .module = THIS_MODULE,
- .proc_name = "mptsas",
- .proc_info = mptscsih_proc_info,
- .name = "MPT SPI Host",
- .info = mptscsih_info,
- .queuecommand = mptsas_qcmd,
- .target_alloc = mptsas_target_alloc,
- .slave_alloc = mptsas_slave_alloc,
- .slave_configure = mptsas_slave_configure,
- .target_destroy = mptsas_target_destroy,
- .slave_destroy = mptscsih_slave_destroy,
- .change_queue_depth = mptscsih_change_queue_depth,
- .eh_abort_handler = mptscsih_abort,
- .eh_device_reset_handler = mptscsih_dev_reset,
- .eh_bus_reset_handler = mptscsih_bus_reset,
- .eh_host_reset_handler = mptscsih_host_reset,
- .bios_param = mptscsih_bios_param,
- .can_queue = MPT_FC_CAN_QUEUE,
- .this_id = -1,
- .sg_tablesize = MPT_SCSI_SG_DEPTH,
- .max_sectors = 8192,
- .cmd_per_lun = 7,
- .use_clustering = ENABLE_CLUSTERING,
- .shost_attrs = mptscsih_host_attrs,
- };
- static int mptsas_get_linkerrors(struct sas_phy *phy)
- {
- MPT_ADAPTER *ioc = phy_to_ioc(phy);
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasPhyPage1_t *buffer;
- dma_addr_t dma_handle;
- int error;
- /* FIXME: only have link errors on local phys */
- if (!scsi_is_sas_phy_local(phy))
- return -EINVAL;
- hdr.PageVersion = MPI_SASPHY1_PAGEVERSION;
- hdr.ExtPageLength = 0;
- hdr.PageNumber = 1 /* page number 1*/;
- hdr.Reserved1 = 0;
- hdr.Reserved2 = 0;
- hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
- cfg.cfghdr.ehdr = &hdr;
- cfg.physAddr = -1;
- cfg.pageAddr = phy->identify.phy_identifier;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- cfg.dir = 0; /* read */
- cfg.timeout = 10;
- error = mpt_config(ioc, &cfg);
- if (error)
- return error;
- if (!hdr.ExtPageLength)
- return -ENXIO;
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer)
- return -ENOMEM;
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- mptsas_print_phy_pg1(ioc, buffer);
- phy->invalid_dword_count = le32_to_cpu(buffer->InvalidDwordCount);
- phy->running_disparity_error_count =
- le32_to_cpu(buffer->RunningDisparityErrorCount);
- phy->loss_of_dword_sync_count =
- le32_to_cpu(buffer->LossDwordSynchCount);
- phy->phy_reset_problem_count =
- le32_to_cpu(buffer->PhyResetProblemCount);
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- return error;
- }
- static int mptsas_mgmt_done(MPT_ADAPTER *ioc, MPT_FRAME_HDR *req,
- MPT_FRAME_HDR *reply)
- {
- ioc->sas_mgmt.status |= MPT_SAS_MGMT_STATUS_COMMAND_GOOD;
- if (reply != NULL) {
- ioc->sas_mgmt.status |= MPT_SAS_MGMT_STATUS_RF_VALID;
- memcpy(ioc->sas_mgmt.reply, reply,
- min(ioc->reply_sz, 4 * reply->u.reply.MsgLength));
- }
- complete(&ioc->sas_mgmt.done);
- return 1;
- }
- static int mptsas_phy_reset(struct sas_phy *phy, int hard_reset)
- {
- MPT_ADAPTER *ioc = phy_to_ioc(phy);
- SasIoUnitControlRequest_t *req;
- SasIoUnitControlReply_t *reply;
- MPT_FRAME_HDR *mf;
- MPIHeader_t *hdr;
- unsigned long timeleft;
- int error = -ERESTARTSYS;
- /* FIXME: fusion doesn't allow non-local phy reset */
- if (!scsi_is_sas_phy_local(phy))
- return -EINVAL;
- /* not implemented for expanders */
- if (phy->identify.target_port_protocols & SAS_PROTOCOL_SMP)
- return -ENXIO;
- if (mutex_lock_interruptible(&ioc->sas_mgmt.mutex))
- goto out;
- mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
- if (!mf) {
- error = -ENOMEM;
- goto out_unlock;
- }
- hdr = (MPIHeader_t *) mf;
- req = (SasIoUnitControlRequest_t *)mf;
- memset(req, 0, sizeof(SasIoUnitControlRequest_t));
- req->Function = MPI_FUNCTION_SAS_IO_UNIT_CONTROL;
- req->MsgContext = hdr->MsgContext;
- req->Operation = hard_reset ?
- MPI_SAS_OP_PHY_HARD_RESET : MPI_SAS_OP_PHY_LINK_RESET;
- req->PhyNum = phy->identify.phy_identifier;
- mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
- timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done,
- 10 * HZ);
- if (!timeleft) {
- /* On timeout reset the board */
- mpt_free_msg_frame(ioc, mf);
- mpt_HardResetHandler(ioc, CAN_SLEEP);
- error = -ETIMEDOUT;
- goto out_unlock;
- }
- /* a reply frame is expected */
- if ((ioc->sas_mgmt.status &
- MPT_IOCTL_STATUS_RF_VALID) == 0) {
- error = -ENXIO;
- goto out_unlock;
- }
- /* process the completed Reply Message Frame */
- reply = (SasIoUnitControlReply_t *)ioc->sas_mgmt.reply;
- if (reply->IOCStatus != MPI_IOCSTATUS_SUCCESS) {
- printk(MYIOC_s_INFO_FMT "%s: IOCStatus=0x%X IOCLogInfo=0x%X\n",
- ioc->name, __FUNCTION__, reply->IOCStatus, reply->IOCLogInfo);
- error = -ENXIO;
- goto out_unlock;
- }
- error = 0;
- out_unlock:
- mutex_unlock(&ioc->sas_mgmt.mutex);
- out:
- return error;
- }
- static int
- mptsas_get_enclosure_identifier(struct sas_rphy *rphy, u64 *identifier)
- {
- MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
- int i, error;
- struct mptsas_portinfo *p;
- struct mptsas_enclosure enclosure_info;
- u64 enclosure_handle;
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(p, &ioc->sas_topology, list) {
- for (i = 0; i < p->num_phys; i++) {
- if (p->phy_info[i].attached.sas_address ==
- rphy->identify.sas_address) {
- enclosure_handle = p->phy_info[i].
- attached.handle_enclosure;
- goto found_info;
- }
- }
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- return -ENXIO;
- found_info:
- mutex_unlock(&ioc->sas_topology_mutex);
- memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
- error = mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
- (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
- MPI_SAS_ENCLOS_PGAD_FORM_SHIFT), enclosure_handle);
- if (!error)
- *identifier = enclosure_info.enclosure_logical_id;
- return error;
- }
- static int
- mptsas_get_bay_identifier(struct sas_rphy *rphy)
- {
- MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
- struct mptsas_portinfo *p;
- int i, rc;
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(p, &ioc->sas_topology, list) {
- for (i = 0; i < p->num_phys; i++) {
- if (p->phy_info[i].attached.sas_address ==
- rphy->identify.sas_address) {
- rc = p->phy_info[i].attached.slot;
- goto out;
- }
- }
- }
- rc = -ENXIO;
- out:
- mutex_unlock(&ioc->sas_topology_mutex);
- return rc;
- }
- static int mptsas_smp_handler(struct Scsi_Host *shost, struct sas_rphy *rphy,
- struct request *req)
- {
- MPT_ADAPTER *ioc = ((MPT_SCSI_HOST *) shost->hostdata)->ioc;
- MPT_FRAME_HDR *mf;
- SmpPassthroughRequest_t *smpreq;
- struct request *rsp = req->next_rq;
- int ret;
- int flagsLength;
- unsigned long timeleft;
- char *psge;
- dma_addr_t dma_addr_in = 0;
- dma_addr_t dma_addr_out = 0;
- u64 sas_address = 0;
- if (!rsp) {
- printk(MYIOC_s_ERR_FMT "%s: the smp response space is missing\n",
- ioc->name, __FUNCTION__);
- return -EINVAL;
- }
- /* do we need to support multiple segments? */
- if (req->bio->bi_vcnt > 1 || rsp->bio->bi_vcnt > 1) {
- printk(MYIOC_s_ERR_FMT "%s: multiple segments req %u %u, rsp %u %u\n",
- ioc->name, __FUNCTION__, req->bio->bi_vcnt, req->data_len,
- rsp->bio->bi_vcnt, rsp->data_len);
- return -EINVAL;
- }
- ret = mutex_lock_interruptible(&ioc->sas_mgmt.mutex);
- if (ret)
- goto out;
- mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
- if (!mf) {
- ret = -ENOMEM;
- goto out_unlock;
- }
- smpreq = (SmpPassthroughRequest_t *)mf;
- memset(smpreq, 0, sizeof(*smpreq));
- smpreq->RequestDataLength = cpu_to_le16(req->data_len - 4);
- smpreq->Function = MPI_FUNCTION_SMP_PASSTHROUGH;
- if (rphy)
- sas_address = rphy->identify.sas_address;
- else {
- struct mptsas_portinfo *port_info;
- mutex_lock(&ioc->sas_topology_mutex);
- port_info = mptsas_find_portinfo_by_handle(ioc, ioc->handle);
- if (port_info && port_info->phy_info)
- sas_address =
- port_info->phy_info[0].phy->identify.sas_address;
- mutex_unlock(&ioc->sas_topology_mutex);
- }
- *((u64 *)&smpreq->SASAddress) = cpu_to_le64(sas_address);
- psge = (char *)
- (((int *) mf) + (offsetof(SmpPassthroughRequest_t, SGL) / 4));
- /* request */
- flagsLength = (MPI_SGE_FLAGS_SIMPLE_ELEMENT |
- MPI_SGE_FLAGS_END_OF_BUFFER |
- MPI_SGE_FLAGS_DIRECTION |
- mpt_addr_size()) << MPI_SGE_FLAGS_SHIFT;
- flagsLength |= (req->data_len - 4);
- dma_addr_out = pci_map_single(ioc->pcidev, bio_data(req->bio),
- req->data_len, PCI_DMA_BIDIRECTIONAL);
- if (!dma_addr_out)
- goto put_mf;
- mpt_add_sge(psge, flagsLength, dma_addr_out);
- psge += (sizeof(u32) + sizeof(dma_addr_t));
- /* response */
- flagsLength = MPT_SGE_FLAGS_SSIMPLE_READ;
- flagsLength |= rsp->data_len + 4;
- dma_addr_in = pci_map_single(ioc->pcidev, bio_data(rsp->bio),
- rsp->data_len, PCI_DMA_BIDIRECTIONAL);
- if (!dma_addr_in)
- goto unmap;
- mpt_add_sge(psge, flagsLength, dma_addr_in);
- mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
- timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done, 10 * HZ);
- if (!timeleft) {
- printk(MYIOC_s_ERR_FMT "%s: smp timeout!\n", ioc->name, __FUNCTION__);
- /* On timeout reset the board */
- mpt_HardResetHandler(ioc, CAN_SLEEP);
- ret = -ETIMEDOUT;
- goto unmap;
- }
- mf = NULL;
- if (ioc->sas_mgmt.status & MPT_IOCTL_STATUS_RF_VALID) {
- SmpPassthroughReply_t *smprep;
- smprep = (SmpPassthroughReply_t *)ioc->sas_mgmt.reply;
- memcpy(req->sense, smprep, sizeof(*smprep));
- req->sense_len = sizeof(*smprep);
- } else {
- printk(MYIOC_s_ERR_FMT "%s: smp passthru reply failed to be returned\n",
- ioc->name, __FUNCTION__);
- ret = -ENXIO;
- }
- unmap:
- if (dma_addr_out)
- pci_unmap_single(ioc->pcidev, dma_addr_out, req->data_len,
- PCI_DMA_BIDIRECTIONAL);
- if (dma_addr_in)
- pci_unmap_single(ioc->pcidev, dma_addr_in, rsp->data_len,
- PCI_DMA_BIDIRECTIONAL);
- put_mf:
- if (mf)
- mpt_free_msg_frame(ioc, mf);
- out_unlock:
- mutex_unlock(&ioc->sas_mgmt.mutex);
- out:
- return ret;
- }
- static struct sas_function_template mptsas_transport_functions = {
- .get_linkerrors = mptsas_get_linkerrors,
- .get_enclosure_identifier = mptsas_get_enclosure_identifier,
- .get_bay_identifier = mptsas_get_bay_identifier,
- .phy_reset = mptsas_phy_reset,
- .smp_handler = mptsas_smp_handler,
- };
- static struct scsi_transport_template *mptsas_transport_template;
- static int
- mptsas_sas_io_unit_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
- {
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasIOUnitPage0_t *buffer;
- dma_addr_t dma_handle;
- int error, i;
- hdr.PageVersion = MPI_SASIOUNITPAGE0_PAGEVERSION;
- hdr.ExtPageLength = 0;
- hdr.PageNumber = 0;
- hdr.Reserved1 = 0;
- hdr.Reserved2 = 0;
- hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
- cfg.cfghdr.ehdr = &hdr;
- cfg.physAddr = -1;
- cfg.pageAddr = 0;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- cfg.dir = 0; /* read */
- cfg.timeout = 10;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out;
- if (!hdr.ExtPageLength) {
- error = -ENXIO;
- goto out;
- }
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer) {
- error = -ENOMEM;
- goto out;
- }
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- port_info->num_phys = buffer->NumPhys;
- port_info->phy_info = kcalloc(port_info->num_phys,
- sizeof(*port_info->phy_info),GFP_KERNEL);
- if (!port_info->phy_info) {
- error = -ENOMEM;
- goto out_free_consistent;
- }
- ioc->nvdata_version_persistent =
- le16_to_cpu(buffer->NvdataVersionPersistent);
- ioc->nvdata_version_default =
- le16_to_cpu(buffer->NvdataVersionDefault);
- for (i = 0; i < port_info->num_phys; i++) {
- mptsas_print_phy_data(ioc, &buffer->PhyData[i]);
- port_info->phy_info[i].phy_id = i;
- port_info->phy_info[i].port_id =
- buffer->PhyData[i].Port;
- port_info->phy_info[i].negotiated_link_rate =
- buffer->PhyData[i].NegotiatedLinkRate;
- port_info->phy_info[i].portinfo = port_info;
- port_info->phy_info[i].handle =
- le16_to_cpu(buffer->PhyData[i].ControllerDevHandle);
- }
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- out:
- return error;
- }
- static int
- mptsas_sas_io_unit_pg1(MPT_ADAPTER *ioc)
- {
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasIOUnitPage1_t *buffer;
- dma_addr_t dma_handle;
- int error;
- u16 device_missing_delay;
- memset(&hdr, 0, sizeof(ConfigExtendedPageHeader_t));
- memset(&cfg, 0, sizeof(CONFIGPARMS));
- cfg.cfghdr.ehdr = &hdr;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- cfg.timeout = 10;
- cfg.cfghdr.ehdr->PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- cfg.cfghdr.ehdr->ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
- cfg.cfghdr.ehdr->PageVersion = MPI_SASIOUNITPAGE1_PAGEVERSION;
- cfg.cfghdr.ehdr->PageNumber = 1;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out;
- if (!hdr.ExtPageLength) {
- error = -ENXIO;
- goto out;
- }
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer) {
- error = -ENOMEM;
- goto out;
- }
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- ioc->io_missing_delay =
- le16_to_cpu(buffer->IODeviceMissingDelay);
- device_missing_delay = le16_to_cpu(buffer->ReportDeviceMissingDelay);
- ioc->device_missing_delay = (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_UNIT_16) ?
- (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK) * 16 :
- device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK;
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- out:
- return error;
- }
- static int
- mptsas_sas_phy_pg0(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
- u32 form, u32 form_specific)
- {
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasPhyPage0_t *buffer;
- dma_addr_t dma_handle;
- int error;
- hdr.PageVersion = MPI_SASPHY0_PAGEVERSION;
- hdr.ExtPageLength = 0;
- hdr.PageNumber = 0;
- hdr.Reserved1 = 0;
- hdr.Reserved2 = 0;
- hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
- cfg.cfghdr.ehdr = &hdr;
- cfg.dir = 0; /* read */
- cfg.timeout = 10;
- /* Get Phy Pg 0 for each Phy. */
- cfg.physAddr = -1;
- cfg.pageAddr = form + form_specific;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out;
- if (!hdr.ExtPageLength) {
- error = -ENXIO;
- goto out;
- }
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer) {
- error = -ENOMEM;
- goto out;
- }
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- mptsas_print_phy_pg0(ioc, buffer);
- phy_info->hw_link_rate = buffer->HwLinkRate;
- phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
- phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
- phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- out:
- return error;
- }
- static int
- mptsas_sas_device_pg0(MPT_ADAPTER *ioc, struct mptsas_devinfo *device_info,
- u32 form, u32 form_specific)
- {
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasDevicePage0_t *buffer;
- dma_addr_t dma_handle;
- __le64 sas_address;
- int error=0;
- if (ioc->sas_discovery_runtime &&
- mptsas_is_end_device(device_info))
- goto out;
- hdr.PageVersion = MPI_SASDEVICE0_PAGEVERSION;
- hdr.ExtPageLength = 0;
- hdr.PageNumber = 0;
- hdr.Reserved1 = 0;
- hdr.Reserved2 = 0;
- hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE;
- cfg.cfghdr.ehdr = &hdr;
- cfg.pageAddr = form + form_specific;
- cfg.physAddr = -1;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- cfg.dir = 0; /* read */
- cfg.timeout = 10;
- memset(device_info, 0, sizeof(struct mptsas_devinfo));
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out;
- if (!hdr.ExtPageLength) {
- error = -ENXIO;
- goto out;
- }
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer) {
- error = -ENOMEM;
- goto out;
- }
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- mptsas_print_device_pg0(ioc, buffer);
- device_info->handle = le16_to_cpu(buffer->DevHandle);
- device_info->handle_parent = le16_to_cpu(buffer->ParentDevHandle);
- device_info->handle_enclosure =
- le16_to_cpu(buffer->EnclosureHandle);
- device_info->slot = le16_to_cpu(buffer->Slot);
- device_info->phy_id = buffer->PhyNum;
- device_info->port_id = buffer->PhysicalPort;
- device_info->id = buffer->TargetID;
- device_info->phys_disk_num = ~0;
- device_info->channel = buffer->Bus;
- memcpy(&sas_address, &buffer->SASAddress, sizeof(__le64));
- device_info->sas_address = le64_to_cpu(sas_address);
- device_info->device_info =
- le32_to_cpu(buffer->DeviceInfo);
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- out:
- return error;
- }
- static int
- mptsas_sas_expander_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info,
- u32 form, u32 form_specific)
- {
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasExpanderPage0_t *buffer;
- dma_addr_t dma_handle;
- int i, error;
- hdr.PageVersion = MPI_SASEXPANDER0_PAGEVERSION;
- hdr.ExtPageLength = 0;
- hdr.PageNumber = 0;
- hdr.Reserved1 = 0;
- hdr.Reserved2 = 0;
- hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
- cfg.cfghdr.ehdr = &hdr;
- cfg.physAddr = -1;
- cfg.pageAddr = form + form_specific;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- cfg.dir = 0; /* read */
- cfg.timeout = 10;
- memset(port_info, 0, sizeof(struct mptsas_portinfo));
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out;
- if (!hdr.ExtPageLength) {
- error = -ENXIO;
- goto out;
- }
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer) {
- error = -ENOMEM;
- goto out;
- }
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- /* save config data */
- port_info->num_phys = buffer->NumPhys;
- port_info->phy_info = kcalloc(port_info->num_phys,
- sizeof(*port_info->phy_info),GFP_KERNEL);
- if (!port_info->phy_info) {
- error = -ENOMEM;
- goto out_free_consistent;
- }
- for (i = 0; i < port_info->num_phys; i++) {
- port_info->phy_info[i].portinfo = port_info;
- port_info->phy_info[i].handle =
- le16_to_cpu(buffer->DevHandle);
- }
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- out:
- return error;
- }
- static int
- mptsas_sas_expander_pg1(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
- u32 form, u32 form_specific)
- {
- ConfigExtendedPageHeader_t hdr;
- CONFIGPARMS cfg;
- SasExpanderPage1_t *buffer;
- dma_addr_t dma_handle;
- int error=0;
- if (ioc->sas_discovery_runtime &&
- mptsas_is_end_device(&phy_info->attached))
- goto out;
- hdr.PageVersion = MPI_SASEXPANDER0_PAGEVERSION;
- hdr.ExtPageLength = 0;
- hdr.PageNumber = 1;
- hdr.Reserved1 = 0;
- hdr.Reserved2 = 0;
- hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
- hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
- cfg.cfghdr.ehdr = &hdr;
- cfg.physAddr = -1;
- cfg.pageAddr = form + form_specific;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- cfg.dir = 0; /* read */
- cfg.timeout = 10;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out;
- if (!hdr.ExtPageLength) {
- error = -ENXIO;
- goto out;
- }
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- &dma_handle);
- if (!buffer) {
- error = -ENOMEM;
- goto out;
- }
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- error = mpt_config(ioc, &cfg);
- if (error)
- goto out_free_consistent;
- mptsas_print_expander_pg1(ioc, buffer);
- /* save config data */
- phy_info->phy_id = buffer->PhyIdentifier;
- phy_info->port_id = buffer->PhysicalPort;
- phy_info->negotiated_link_rate = buffer->NegotiatedLinkRate;
- phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
- phy_info->hw_link_rate = buffer->HwLinkRate;
- phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
- phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
- out_free_consistent:
- pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
- buffer, dma_handle);
- out:
- return error;
- }
- static void
- mptsas_parse_device_info(struct sas_identify *identify,
- struct mptsas_devinfo *device_info)
- {
- u16 protocols;
- identify->sas_address = device_info->sas_address;
- identify->phy_identifier = device_info->phy_id;
- /*
- * Fill in Phy Initiator Port Protocol.
- * Bits 6:3, more than one bit can be set, fall through cases.
- */
- protocols = device_info->device_info & 0x78;
- identify->initiator_port_protocols = 0;
- if (protocols & MPI_SAS_DEVICE_INFO_SSP_INITIATOR)
- identify->initiator_port_protocols |= SAS_PROTOCOL_SSP;
- if (protocols & MPI_SAS_DEVICE_INFO_STP_INITIATOR)
- identify->initiator_port_protocols |= SAS_PROTOCOL_STP;
- if (protocols & MPI_SAS_DEVICE_INFO_SMP_INITIATOR)
- identify->initiator_port_protocols |= SAS_PROTOCOL_SMP;
- if (protocols & MPI_SAS_DEVICE_INFO_SATA_HOST)
- identify->initiator_port_protocols |= SAS_PROTOCOL_SATA;
- /*
- * Fill in Phy Target Port Protocol.
- * Bits 10:7, more than one bit can be set, fall through cases.
- */
- protocols = device_info->device_info & 0x780;
- identify->target_port_protocols = 0;
- if (protocols & MPI_SAS_DEVICE_INFO_SSP_TARGET)
- identify->target_port_protocols |= SAS_PROTOCOL_SSP;
- if (protocols & MPI_SAS_DEVICE_INFO_STP_TARGET)
- identify->target_port_protocols |= SAS_PROTOCOL_STP;
- if (protocols & MPI_SAS_DEVICE_INFO_SMP_TARGET)
- identify->target_port_protocols |= SAS_PROTOCOL_SMP;
- if (protocols & MPI_SAS_DEVICE_INFO_SATA_DEVICE)
- identify->target_port_protocols |= SAS_PROTOCOL_SATA;
- /*
- * Fill in Attached device type.
- */
- switch (device_info->device_info &
- MPI_SAS_DEVICE_INFO_MASK_DEVICE_TYPE) {
- case MPI_SAS_DEVICE_INFO_NO_DEVICE:
- identify->device_type = SAS_PHY_UNUSED;
- break;
- case MPI_SAS_DEVICE_INFO_END_DEVICE:
- identify->device_type = SAS_END_DEVICE;
- break;
- case MPI_SAS_DEVICE_INFO_EDGE_EXPANDER:
- identify->device_type = SAS_EDGE_EXPANDER_DEVICE;
- break;
- case MPI_SAS_DEVICE_INFO_FANOUT_EXPANDER:
- identify->device_type = SAS_FANOUT_EXPANDER_DEVICE;
- break;
- }
- }
- static int mptsas_probe_one_phy(struct device *dev,
- struct mptsas_phyinfo *phy_info, int index, int local)
- {
- MPT_ADAPTER *ioc;
- struct sas_phy *phy;
- struct sas_port *port;
- int error = 0;
- if (!dev) {
- error = -ENODEV;
- goto out;
- }
- if (!phy_info->phy) {
- phy = sas_phy_alloc(dev, index);
- if (!phy) {
- error = -ENOMEM;
- goto out;
- }
- } else
- phy = phy_info->phy;
- mptsas_parse_device_info(&phy->identify, &phy_info->identify);
- /*
- * Set Negotiated link rate.
- */
- switch (phy_info->negotiated_link_rate) {
- case MPI_SAS_IOUNIT0_RATE_PHY_DISABLED:
- phy->negotiated_linkrate = SAS_PHY_DISABLED;
- break;
- case MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION:
- phy->negotiated_linkrate = SAS_LINK_RATE_FAILED;
- break;
- case MPI_SAS_IOUNIT0_RATE_1_5:
- phy->negotiated_linkrate = SAS_LINK_RATE_1_5_GBPS;
- break;
- case MPI_SAS_IOUNIT0_RATE_3_0:
- phy->negotiated_linkrate = SAS_LINK_RATE_3_0_GBPS;
- break;
- case MPI_SAS_IOUNIT0_RATE_SATA_OOB_COMPLETE:
- case MPI_SAS_IOUNIT0_RATE_UNKNOWN:
- default:
- phy->negotiated_linkrate = SAS_LINK_RATE_UNKNOWN;
- break;
- }
- /*
- * Set Max hardware link rate.
- */
- switch (phy_info->hw_link_rate & MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
- case MPI_SAS_PHY0_HWRATE_MAX_RATE_1_5:
- phy->maximum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
- break;
- case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
- phy->maximum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
- break;
- default:
- break;
- }
- /*
- * Set Max programmed link rate.
- */
- switch (phy_info->programmed_link_rate &
- MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
- case MPI_SAS_PHY0_PRATE_MAX_RATE_1_5:
- phy->maximum_linkrate = SAS_LINK_RATE_1_5_GBPS;
- break;
- case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
- phy->maximum_linkrate = SAS_LINK_RATE_3_0_GBPS;
- break;
- default:
- break;
- }
- /*
- * Set Min hardware link rate.
- */
- switch (phy_info->hw_link_rate & MPI_SAS_PHY0_HWRATE_MIN_RATE_MASK) {
- case MPI_SAS_PHY0_HWRATE_MIN_RATE_1_5:
- phy->minimum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
- break;
- case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
- phy->minimum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
- break;
- default:
- break;
- }
- /*
- * Set Min programmed link rate.
- */
- switch (phy_info->programmed_link_rate &
- MPI_SAS_PHY0_PRATE_MIN_RATE_MASK) {
- case MPI_SAS_PHY0_PRATE_MIN_RATE_1_5:
- phy->minimum_linkrate = SAS_LINK_RATE_1_5_GBPS;
- break;
- case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
- phy->minimum_linkrate = SAS_LINK_RATE_3_0_GBPS;
- break;
- default:
- break;
- }
- if (!phy_info->phy) {
- error = sas_phy_add(phy);
- if (error) {
- sas_phy_free(phy);
- goto out;
- }
- phy_info->phy = phy;
- }
- if (!phy_info->attached.handle ||
- !phy_info->port_details)
- goto out;
- port = mptsas_get_port(phy_info);
- ioc = phy_to_ioc(phy_info->phy);
- if (phy_info->sas_port_add_phy) {
- if (!port) {
- port = sas_port_alloc_num(dev);
- if (!port) {
- error = -ENOMEM;
- goto out;
- }
- error = sas_port_add(port);
- if (error) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- goto out;
- }
- mptsas_set_port(ioc, phy_info, port);
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "sas_port_alloc: port=%p dev=%p port_id=%d\n",
- ioc->name, port, dev, port->port_identifier));
- }
- dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "sas_port_add_phy: phy_id=%d\n",
- ioc->name, phy_info->phy_id));
- sas_port_add_phy(port, phy_info->phy);
- phy_info->sas_port_add_phy = 0;
- }
- if (!mptsas_get_rphy(phy_info) && port && !port->rphy) {
- struct sas_rphy *rphy;
- struct device *parent;
- struct sas_identify identify;
- parent = dev->parent->parent;
- /*
- * Let the hotplug_work thread handle processing
- * the adding/removing of devices that occur
- * after start of day.
- */
- if (ioc->sas_discovery_runtime &&
- mptsas_is_end_device(&phy_info->attached))
- goto out;
- mptsas_parse_device_info(&identify, &phy_info->attached);
- if (scsi_is_host_device(parent)) {
- struct mptsas_portinfo *port_info;
- int i;
- mutex_lock(&ioc->sas_topology_mutex);
- port_info = mptsas_find_portinfo_by_handle(ioc,
- ioc->handle);
- mutex_unlock(&ioc->sas_topology_mutex);
- for (i = 0; i < port_info->num_phys; i++)
- if (port_info->phy_info[i].identify.sas_address ==
- identify.sas_address) {
- sas_port_mark_backlink(port);
- goto out;
- }
- } else if (scsi_is_sas_rphy(parent)) {
- struct sas_rphy *parent_rphy = dev_to_rphy(parent);
- if (identify.sas_address ==
- parent_rphy->identify.sas_address) {
- sas_port_mark_backlink(port);
- goto out;
- }
- }
- switch (identify.device_type) {
- case SAS_END_DEVICE:
- rphy = sas_end_device_alloc(port);
- break;
- case SAS_EDGE_EXPANDER_DEVICE:
- case SAS_FANOUT_EXPANDER_DEVICE:
- rphy = sas_expander_alloc(port, identify.device_type);
- break;
- default:
- rphy = NULL;
- break;
- }
- if (!rphy) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- goto out;
- }
- rphy->identify = identify;
- error = sas_rphy_add(rphy);
- if (error) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- sas_rphy_free(rphy);
- goto out;
- }
- mptsas_set_rphy(ioc, phy_info, rphy);
- }
- out:
- return error;
- }
- static int
- mptsas_probe_hba_phys(MPT_ADAPTER *ioc)
- {
- struct mptsas_portinfo *port_info, *hba;
- int error = -ENOMEM, i;
- hba = kzalloc(sizeof(*port_info), GFP_KERNEL);
- if (! hba)
- goto out;
- error = mptsas_sas_io_unit_pg0(ioc, hba);
- if (error)
- goto out_free_port_info;
- mptsas_sas_io_unit_pg1(ioc);
- mutex_lock(&ioc->sas_topology_mutex);
- ioc->handle = hba->phy_info[0].handle;
- port_info = mptsas_find_portinfo_by_handle(ioc, ioc->handle);
- if (!port_info) {
- port_info = hba;
- list_add_tail(&port_info->list, &ioc->sas_topology);
- } else {
- for (i = 0; i < hba->num_phys; i++) {
- port_info->phy_info[i].negotiated_link_rate =
- hba->phy_info[i].negotiated_link_rate;
- port_info->phy_info[i].handle =
- hba->phy_info[i].handle;
- port_info->phy_info[i].port_id =
- hba->phy_info[i].port_id;
- }
- kfree(hba->phy_info);
- kfree(hba);
- hba = NULL;
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- for (i = 0; i < port_info->num_phys; i++) {
- mptsas_sas_phy_pg0(ioc, &port_info->phy_info[i],
- (MPI_SAS_PHY_PGAD_FORM_PHY_NUMBER <<
- MPI_SAS_PHY_PGAD_FORM_SHIFT), i);
- mptsas_sas_device_pg0(ioc, &port_info->phy_info[i].identify,
- (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
- MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
- port_info->phy_info[i].handle);
- port_info->phy_info[i].identify.phy_id =
- port_info->phy_info[i].phy_id = i;
- if (port_info->phy_info[i].attached.handle)
- mptsas_sas_device_pg0(ioc,
- &port_info->phy_info[i].attached,
- (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
- MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
- port_info->phy_info[i].attached.handle);
- }
- mptsas_setup_wide_ports(ioc, port_info);
- for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
- mptsas_probe_one_phy(&ioc->sh->shost_gendev,
- &port_info->phy_info[i], ioc->sas_index, 1);
- return 0;
- out_free_port_info:
- kfree(hba);
- out:
- return error;
- }
- static int
- mptsas_probe_expander_phys(MPT_ADAPTER *ioc, u32 *handle)
- {
- struct mptsas_portinfo *port_info, *p, *ex;
- struct device *parent;
- struct sas_rphy *rphy;
- int error = -ENOMEM, i, j;
- ex = kzalloc(sizeof(*port_info), GFP_KERNEL);
- if (!ex)
- goto out;
- error = mptsas_sas_expander_pg0(ioc, ex,
- (MPI_SAS_EXPAND_PGAD_FORM_GET_NEXT_HANDLE <<
- MPI_SAS_EXPAND_PGAD_FORM_SHIFT), *handle);
- if (error)
- goto out_free_port_info;
- *handle = ex->phy_info[0].handle;
- mutex_lock(&ioc->sas_topology_mutex);
- port_info = mptsas_find_portinfo_by_handle(ioc, *handle);
- if (!port_info) {
- port_info = ex;
- list_add_tail(&port_info->list, &ioc->sas_topology);
- } else {
- for (i = 0; i < ex->num_phys; i++) {
- port_info->phy_info[i].handle =
- ex->phy_info[i].handle;
- port_info->phy_info[i].port_id =
- ex->phy_info[i].port_id;
- }
- kfree(ex->phy_info);
- kfree(ex);
- ex = NULL;
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- for (i = 0; i < port_info->num_phys; i++) {
- mptsas_sas_expander_pg1(ioc, &port_info->phy_info[i],
- (MPI_SAS_EXPAND_PGAD_FORM_HANDLE_PHY_NUM <<
- MPI_SAS_EXPAND_PGAD_FORM_SHIFT), (i << 16) + *handle);
- if (port_info->phy_info[i].identify.handle) {
- mptsas_sas_device_pg0(ioc,
- &port_info->phy_info[i].identify,
- (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
- MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
- port_info->phy_info[i].identify.handle);
- port_info->phy_info[i].identify.phy_id =
- port_info->phy_info[i].phy_id;
- }
- if (port_info->phy_info[i].attached.handle) {
- mptsas_sas_device_pg0(ioc,
- &port_info->phy_info[i].attached,
- (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
- MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
- port_info->phy_info[i].attached.handle);
- port_info->phy_info[i].attached.phy_id =
- port_info->phy_info[i].phy_id;
- }
- }
- parent = &ioc->sh->shost_gendev;
- for (i = 0; i < port_info->num_phys; i++) {
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(p, &ioc->sas_topology, list) {
- for (j = 0; j < p->num_phys; j++) {
- if (port_info->phy_info[i].identify.handle !=
- p->phy_info[j].attached.handle)
- continue;
- rphy = mptsas_get_rphy(&p->phy_info[j]);
- parent = &rphy->dev;
- }
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- }
- mptsas_setup_wide_ports(ioc, port_info);
- for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
- mptsas_probe_one_phy(parent, &port_info->phy_info[i],
- ioc->sas_index, 0);
- return 0;
- out_free_port_info:
- if (ex) {
- kfree(ex->phy_info);
- kfree(ex);
- }
- out:
- return error;
- }
- /*
- * mptsas_delete_expander_phys
- *
- *
- * This will traverse topology, and remove expanders
- * that are no longer present
- */
- static void
- mptsas_delete_expander_phys(MPT_ADAPTER *ioc)
- {
- struct mptsas_portinfo buffer;
- struct mptsas_portinfo *port_info, *n, *parent;
- struct mptsas_phyinfo *phy_info;
- struct sas_port * port;
- int i;
- u64 expander_sas_address;
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry_safe(port_info, n, &ioc->sas_topology, list) {
- if (port_info->phy_info &&
- (!(port_info->phy_info[0].identify.device_info &
- MPI_SAS_DEVICE_INFO_SMP_TARGET)))
- continue;
- if (mptsas_sas_expander_pg0(ioc, &buffer,
- (MPI_SAS_EXPAND_PGAD_FORM_HANDLE <<
- MPI_SAS_EXPAND_PGAD_FORM_SHIFT),
- port_info->phy_info[0].handle)) {
- /*
- * Obtain the port_info instance to the parent port
- */
- parent = mptsas_find_portinfo_by_handle(ioc,
- port_info->phy_info[0].identify.handle_parent);
- if (!parent)
- goto next_port;
- expander_sas_address =
- port_info->phy_info[0].identify.sas_address;
- /*
- * Delete rphys in the parent that point
- * to this expander. The transport layer will
- * cleanup all the children.
- */
- phy_info = parent->phy_info;
- for (i = 0; i < parent->num_phys; i++, phy_info++) {
- port = mptsas_get_port(phy_info);
- if (!port)
- continue;
- if (phy_info->attached.sas_address !=
- expander_sas_address)
- continue;
- dsaswideprintk(ioc,
- dev_printk(KERN_DEBUG, &port->dev,
- MYIOC_s_FMT "delete port (%d)\n", ioc->name,
- port->port_identifier));
- sas_port_delete(port);
- mptsas_port_delete(ioc, phy_info->port_details);
- }
- next_port:
- phy_info = port_info->phy_info;
- for (i = 0; i < port_info->num_phys; i++, phy_info++)
- mptsas_port_delete(ioc, phy_info->port_details);
- list_del(&port_info->list);
- kfree(port_info->phy_info);
- kfree(port_info);
- }
- /*
- * Free this memory allocated from inside
- * mptsas_sas_expander_pg0
- */
- kfree(buffer.phy_info);
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- }
- /*
- * Start of day discovery
- */
- static void
- mptsas_scan_sas_topology(MPT_ADAPTER *ioc)
- {
- u32 handle = 0xFFFF;
- int i;
- mutex_lock(&ioc->sas_discovery_mutex);
- mptsas_probe_hba_phys(ioc);
- while (!mptsas_probe_expander_phys(ioc, &handle))
- ;
- /*
- Reporting RAID volumes.
- */
- if (!ioc->ir_firmware)
- goto out;
- if (!ioc->raid_data.pIocPg2)
- goto out;
- if (!ioc->raid_data.pIocPg2->NumActiveVolumes)
- goto out;
- for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
- scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL,
- ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID, 0);
- }
- out:
- mutex_unlock(&ioc->sas_discovery_mutex);
- }
- /*
- * Work queue thread to handle Runtime discovery
- * Mere purpose is the hot add/delete of expanders
- *(Mutex UNLOCKED)
- */
- static void
- __mptsas_discovery_work(MPT_ADAPTER *ioc)
- {
- u32 handle = 0xFFFF;
- ioc->sas_discovery_runtime=1;
- mptsas_delete_expander_phys(ioc);
- mptsas_probe_hba_phys(ioc);
- while (!mptsas_probe_expander_phys(ioc, &handle))
- ;
- ioc->sas_discovery_runtime=0;
- }
- /*
- * Work queue thread to handle Runtime discovery
- * Mere purpose is the hot add/delete of expanders
- *(Mutex LOCKED)
- */
- static void
- mptsas_discovery_work(struct work_struct *work)
- {
- struct mptsas_discovery_event *ev =
- container_of(work, struct mptsas_discovery_event, work);
- MPT_ADAPTER *ioc = ev->ioc;
- mutex_lock(&ioc->sas_discovery_mutex);
- __mptsas_discovery_work(ioc);
- mutex_unlock(&ioc->sas_discovery_mutex);
- kfree(ev);
- }
- static struct mptsas_phyinfo *
- mptsas_find_phyinfo_by_sas_address(MPT_ADAPTER *ioc, u64 sas_address)
- {
- struct mptsas_portinfo *port_info;
- struct mptsas_phyinfo *phy_info = NULL;
- int i;
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(port_info, &ioc->sas_topology, list) {
- for (i = 0; i < port_info->num_phys; i++) {
- if (!mptsas_is_end_device(
- &port_info->phy_info[i].attached))
- continue;
- if (port_info->phy_info[i].attached.sas_address
- != sas_address)
- continue;
- phy_info = &port_info->phy_info[i];
- break;
- }
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- return phy_info;
- }
- static struct mptsas_phyinfo *
- mptsas_find_phyinfo_by_target(MPT_ADAPTER *ioc, u8 channel, u8 id)
- {
- struct mptsas_portinfo *port_info;
- struct mptsas_phyinfo *phy_info = NULL;
- int i;
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(port_info, &ioc->sas_topology, list) {
- for (i = 0; i < port_info->num_phys; i++) {
- if (!mptsas_is_end_device(
- &port_info->phy_info[i].attached))
- continue;
- if (port_info->phy_info[i].attached.id != id)
- continue;
- if (port_info->phy_info[i].attached.channel != channel)
- continue;
- phy_info = &port_info->phy_info[i];
- break;
- }
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- return phy_info;
- }
- static struct mptsas_phyinfo *
- mptsas_find_phyinfo_by_phys_disk_num(MPT_ADAPTER *ioc, u8 channel, u8 id)
- {
- struct mptsas_portinfo *port_info;
- struct mptsas_phyinfo *phy_info = NULL;
- int i;
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry(port_info, &ioc->sas_topology, list) {
- for (i = 0; i < port_info->num_phys; i++) {
- if (!mptsas_is_end_device(
- &port_info->phy_info[i].attached))
- continue;
- if (port_info->phy_info[i].attached.phys_disk_num == ~0)
- continue;
- if (port_info->phy_info[i].attached.phys_disk_num != id)
- continue;
- if (port_info->phy_info[i].attached.channel != channel)
- continue;
- phy_info = &port_info->phy_info[i];
- break;
- }
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- return phy_info;
- }
- /*
- * Work queue thread to clear the persitency table
- */
- static void
- mptsas_persist_clear_table(struct work_struct *work)
- {
- MPT_ADAPTER *ioc = container_of(work, MPT_ADAPTER, sas_persist_task);
- mptbase_sas_persist_operation(ioc, MPI_SAS_OP_CLEAR_NOT_PRESENT);
- }
- static void
- mptsas_reprobe_lun(struct scsi_device *sdev, void *data)
- {
- int rc;
- sdev->no_uld_attach = data ? 1 : 0;
- rc = scsi_device_reprobe(sdev);
- }
- static void
- mptsas_reprobe_target(struct scsi_target *starget, int uld_attach)
- {
- starget_for_each_device(starget, uld_attach ? (void *)1 : NULL,
- mptsas_reprobe_lun);
- }
- static void
- mptsas_adding_inactive_raid_components(MPT_ADAPTER *ioc, u8 channel, u8 id)
- {
- CONFIGPARMS cfg;
- ConfigPageHeader_t hdr;
- dma_addr_t dma_handle;
- pRaidVolumePage0_t buffer = NULL;
- RaidPhysDiskPage0_t phys_disk;
- int i;
- struct mptsas_hotplug_event *ev;
- memset(&cfg, 0 , sizeof(CONFIGPARMS));
- memset(&hdr, 0 , sizeof(ConfigPageHeader_t));
- hdr.PageType = MPI_CONFIG_PAGETYPE_RAID_VOLUME;
- cfg.pageAddr = (channel << 8) + id;
- cfg.cfghdr.hdr = &hdr;
- cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
- if (mpt_config(ioc, &cfg) != 0)
- goto out;
- if (!hdr.PageLength)
- goto out;
- buffer = pci_alloc_consistent(ioc->pcidev, hdr.PageLength * 4,
- &dma_handle);
- if (!buffer)
- goto out;
- cfg.physAddr = dma_handle;
- cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
- if (mpt_config(ioc, &cfg) != 0)
- goto out;
- if (!(buffer->VolumeStatus.Flags &
- MPI_RAIDVOL0_STATUS_FLAG_VOLUME_INACTIVE))
- goto out;
- if (!buffer->NumPhysDisks)
- goto out;
- for (i = 0; i < buffer->NumPhysDisks; i++) {
- if (mpt_raid_phys_disk_pg0(ioc,
- buffer->PhysDisk[i].PhysDiskNum, &phys_disk) != 0)
- continue;
- ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
- if (!ev) {
- printk(MYIOC_s_WARN_FMT "mptsas: lost hotplug event\n", ioc->name);
- goto out;
- }
- INIT_WORK(&ev->work, mptsas_hotplug_work);
- ev->ioc = ioc;
- ev->id = phys_disk.PhysDiskID;
- ev->channel = phys_disk.PhysDiskBus;
- ev->phys_disk_num_valid = 1;
- ev->phys_disk_num = phys_disk.PhysDiskNum;
- ev->event_type = MPTSAS_ADD_DEVICE;
- schedule_work(&ev->work);
- }
- out:
- if (buffer)
- pci_free_consistent(ioc->pcidev, hdr.PageLength * 4, buffer,
- dma_handle);
- }
- /*
- * Work queue thread to handle SAS hotplug events
- */
- static void
- mptsas_hotplug_work(struct work_struct *work)
- {
- struct mptsas_hotplug_event *ev =
- container_of(work, struct mptsas_hotplug_event, work);
- MPT_ADAPTER *ioc = ev->ioc;
- struct mptsas_phyinfo *phy_info;
- struct sas_rphy *rphy;
- struct sas_port *port;
- struct scsi_device *sdev;
- struct scsi_target * starget;
- struct sas_identify identify;
- char *ds = NULL;
- struct mptsas_devinfo sas_device;
- VirtTarget *vtarget;
- VirtDevice *vdevice;
- mutex_lock(&ioc->sas_discovery_mutex);
- switch (ev->event_type) {
- case MPTSAS_DEL_DEVICE:
- phy_info = NULL;
- if (ev->phys_disk_num_valid) {
- if (ev->hidden_raid_component){
- if (mptsas_sas_device_pg0(ioc, &sas_device,
- (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
- MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
- (ev->channel << 8) + ev->id)) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- phy_info = mptsas_find_phyinfo_by_sas_address(
- ioc, sas_device.sas_address);
- }else
- phy_info = mptsas_find_phyinfo_by_phys_disk_num(
- ioc, ev->channel, ev->phys_disk_num);
- }
- if (!phy_info)
- phy_info = mptsas_find_phyinfo_by_target(ioc,
- ev->channel, ev->id);
- /*
- * Sanity checks, for non-existing phys and remote rphys.
- */
- if (!phy_info){
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- if (!phy_info->port_details) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- rphy = mptsas_get_rphy(phy_info);
- if (!rphy) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- port = mptsas_get_port(phy_info);
- if (!port) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- starget = mptsas_get_starget(phy_info);
- if (starget) {
- vtarget = starget->hostdata;
- if (!vtarget) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- /*
- * Handling RAID components
- */
- if (ev->phys_disk_num_valid &&
- ev->hidden_raid_component) {
- printk(MYIOC_s_INFO_FMT
- "RAID Hidding: channel=%d, id=%d, "
- "physdsk %d \n", ioc->name, ev->channel,
- ev->id, ev->phys_disk_num);
- vtarget->id = ev->phys_disk_num;
- vtarget->tflags |=
- MPT_TARGET_FLAGS_RAID_COMPONENT;
- mptsas_reprobe_target(starget, 1);
- phy_info->attached.phys_disk_num =
- ev->phys_disk_num;
- break;
- }
- }
- if (phy_info->attached.device_info &
- MPI_SAS_DEVICE_INFO_SSP_TARGET)
- ds = "ssp";
- if (phy_info->attached.device_info &
- MPI_SAS_DEVICE_INFO_STP_TARGET)
- ds = "stp";
- if (phy_info->attached.device_info &
- MPI_SAS_DEVICE_INFO_SATA_DEVICE)
- ds = "sata";
- printk(MYIOC_s_INFO_FMT
- "removing %s device, channel %d, id %d, phy %d\n",
- ioc->name, ds, ev->channel, ev->id, phy_info->phy_id);
- dev_printk(KERN_DEBUG, &port->dev, MYIOC_s_FMT
- "delete port (%d)\n", ioc->name, port->port_identifier);
- sas_port_delete(port);
- mptsas_port_delete(ioc, phy_info->port_details);
- break;
- case MPTSAS_ADD_DEVICE:
- if (ev->phys_disk_num_valid)
- mpt_findImVolumes(ioc);
- /*
- * Refresh sas device pg0 data
- */
- if (mptsas_sas_device_pg0(ioc, &sas_device,
- (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
- MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
- (ev->channel << 8) + ev->id)) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- __mptsas_discovery_work(ioc);
- phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
- sas_device.sas_address);
- if (!phy_info || !phy_info->port_details) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- starget = mptsas_get_starget(phy_info);
- if (starget && (!ev->hidden_raid_component)){
- vtarget = starget->hostdata;
- if (!vtarget) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- /*
- * Handling RAID components
- */
- if (vtarget->tflags & MPT_TARGET_FLAGS_RAID_COMPONENT) {
- printk(MYIOC_s_INFO_FMT
- "RAID Exposing: channel=%d, id=%d, "
- "physdsk %d \n", ioc->name, ev->channel,
- ev->id, ev->phys_disk_num);
- vtarget->tflags &=
- ~MPT_TARGET_FLAGS_RAID_COMPONENT;
- vtarget->id = ev->id;
- mptsas_reprobe_target(starget, 0);
- phy_info->attached.phys_disk_num = ~0;
- }
- break;
- }
- if (mptsas_get_rphy(phy_info)) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- if (ev->channel) printk("%d\n", __LINE__);
- break;
- }
- port = mptsas_get_port(phy_info);
- if (!port) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break;
- }
- memcpy(&phy_info->attached, &sas_device,
- sizeof(struct mptsas_devinfo));
- if (phy_info->attached.device_info &
- MPI_SAS_DEVICE_INFO_SSP_TARGET)
- ds = "ssp";
- if (phy_info->attached.device_info &
- MPI_SAS_DEVICE_INFO_STP_TARGET)
- ds = "stp";
- if (phy_info->attached.device_info &
- MPI_SAS_DEVICE_INFO_SATA_DEVICE)
- ds = "sata";
- printk(MYIOC_s_INFO_FMT
- "attaching %s device, channel %d, id %d, phy %d\n",
- ioc->name, ds, ev->channel, ev->id, ev->phy_id);
- mptsas_parse_device_info(&identify, &phy_info->attached);
- rphy = sas_end_device_alloc(port);
- if (!rphy) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- break; /* non-fatal: an rphy can be added later */
- }
- rphy->identify = identify;
- if (sas_rphy_add(rphy)) {
- dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
- "%s: exit at line=%d\n", ioc->name,
- __FUNCTION__, __LINE__));
- sas_rphy_free(rphy);
- break;
- }
- mptsas_set_rphy(ioc, phy_info, rphy);
- break;
- case MPTSAS_ADD_RAID:
- sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
- ev->id, 0);
- if (sdev) {
- scsi_device_put(sdev);
- break;
- }
- printk(MYIOC_s_INFO_FMT
- "attaching raid volume, channel %d, id %d\n",
- ioc->name, MPTSAS_RAID_CHANNEL, ev->id);
- scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL, ev->id, 0);
- mpt_findImVolumes(ioc);
- break;
- case MPTSAS_DEL_RAID:
- sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
- ev->id, 0);
- if (!sdev)
- break;
- printk(MYIOC_s_INFO_FMT
- "removing raid volume, channel %d, id %d\n",
- ioc->name, MPTSAS_RAID_CHANNEL, ev->id);
- vdevice = sdev->hostdata;
- scsi_remove_device(sdev);
- scsi_device_put(sdev);
- mpt_findImVolumes(ioc);
- break;
- case MPTSAS_ADD_INACTIVE_VOLUME:
- mptsas_adding_inactive_raid_components(ioc,
- ev->channel, ev->id);
- break;
- case MPTSAS_IGNORE_EVENT:
- default:
- break;
- }
- mutex_unlock(&ioc->sas_discovery_mutex);
- kfree(ev);
- }
- static void
- mptsas_send_sas_event(MPT_ADAPTER *ioc,
- EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data)
- {
- struct mptsas_hotplug_event *ev;
- u32 device_info = le32_to_cpu(sas_event_data->DeviceInfo);
- __le64 sas_address;
- if ((device_info &
- (MPI_SAS_DEVICE_INFO_SSP_TARGET |
- MPI_SAS_DEVICE_INFO_STP_TARGET |
- MPI_SAS_DEVICE_INFO_SATA_DEVICE )) == 0)
- return;
- switch (sas_event_data->ReasonCode) {
- case MPI_EVENT_SAS_DEV_STAT_RC_NOT_RESPONDING:
- mptsas_target_reset_queue(ioc, sas_event_data);
- break;
- case MPI_EVENT_SAS_DEV_STAT_RC_ADDED:
- ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
- if (!ev) {
- printk(MYIOC_s_WARN_FMT "lost hotplug event\n", ioc->name);
- break;
- }
- INIT_WORK(&ev->work, mptsas_hotplug_work);
- ev->ioc = ioc;
- ev->handle = le16_to_cpu(sas_event_data->DevHandle);
- ev->parent_handle =
- le16_to_cpu(sas_event_data->ParentDevHandle);
- ev->channel = sas_event_data->Bus;
- ev->id = sas_event_data->TargetID;
- ev->phy_id = sas_event_data->PhyNum;
- memcpy(&sas_address, &sas_event_data->SASAddress,
- sizeof(__le64));
- ev->sas_address = le64_to_cpu(sas_address);
- ev->device_info = device_info;
- if (sas_event_data->ReasonCode &
- MPI_EVENT_SAS_DEV_STAT_RC_ADDED)
- ev->event_type = MPTSAS_ADD_DEVICE;
- else
- ev->event_type = MPTSAS_DEL_DEVICE;
- schedule_work(&ev->work);
- break;
- case MPI_EVENT_SAS_DEV_STAT_RC_NO_PERSIST_ADDED:
- /*
- * Persistent table is full.
- */
- INIT_WORK(&ioc->sas_persist_task,
- mptsas_persist_clear_table);
- schedule_work(&ioc->sas_persist_task);
- break;
- /*
- * TODO, handle other events
- */
- case MPI_EVENT_SAS_DEV_STAT_RC_SMART_DATA:
- case MPI_EVENT_SAS_DEV_STAT_RC_UNSUPPORTED:
- case MPI_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET:
- case MPI_EVENT_SAS_DEV_STAT_RC_TASK_ABORT_INTERNAL:
- case MPI_EVENT_SAS_DEV_STAT_RC_ABORT_TASK_SET_INTERNAL:
- case MPI_EVENT_SAS_DEV_STAT_RC_CLEAR_TASK_SET_INTERNAL:
- case MPI_EVENT_SAS_DEV_STAT_RC_QUERY_TASK_INTERNAL:
- default:
- break;
- }
- }
- static void
- mptsas_send_raid_event(MPT_ADAPTER *ioc,
- EVENT_DATA_RAID *raid_event_data)
- {
- struct mptsas_hotplug_event *ev;
- int status = le32_to_cpu(raid_event_data->SettingsStatus);
- int state = (status >> 8) & 0xff;
- if (ioc->bus_type != SAS)
- return;
- ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
- if (!ev) {
- printk(MYIOC_s_WARN_FMT "lost hotplug event\n", ioc->name);
- return;
- }
- INIT_WORK(&ev->work, mptsas_hotplug_work);
- ev->ioc = ioc;
- ev->id = raid_event_data->VolumeID;
- ev->channel = raid_event_data->VolumeBus;
- ev->event_type = MPTSAS_IGNORE_EVENT;
- switch (raid_event_data->ReasonCode) {
- case MPI_EVENT_RAID_RC_PHYSDISK_DELETED:
- ev->phys_disk_num_valid = 1;
- ev->phys_disk_num = raid_event_data->PhysDiskNum;
- ev->event_type = MPTSAS_ADD_DEVICE;
- break;
- case MPI_EVENT_RAID_RC_PHYSDISK_CREATED:
- ev->phys_disk_num_valid = 1;
- ev->phys_disk_num = raid_event_data->PhysDiskNum;
- ev->hidden_raid_component = 1;
- ev->event_type = MPTSAS_DEL_DEVICE;
- break;
- case MPI_EVENT_RAID_RC_PHYSDISK_STATUS_CHANGED:
- switch (state) {
- case MPI_PD_STATE_ONLINE:
- case MPI_PD_STATE_NOT_COMPATIBLE:
- ev->phys_disk_num_valid = 1;
- ev->phys_disk_num = raid_event_data->PhysDiskNum;
- ev->hidden_raid_component = 1;
- ev->event_type = MPTSAS_ADD_DEVICE;
- break;
- case MPI_PD_STATE_MISSING:
- case MPI_PD_STATE_OFFLINE_AT_HOST_REQUEST:
- case MPI_PD_STATE_FAILED_AT_HOST_REQUEST:
- case MPI_PD_STATE_OFFLINE_FOR_ANOTHER_REASON:
- ev->phys_disk_num_valid = 1;
- ev->phys_disk_num = raid_event_data->PhysDiskNum;
- ev->event_type = MPTSAS_DEL_DEVICE;
- break;
- default:
- break;
- }
- break;
- case MPI_EVENT_RAID_RC_VOLUME_DELETED:
- ev->event_type = MPTSAS_DEL_RAID;
- break;
- case MPI_EVENT_RAID_RC_VOLUME_CREATED:
- ev->event_type = MPTSAS_ADD_RAID;
- break;
- case MPI_EVENT_RAID_RC_VOLUME_STATUS_CHANGED:
- switch (state) {
- case MPI_RAIDVOL0_STATUS_STATE_FAILED:
- case MPI_RAIDVOL0_STATUS_STATE_MISSING:
- ev->event_type = MPTSAS_DEL_RAID;
- break;
- case MPI_RAIDVOL0_STATUS_STATE_OPTIMAL:
- case MPI_RAIDVOL0_STATUS_STATE_DEGRADED:
- ev->event_type = MPTSAS_ADD_RAID;
- break;
- default:
- break;
- }
- break;
- default:
- break;
- }
- schedule_work(&ev->work);
- }
- static void
- mptsas_send_discovery_event(MPT_ADAPTER *ioc,
- EVENT_DATA_SAS_DISCOVERY *discovery_data)
- {
- struct mptsas_discovery_event *ev;
- /*
- * DiscoveryStatus
- *
- * This flag will be non-zero when firmware
- * kicks off discovery, and return to zero
- * once its completed.
- */
- if (discovery_data->DiscoveryStatus)
- return;
- ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
- if (!ev)
- return;
- INIT_WORK(&ev->work, mptsas_discovery_work);
- ev->ioc = ioc;
- schedule_work(&ev->work);
- };
- /*
- * mptsas_send_ir2_event - handle exposing hidden disk when
- * an inactive raid volume is added
- *
- * @ioc: Pointer to MPT_ADAPTER structure
- * @ir2_data
- *
- */
- static void
- mptsas_send_ir2_event(MPT_ADAPTER *ioc, PTR_MPI_EVENT_DATA_IR2 ir2_data)
- {
- struct mptsas_hotplug_event *ev;
- if (ir2_data->ReasonCode !=
- MPI_EVENT_IR2_RC_FOREIGN_CFG_DETECTED)
- return;
- ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
- if (!ev)
- return;
- INIT_WORK(&ev->work, mptsas_hotplug_work);
- ev->ioc = ioc;
- ev->id = ir2_data->TargetID;
- ev->channel = ir2_data->Bus;
- ev->event_type = MPTSAS_ADD_INACTIVE_VOLUME;
- schedule_work(&ev->work);
- };
- static int
- mptsas_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *reply)
- {
- int rc=1;
- u8 event = le32_to_cpu(reply->Event) & 0xFF;
- if (!ioc->sh)
- goto out;
- /*
- * sas_discovery_ignore_events
- *
- * This flag is to prevent anymore processing of
- * sas events once mptsas_remove function is called.
- */
- if (ioc->sas_discovery_ignore_events) {
- rc = mptscsih_event_process(ioc, reply);
- goto out;
- }
- switch (event) {
- case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
- mptsas_send_sas_event(ioc,
- (EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *)reply->Data);
- break;
- case MPI_EVENT_INTEGRATED_RAID:
- mptsas_send_raid_event(ioc,
- (EVENT_DATA_RAID *)reply->Data);
- break;
- case MPI_EVENT_PERSISTENT_TABLE_FULL:
- INIT_WORK(&ioc->sas_persist_task,
- mptsas_persist_clear_table);
- schedule_work(&ioc->sas_persist_task);
- break;
- case MPI_EVENT_SAS_DISCOVERY:
- mptsas_send_discovery_event(ioc,
- (EVENT_DATA_SAS_DISCOVERY *)reply->Data);
- break;
- case MPI_EVENT_IR2:
- mptsas_send_ir2_event(ioc,
- (PTR_MPI_EVENT_DATA_IR2)reply->Data);
- break;
- default:
- rc = mptscsih_event_process(ioc, reply);
- break;
- }
- out:
- return rc;
- }
- static int
- mptsas_probe(struct pci_dev *pdev, const struct pci_device_id *id)
- {
- struct Scsi_Host *sh;
- MPT_SCSI_HOST *hd;
- MPT_ADAPTER *ioc;
- unsigned long flags;
- int ii;
- int numSGE = 0;
- int scale;
- int ioc_cap;
- int error=0;
- int r;
- r = mpt_attach(pdev,id);
- if (r)
- return r;
- ioc = pci_get_drvdata(pdev);
- ioc->DoneCtx = mptsasDoneCtx;
- ioc->TaskCtx = mptsasTaskCtx;
- ioc->InternalCtx = mptsasInternalCtx;
- /* Added sanity check on readiness of the MPT adapter.
- */
- if (ioc->last_state != MPI_IOC_STATE_OPERATIONAL) {
- printk(MYIOC_s_WARN_FMT
- "Skipping because it's not operational!\n",
- ioc->name);
- error = -ENODEV;
- goto out_mptsas_probe;
- }
- if (!ioc->active) {
- printk(MYIOC_s_WARN_FMT "Skipping because it's disabled!\n",
- ioc->name);
- error = -ENODEV;
- goto out_mptsas_probe;
- }
- /* Sanity check - ensure at least 1 port is INITIATOR capable
- */
- ioc_cap = 0;
- for (ii = 0; ii < ioc->facts.NumberOfPorts; ii++) {
- if (ioc->pfacts[ii].ProtocolFlags &
- MPI_PORTFACTS_PROTOCOL_INITIATOR)
- ioc_cap++;
- }
- if (!ioc_cap) {
- printk(MYIOC_s_WARN_FMT
- "Skipping ioc=%p because SCSI Initiator mode "
- "is NOT enabled!\n", ioc->name, ioc);
- return 0;
- }
- sh = scsi_host_alloc(&mptsas_driver_template, sizeof(MPT_SCSI_HOST));
- if (!sh) {
- printk(MYIOC_s_WARN_FMT
- "Unable to register controller with SCSI subsystem\n",
- ioc->name);
- error = -1;
- goto out_mptsas_probe;
- }
- spin_lock_irqsave(&ioc->FreeQlock, flags);
- /* Attach the SCSI Host to the IOC structure
- */
- ioc->sh = sh;
- sh->io_port = 0;
- sh->n_io_port = 0;
- sh->irq = 0;
- /* set 16 byte cdb's */
- sh->max_cmd_len = 16;
- sh->max_id = ioc->pfacts[0].PortSCSIID;
- sh->max_lun = max_lun;
- sh->transportt = mptsas_transport_template;
- sh->this_id = ioc->pfacts[0].PortSCSIID;
- /* Required entry.
- */
- sh->unique_id = ioc->id;
- INIT_LIST_HEAD(&ioc->sas_topology);
- mutex_init(&ioc->sas_topology_mutex);
- mutex_init(&ioc->sas_discovery_mutex);
- mutex_init(&ioc->sas_mgmt.mutex);
- init_completion(&ioc->sas_mgmt.done);
- /* Verify that we won't exceed the maximum
- * number of chain buffers
- * We can optimize: ZZ = req_sz/sizeof(SGE)
- * For 32bit SGE's:
- * numSGE = 1 + (ZZ-1)*(maxChain -1) + ZZ
- * + (req_sz - 64)/sizeof(SGE)
- * A slightly different algorithm is required for
- * 64bit SGEs.
- */
- scale = ioc->req_sz/(sizeof(dma_addr_t) + sizeof(u32));
- if (sizeof(dma_addr_t) == sizeof(u64)) {
- numSGE = (scale - 1) *
- (ioc->facts.MaxChainDepth-1) + scale +
- (ioc->req_sz - 60) / (sizeof(dma_addr_t) +
- sizeof(u32));
- } else {
- numSGE = 1 + (scale - 1) *
- (ioc->facts.MaxChainDepth-1) + scale +
- (ioc->req_sz - 64) / (sizeof(dma_addr_t) +
- sizeof(u32));
- }
- if (numSGE < sh->sg_tablesize) {
- /* Reset this value */
- dprintk(ioc, printk(MYIOC_s_DEBUG_FMT
- "Resetting sg_tablesize to %d from %d\n",
- ioc->name, numSGE, sh->sg_tablesize));
- sh->sg_tablesize = numSGE;
- }
- hd = shost_priv(sh);
- hd->ioc = ioc;
- /* SCSI needs scsi_cmnd lookup table!
- * (with size equal to req_depth*PtrSz!)
- */
- ioc->ScsiLookup = kcalloc(ioc->req_depth, sizeof(void *), GFP_ATOMIC);
- if (!ioc->ScsiLookup) {
- error = -ENOMEM;
- spin_unlock_irqrestore(&ioc->FreeQlock, flags);
- goto out_mptsas_probe;
- }
- spin_lock_init(&ioc->scsi_lookup_lock);
- dprintk(ioc, printk(MYIOC_s_DEBUG_FMT "ScsiLookup @ %p\n",
- ioc->name, ioc->ScsiLookup));
- /* Clear the TM flags
- */
- hd->tmPending = 0;
- hd->tmState = TM_STATE_NONE;
- hd->resetPending = 0;
- hd->abortSCpnt = NULL;
- /* Clear the pointer used to store
- * single-threaded commands, i.e., those
- * issued during a bus scan, dv and
- * configuration pages.
- */
- hd->cmdPtr = NULL;
- /* Initialize this SCSI Hosts' timers
- * To use, set the timer expires field
- * and add_timer
- */
- init_timer(&hd->timer);
- hd->timer.data = (unsigned long) hd;
- hd->timer.function = mptscsih_timer_expired;
- ioc->sas_data.ptClear = mpt_pt_clear;
- init_waitqueue_head(&hd->scandv_waitq);
- hd->scandv_wait_done = 0;
- hd->last_queue_full = 0;
- INIT_LIST_HEAD(&hd->target_reset_list);
- spin_unlock_irqrestore(&ioc->FreeQlock, flags);
- if (ioc->sas_data.ptClear==1) {
- mptbase_sas_persist_operation(
- ioc, MPI_SAS_OP_CLEAR_ALL_PERSISTENT);
- }
- error = scsi_add_host(sh, &ioc->pcidev->dev);
- if (error) {
- dprintk(ioc, printk(MYIOC_s_ERR_FMT
- "scsi_add_host failed\n", ioc->name));
- goto out_mptsas_probe;
- }
- mptsas_scan_sas_topology(ioc);
- return 0;
- out_mptsas_probe:
- mptscsih_remove(pdev);
- return error;
- }
- static void __devexit mptsas_remove(struct pci_dev *pdev)
- {
- MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
- struct mptsas_portinfo *p, *n;
- int i;
- ioc->sas_discovery_ignore_events = 1;
- sas_remove_host(ioc->sh);
- mutex_lock(&ioc->sas_topology_mutex);
- list_for_each_entry_safe(p, n, &ioc->sas_topology, list) {
- list_del(&p->list);
- for (i = 0 ; i < p->num_phys ; i++)
- mptsas_port_delete(ioc, p->phy_info[i].port_details);
- kfree(p->phy_info);
- kfree(p);
- }
- mutex_unlock(&ioc->sas_topology_mutex);
- mptscsih_remove(pdev);
- }
- static struct pci_device_id mptsas_pci_table[] = {
- { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064,
- PCI_ANY_ID, PCI_ANY_ID },
- { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068,
- PCI_ANY_ID, PCI_ANY_ID },
- { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064E,
- PCI_ANY_ID, PCI_ANY_ID },
- { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068E,
- PCI_ANY_ID, PCI_ANY_ID },
- { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1078,
- PCI_ANY_ID, PCI_ANY_ID },
- {0} /* Terminating entry */
- };
- MODULE_DEVICE_TABLE(pci, mptsas_pci_table);
- static struct pci_driver mptsas_driver = {
- .name = "mptsas",
- .id_table = mptsas_pci_table,
- .probe = mptsas_probe,
- .remove = __devexit_p(mptsas_remove),
- .shutdown = mptscsih_shutdown,
- #ifdef CONFIG_PM
- .suspend = mptscsih_suspend,
- .resume = mptscsih_resume,
- #endif
- };
- static int __init
- mptsas_init(void)
- {
- int error;
- show_mptmod_ver(my_NAME, my_VERSION);
- mptsas_transport_template =
- sas_attach_transport(&mptsas_transport_functions);
- if (!mptsas_transport_template)
- return -ENODEV;
- mptsasDoneCtx = mpt_register(mptscsih_io_done, MPTSAS_DRIVER);
- mptsasTaskCtx = mpt_register(mptsas_taskmgmt_complete, MPTSAS_DRIVER);
- mptsasInternalCtx =
- mpt_register(mptscsih_scandv_complete, MPTSAS_DRIVER);
- mptsasMgmtCtx = mpt_register(mptsas_mgmt_done, MPTSAS_DRIVER);
- mpt_event_register(mptsasDoneCtx, mptsas_event_process);
- mpt_reset_register(mptsasDoneCtx, mptsas_ioc_reset);
- error = pci_register_driver(&mptsas_driver);
- if (error)
- sas_release_transport(mptsas_transport_template);
- return error;
- }
- static void __exit
- mptsas_exit(void)
- {
- pci_unregister_driver(&mptsas_driver);
- sas_release_transport(mptsas_transport_template);
- mpt_reset_deregister(mptsasDoneCtx);
- mpt_event_deregister(mptsasDoneCtx);
- mpt_deregister(mptsasMgmtCtx);
- mpt_deregister(mptsasInternalCtx);
- mpt_deregister(mptsasTaskCtx);
- mpt_deregister(mptsasDoneCtx);
- }
- module_init(mptsas_init);
- module_exit(mptsas_exit);
|