host.c 81 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762
  1. /*
  2. * This file is provided under a dual BSD/GPLv2 license. When using or
  3. * redistributing this file, you may do so under either license.
  4. *
  5. * GPL LICENSE SUMMARY
  6. *
  7. * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of version 2 of the GNU General Public License as
  11. * published by the Free Software Foundation.
  12. *
  13. * This program is distributed in the hope that it will be useful, but
  14. * WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16. * General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  21. * The full GNU General Public License is included in this distribution
  22. * in the file called LICENSE.GPL.
  23. *
  24. * BSD LICENSE
  25. *
  26. * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
  27. * All rights reserved.
  28. *
  29. * Redistribution and use in source and binary forms, with or without
  30. * modification, are permitted provided that the following conditions
  31. * are met:
  32. *
  33. * * Redistributions of source code must retain the above copyright
  34. * notice, this list of conditions and the following disclaimer.
  35. * * Redistributions in binary form must reproduce the above copyright
  36. * notice, this list of conditions and the following disclaimer in
  37. * the documentation and/or other materials provided with the
  38. * distribution.
  39. * * Neither the name of Intel Corporation nor the names of its
  40. * contributors may be used to endorse or promote products derived
  41. * from this software without specific prior written permission.
  42. *
  43. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  44. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  45. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  46. * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  47. * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  48. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  49. * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  50. * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  51. * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  52. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  53. * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  54. */
  55. #include <linux/circ_buf.h>
  56. #include <linux/device.h>
  57. #include <scsi/sas.h>
  58. #include "host.h"
  59. #include "isci.h"
  60. #include "port.h"
  61. #include "host.h"
  62. #include "probe_roms.h"
  63. #include "remote_device.h"
  64. #include "request.h"
  65. #include "scu_completion_codes.h"
  66. #include "scu_event_codes.h"
  67. #include "registers.h"
  68. #include "scu_remote_node_context.h"
  69. #include "scu_task_context.h"
  70. #define SCU_CONTEXT_RAM_INIT_STALL_TIME 200
  71. #define smu_max_ports(dcc_value) \
  72. (\
  73. (((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_LP_MASK) \
  74. >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_LP_SHIFT) + 1 \
  75. )
  76. #define smu_max_task_contexts(dcc_value) \
  77. (\
  78. (((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_TC_MASK) \
  79. >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_TC_SHIFT) + 1 \
  80. )
  81. #define smu_max_rncs(dcc_value) \
  82. (\
  83. (((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_RNC_MASK) \
  84. >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_RNC_SHIFT) + 1 \
  85. )
  86. #define SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT 100
  87. /**
  88. *
  89. *
  90. * The number of milliseconds to wait while a given phy is consuming power
  91. * before allowing another set of phys to consume power. Ultimately, this will
  92. * be specified by OEM parameter.
  93. */
  94. #define SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL 500
  95. /**
  96. * NORMALIZE_PUT_POINTER() -
  97. *
  98. * This macro will normalize the completion queue put pointer so its value can
  99. * be used as an array inde
  100. */
  101. #define NORMALIZE_PUT_POINTER(x) \
  102. ((x) & SMU_COMPLETION_QUEUE_PUT_POINTER_MASK)
  103. /**
  104. * NORMALIZE_EVENT_POINTER() -
  105. *
  106. * This macro will normalize the completion queue event entry so its value can
  107. * be used as an index.
  108. */
  109. #define NORMALIZE_EVENT_POINTER(x) \
  110. (\
  111. ((x) & SMU_COMPLETION_QUEUE_GET_EVENT_POINTER_MASK) \
  112. >> SMU_COMPLETION_QUEUE_GET_EVENT_POINTER_SHIFT \
  113. )
  114. /**
  115. * NORMALIZE_GET_POINTER() -
  116. *
  117. * This macro will normalize the completion queue get pointer so its value can
  118. * be used as an index into an array
  119. */
  120. #define NORMALIZE_GET_POINTER(x) \
  121. ((x) & SMU_COMPLETION_QUEUE_GET_POINTER_MASK)
  122. /**
  123. * NORMALIZE_GET_POINTER_CYCLE_BIT() -
  124. *
  125. * This macro will normalize the completion queue cycle pointer so it matches
  126. * the completion queue cycle bit
  127. */
  128. #define NORMALIZE_GET_POINTER_CYCLE_BIT(x) \
  129. ((SMU_CQGR_CYCLE_BIT & (x)) << (31 - SMU_COMPLETION_QUEUE_GET_CYCLE_BIT_SHIFT))
  130. /**
  131. * COMPLETION_QUEUE_CYCLE_BIT() -
  132. *
  133. * This macro will return the cycle bit of the completion queue entry
  134. */
  135. #define COMPLETION_QUEUE_CYCLE_BIT(x) ((x) & 0x80000000)
  136. /* Init the state machine and call the state entry function (if any) */
  137. void sci_init_sm(struct sci_base_state_machine *sm,
  138. const struct sci_base_state *state_table, u32 initial_state)
  139. {
  140. sci_state_transition_t handler;
  141. sm->initial_state_id = initial_state;
  142. sm->previous_state_id = initial_state;
  143. sm->current_state_id = initial_state;
  144. sm->state_table = state_table;
  145. handler = sm->state_table[initial_state].enter_state;
  146. if (handler)
  147. handler(sm);
  148. }
  149. /* Call the state exit fn, update the current state, call the state entry fn */
  150. void sci_change_state(struct sci_base_state_machine *sm, u32 next_state)
  151. {
  152. sci_state_transition_t handler;
  153. handler = sm->state_table[sm->current_state_id].exit_state;
  154. if (handler)
  155. handler(sm);
  156. sm->previous_state_id = sm->current_state_id;
  157. sm->current_state_id = next_state;
  158. handler = sm->state_table[sm->current_state_id].enter_state;
  159. if (handler)
  160. handler(sm);
  161. }
  162. static bool sci_controller_completion_queue_has_entries(struct isci_host *ihost)
  163. {
  164. u32 get_value = ihost->completion_queue_get;
  165. u32 get_index = get_value & SMU_COMPLETION_QUEUE_GET_POINTER_MASK;
  166. if (NORMALIZE_GET_POINTER_CYCLE_BIT(get_value) ==
  167. COMPLETION_QUEUE_CYCLE_BIT(ihost->completion_queue[get_index]))
  168. return true;
  169. return false;
  170. }
  171. static bool sci_controller_isr(struct isci_host *ihost)
  172. {
  173. if (sci_controller_completion_queue_has_entries(ihost)) {
  174. return true;
  175. } else {
  176. /*
  177. * we have a spurious interrupt it could be that we have already
  178. * emptied the completion queue from a previous interrupt */
  179. writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status);
  180. /*
  181. * There is a race in the hardware that could cause us not to be notified
  182. * of an interrupt completion if we do not take this step. We will mask
  183. * then unmask the interrupts so if there is another interrupt pending
  184. * the clearing of the interrupt source we get the next interrupt message. */
  185. writel(0xFF000000, &ihost->smu_registers->interrupt_mask);
  186. writel(0, &ihost->smu_registers->interrupt_mask);
  187. }
  188. return false;
  189. }
  190. irqreturn_t isci_msix_isr(int vec, void *data)
  191. {
  192. struct isci_host *ihost = data;
  193. if (sci_controller_isr(ihost))
  194. tasklet_schedule(&ihost->completion_tasklet);
  195. return IRQ_HANDLED;
  196. }
  197. static bool sci_controller_error_isr(struct isci_host *ihost)
  198. {
  199. u32 interrupt_status;
  200. interrupt_status =
  201. readl(&ihost->smu_registers->interrupt_status);
  202. interrupt_status &= (SMU_ISR_QUEUE_ERROR | SMU_ISR_QUEUE_SUSPEND);
  203. if (interrupt_status != 0) {
  204. /*
  205. * There is an error interrupt pending so let it through and handle
  206. * in the callback */
  207. return true;
  208. }
  209. /*
  210. * There is a race in the hardware that could cause us not to be notified
  211. * of an interrupt completion if we do not take this step. We will mask
  212. * then unmask the error interrupts so if there was another interrupt
  213. * pending we will be notified.
  214. * Could we write the value of (SMU_ISR_QUEUE_ERROR | SMU_ISR_QUEUE_SUSPEND)? */
  215. writel(0xff, &ihost->smu_registers->interrupt_mask);
  216. writel(0, &ihost->smu_registers->interrupt_mask);
  217. return false;
  218. }
  219. static void sci_controller_task_completion(struct isci_host *ihost, u32 ent)
  220. {
  221. u32 index = SCU_GET_COMPLETION_INDEX(ent);
  222. struct isci_request *ireq = ihost->reqs[index];
  223. /* Make sure that we really want to process this IO request */
  224. if (test_bit(IREQ_ACTIVE, &ireq->flags) &&
  225. ireq->io_tag != SCI_CONTROLLER_INVALID_IO_TAG &&
  226. ISCI_TAG_SEQ(ireq->io_tag) == ihost->io_request_sequence[index])
  227. /* Yep this is a valid io request pass it along to the
  228. * io request handler
  229. */
  230. sci_io_request_tc_completion(ireq, ent);
  231. }
  232. static void sci_controller_sdma_completion(struct isci_host *ihost, u32 ent)
  233. {
  234. u32 index;
  235. struct isci_request *ireq;
  236. struct isci_remote_device *idev;
  237. index = SCU_GET_COMPLETION_INDEX(ent);
  238. switch (scu_get_command_request_type(ent)) {
  239. case SCU_CONTEXT_COMMAND_REQUEST_TYPE_POST_TC:
  240. case SCU_CONTEXT_COMMAND_REQUEST_TYPE_DUMP_TC:
  241. ireq = ihost->reqs[index];
  242. dev_warn(&ihost->pdev->dev, "%s: %x for io request %p\n",
  243. __func__, ent, ireq);
  244. /* @todo For a post TC operation we need to fail the IO
  245. * request
  246. */
  247. break;
  248. case SCU_CONTEXT_COMMAND_REQUEST_TYPE_DUMP_RNC:
  249. case SCU_CONTEXT_COMMAND_REQUEST_TYPE_OTHER_RNC:
  250. case SCU_CONTEXT_COMMAND_REQUEST_TYPE_POST_RNC:
  251. idev = ihost->device_table[index];
  252. dev_warn(&ihost->pdev->dev, "%s: %x for device %p\n",
  253. __func__, ent, idev);
  254. /* @todo For a port RNC operation we need to fail the
  255. * device
  256. */
  257. break;
  258. default:
  259. dev_warn(&ihost->pdev->dev, "%s: unknown completion type %x\n",
  260. __func__, ent);
  261. break;
  262. }
  263. }
  264. static void sci_controller_unsolicited_frame(struct isci_host *ihost, u32 ent)
  265. {
  266. u32 index;
  267. u32 frame_index;
  268. struct scu_unsolicited_frame_header *frame_header;
  269. struct isci_phy *iphy;
  270. struct isci_remote_device *idev;
  271. enum sci_status result = SCI_FAILURE;
  272. frame_index = SCU_GET_FRAME_INDEX(ent);
  273. frame_header = ihost->uf_control.buffers.array[frame_index].header;
  274. ihost->uf_control.buffers.array[frame_index].state = UNSOLICITED_FRAME_IN_USE;
  275. if (SCU_GET_FRAME_ERROR(ent)) {
  276. /*
  277. * / @todo If the IAF frame or SIGNATURE FIS frame has an error will
  278. * / this cause a problem? We expect the phy initialization will
  279. * / fail if there is an error in the frame. */
  280. sci_controller_release_frame(ihost, frame_index);
  281. return;
  282. }
  283. if (frame_header->is_address_frame) {
  284. index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent);
  285. iphy = &ihost->phys[index];
  286. result = sci_phy_frame_handler(iphy, frame_index);
  287. } else {
  288. index = SCU_GET_COMPLETION_INDEX(ent);
  289. if (index == SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX) {
  290. /*
  291. * This is a signature fis or a frame from a direct attached SATA
  292. * device that has not yet been created. In either case forwared
  293. * the frame to the PE and let it take care of the frame data. */
  294. index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent);
  295. iphy = &ihost->phys[index];
  296. result = sci_phy_frame_handler(iphy, frame_index);
  297. } else {
  298. if (index < ihost->remote_node_entries)
  299. idev = ihost->device_table[index];
  300. else
  301. idev = NULL;
  302. if (idev != NULL)
  303. result = sci_remote_device_frame_handler(idev, frame_index);
  304. else
  305. sci_controller_release_frame(ihost, frame_index);
  306. }
  307. }
  308. if (result != SCI_SUCCESS) {
  309. /*
  310. * / @todo Is there any reason to report some additional error message
  311. * / when we get this failure notifiction? */
  312. }
  313. }
  314. static void sci_controller_event_completion(struct isci_host *ihost, u32 ent)
  315. {
  316. struct isci_remote_device *idev;
  317. struct isci_request *ireq;
  318. struct isci_phy *iphy;
  319. u32 index;
  320. index = SCU_GET_COMPLETION_INDEX(ent);
  321. switch (scu_get_event_type(ent)) {
  322. case SCU_EVENT_TYPE_SMU_COMMAND_ERROR:
  323. /* / @todo The driver did something wrong and we need to fix the condtion. */
  324. dev_err(&ihost->pdev->dev,
  325. "%s: SCIC Controller 0x%p received SMU command error "
  326. "0x%x\n",
  327. __func__,
  328. ihost,
  329. ent);
  330. break;
  331. case SCU_EVENT_TYPE_SMU_PCQ_ERROR:
  332. case SCU_EVENT_TYPE_SMU_ERROR:
  333. case SCU_EVENT_TYPE_FATAL_MEMORY_ERROR:
  334. /*
  335. * / @todo This is a hardware failure and its likely that we want to
  336. * / reset the controller. */
  337. dev_err(&ihost->pdev->dev,
  338. "%s: SCIC Controller 0x%p received fatal controller "
  339. "event 0x%x\n",
  340. __func__,
  341. ihost,
  342. ent);
  343. break;
  344. case SCU_EVENT_TYPE_TRANSPORT_ERROR:
  345. ireq = ihost->reqs[index];
  346. sci_io_request_event_handler(ireq, ent);
  347. break;
  348. case SCU_EVENT_TYPE_PTX_SCHEDULE_EVENT:
  349. switch (scu_get_event_specifier(ent)) {
  350. case SCU_EVENT_SPECIFIC_SMP_RESPONSE_NO_PE:
  351. case SCU_EVENT_SPECIFIC_TASK_TIMEOUT:
  352. ireq = ihost->reqs[index];
  353. if (ireq != NULL)
  354. sci_io_request_event_handler(ireq, ent);
  355. else
  356. dev_warn(&ihost->pdev->dev,
  357. "%s: SCIC Controller 0x%p received "
  358. "event 0x%x for io request object "
  359. "that doesnt exist.\n",
  360. __func__,
  361. ihost,
  362. ent);
  363. break;
  364. case SCU_EVENT_SPECIFIC_IT_NEXUS_TIMEOUT:
  365. idev = ihost->device_table[index];
  366. if (idev != NULL)
  367. sci_remote_device_event_handler(idev, ent);
  368. else
  369. dev_warn(&ihost->pdev->dev,
  370. "%s: SCIC Controller 0x%p received "
  371. "event 0x%x for remote device object "
  372. "that doesnt exist.\n",
  373. __func__,
  374. ihost,
  375. ent);
  376. break;
  377. }
  378. break;
  379. case SCU_EVENT_TYPE_BROADCAST_CHANGE:
  380. /*
  381. * direct the broadcast change event to the phy first and then let
  382. * the phy redirect the broadcast change to the port object */
  383. case SCU_EVENT_TYPE_ERR_CNT_EVENT:
  384. /*
  385. * direct error counter event to the phy object since that is where
  386. * we get the event notification. This is a type 4 event. */
  387. case SCU_EVENT_TYPE_OSSP_EVENT:
  388. index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent);
  389. iphy = &ihost->phys[index];
  390. sci_phy_event_handler(iphy, ent);
  391. break;
  392. case SCU_EVENT_TYPE_RNC_SUSPEND_TX:
  393. case SCU_EVENT_TYPE_RNC_SUSPEND_TX_RX:
  394. case SCU_EVENT_TYPE_RNC_OPS_MISC:
  395. if (index < ihost->remote_node_entries) {
  396. idev = ihost->device_table[index];
  397. if (idev != NULL)
  398. sci_remote_device_event_handler(idev, ent);
  399. } else
  400. dev_err(&ihost->pdev->dev,
  401. "%s: SCIC Controller 0x%p received event 0x%x "
  402. "for remote device object 0x%0x that doesnt "
  403. "exist.\n",
  404. __func__,
  405. ihost,
  406. ent,
  407. index);
  408. break;
  409. default:
  410. dev_warn(&ihost->pdev->dev,
  411. "%s: SCIC Controller received unknown event code %x\n",
  412. __func__,
  413. ent);
  414. break;
  415. }
  416. }
  417. static void sci_controller_process_completions(struct isci_host *ihost)
  418. {
  419. u32 completion_count = 0;
  420. u32 ent;
  421. u32 get_index;
  422. u32 get_cycle;
  423. u32 event_get;
  424. u32 event_cycle;
  425. dev_dbg(&ihost->pdev->dev,
  426. "%s: completion queue begining get:0x%08x\n",
  427. __func__,
  428. ihost->completion_queue_get);
  429. /* Get the component parts of the completion queue */
  430. get_index = NORMALIZE_GET_POINTER(ihost->completion_queue_get);
  431. get_cycle = SMU_CQGR_CYCLE_BIT & ihost->completion_queue_get;
  432. event_get = NORMALIZE_EVENT_POINTER(ihost->completion_queue_get);
  433. event_cycle = SMU_CQGR_EVENT_CYCLE_BIT & ihost->completion_queue_get;
  434. while (
  435. NORMALIZE_GET_POINTER_CYCLE_BIT(get_cycle)
  436. == COMPLETION_QUEUE_CYCLE_BIT(ihost->completion_queue[get_index])
  437. ) {
  438. completion_count++;
  439. ent = ihost->completion_queue[get_index];
  440. /* increment the get pointer and check for rollover to toggle the cycle bit */
  441. get_cycle ^= ((get_index+1) & SCU_MAX_COMPLETION_QUEUE_ENTRIES) <<
  442. (SMU_COMPLETION_QUEUE_GET_CYCLE_BIT_SHIFT - SCU_MAX_COMPLETION_QUEUE_SHIFT);
  443. get_index = (get_index+1) & (SCU_MAX_COMPLETION_QUEUE_ENTRIES-1);
  444. dev_dbg(&ihost->pdev->dev,
  445. "%s: completion queue entry:0x%08x\n",
  446. __func__,
  447. ent);
  448. switch (SCU_GET_COMPLETION_TYPE(ent)) {
  449. case SCU_COMPLETION_TYPE_TASK:
  450. sci_controller_task_completion(ihost, ent);
  451. break;
  452. case SCU_COMPLETION_TYPE_SDMA:
  453. sci_controller_sdma_completion(ihost, ent);
  454. break;
  455. case SCU_COMPLETION_TYPE_UFI:
  456. sci_controller_unsolicited_frame(ihost, ent);
  457. break;
  458. case SCU_COMPLETION_TYPE_EVENT:
  459. sci_controller_event_completion(ihost, ent);
  460. break;
  461. case SCU_COMPLETION_TYPE_NOTIFY: {
  462. event_cycle ^= ((event_get+1) & SCU_MAX_EVENTS) <<
  463. (SMU_COMPLETION_QUEUE_GET_EVENT_CYCLE_BIT_SHIFT - SCU_MAX_EVENTS_SHIFT);
  464. event_get = (event_get+1) & (SCU_MAX_EVENTS-1);
  465. sci_controller_event_completion(ihost, ent);
  466. break;
  467. }
  468. default:
  469. dev_warn(&ihost->pdev->dev,
  470. "%s: SCIC Controller received unknown "
  471. "completion type %x\n",
  472. __func__,
  473. ent);
  474. break;
  475. }
  476. }
  477. /* Update the get register if we completed one or more entries */
  478. if (completion_count > 0) {
  479. ihost->completion_queue_get =
  480. SMU_CQGR_GEN_BIT(ENABLE) |
  481. SMU_CQGR_GEN_BIT(EVENT_ENABLE) |
  482. event_cycle |
  483. SMU_CQGR_GEN_VAL(EVENT_POINTER, event_get) |
  484. get_cycle |
  485. SMU_CQGR_GEN_VAL(POINTER, get_index);
  486. writel(ihost->completion_queue_get,
  487. &ihost->smu_registers->completion_queue_get);
  488. }
  489. dev_dbg(&ihost->pdev->dev,
  490. "%s: completion queue ending get:0x%08x\n",
  491. __func__,
  492. ihost->completion_queue_get);
  493. }
  494. static void sci_controller_error_handler(struct isci_host *ihost)
  495. {
  496. u32 interrupt_status;
  497. interrupt_status =
  498. readl(&ihost->smu_registers->interrupt_status);
  499. if ((interrupt_status & SMU_ISR_QUEUE_SUSPEND) &&
  500. sci_controller_completion_queue_has_entries(ihost)) {
  501. sci_controller_process_completions(ihost);
  502. writel(SMU_ISR_QUEUE_SUSPEND, &ihost->smu_registers->interrupt_status);
  503. } else {
  504. dev_err(&ihost->pdev->dev, "%s: status: %#x\n", __func__,
  505. interrupt_status);
  506. sci_change_state(&ihost->sm, SCIC_FAILED);
  507. return;
  508. }
  509. /* If we dont process any completions I am not sure that we want to do this.
  510. * We are in the middle of a hardware fault and should probably be reset.
  511. */
  512. writel(0, &ihost->smu_registers->interrupt_mask);
  513. }
  514. irqreturn_t isci_intx_isr(int vec, void *data)
  515. {
  516. irqreturn_t ret = IRQ_NONE;
  517. struct isci_host *ihost = data;
  518. if (sci_controller_isr(ihost)) {
  519. writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status);
  520. tasklet_schedule(&ihost->completion_tasklet);
  521. ret = IRQ_HANDLED;
  522. } else if (sci_controller_error_isr(ihost)) {
  523. spin_lock(&ihost->scic_lock);
  524. sci_controller_error_handler(ihost);
  525. spin_unlock(&ihost->scic_lock);
  526. ret = IRQ_HANDLED;
  527. }
  528. return ret;
  529. }
  530. irqreturn_t isci_error_isr(int vec, void *data)
  531. {
  532. struct isci_host *ihost = data;
  533. if (sci_controller_error_isr(ihost))
  534. sci_controller_error_handler(ihost);
  535. return IRQ_HANDLED;
  536. }
  537. /**
  538. * isci_host_start_complete() - This function is called by the core library,
  539. * through the ISCI Module, to indicate controller start status.
  540. * @isci_host: This parameter specifies the ISCI host object
  541. * @completion_status: This parameter specifies the completion status from the
  542. * core library.
  543. *
  544. */
  545. static void isci_host_start_complete(struct isci_host *ihost, enum sci_status completion_status)
  546. {
  547. if (completion_status != SCI_SUCCESS)
  548. dev_info(&ihost->pdev->dev,
  549. "controller start timed out, continuing...\n");
  550. isci_host_change_state(ihost, isci_ready);
  551. clear_bit(IHOST_START_PENDING, &ihost->flags);
  552. wake_up(&ihost->eventq);
  553. }
  554. int isci_host_scan_finished(struct Scsi_Host *shost, unsigned long time)
  555. {
  556. struct isci_host *ihost = SHOST_TO_SAS_HA(shost)->lldd_ha;
  557. if (test_bit(IHOST_START_PENDING, &ihost->flags))
  558. return 0;
  559. /* todo: use sas_flush_discovery once it is upstream */
  560. scsi_flush_work(shost);
  561. scsi_flush_work(shost);
  562. dev_dbg(&ihost->pdev->dev,
  563. "%s: ihost->status = %d, time = %ld\n",
  564. __func__, isci_host_get_state(ihost), time);
  565. return 1;
  566. }
  567. /**
  568. * sci_controller_get_suggested_start_timeout() - This method returns the
  569. * suggested sci_controller_start() timeout amount. The user is free to
  570. * use any timeout value, but this method provides the suggested minimum
  571. * start timeout value. The returned value is based upon empirical
  572. * information determined as a result of interoperability testing.
  573. * @controller: the handle to the controller object for which to return the
  574. * suggested start timeout.
  575. *
  576. * This method returns the number of milliseconds for the suggested start
  577. * operation timeout.
  578. */
  579. static u32 sci_controller_get_suggested_start_timeout(struct isci_host *ihost)
  580. {
  581. /* Validate the user supplied parameters. */
  582. if (!ihost)
  583. return 0;
  584. /*
  585. * The suggested minimum timeout value for a controller start operation:
  586. *
  587. * Signature FIS Timeout
  588. * + Phy Start Timeout
  589. * + Number of Phy Spin Up Intervals
  590. * ---------------------------------
  591. * Number of milliseconds for the controller start operation.
  592. *
  593. * NOTE: The number of phy spin up intervals will be equivalent
  594. * to the number of phys divided by the number phys allowed
  595. * per interval - 1 (once OEM parameters are supported).
  596. * Currently we assume only 1 phy per interval. */
  597. return SCIC_SDS_SIGNATURE_FIS_TIMEOUT
  598. + SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT
  599. + ((SCI_MAX_PHYS - 1) * SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL);
  600. }
  601. static void sci_controller_enable_interrupts(struct isci_host *ihost)
  602. {
  603. BUG_ON(ihost->smu_registers == NULL);
  604. writel(0, &ihost->smu_registers->interrupt_mask);
  605. }
  606. void sci_controller_disable_interrupts(struct isci_host *ihost)
  607. {
  608. BUG_ON(ihost->smu_registers == NULL);
  609. writel(0xffffffff, &ihost->smu_registers->interrupt_mask);
  610. }
  611. static void sci_controller_enable_port_task_scheduler(struct isci_host *ihost)
  612. {
  613. u32 port_task_scheduler_value;
  614. port_task_scheduler_value =
  615. readl(&ihost->scu_registers->peg0.ptsg.control);
  616. port_task_scheduler_value |=
  617. (SCU_PTSGCR_GEN_BIT(ETM_ENABLE) |
  618. SCU_PTSGCR_GEN_BIT(PTSG_ENABLE));
  619. writel(port_task_scheduler_value,
  620. &ihost->scu_registers->peg0.ptsg.control);
  621. }
  622. static void sci_controller_assign_task_entries(struct isci_host *ihost)
  623. {
  624. u32 task_assignment;
  625. /*
  626. * Assign all the TCs to function 0
  627. * TODO: Do we actually need to read this register to write it back?
  628. */
  629. task_assignment =
  630. readl(&ihost->smu_registers->task_context_assignment[0]);
  631. task_assignment |= (SMU_TCA_GEN_VAL(STARTING, 0)) |
  632. (SMU_TCA_GEN_VAL(ENDING, ihost->task_context_entries - 1)) |
  633. (SMU_TCA_GEN_BIT(RANGE_CHECK_ENABLE));
  634. writel(task_assignment,
  635. &ihost->smu_registers->task_context_assignment[0]);
  636. }
  637. static void sci_controller_initialize_completion_queue(struct isci_host *ihost)
  638. {
  639. u32 index;
  640. u32 completion_queue_control_value;
  641. u32 completion_queue_get_value;
  642. u32 completion_queue_put_value;
  643. ihost->completion_queue_get = 0;
  644. completion_queue_control_value =
  645. (SMU_CQC_QUEUE_LIMIT_SET(SCU_MAX_COMPLETION_QUEUE_ENTRIES - 1) |
  646. SMU_CQC_EVENT_LIMIT_SET(SCU_MAX_EVENTS - 1));
  647. writel(completion_queue_control_value,
  648. &ihost->smu_registers->completion_queue_control);
  649. /* Set the completion queue get pointer and enable the queue */
  650. completion_queue_get_value = (
  651. (SMU_CQGR_GEN_VAL(POINTER, 0))
  652. | (SMU_CQGR_GEN_VAL(EVENT_POINTER, 0))
  653. | (SMU_CQGR_GEN_BIT(ENABLE))
  654. | (SMU_CQGR_GEN_BIT(EVENT_ENABLE))
  655. );
  656. writel(completion_queue_get_value,
  657. &ihost->smu_registers->completion_queue_get);
  658. /* Set the completion queue put pointer */
  659. completion_queue_put_value = (
  660. (SMU_CQPR_GEN_VAL(POINTER, 0))
  661. | (SMU_CQPR_GEN_VAL(EVENT_POINTER, 0))
  662. );
  663. writel(completion_queue_put_value,
  664. &ihost->smu_registers->completion_queue_put);
  665. /* Initialize the cycle bit of the completion queue entries */
  666. for (index = 0; index < SCU_MAX_COMPLETION_QUEUE_ENTRIES; index++) {
  667. /*
  668. * If get.cycle_bit != completion_queue.cycle_bit
  669. * its not a valid completion queue entry
  670. * so at system start all entries are invalid */
  671. ihost->completion_queue[index] = 0x80000000;
  672. }
  673. }
  674. static void sci_controller_initialize_unsolicited_frame_queue(struct isci_host *ihost)
  675. {
  676. u32 frame_queue_control_value;
  677. u32 frame_queue_get_value;
  678. u32 frame_queue_put_value;
  679. /* Write the queue size */
  680. frame_queue_control_value =
  681. SCU_UFQC_GEN_VAL(QUEUE_SIZE, SCU_MAX_UNSOLICITED_FRAMES);
  682. writel(frame_queue_control_value,
  683. &ihost->scu_registers->sdma.unsolicited_frame_queue_control);
  684. /* Setup the get pointer for the unsolicited frame queue */
  685. frame_queue_get_value = (
  686. SCU_UFQGP_GEN_VAL(POINTER, 0)
  687. | SCU_UFQGP_GEN_BIT(ENABLE_BIT)
  688. );
  689. writel(frame_queue_get_value,
  690. &ihost->scu_registers->sdma.unsolicited_frame_get_pointer);
  691. /* Setup the put pointer for the unsolicited frame queue */
  692. frame_queue_put_value = SCU_UFQPP_GEN_VAL(POINTER, 0);
  693. writel(frame_queue_put_value,
  694. &ihost->scu_registers->sdma.unsolicited_frame_put_pointer);
  695. }
  696. static void sci_controller_transition_to_ready(struct isci_host *ihost, enum sci_status status)
  697. {
  698. if (ihost->sm.current_state_id == SCIC_STARTING) {
  699. /*
  700. * We move into the ready state, because some of the phys/ports
  701. * may be up and operational.
  702. */
  703. sci_change_state(&ihost->sm, SCIC_READY);
  704. isci_host_start_complete(ihost, status);
  705. }
  706. }
  707. static bool is_phy_starting(struct isci_phy *iphy)
  708. {
  709. enum sci_phy_states state;
  710. state = iphy->sm.current_state_id;
  711. switch (state) {
  712. case SCI_PHY_STARTING:
  713. case SCI_PHY_SUB_INITIAL:
  714. case SCI_PHY_SUB_AWAIT_SAS_SPEED_EN:
  715. case SCI_PHY_SUB_AWAIT_IAF_UF:
  716. case SCI_PHY_SUB_AWAIT_SAS_POWER:
  717. case SCI_PHY_SUB_AWAIT_SATA_POWER:
  718. case SCI_PHY_SUB_AWAIT_SATA_PHY_EN:
  719. case SCI_PHY_SUB_AWAIT_SATA_SPEED_EN:
  720. case SCI_PHY_SUB_AWAIT_SIG_FIS_UF:
  721. case SCI_PHY_SUB_FINAL:
  722. return true;
  723. default:
  724. return false;
  725. }
  726. }
  727. /**
  728. * sci_controller_start_next_phy - start phy
  729. * @scic: controller
  730. *
  731. * If all the phys have been started, then attempt to transition the
  732. * controller to the READY state and inform the user
  733. * (sci_cb_controller_start_complete()).
  734. */
  735. static enum sci_status sci_controller_start_next_phy(struct isci_host *ihost)
  736. {
  737. struct sci_oem_params *oem = &ihost->oem_parameters;
  738. struct isci_phy *iphy;
  739. enum sci_status status;
  740. status = SCI_SUCCESS;
  741. if (ihost->phy_startup_timer_pending)
  742. return status;
  743. if (ihost->next_phy_to_start >= SCI_MAX_PHYS) {
  744. bool is_controller_start_complete = true;
  745. u32 state;
  746. u8 index;
  747. for (index = 0; index < SCI_MAX_PHYS; index++) {
  748. iphy = &ihost->phys[index];
  749. state = iphy->sm.current_state_id;
  750. if (!phy_get_non_dummy_port(iphy))
  751. continue;
  752. /* The controller start operation is complete iff:
  753. * - all links have been given an opportunity to start
  754. * - have no indication of a connected device
  755. * - have an indication of a connected device and it has
  756. * finished the link training process.
  757. */
  758. if ((iphy->is_in_link_training == false && state == SCI_PHY_INITIAL) ||
  759. (iphy->is_in_link_training == false && state == SCI_PHY_STOPPED) ||
  760. (iphy->is_in_link_training == true && is_phy_starting(iphy))) {
  761. is_controller_start_complete = false;
  762. break;
  763. }
  764. }
  765. /*
  766. * The controller has successfully finished the start process.
  767. * Inform the SCI Core user and transition to the READY state. */
  768. if (is_controller_start_complete == true) {
  769. sci_controller_transition_to_ready(ihost, SCI_SUCCESS);
  770. sci_del_timer(&ihost->phy_timer);
  771. ihost->phy_startup_timer_pending = false;
  772. }
  773. } else {
  774. iphy = &ihost->phys[ihost->next_phy_to_start];
  775. if (oem->controller.mode_type == SCIC_PORT_MANUAL_CONFIGURATION_MODE) {
  776. if (phy_get_non_dummy_port(iphy) == NULL) {
  777. ihost->next_phy_to_start++;
  778. /* Caution recursion ahead be forwarned
  779. *
  780. * The PHY was never added to a PORT in MPC mode
  781. * so start the next phy in sequence This phy
  782. * will never go link up and will not draw power
  783. * the OEM parameters either configured the phy
  784. * incorrectly for the PORT or it was never
  785. * assigned to a PORT
  786. */
  787. return sci_controller_start_next_phy(ihost);
  788. }
  789. }
  790. status = sci_phy_start(iphy);
  791. if (status == SCI_SUCCESS) {
  792. sci_mod_timer(&ihost->phy_timer,
  793. SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT);
  794. ihost->phy_startup_timer_pending = true;
  795. } else {
  796. dev_warn(&ihost->pdev->dev,
  797. "%s: Controller stop operation failed "
  798. "to stop phy %d because of status "
  799. "%d.\n",
  800. __func__,
  801. ihost->phys[ihost->next_phy_to_start].phy_index,
  802. status);
  803. }
  804. ihost->next_phy_to_start++;
  805. }
  806. return status;
  807. }
  808. static void phy_startup_timeout(unsigned long data)
  809. {
  810. struct sci_timer *tmr = (struct sci_timer *)data;
  811. struct isci_host *ihost = container_of(tmr, typeof(*ihost), phy_timer);
  812. unsigned long flags;
  813. enum sci_status status;
  814. spin_lock_irqsave(&ihost->scic_lock, flags);
  815. if (tmr->cancel)
  816. goto done;
  817. ihost->phy_startup_timer_pending = false;
  818. do {
  819. status = sci_controller_start_next_phy(ihost);
  820. } while (status != SCI_SUCCESS);
  821. done:
  822. spin_unlock_irqrestore(&ihost->scic_lock, flags);
  823. }
  824. static u16 isci_tci_active(struct isci_host *ihost)
  825. {
  826. return CIRC_CNT(ihost->tci_head, ihost->tci_tail, SCI_MAX_IO_REQUESTS);
  827. }
  828. static enum sci_status sci_controller_start(struct isci_host *ihost,
  829. u32 timeout)
  830. {
  831. enum sci_status result;
  832. u16 index;
  833. if (ihost->sm.current_state_id != SCIC_INITIALIZED) {
  834. dev_warn(&ihost->pdev->dev,
  835. "SCIC Controller start operation requested in "
  836. "invalid state\n");
  837. return SCI_FAILURE_INVALID_STATE;
  838. }
  839. /* Build the TCi free pool */
  840. BUILD_BUG_ON(SCI_MAX_IO_REQUESTS > 1 << sizeof(ihost->tci_pool[0]) * 8);
  841. ihost->tci_head = 0;
  842. ihost->tci_tail = 0;
  843. for (index = 0; index < ihost->task_context_entries; index++)
  844. isci_tci_free(ihost, index);
  845. /* Build the RNi free pool */
  846. sci_remote_node_table_initialize(&ihost->available_remote_nodes,
  847. ihost->remote_node_entries);
  848. /*
  849. * Before anything else lets make sure we will not be
  850. * interrupted by the hardware.
  851. */
  852. sci_controller_disable_interrupts(ihost);
  853. /* Enable the port task scheduler */
  854. sci_controller_enable_port_task_scheduler(ihost);
  855. /* Assign all the task entries to ihost physical function */
  856. sci_controller_assign_task_entries(ihost);
  857. /* Now initialize the completion queue */
  858. sci_controller_initialize_completion_queue(ihost);
  859. /* Initialize the unsolicited frame queue for use */
  860. sci_controller_initialize_unsolicited_frame_queue(ihost);
  861. /* Start all of the ports on this controller */
  862. for (index = 0; index < ihost->logical_port_entries; index++) {
  863. struct isci_port *iport = &ihost->ports[index];
  864. result = sci_port_start(iport);
  865. if (result)
  866. return result;
  867. }
  868. sci_controller_start_next_phy(ihost);
  869. sci_mod_timer(&ihost->timer, timeout);
  870. sci_change_state(&ihost->sm, SCIC_STARTING);
  871. return SCI_SUCCESS;
  872. }
  873. void isci_host_scan_start(struct Scsi_Host *shost)
  874. {
  875. struct isci_host *ihost = SHOST_TO_SAS_HA(shost)->lldd_ha;
  876. unsigned long tmo = sci_controller_get_suggested_start_timeout(ihost);
  877. set_bit(IHOST_START_PENDING, &ihost->flags);
  878. spin_lock_irq(&ihost->scic_lock);
  879. sci_controller_start(ihost, tmo);
  880. sci_controller_enable_interrupts(ihost);
  881. spin_unlock_irq(&ihost->scic_lock);
  882. }
  883. static void isci_host_stop_complete(struct isci_host *ihost, enum sci_status completion_status)
  884. {
  885. isci_host_change_state(ihost, isci_stopped);
  886. sci_controller_disable_interrupts(ihost);
  887. clear_bit(IHOST_STOP_PENDING, &ihost->flags);
  888. wake_up(&ihost->eventq);
  889. }
  890. static void sci_controller_completion_handler(struct isci_host *ihost)
  891. {
  892. /* Empty out the completion queue */
  893. if (sci_controller_completion_queue_has_entries(ihost))
  894. sci_controller_process_completions(ihost);
  895. /* Clear the interrupt and enable all interrupts again */
  896. writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status);
  897. /* Could we write the value of SMU_ISR_COMPLETION? */
  898. writel(0xFF000000, &ihost->smu_registers->interrupt_mask);
  899. writel(0, &ihost->smu_registers->interrupt_mask);
  900. }
  901. /**
  902. * isci_host_completion_routine() - This function is the delayed service
  903. * routine that calls the sci core library's completion handler. It's
  904. * scheduled as a tasklet from the interrupt service routine when interrupts
  905. * in use, or set as the timeout function in polled mode.
  906. * @data: This parameter specifies the ISCI host object
  907. *
  908. */
  909. static void isci_host_completion_routine(unsigned long data)
  910. {
  911. struct isci_host *ihost = (struct isci_host *)data;
  912. struct list_head completed_request_list;
  913. struct list_head errored_request_list;
  914. struct list_head *current_position;
  915. struct list_head *next_position;
  916. struct isci_request *request;
  917. struct isci_request *next_request;
  918. struct sas_task *task;
  919. u16 active;
  920. INIT_LIST_HEAD(&completed_request_list);
  921. INIT_LIST_HEAD(&errored_request_list);
  922. spin_lock_irq(&ihost->scic_lock);
  923. sci_controller_completion_handler(ihost);
  924. /* Take the lists of completed I/Os from the host. */
  925. list_splice_init(&ihost->requests_to_complete,
  926. &completed_request_list);
  927. /* Take the list of errored I/Os from the host. */
  928. list_splice_init(&ihost->requests_to_errorback,
  929. &errored_request_list);
  930. spin_unlock_irq(&ihost->scic_lock);
  931. /* Process any completions in the lists. */
  932. list_for_each_safe(current_position, next_position,
  933. &completed_request_list) {
  934. request = list_entry(current_position, struct isci_request,
  935. completed_node);
  936. task = isci_request_access_task(request);
  937. /* Normal notification (task_done) */
  938. dev_dbg(&ihost->pdev->dev,
  939. "%s: Normal - request/task = %p/%p\n",
  940. __func__,
  941. request,
  942. task);
  943. /* Return the task to libsas */
  944. if (task != NULL) {
  945. task->lldd_task = NULL;
  946. if (!(task->task_state_flags & SAS_TASK_STATE_ABORTED)) {
  947. /* If the task is already in the abort path,
  948. * the task_done callback cannot be called.
  949. */
  950. task->task_done(task);
  951. }
  952. }
  953. spin_lock_irq(&ihost->scic_lock);
  954. isci_free_tag(ihost, request->io_tag);
  955. spin_unlock_irq(&ihost->scic_lock);
  956. }
  957. list_for_each_entry_safe(request, next_request, &errored_request_list,
  958. completed_node) {
  959. task = isci_request_access_task(request);
  960. /* Use sas_task_abort */
  961. dev_warn(&ihost->pdev->dev,
  962. "%s: Error - request/task = %p/%p\n",
  963. __func__,
  964. request,
  965. task);
  966. if (task != NULL) {
  967. /* Put the task into the abort path if it's not there
  968. * already.
  969. */
  970. if (!(task->task_state_flags & SAS_TASK_STATE_ABORTED))
  971. sas_task_abort(task);
  972. } else {
  973. /* This is a case where the request has completed with a
  974. * status such that it needed further target servicing,
  975. * but the sas_task reference has already been removed
  976. * from the request. Since it was errored, it was not
  977. * being aborted, so there is nothing to do except free
  978. * it.
  979. */
  980. spin_lock_irq(&ihost->scic_lock);
  981. /* Remove the request from the remote device's list
  982. * of pending requests.
  983. */
  984. list_del_init(&request->dev_node);
  985. isci_free_tag(ihost, request->io_tag);
  986. spin_unlock_irq(&ihost->scic_lock);
  987. }
  988. }
  989. /* the coalesence timeout doubles at each encoding step, so
  990. * update it based on the ilog2 value of the outstanding requests
  991. */
  992. active = isci_tci_active(ihost);
  993. writel(SMU_ICC_GEN_VAL(NUMBER, active) |
  994. SMU_ICC_GEN_VAL(TIMER, ISCI_COALESCE_BASE + ilog2(active)),
  995. &ihost->smu_registers->interrupt_coalesce_control);
  996. }
  997. /**
  998. * sci_controller_stop() - This method will stop an individual controller
  999. * object.This method will invoke the associated user callback upon
  1000. * completion. The completion callback is called when the following
  1001. * conditions are met: -# the method return status is SCI_SUCCESS. -# the
  1002. * controller has been quiesced. This method will ensure that all IO
  1003. * requests are quiesced, phys are stopped, and all additional operation by
  1004. * the hardware is halted.
  1005. * @controller: the handle to the controller object to stop.
  1006. * @timeout: This parameter specifies the number of milliseconds in which the
  1007. * stop operation should complete.
  1008. *
  1009. * The controller must be in the STARTED or STOPPED state. Indicate if the
  1010. * controller stop method succeeded or failed in some way. SCI_SUCCESS if the
  1011. * stop operation successfully began. SCI_WARNING_ALREADY_IN_STATE if the
  1012. * controller is already in the STOPPED state. SCI_FAILURE_INVALID_STATE if the
  1013. * controller is not either in the STARTED or STOPPED states.
  1014. */
  1015. static enum sci_status sci_controller_stop(struct isci_host *ihost, u32 timeout)
  1016. {
  1017. if (ihost->sm.current_state_id != SCIC_READY) {
  1018. dev_warn(&ihost->pdev->dev,
  1019. "SCIC Controller stop operation requested in "
  1020. "invalid state\n");
  1021. return SCI_FAILURE_INVALID_STATE;
  1022. }
  1023. sci_mod_timer(&ihost->timer, timeout);
  1024. sci_change_state(&ihost->sm, SCIC_STOPPING);
  1025. return SCI_SUCCESS;
  1026. }
  1027. /**
  1028. * sci_controller_reset() - This method will reset the supplied core
  1029. * controller regardless of the state of said controller. This operation is
  1030. * considered destructive. In other words, all current operations are wiped
  1031. * out. No IO completions for outstanding devices occur. Outstanding IO
  1032. * requests are not aborted or completed at the actual remote device.
  1033. * @controller: the handle to the controller object to reset.
  1034. *
  1035. * Indicate if the controller reset method succeeded or failed in some way.
  1036. * SCI_SUCCESS if the reset operation successfully started. SCI_FATAL_ERROR if
  1037. * the controller reset operation is unable to complete.
  1038. */
  1039. static enum sci_status sci_controller_reset(struct isci_host *ihost)
  1040. {
  1041. switch (ihost->sm.current_state_id) {
  1042. case SCIC_RESET:
  1043. case SCIC_READY:
  1044. case SCIC_STOPPED:
  1045. case SCIC_FAILED:
  1046. /*
  1047. * The reset operation is not a graceful cleanup, just
  1048. * perform the state transition.
  1049. */
  1050. sci_change_state(&ihost->sm, SCIC_RESETTING);
  1051. return SCI_SUCCESS;
  1052. default:
  1053. dev_warn(&ihost->pdev->dev,
  1054. "SCIC Controller reset operation requested in "
  1055. "invalid state\n");
  1056. return SCI_FAILURE_INVALID_STATE;
  1057. }
  1058. }
  1059. void isci_host_deinit(struct isci_host *ihost)
  1060. {
  1061. int i;
  1062. isci_host_change_state(ihost, isci_stopping);
  1063. for (i = 0; i < SCI_MAX_PORTS; i++) {
  1064. struct isci_port *iport = &ihost->ports[i];
  1065. struct isci_remote_device *idev, *d;
  1066. list_for_each_entry_safe(idev, d, &iport->remote_dev_list, node) {
  1067. if (test_bit(IDEV_ALLOCATED, &idev->flags))
  1068. isci_remote_device_stop(ihost, idev);
  1069. }
  1070. }
  1071. set_bit(IHOST_STOP_PENDING, &ihost->flags);
  1072. spin_lock_irq(&ihost->scic_lock);
  1073. sci_controller_stop(ihost, SCIC_CONTROLLER_STOP_TIMEOUT);
  1074. spin_unlock_irq(&ihost->scic_lock);
  1075. wait_for_stop(ihost);
  1076. sci_controller_reset(ihost);
  1077. /* Cancel any/all outstanding port timers */
  1078. for (i = 0; i < ihost->logical_port_entries; i++) {
  1079. struct isci_port *iport = &ihost->ports[i];
  1080. del_timer_sync(&iport->timer.timer);
  1081. }
  1082. /* Cancel any/all outstanding phy timers */
  1083. for (i = 0; i < SCI_MAX_PHYS; i++) {
  1084. struct isci_phy *iphy = &ihost->phys[i];
  1085. del_timer_sync(&iphy->sata_timer.timer);
  1086. }
  1087. del_timer_sync(&ihost->port_agent.timer.timer);
  1088. del_timer_sync(&ihost->power_control.timer.timer);
  1089. del_timer_sync(&ihost->timer.timer);
  1090. del_timer_sync(&ihost->phy_timer.timer);
  1091. }
  1092. static void __iomem *scu_base(struct isci_host *isci_host)
  1093. {
  1094. struct pci_dev *pdev = isci_host->pdev;
  1095. int id = isci_host->id;
  1096. return pcim_iomap_table(pdev)[SCI_SCU_BAR * 2] + SCI_SCU_BAR_SIZE * id;
  1097. }
  1098. static void __iomem *smu_base(struct isci_host *isci_host)
  1099. {
  1100. struct pci_dev *pdev = isci_host->pdev;
  1101. int id = isci_host->id;
  1102. return pcim_iomap_table(pdev)[SCI_SMU_BAR * 2] + SCI_SMU_BAR_SIZE * id;
  1103. }
  1104. static void isci_user_parameters_get(struct sci_user_parameters *u)
  1105. {
  1106. int i;
  1107. for (i = 0; i < SCI_MAX_PHYS; i++) {
  1108. struct sci_phy_user_params *u_phy = &u->phys[i];
  1109. u_phy->max_speed_generation = phy_gen;
  1110. /* we are not exporting these for now */
  1111. u_phy->align_insertion_frequency = 0x7f;
  1112. u_phy->in_connection_align_insertion_frequency = 0xff;
  1113. u_phy->notify_enable_spin_up_insertion_frequency = 0x33;
  1114. }
  1115. u->stp_inactivity_timeout = stp_inactive_to;
  1116. u->ssp_inactivity_timeout = ssp_inactive_to;
  1117. u->stp_max_occupancy_timeout = stp_max_occ_to;
  1118. u->ssp_max_occupancy_timeout = ssp_max_occ_to;
  1119. u->no_outbound_task_timeout = no_outbound_task_to;
  1120. u->max_number_concurrent_device_spin_up = max_concurr_spinup;
  1121. }
  1122. static void sci_controller_initial_state_enter(struct sci_base_state_machine *sm)
  1123. {
  1124. struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
  1125. sci_change_state(&ihost->sm, SCIC_RESET);
  1126. }
  1127. static inline void sci_controller_starting_state_exit(struct sci_base_state_machine *sm)
  1128. {
  1129. struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
  1130. sci_del_timer(&ihost->timer);
  1131. }
  1132. #define INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_LOWER_BOUND_NS 853
  1133. #define INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_UPPER_BOUND_NS 1280
  1134. #define INTERRUPT_COALESCE_TIMEOUT_MAX_US 2700000
  1135. #define INTERRUPT_COALESCE_NUMBER_MAX 256
  1136. #define INTERRUPT_COALESCE_TIMEOUT_ENCODE_MIN 7
  1137. #define INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX 28
  1138. /**
  1139. * sci_controller_set_interrupt_coalescence() - This method allows the user to
  1140. * configure the interrupt coalescence.
  1141. * @controller: This parameter represents the handle to the controller object
  1142. * for which its interrupt coalesce register is overridden.
  1143. * @coalesce_number: Used to control the number of entries in the Completion
  1144. * Queue before an interrupt is generated. If the number of entries exceed
  1145. * this number, an interrupt will be generated. The valid range of the input
  1146. * is [0, 256]. A setting of 0 results in coalescing being disabled.
  1147. * @coalesce_timeout: Timeout value in microseconds. The valid range of the
  1148. * input is [0, 2700000] . A setting of 0 is allowed and results in no
  1149. * interrupt coalescing timeout.
  1150. *
  1151. * Indicate if the user successfully set the interrupt coalesce parameters.
  1152. * SCI_SUCCESS The user successfully updated the interrutp coalescence.
  1153. * SCI_FAILURE_INVALID_PARAMETER_VALUE The user input value is out of range.
  1154. */
  1155. static enum sci_status
  1156. sci_controller_set_interrupt_coalescence(struct isci_host *ihost,
  1157. u32 coalesce_number,
  1158. u32 coalesce_timeout)
  1159. {
  1160. u8 timeout_encode = 0;
  1161. u32 min = 0;
  1162. u32 max = 0;
  1163. /* Check if the input parameters fall in the range. */
  1164. if (coalesce_number > INTERRUPT_COALESCE_NUMBER_MAX)
  1165. return SCI_FAILURE_INVALID_PARAMETER_VALUE;
  1166. /*
  1167. * Defined encoding for interrupt coalescing timeout:
  1168. * Value Min Max Units
  1169. * ----- --- --- -----
  1170. * 0 - - Disabled
  1171. * 1 13.3 20.0 ns
  1172. * 2 26.7 40.0
  1173. * 3 53.3 80.0
  1174. * 4 106.7 160.0
  1175. * 5 213.3 320.0
  1176. * 6 426.7 640.0
  1177. * 7 853.3 1280.0
  1178. * 8 1.7 2.6 us
  1179. * 9 3.4 5.1
  1180. * 10 6.8 10.2
  1181. * 11 13.7 20.5
  1182. * 12 27.3 41.0
  1183. * 13 54.6 81.9
  1184. * 14 109.2 163.8
  1185. * 15 218.5 327.7
  1186. * 16 436.9 655.4
  1187. * 17 873.8 1310.7
  1188. * 18 1.7 2.6 ms
  1189. * 19 3.5 5.2
  1190. * 20 7.0 10.5
  1191. * 21 14.0 21.0
  1192. * 22 28.0 41.9
  1193. * 23 55.9 83.9
  1194. * 24 111.8 167.8
  1195. * 25 223.7 335.5
  1196. * 26 447.4 671.1
  1197. * 27 894.8 1342.2
  1198. * 28 1.8 2.7 s
  1199. * Others Undefined */
  1200. /*
  1201. * Use the table above to decide the encode of interrupt coalescing timeout
  1202. * value for register writing. */
  1203. if (coalesce_timeout == 0)
  1204. timeout_encode = 0;
  1205. else{
  1206. /* make the timeout value in unit of (10 ns). */
  1207. coalesce_timeout = coalesce_timeout * 100;
  1208. min = INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_LOWER_BOUND_NS / 10;
  1209. max = INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_UPPER_BOUND_NS / 10;
  1210. /* get the encode of timeout for register writing. */
  1211. for (timeout_encode = INTERRUPT_COALESCE_TIMEOUT_ENCODE_MIN;
  1212. timeout_encode <= INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX;
  1213. timeout_encode++) {
  1214. if (min <= coalesce_timeout && max > coalesce_timeout)
  1215. break;
  1216. else if (coalesce_timeout >= max && coalesce_timeout < min * 2
  1217. && coalesce_timeout <= INTERRUPT_COALESCE_TIMEOUT_MAX_US * 100) {
  1218. if ((coalesce_timeout - max) < (2 * min - coalesce_timeout))
  1219. break;
  1220. else{
  1221. timeout_encode++;
  1222. break;
  1223. }
  1224. } else {
  1225. max = max * 2;
  1226. min = min * 2;
  1227. }
  1228. }
  1229. if (timeout_encode == INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX + 1)
  1230. /* the value is out of range. */
  1231. return SCI_FAILURE_INVALID_PARAMETER_VALUE;
  1232. }
  1233. writel(SMU_ICC_GEN_VAL(NUMBER, coalesce_number) |
  1234. SMU_ICC_GEN_VAL(TIMER, timeout_encode),
  1235. &ihost->smu_registers->interrupt_coalesce_control);
  1236. ihost->interrupt_coalesce_number = (u16)coalesce_number;
  1237. ihost->interrupt_coalesce_timeout = coalesce_timeout / 100;
  1238. return SCI_SUCCESS;
  1239. }
  1240. static void sci_controller_ready_state_enter(struct sci_base_state_machine *sm)
  1241. {
  1242. struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
  1243. /* set the default interrupt coalescence number and timeout value. */
  1244. sci_controller_set_interrupt_coalescence(ihost, 0, 0);
  1245. }
  1246. static void sci_controller_ready_state_exit(struct sci_base_state_machine *sm)
  1247. {
  1248. struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
  1249. /* disable interrupt coalescence. */
  1250. sci_controller_set_interrupt_coalescence(ihost, 0, 0);
  1251. }
  1252. static enum sci_status sci_controller_stop_phys(struct isci_host *ihost)
  1253. {
  1254. u32 index;
  1255. enum sci_status status;
  1256. enum sci_status phy_status;
  1257. status = SCI_SUCCESS;
  1258. for (index = 0; index < SCI_MAX_PHYS; index++) {
  1259. phy_status = sci_phy_stop(&ihost->phys[index]);
  1260. if (phy_status != SCI_SUCCESS &&
  1261. phy_status != SCI_FAILURE_INVALID_STATE) {
  1262. status = SCI_FAILURE;
  1263. dev_warn(&ihost->pdev->dev,
  1264. "%s: Controller stop operation failed to stop "
  1265. "phy %d because of status %d.\n",
  1266. __func__,
  1267. ihost->phys[index].phy_index, phy_status);
  1268. }
  1269. }
  1270. return status;
  1271. }
  1272. static enum sci_status sci_controller_stop_ports(struct isci_host *ihost)
  1273. {
  1274. u32 index;
  1275. enum sci_status port_status;
  1276. enum sci_status status = SCI_SUCCESS;
  1277. for (index = 0; index < ihost->logical_port_entries; index++) {
  1278. struct isci_port *iport = &ihost->ports[index];
  1279. port_status = sci_port_stop(iport);
  1280. if ((port_status != SCI_SUCCESS) &&
  1281. (port_status != SCI_FAILURE_INVALID_STATE)) {
  1282. status = SCI_FAILURE;
  1283. dev_warn(&ihost->pdev->dev,
  1284. "%s: Controller stop operation failed to "
  1285. "stop port %d because of status %d.\n",
  1286. __func__,
  1287. iport->logical_port_index,
  1288. port_status);
  1289. }
  1290. }
  1291. return status;
  1292. }
  1293. static enum sci_status sci_controller_stop_devices(struct isci_host *ihost)
  1294. {
  1295. u32 index;
  1296. enum sci_status status;
  1297. enum sci_status device_status;
  1298. status = SCI_SUCCESS;
  1299. for (index = 0; index < ihost->remote_node_entries; index++) {
  1300. if (ihost->device_table[index] != NULL) {
  1301. /* / @todo What timeout value do we want to provide to this request? */
  1302. device_status = sci_remote_device_stop(ihost->device_table[index], 0);
  1303. if ((device_status != SCI_SUCCESS) &&
  1304. (device_status != SCI_FAILURE_INVALID_STATE)) {
  1305. dev_warn(&ihost->pdev->dev,
  1306. "%s: Controller stop operation failed "
  1307. "to stop device 0x%p because of "
  1308. "status %d.\n",
  1309. __func__,
  1310. ihost->device_table[index], device_status);
  1311. }
  1312. }
  1313. }
  1314. return status;
  1315. }
  1316. static void sci_controller_stopping_state_enter(struct sci_base_state_machine *sm)
  1317. {
  1318. struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
  1319. /* Stop all of the components for this controller */
  1320. sci_controller_stop_phys(ihost);
  1321. sci_controller_stop_ports(ihost);
  1322. sci_controller_stop_devices(ihost);
  1323. }
  1324. static void sci_controller_stopping_state_exit(struct sci_base_state_machine *sm)
  1325. {
  1326. struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
  1327. sci_del_timer(&ihost->timer);
  1328. }
  1329. static void sci_controller_reset_hardware(struct isci_host *ihost)
  1330. {
  1331. /* Disable interrupts so we dont take any spurious interrupts */
  1332. sci_controller_disable_interrupts(ihost);
  1333. /* Reset the SCU */
  1334. writel(0xFFFFFFFF, &ihost->smu_registers->soft_reset_control);
  1335. /* Delay for 1ms to before clearing the CQP and UFQPR. */
  1336. udelay(1000);
  1337. /* The write to the CQGR clears the CQP */
  1338. writel(0x00000000, &ihost->smu_registers->completion_queue_get);
  1339. /* The write to the UFQGP clears the UFQPR */
  1340. writel(0, &ihost->scu_registers->sdma.unsolicited_frame_get_pointer);
  1341. }
  1342. static void sci_controller_resetting_state_enter(struct sci_base_state_machine *sm)
  1343. {
  1344. struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
  1345. sci_controller_reset_hardware(ihost);
  1346. sci_change_state(&ihost->sm, SCIC_RESET);
  1347. }
  1348. static const struct sci_base_state sci_controller_state_table[] = {
  1349. [SCIC_INITIAL] = {
  1350. .enter_state = sci_controller_initial_state_enter,
  1351. },
  1352. [SCIC_RESET] = {},
  1353. [SCIC_INITIALIZING] = {},
  1354. [SCIC_INITIALIZED] = {},
  1355. [SCIC_STARTING] = {
  1356. .exit_state = sci_controller_starting_state_exit,
  1357. },
  1358. [SCIC_READY] = {
  1359. .enter_state = sci_controller_ready_state_enter,
  1360. .exit_state = sci_controller_ready_state_exit,
  1361. },
  1362. [SCIC_RESETTING] = {
  1363. .enter_state = sci_controller_resetting_state_enter,
  1364. },
  1365. [SCIC_STOPPING] = {
  1366. .enter_state = sci_controller_stopping_state_enter,
  1367. .exit_state = sci_controller_stopping_state_exit,
  1368. },
  1369. [SCIC_STOPPED] = {},
  1370. [SCIC_FAILED] = {}
  1371. };
  1372. static void sci_controller_set_default_config_parameters(struct isci_host *ihost)
  1373. {
  1374. /* these defaults are overridden by the platform / firmware */
  1375. u16 index;
  1376. /* Default to APC mode. */
  1377. ihost->oem_parameters.controller.mode_type = SCIC_PORT_AUTOMATIC_CONFIGURATION_MODE;
  1378. /* Default to APC mode. */
  1379. ihost->oem_parameters.controller.max_concurrent_dev_spin_up = 1;
  1380. /* Default to no SSC operation. */
  1381. ihost->oem_parameters.controller.do_enable_ssc = false;
  1382. /* Initialize all of the port parameter information to narrow ports. */
  1383. for (index = 0; index < SCI_MAX_PORTS; index++) {
  1384. ihost->oem_parameters.ports[index].phy_mask = 0;
  1385. }
  1386. /* Initialize all of the phy parameter information. */
  1387. for (index = 0; index < SCI_MAX_PHYS; index++) {
  1388. /* Default to 6G (i.e. Gen 3) for now. */
  1389. ihost->user_parameters.phys[index].max_speed_generation = 3;
  1390. /* the frequencies cannot be 0 */
  1391. ihost->user_parameters.phys[index].align_insertion_frequency = 0x7f;
  1392. ihost->user_parameters.phys[index].in_connection_align_insertion_frequency = 0xff;
  1393. ihost->user_parameters.phys[index].notify_enable_spin_up_insertion_frequency = 0x33;
  1394. /*
  1395. * Previous Vitesse based expanders had a arbitration issue that
  1396. * is worked around by having the upper 32-bits of SAS address
  1397. * with a value greater then the Vitesse company identifier.
  1398. * Hence, usage of 0x5FCFFFFF. */
  1399. ihost->oem_parameters.phys[index].sas_address.low = 0x1 + ihost->id;
  1400. ihost->oem_parameters.phys[index].sas_address.high = 0x5FCFFFFF;
  1401. }
  1402. ihost->user_parameters.stp_inactivity_timeout = 5;
  1403. ihost->user_parameters.ssp_inactivity_timeout = 5;
  1404. ihost->user_parameters.stp_max_occupancy_timeout = 5;
  1405. ihost->user_parameters.ssp_max_occupancy_timeout = 20;
  1406. ihost->user_parameters.no_outbound_task_timeout = 20;
  1407. }
  1408. static void controller_timeout(unsigned long data)
  1409. {
  1410. struct sci_timer *tmr = (struct sci_timer *)data;
  1411. struct isci_host *ihost = container_of(tmr, typeof(*ihost), timer);
  1412. struct sci_base_state_machine *sm = &ihost->sm;
  1413. unsigned long flags;
  1414. spin_lock_irqsave(&ihost->scic_lock, flags);
  1415. if (tmr->cancel)
  1416. goto done;
  1417. if (sm->current_state_id == SCIC_STARTING)
  1418. sci_controller_transition_to_ready(ihost, SCI_FAILURE_TIMEOUT);
  1419. else if (sm->current_state_id == SCIC_STOPPING) {
  1420. sci_change_state(sm, SCIC_FAILED);
  1421. isci_host_stop_complete(ihost, SCI_FAILURE_TIMEOUT);
  1422. } else /* / @todo Now what do we want to do in this case? */
  1423. dev_err(&ihost->pdev->dev,
  1424. "%s: Controller timer fired when controller was not "
  1425. "in a state being timed.\n",
  1426. __func__);
  1427. done:
  1428. spin_unlock_irqrestore(&ihost->scic_lock, flags);
  1429. }
  1430. static enum sci_status sci_controller_construct(struct isci_host *ihost,
  1431. void __iomem *scu_base,
  1432. void __iomem *smu_base)
  1433. {
  1434. u8 i;
  1435. sci_init_sm(&ihost->sm, sci_controller_state_table, SCIC_INITIAL);
  1436. ihost->scu_registers = scu_base;
  1437. ihost->smu_registers = smu_base;
  1438. sci_port_configuration_agent_construct(&ihost->port_agent);
  1439. /* Construct the ports for this controller */
  1440. for (i = 0; i < SCI_MAX_PORTS; i++)
  1441. sci_port_construct(&ihost->ports[i], i, ihost);
  1442. sci_port_construct(&ihost->ports[i], SCIC_SDS_DUMMY_PORT, ihost);
  1443. /* Construct the phys for this controller */
  1444. for (i = 0; i < SCI_MAX_PHYS; i++) {
  1445. /* Add all the PHYs to the dummy port */
  1446. sci_phy_construct(&ihost->phys[i],
  1447. &ihost->ports[SCI_MAX_PORTS], i);
  1448. }
  1449. ihost->invalid_phy_mask = 0;
  1450. sci_init_timer(&ihost->timer, controller_timeout);
  1451. /* Initialize the User and OEM parameters to default values. */
  1452. sci_controller_set_default_config_parameters(ihost);
  1453. return sci_controller_reset(ihost);
  1454. }
  1455. int sci_oem_parameters_validate(struct sci_oem_params *oem)
  1456. {
  1457. int i;
  1458. for (i = 0; i < SCI_MAX_PORTS; i++)
  1459. if (oem->ports[i].phy_mask > SCIC_SDS_PARM_PHY_MASK_MAX)
  1460. return -EINVAL;
  1461. for (i = 0; i < SCI_MAX_PHYS; i++)
  1462. if (oem->phys[i].sas_address.high == 0 &&
  1463. oem->phys[i].sas_address.low == 0)
  1464. return -EINVAL;
  1465. if (oem->controller.mode_type == SCIC_PORT_AUTOMATIC_CONFIGURATION_MODE) {
  1466. for (i = 0; i < SCI_MAX_PHYS; i++)
  1467. if (oem->ports[i].phy_mask != 0)
  1468. return -EINVAL;
  1469. } else if (oem->controller.mode_type == SCIC_PORT_MANUAL_CONFIGURATION_MODE) {
  1470. u8 phy_mask = 0;
  1471. for (i = 0; i < SCI_MAX_PHYS; i++)
  1472. phy_mask |= oem->ports[i].phy_mask;
  1473. if (phy_mask == 0)
  1474. return -EINVAL;
  1475. } else
  1476. return -EINVAL;
  1477. if (oem->controller.max_concurrent_dev_spin_up > MAX_CONCURRENT_DEVICE_SPIN_UP_COUNT)
  1478. return -EINVAL;
  1479. return 0;
  1480. }
  1481. static enum sci_status sci_oem_parameters_set(struct isci_host *ihost)
  1482. {
  1483. u32 state = ihost->sm.current_state_id;
  1484. if (state == SCIC_RESET ||
  1485. state == SCIC_INITIALIZING ||
  1486. state == SCIC_INITIALIZED) {
  1487. if (sci_oem_parameters_validate(&ihost->oem_parameters))
  1488. return SCI_FAILURE_INVALID_PARAMETER_VALUE;
  1489. return SCI_SUCCESS;
  1490. }
  1491. return SCI_FAILURE_INVALID_STATE;
  1492. }
  1493. static void power_control_timeout(unsigned long data)
  1494. {
  1495. struct sci_timer *tmr = (struct sci_timer *)data;
  1496. struct isci_host *ihost = container_of(tmr, typeof(*ihost), power_control.timer);
  1497. struct isci_phy *iphy;
  1498. unsigned long flags;
  1499. u8 i;
  1500. spin_lock_irqsave(&ihost->scic_lock, flags);
  1501. if (tmr->cancel)
  1502. goto done;
  1503. ihost->power_control.phys_granted_power = 0;
  1504. if (ihost->power_control.phys_waiting == 0) {
  1505. ihost->power_control.timer_started = false;
  1506. goto done;
  1507. }
  1508. for (i = 0; i < SCI_MAX_PHYS; i++) {
  1509. if (ihost->power_control.phys_waiting == 0)
  1510. break;
  1511. iphy = ihost->power_control.requesters[i];
  1512. if (iphy == NULL)
  1513. continue;
  1514. if (ihost->power_control.phys_granted_power >=
  1515. ihost->oem_parameters.controller.max_concurrent_dev_spin_up)
  1516. break;
  1517. ihost->power_control.requesters[i] = NULL;
  1518. ihost->power_control.phys_waiting--;
  1519. ihost->power_control.phys_granted_power++;
  1520. sci_phy_consume_power_handler(iphy);
  1521. }
  1522. /*
  1523. * It doesn't matter if the power list is empty, we need to start the
  1524. * timer in case another phy becomes ready.
  1525. */
  1526. sci_mod_timer(tmr, SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL);
  1527. ihost->power_control.timer_started = true;
  1528. done:
  1529. spin_unlock_irqrestore(&ihost->scic_lock, flags);
  1530. }
  1531. void sci_controller_power_control_queue_insert(struct isci_host *ihost,
  1532. struct isci_phy *iphy)
  1533. {
  1534. BUG_ON(iphy == NULL);
  1535. if (ihost->power_control.phys_granted_power <
  1536. ihost->oem_parameters.controller.max_concurrent_dev_spin_up) {
  1537. ihost->power_control.phys_granted_power++;
  1538. sci_phy_consume_power_handler(iphy);
  1539. /*
  1540. * stop and start the power_control timer. When the timer fires, the
  1541. * no_of_phys_granted_power will be set to 0
  1542. */
  1543. if (ihost->power_control.timer_started)
  1544. sci_del_timer(&ihost->power_control.timer);
  1545. sci_mod_timer(&ihost->power_control.timer,
  1546. SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL);
  1547. ihost->power_control.timer_started = true;
  1548. } else {
  1549. /* Add the phy in the waiting list */
  1550. ihost->power_control.requesters[iphy->phy_index] = iphy;
  1551. ihost->power_control.phys_waiting++;
  1552. }
  1553. }
  1554. void sci_controller_power_control_queue_remove(struct isci_host *ihost,
  1555. struct isci_phy *iphy)
  1556. {
  1557. BUG_ON(iphy == NULL);
  1558. if (ihost->power_control.requesters[iphy->phy_index])
  1559. ihost->power_control.phys_waiting--;
  1560. ihost->power_control.requesters[iphy->phy_index] = NULL;
  1561. }
  1562. #define AFE_REGISTER_WRITE_DELAY 10
  1563. /* Initialize the AFE for this phy index. We need to read the AFE setup from
  1564. * the OEM parameters
  1565. */
  1566. static void sci_controller_afe_initialization(struct isci_host *ihost)
  1567. {
  1568. const struct sci_oem_params *oem = &ihost->oem_parameters;
  1569. struct pci_dev *pdev = ihost->pdev;
  1570. u32 afe_status;
  1571. u32 phy_id;
  1572. /* Clear DFX Status registers */
  1573. writel(0x0081000f, &ihost->scu_registers->afe.afe_dfx_master_control0);
  1574. udelay(AFE_REGISTER_WRITE_DELAY);
  1575. if (is_b0(pdev)) {
  1576. /* PM Rx Equalization Save, PM SPhy Rx Acknowledgement
  1577. * Timer, PM Stagger Timer */
  1578. writel(0x0007BFFF, &ihost->scu_registers->afe.afe_pmsn_master_control2);
  1579. udelay(AFE_REGISTER_WRITE_DELAY);
  1580. }
  1581. /* Configure bias currents to normal */
  1582. if (is_a2(pdev))
  1583. writel(0x00005A00, &ihost->scu_registers->afe.afe_bias_control);
  1584. else if (is_b0(pdev) || is_c0(pdev))
  1585. writel(0x00005F00, &ihost->scu_registers->afe.afe_bias_control);
  1586. udelay(AFE_REGISTER_WRITE_DELAY);
  1587. /* Enable PLL */
  1588. if (is_b0(pdev) || is_c0(pdev))
  1589. writel(0x80040A08, &ihost->scu_registers->afe.afe_pll_control0);
  1590. else
  1591. writel(0x80040908, &ihost->scu_registers->afe.afe_pll_control0);
  1592. udelay(AFE_REGISTER_WRITE_DELAY);
  1593. /* Wait for the PLL to lock */
  1594. do {
  1595. afe_status = readl(&ihost->scu_registers->afe.afe_common_block_status);
  1596. udelay(AFE_REGISTER_WRITE_DELAY);
  1597. } while ((afe_status & 0x00001000) == 0);
  1598. if (is_a2(pdev)) {
  1599. /* Shorten SAS SNW lock time (RxLock timer value from 76 us to 50 us) */
  1600. writel(0x7bcc96ad, &ihost->scu_registers->afe.afe_pmsn_master_control0);
  1601. udelay(AFE_REGISTER_WRITE_DELAY);
  1602. }
  1603. for (phy_id = 0; phy_id < SCI_MAX_PHYS; phy_id++) {
  1604. const struct sci_phy_oem_params *oem_phy = &oem->phys[phy_id];
  1605. if (is_b0(pdev)) {
  1606. /* Configure transmitter SSC parameters */
  1607. writel(0x00030000, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_ssc_control);
  1608. udelay(AFE_REGISTER_WRITE_DELAY);
  1609. } else if (is_c0(pdev)) {
  1610. /* Configure transmitter SSC parameters */
  1611. writel(0x0003000, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_ssc_control);
  1612. udelay(AFE_REGISTER_WRITE_DELAY);
  1613. /*
  1614. * All defaults, except the Receive Word Alignament/Comma Detect
  1615. * Enable....(0xe800) */
  1616. writel(0x00004500, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_xcvr_control0);
  1617. udelay(AFE_REGISTER_WRITE_DELAY);
  1618. } else {
  1619. /*
  1620. * All defaults, except the Receive Word Alignament/Comma Detect
  1621. * Enable....(0xe800) */
  1622. writel(0x00004512, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_xcvr_control0);
  1623. udelay(AFE_REGISTER_WRITE_DELAY);
  1624. writel(0x0050100F, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_xcvr_control1);
  1625. udelay(AFE_REGISTER_WRITE_DELAY);
  1626. }
  1627. /*
  1628. * Power up TX and RX out from power down (PWRDNTX and PWRDNRX)
  1629. * & increase TX int & ext bias 20%....(0xe85c) */
  1630. if (is_a2(pdev))
  1631. writel(0x000003F0, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_channel_control);
  1632. else if (is_b0(pdev)) {
  1633. /* Power down TX and RX (PWRDNTX and PWRDNRX) */
  1634. writel(0x000003D7, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_channel_control);
  1635. udelay(AFE_REGISTER_WRITE_DELAY);
  1636. /*
  1637. * Power up TX and RX out from power down (PWRDNTX and PWRDNRX)
  1638. * & increase TX int & ext bias 20%....(0xe85c) */
  1639. writel(0x000003D4, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_channel_control);
  1640. } else {
  1641. writel(0x000001E7, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_channel_control);
  1642. udelay(AFE_REGISTER_WRITE_DELAY);
  1643. /*
  1644. * Power up TX and RX out from power down (PWRDNTX and PWRDNRX)
  1645. * & increase TX int & ext bias 20%....(0xe85c) */
  1646. writel(0x000001E4, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_channel_control);
  1647. }
  1648. udelay(AFE_REGISTER_WRITE_DELAY);
  1649. if (is_a2(pdev)) {
  1650. /* Enable TX equalization (0xe824) */
  1651. writel(0x00040000, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_control);
  1652. udelay(AFE_REGISTER_WRITE_DELAY);
  1653. }
  1654. /*
  1655. * RDPI=0x0(RX Power On), RXOOBDETPDNC=0x0, TPD=0x0(TX Power On),
  1656. * RDD=0x0(RX Detect Enabled) ....(0xe800) */
  1657. writel(0x00004100, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_xcvr_control0);
  1658. udelay(AFE_REGISTER_WRITE_DELAY);
  1659. /* Leave DFE/FFE on */
  1660. if (is_a2(pdev))
  1661. writel(0x3F11103F, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_rx_ssc_control0);
  1662. else if (is_b0(pdev)) {
  1663. writel(0x3F11103F, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_rx_ssc_control0);
  1664. udelay(AFE_REGISTER_WRITE_DELAY);
  1665. /* Enable TX equalization (0xe824) */
  1666. writel(0x00040000, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_control);
  1667. } else {
  1668. writel(0x0140DF0F, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_rx_ssc_control1);
  1669. udelay(AFE_REGISTER_WRITE_DELAY);
  1670. writel(0x3F6F103F, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_rx_ssc_control0);
  1671. udelay(AFE_REGISTER_WRITE_DELAY);
  1672. /* Enable TX equalization (0xe824) */
  1673. writel(0x00040000, &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_control);
  1674. }
  1675. udelay(AFE_REGISTER_WRITE_DELAY);
  1676. writel(oem_phy->afe_tx_amp_control0,
  1677. &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_amp_control0);
  1678. udelay(AFE_REGISTER_WRITE_DELAY);
  1679. writel(oem_phy->afe_tx_amp_control1,
  1680. &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_amp_control1);
  1681. udelay(AFE_REGISTER_WRITE_DELAY);
  1682. writel(oem_phy->afe_tx_amp_control2,
  1683. &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_amp_control2);
  1684. udelay(AFE_REGISTER_WRITE_DELAY);
  1685. writel(oem_phy->afe_tx_amp_control3,
  1686. &ihost->scu_registers->afe.scu_afe_xcvr[phy_id].afe_tx_amp_control3);
  1687. udelay(AFE_REGISTER_WRITE_DELAY);
  1688. }
  1689. /* Transfer control to the PEs */
  1690. writel(0x00010f00, &ihost->scu_registers->afe.afe_dfx_master_control0);
  1691. udelay(AFE_REGISTER_WRITE_DELAY);
  1692. }
  1693. static void sci_controller_initialize_power_control(struct isci_host *ihost)
  1694. {
  1695. sci_init_timer(&ihost->power_control.timer, power_control_timeout);
  1696. memset(ihost->power_control.requesters, 0,
  1697. sizeof(ihost->power_control.requesters));
  1698. ihost->power_control.phys_waiting = 0;
  1699. ihost->power_control.phys_granted_power = 0;
  1700. }
  1701. static enum sci_status sci_controller_initialize(struct isci_host *ihost)
  1702. {
  1703. struct sci_base_state_machine *sm = &ihost->sm;
  1704. enum sci_status result = SCI_FAILURE;
  1705. unsigned long i, state, val;
  1706. if (ihost->sm.current_state_id != SCIC_RESET) {
  1707. dev_warn(&ihost->pdev->dev,
  1708. "SCIC Controller initialize operation requested "
  1709. "in invalid state\n");
  1710. return SCI_FAILURE_INVALID_STATE;
  1711. }
  1712. sci_change_state(sm, SCIC_INITIALIZING);
  1713. sci_init_timer(&ihost->phy_timer, phy_startup_timeout);
  1714. ihost->next_phy_to_start = 0;
  1715. ihost->phy_startup_timer_pending = false;
  1716. sci_controller_initialize_power_control(ihost);
  1717. /*
  1718. * There is nothing to do here for B0 since we do not have to
  1719. * program the AFE registers.
  1720. * / @todo The AFE settings are supposed to be correct for the B0 but
  1721. * / presently they seem to be wrong. */
  1722. sci_controller_afe_initialization(ihost);
  1723. /* Take the hardware out of reset */
  1724. writel(0, &ihost->smu_registers->soft_reset_control);
  1725. /*
  1726. * / @todo Provide meaningfull error code for hardware failure
  1727. * result = SCI_FAILURE_CONTROLLER_HARDWARE; */
  1728. for (i = 100; i >= 1; i--) {
  1729. u32 status;
  1730. /* Loop until the hardware reports success */
  1731. udelay(SCU_CONTEXT_RAM_INIT_STALL_TIME);
  1732. status = readl(&ihost->smu_registers->control_status);
  1733. if ((status & SCU_RAM_INIT_COMPLETED) == SCU_RAM_INIT_COMPLETED)
  1734. break;
  1735. }
  1736. if (i == 0)
  1737. goto out;
  1738. /*
  1739. * Determine what are the actaul device capacities that the
  1740. * hardware will support */
  1741. val = readl(&ihost->smu_registers->device_context_capacity);
  1742. /* Record the smaller of the two capacity values */
  1743. ihost->logical_port_entries = min(smu_max_ports(val), SCI_MAX_PORTS);
  1744. ihost->task_context_entries = min(smu_max_task_contexts(val), SCI_MAX_IO_REQUESTS);
  1745. ihost->remote_node_entries = min(smu_max_rncs(val), SCI_MAX_REMOTE_DEVICES);
  1746. /*
  1747. * Make all PEs that are unassigned match up with the
  1748. * logical ports
  1749. */
  1750. for (i = 0; i < ihost->logical_port_entries; i++) {
  1751. struct scu_port_task_scheduler_group_registers __iomem
  1752. *ptsg = &ihost->scu_registers->peg0.ptsg;
  1753. writel(i, &ptsg->protocol_engine[i]);
  1754. }
  1755. /* Initialize hardware PCI Relaxed ordering in DMA engines */
  1756. val = readl(&ihost->scu_registers->sdma.pdma_configuration);
  1757. val |= SCU_PDMACR_GEN_BIT(PCI_RELAXED_ORDERING_ENABLE);
  1758. writel(val, &ihost->scu_registers->sdma.pdma_configuration);
  1759. val = readl(&ihost->scu_registers->sdma.cdma_configuration);
  1760. val |= SCU_CDMACR_GEN_BIT(PCI_RELAXED_ORDERING_ENABLE);
  1761. writel(val, &ihost->scu_registers->sdma.cdma_configuration);
  1762. /*
  1763. * Initialize the PHYs before the PORTs because the PHY registers
  1764. * are accessed during the port initialization.
  1765. */
  1766. for (i = 0; i < SCI_MAX_PHYS; i++) {
  1767. result = sci_phy_initialize(&ihost->phys[i],
  1768. &ihost->scu_registers->peg0.pe[i].tl,
  1769. &ihost->scu_registers->peg0.pe[i].ll);
  1770. if (result != SCI_SUCCESS)
  1771. goto out;
  1772. }
  1773. for (i = 0; i < ihost->logical_port_entries; i++) {
  1774. struct isci_port *iport = &ihost->ports[i];
  1775. iport->port_task_scheduler_registers = &ihost->scu_registers->peg0.ptsg.port[i];
  1776. iport->port_pe_configuration_register = &ihost->scu_registers->peg0.ptsg.protocol_engine[0];
  1777. iport->viit_registers = &ihost->scu_registers->peg0.viit[i];
  1778. }
  1779. result = sci_port_configuration_agent_initialize(ihost, &ihost->port_agent);
  1780. out:
  1781. /* Advance the controller state machine */
  1782. if (result == SCI_SUCCESS)
  1783. state = SCIC_INITIALIZED;
  1784. else
  1785. state = SCIC_FAILED;
  1786. sci_change_state(sm, state);
  1787. return result;
  1788. }
  1789. static enum sci_status sci_user_parameters_set(struct isci_host *ihost,
  1790. struct sci_user_parameters *sci_parms)
  1791. {
  1792. u32 state = ihost->sm.current_state_id;
  1793. if (state == SCIC_RESET ||
  1794. state == SCIC_INITIALIZING ||
  1795. state == SCIC_INITIALIZED) {
  1796. u16 index;
  1797. /*
  1798. * Validate the user parameters. If they are not legal, then
  1799. * return a failure.
  1800. */
  1801. for (index = 0; index < SCI_MAX_PHYS; index++) {
  1802. struct sci_phy_user_params *user_phy;
  1803. user_phy = &sci_parms->phys[index];
  1804. if (!((user_phy->max_speed_generation <=
  1805. SCIC_SDS_PARM_MAX_SPEED) &&
  1806. (user_phy->max_speed_generation >
  1807. SCIC_SDS_PARM_NO_SPEED)))
  1808. return SCI_FAILURE_INVALID_PARAMETER_VALUE;
  1809. if (user_phy->in_connection_align_insertion_frequency <
  1810. 3)
  1811. return SCI_FAILURE_INVALID_PARAMETER_VALUE;
  1812. if ((user_phy->in_connection_align_insertion_frequency <
  1813. 3) ||
  1814. (user_phy->align_insertion_frequency == 0) ||
  1815. (user_phy->
  1816. notify_enable_spin_up_insertion_frequency ==
  1817. 0))
  1818. return SCI_FAILURE_INVALID_PARAMETER_VALUE;
  1819. }
  1820. if ((sci_parms->stp_inactivity_timeout == 0) ||
  1821. (sci_parms->ssp_inactivity_timeout == 0) ||
  1822. (sci_parms->stp_max_occupancy_timeout == 0) ||
  1823. (sci_parms->ssp_max_occupancy_timeout == 0) ||
  1824. (sci_parms->no_outbound_task_timeout == 0))
  1825. return SCI_FAILURE_INVALID_PARAMETER_VALUE;
  1826. memcpy(&ihost->user_parameters, sci_parms, sizeof(*sci_parms));
  1827. return SCI_SUCCESS;
  1828. }
  1829. return SCI_FAILURE_INVALID_STATE;
  1830. }
  1831. static int sci_controller_mem_init(struct isci_host *ihost)
  1832. {
  1833. struct device *dev = &ihost->pdev->dev;
  1834. dma_addr_t dma;
  1835. size_t size;
  1836. int err;
  1837. size = SCU_MAX_COMPLETION_QUEUE_ENTRIES * sizeof(u32);
  1838. ihost->completion_queue = dmam_alloc_coherent(dev, size, &dma, GFP_KERNEL);
  1839. if (!ihost->completion_queue)
  1840. return -ENOMEM;
  1841. writel(lower_32_bits(dma), &ihost->smu_registers->completion_queue_lower);
  1842. writel(upper_32_bits(dma), &ihost->smu_registers->completion_queue_upper);
  1843. size = ihost->remote_node_entries * sizeof(union scu_remote_node_context);
  1844. ihost->remote_node_context_table = dmam_alloc_coherent(dev, size, &dma,
  1845. GFP_KERNEL);
  1846. if (!ihost->remote_node_context_table)
  1847. return -ENOMEM;
  1848. writel(lower_32_bits(dma), &ihost->smu_registers->remote_node_context_lower);
  1849. writel(upper_32_bits(dma), &ihost->smu_registers->remote_node_context_upper);
  1850. size = ihost->task_context_entries * sizeof(struct scu_task_context),
  1851. ihost->task_context_table = dmam_alloc_coherent(dev, size, &dma, GFP_KERNEL);
  1852. if (!ihost->task_context_table)
  1853. return -ENOMEM;
  1854. ihost->task_context_dma = dma;
  1855. writel(lower_32_bits(dma), &ihost->smu_registers->host_task_table_lower);
  1856. writel(upper_32_bits(dma), &ihost->smu_registers->host_task_table_upper);
  1857. err = sci_unsolicited_frame_control_construct(ihost);
  1858. if (err)
  1859. return err;
  1860. /*
  1861. * Inform the silicon as to the location of the UF headers and
  1862. * address table.
  1863. */
  1864. writel(lower_32_bits(ihost->uf_control.headers.physical_address),
  1865. &ihost->scu_registers->sdma.uf_header_base_address_lower);
  1866. writel(upper_32_bits(ihost->uf_control.headers.physical_address),
  1867. &ihost->scu_registers->sdma.uf_header_base_address_upper);
  1868. writel(lower_32_bits(ihost->uf_control.address_table.physical_address),
  1869. &ihost->scu_registers->sdma.uf_address_table_lower);
  1870. writel(upper_32_bits(ihost->uf_control.address_table.physical_address),
  1871. &ihost->scu_registers->sdma.uf_address_table_upper);
  1872. return 0;
  1873. }
  1874. int isci_host_init(struct isci_host *ihost)
  1875. {
  1876. int err = 0, i;
  1877. enum sci_status status;
  1878. struct sci_user_parameters sci_user_params;
  1879. struct isci_pci_info *pci_info = to_pci_info(ihost->pdev);
  1880. spin_lock_init(&ihost->state_lock);
  1881. spin_lock_init(&ihost->scic_lock);
  1882. init_waitqueue_head(&ihost->eventq);
  1883. isci_host_change_state(ihost, isci_starting);
  1884. status = sci_controller_construct(ihost, scu_base(ihost),
  1885. smu_base(ihost));
  1886. if (status != SCI_SUCCESS) {
  1887. dev_err(&ihost->pdev->dev,
  1888. "%s: sci_controller_construct failed - status = %x\n",
  1889. __func__,
  1890. status);
  1891. return -ENODEV;
  1892. }
  1893. ihost->sas_ha.dev = &ihost->pdev->dev;
  1894. ihost->sas_ha.lldd_ha = ihost;
  1895. /*
  1896. * grab initial values stored in the controller object for OEM and USER
  1897. * parameters
  1898. */
  1899. isci_user_parameters_get(&sci_user_params);
  1900. status = sci_user_parameters_set(ihost, &sci_user_params);
  1901. if (status != SCI_SUCCESS) {
  1902. dev_warn(&ihost->pdev->dev,
  1903. "%s: sci_user_parameters_set failed\n",
  1904. __func__);
  1905. return -ENODEV;
  1906. }
  1907. /* grab any OEM parameters specified in orom */
  1908. if (pci_info->orom) {
  1909. status = isci_parse_oem_parameters(&ihost->oem_parameters,
  1910. pci_info->orom,
  1911. ihost->id);
  1912. if (status != SCI_SUCCESS) {
  1913. dev_warn(&ihost->pdev->dev,
  1914. "parsing firmware oem parameters failed\n");
  1915. return -EINVAL;
  1916. }
  1917. }
  1918. status = sci_oem_parameters_set(ihost);
  1919. if (status != SCI_SUCCESS) {
  1920. dev_warn(&ihost->pdev->dev,
  1921. "%s: sci_oem_parameters_set failed\n",
  1922. __func__);
  1923. return -ENODEV;
  1924. }
  1925. tasklet_init(&ihost->completion_tasklet,
  1926. isci_host_completion_routine, (unsigned long)ihost);
  1927. INIT_LIST_HEAD(&ihost->requests_to_complete);
  1928. INIT_LIST_HEAD(&ihost->requests_to_errorback);
  1929. spin_lock_irq(&ihost->scic_lock);
  1930. status = sci_controller_initialize(ihost);
  1931. spin_unlock_irq(&ihost->scic_lock);
  1932. if (status != SCI_SUCCESS) {
  1933. dev_warn(&ihost->pdev->dev,
  1934. "%s: sci_controller_initialize failed -"
  1935. " status = 0x%x\n",
  1936. __func__, status);
  1937. return -ENODEV;
  1938. }
  1939. err = sci_controller_mem_init(ihost);
  1940. if (err)
  1941. return err;
  1942. for (i = 0; i < SCI_MAX_PORTS; i++)
  1943. isci_port_init(&ihost->ports[i], ihost, i);
  1944. for (i = 0; i < SCI_MAX_PHYS; i++)
  1945. isci_phy_init(&ihost->phys[i], ihost, i);
  1946. for (i = 0; i < SCI_MAX_REMOTE_DEVICES; i++) {
  1947. struct isci_remote_device *idev = &ihost->devices[i];
  1948. INIT_LIST_HEAD(&idev->reqs_in_process);
  1949. INIT_LIST_HEAD(&idev->node);
  1950. }
  1951. for (i = 0; i < SCI_MAX_IO_REQUESTS; i++) {
  1952. struct isci_request *ireq;
  1953. dma_addr_t dma;
  1954. ireq = dmam_alloc_coherent(&ihost->pdev->dev,
  1955. sizeof(struct isci_request), &dma,
  1956. GFP_KERNEL);
  1957. if (!ireq)
  1958. return -ENOMEM;
  1959. ireq->tc = &ihost->task_context_table[i];
  1960. ireq->owning_controller = ihost;
  1961. spin_lock_init(&ireq->state_lock);
  1962. ireq->request_daddr = dma;
  1963. ireq->isci_host = ihost;
  1964. ihost->reqs[i] = ireq;
  1965. }
  1966. return 0;
  1967. }
  1968. void sci_controller_link_up(struct isci_host *ihost, struct isci_port *iport,
  1969. struct isci_phy *iphy)
  1970. {
  1971. switch (ihost->sm.current_state_id) {
  1972. case SCIC_STARTING:
  1973. sci_del_timer(&ihost->phy_timer);
  1974. ihost->phy_startup_timer_pending = false;
  1975. ihost->port_agent.link_up_handler(ihost, &ihost->port_agent,
  1976. iport, iphy);
  1977. sci_controller_start_next_phy(ihost);
  1978. break;
  1979. case SCIC_READY:
  1980. ihost->port_agent.link_up_handler(ihost, &ihost->port_agent,
  1981. iport, iphy);
  1982. break;
  1983. default:
  1984. dev_dbg(&ihost->pdev->dev,
  1985. "%s: SCIC Controller linkup event from phy %d in "
  1986. "unexpected state %d\n", __func__, iphy->phy_index,
  1987. ihost->sm.current_state_id);
  1988. }
  1989. }
  1990. void sci_controller_link_down(struct isci_host *ihost, struct isci_port *iport,
  1991. struct isci_phy *iphy)
  1992. {
  1993. switch (ihost->sm.current_state_id) {
  1994. case SCIC_STARTING:
  1995. case SCIC_READY:
  1996. ihost->port_agent.link_down_handler(ihost, &ihost->port_agent,
  1997. iport, iphy);
  1998. break;
  1999. default:
  2000. dev_dbg(&ihost->pdev->dev,
  2001. "%s: SCIC Controller linkdown event from phy %d in "
  2002. "unexpected state %d\n",
  2003. __func__,
  2004. iphy->phy_index,
  2005. ihost->sm.current_state_id);
  2006. }
  2007. }
  2008. static bool sci_controller_has_remote_devices_stopping(struct isci_host *ihost)
  2009. {
  2010. u32 index;
  2011. for (index = 0; index < ihost->remote_node_entries; index++) {
  2012. if ((ihost->device_table[index] != NULL) &&
  2013. (ihost->device_table[index]->sm.current_state_id == SCI_DEV_STOPPING))
  2014. return true;
  2015. }
  2016. return false;
  2017. }
  2018. void sci_controller_remote_device_stopped(struct isci_host *ihost,
  2019. struct isci_remote_device *idev)
  2020. {
  2021. if (ihost->sm.current_state_id != SCIC_STOPPING) {
  2022. dev_dbg(&ihost->pdev->dev,
  2023. "SCIC Controller 0x%p remote device stopped event "
  2024. "from device 0x%p in unexpected state %d\n",
  2025. ihost, idev,
  2026. ihost->sm.current_state_id);
  2027. return;
  2028. }
  2029. if (!sci_controller_has_remote_devices_stopping(ihost))
  2030. sci_change_state(&ihost->sm, SCIC_STOPPED);
  2031. }
  2032. void sci_controller_post_request(struct isci_host *ihost, u32 request)
  2033. {
  2034. dev_dbg(&ihost->pdev->dev, "%s[%d]: %#x\n",
  2035. __func__, ihost->id, request);
  2036. writel(request, &ihost->smu_registers->post_context_port);
  2037. }
  2038. struct isci_request *sci_request_by_tag(struct isci_host *ihost, u16 io_tag)
  2039. {
  2040. u16 task_index;
  2041. u16 task_sequence;
  2042. task_index = ISCI_TAG_TCI(io_tag);
  2043. if (task_index < ihost->task_context_entries) {
  2044. struct isci_request *ireq = ihost->reqs[task_index];
  2045. if (test_bit(IREQ_ACTIVE, &ireq->flags)) {
  2046. task_sequence = ISCI_TAG_SEQ(io_tag);
  2047. if (task_sequence == ihost->io_request_sequence[task_index])
  2048. return ireq;
  2049. }
  2050. }
  2051. return NULL;
  2052. }
  2053. /**
  2054. * This method allocates remote node index and the reserves the remote node
  2055. * context space for use. This method can fail if there are no more remote
  2056. * node index available.
  2057. * @scic: This is the controller object which contains the set of
  2058. * free remote node ids
  2059. * @sci_dev: This is the device object which is requesting the a remote node
  2060. * id
  2061. * @node_id: This is the remote node id that is assinged to the device if one
  2062. * is available
  2063. *
  2064. * enum sci_status SCI_FAILURE_OUT_OF_RESOURCES if there are no available remote
  2065. * node index available.
  2066. */
  2067. enum sci_status sci_controller_allocate_remote_node_context(struct isci_host *ihost,
  2068. struct isci_remote_device *idev,
  2069. u16 *node_id)
  2070. {
  2071. u16 node_index;
  2072. u32 remote_node_count = sci_remote_device_node_count(idev);
  2073. node_index = sci_remote_node_table_allocate_remote_node(
  2074. &ihost->available_remote_nodes, remote_node_count
  2075. );
  2076. if (node_index != SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX) {
  2077. ihost->device_table[node_index] = idev;
  2078. *node_id = node_index;
  2079. return SCI_SUCCESS;
  2080. }
  2081. return SCI_FAILURE_INSUFFICIENT_RESOURCES;
  2082. }
  2083. void sci_controller_free_remote_node_context(struct isci_host *ihost,
  2084. struct isci_remote_device *idev,
  2085. u16 node_id)
  2086. {
  2087. u32 remote_node_count = sci_remote_device_node_count(idev);
  2088. if (ihost->device_table[node_id] == idev) {
  2089. ihost->device_table[node_id] = NULL;
  2090. sci_remote_node_table_release_remote_node_index(
  2091. &ihost->available_remote_nodes, remote_node_count, node_id
  2092. );
  2093. }
  2094. }
  2095. void sci_controller_copy_sata_response(void *response_buffer,
  2096. void *frame_header,
  2097. void *frame_buffer)
  2098. {
  2099. /* XXX type safety? */
  2100. memcpy(response_buffer, frame_header, sizeof(u32));
  2101. memcpy(response_buffer + sizeof(u32),
  2102. frame_buffer,
  2103. sizeof(struct dev_to_host_fis) - sizeof(u32));
  2104. }
  2105. void sci_controller_release_frame(struct isci_host *ihost, u32 frame_index)
  2106. {
  2107. if (sci_unsolicited_frame_control_release_frame(&ihost->uf_control, frame_index))
  2108. writel(ihost->uf_control.get,
  2109. &ihost->scu_registers->sdma.unsolicited_frame_get_pointer);
  2110. }
  2111. void isci_tci_free(struct isci_host *ihost, u16 tci)
  2112. {
  2113. u16 tail = ihost->tci_tail & (SCI_MAX_IO_REQUESTS-1);
  2114. ihost->tci_pool[tail] = tci;
  2115. ihost->tci_tail = tail + 1;
  2116. }
  2117. static u16 isci_tci_alloc(struct isci_host *ihost)
  2118. {
  2119. u16 head = ihost->tci_head & (SCI_MAX_IO_REQUESTS-1);
  2120. u16 tci = ihost->tci_pool[head];
  2121. ihost->tci_head = head + 1;
  2122. return tci;
  2123. }
  2124. static u16 isci_tci_space(struct isci_host *ihost)
  2125. {
  2126. return CIRC_SPACE(ihost->tci_head, ihost->tci_tail, SCI_MAX_IO_REQUESTS);
  2127. }
  2128. u16 isci_alloc_tag(struct isci_host *ihost)
  2129. {
  2130. if (isci_tci_space(ihost)) {
  2131. u16 tci = isci_tci_alloc(ihost);
  2132. u8 seq = ihost->io_request_sequence[tci];
  2133. return ISCI_TAG(seq, tci);
  2134. }
  2135. return SCI_CONTROLLER_INVALID_IO_TAG;
  2136. }
  2137. enum sci_status isci_free_tag(struct isci_host *ihost, u16 io_tag)
  2138. {
  2139. u16 tci = ISCI_TAG_TCI(io_tag);
  2140. u16 seq = ISCI_TAG_SEQ(io_tag);
  2141. /* prevent tail from passing head */
  2142. if (isci_tci_active(ihost) == 0)
  2143. return SCI_FAILURE_INVALID_IO_TAG;
  2144. if (seq == ihost->io_request_sequence[tci]) {
  2145. ihost->io_request_sequence[tci] = (seq+1) & (SCI_MAX_SEQ-1);
  2146. isci_tci_free(ihost, tci);
  2147. return SCI_SUCCESS;
  2148. }
  2149. return SCI_FAILURE_INVALID_IO_TAG;
  2150. }
  2151. enum sci_status sci_controller_start_io(struct isci_host *ihost,
  2152. struct isci_remote_device *idev,
  2153. struct isci_request *ireq)
  2154. {
  2155. enum sci_status status;
  2156. if (ihost->sm.current_state_id != SCIC_READY) {
  2157. dev_warn(&ihost->pdev->dev, "invalid state to start I/O");
  2158. return SCI_FAILURE_INVALID_STATE;
  2159. }
  2160. status = sci_remote_device_start_io(ihost, idev, ireq);
  2161. if (status != SCI_SUCCESS)
  2162. return status;
  2163. set_bit(IREQ_ACTIVE, &ireq->flags);
  2164. sci_controller_post_request(ihost, ireq->post_context);
  2165. return SCI_SUCCESS;
  2166. }
  2167. enum sci_status sci_controller_terminate_request(struct isci_host *ihost,
  2168. struct isci_remote_device *idev,
  2169. struct isci_request *ireq)
  2170. {
  2171. /* terminate an ongoing (i.e. started) core IO request. This does not
  2172. * abort the IO request at the target, but rather removes the IO
  2173. * request from the host controller.
  2174. */
  2175. enum sci_status status;
  2176. if (ihost->sm.current_state_id != SCIC_READY) {
  2177. dev_warn(&ihost->pdev->dev,
  2178. "invalid state to terminate request\n");
  2179. return SCI_FAILURE_INVALID_STATE;
  2180. }
  2181. status = sci_io_request_terminate(ireq);
  2182. if (status != SCI_SUCCESS)
  2183. return status;
  2184. /*
  2185. * Utilize the original post context command and or in the POST_TC_ABORT
  2186. * request sub-type.
  2187. */
  2188. sci_controller_post_request(ihost,
  2189. ireq->post_context | SCU_CONTEXT_COMMAND_REQUEST_POST_TC_ABORT);
  2190. return SCI_SUCCESS;
  2191. }
  2192. /**
  2193. * sci_controller_complete_io() - This method will perform core specific
  2194. * completion operations for an IO request. After this method is invoked,
  2195. * the user should consider the IO request as invalid until it is properly
  2196. * reused (i.e. re-constructed).
  2197. * @ihost: The handle to the controller object for which to complete the
  2198. * IO request.
  2199. * @idev: The handle to the remote device object for which to complete
  2200. * the IO request.
  2201. * @ireq: the handle to the io request object to complete.
  2202. */
  2203. enum sci_status sci_controller_complete_io(struct isci_host *ihost,
  2204. struct isci_remote_device *idev,
  2205. struct isci_request *ireq)
  2206. {
  2207. enum sci_status status;
  2208. u16 index;
  2209. switch (ihost->sm.current_state_id) {
  2210. case SCIC_STOPPING:
  2211. /* XXX: Implement this function */
  2212. return SCI_FAILURE;
  2213. case SCIC_READY:
  2214. status = sci_remote_device_complete_io(ihost, idev, ireq);
  2215. if (status != SCI_SUCCESS)
  2216. return status;
  2217. index = ISCI_TAG_TCI(ireq->io_tag);
  2218. clear_bit(IREQ_ACTIVE, &ireq->flags);
  2219. return SCI_SUCCESS;
  2220. default:
  2221. dev_warn(&ihost->pdev->dev, "invalid state to complete I/O");
  2222. return SCI_FAILURE_INVALID_STATE;
  2223. }
  2224. }
  2225. enum sci_status sci_controller_continue_io(struct isci_request *ireq)
  2226. {
  2227. struct isci_host *ihost = ireq->owning_controller;
  2228. if (ihost->sm.current_state_id != SCIC_READY) {
  2229. dev_warn(&ihost->pdev->dev, "invalid state to continue I/O");
  2230. return SCI_FAILURE_INVALID_STATE;
  2231. }
  2232. set_bit(IREQ_ACTIVE, &ireq->flags);
  2233. sci_controller_post_request(ihost, ireq->post_context);
  2234. return SCI_SUCCESS;
  2235. }
  2236. /**
  2237. * sci_controller_start_task() - This method is called by the SCIC user to
  2238. * send/start a framework task management request.
  2239. * @controller: the handle to the controller object for which to start the task
  2240. * management request.
  2241. * @remote_device: the handle to the remote device object for which to start
  2242. * the task management request.
  2243. * @task_request: the handle to the task request object to start.
  2244. */
  2245. enum sci_task_status sci_controller_start_task(struct isci_host *ihost,
  2246. struct isci_remote_device *idev,
  2247. struct isci_request *ireq)
  2248. {
  2249. enum sci_status status;
  2250. if (ihost->sm.current_state_id != SCIC_READY) {
  2251. dev_warn(&ihost->pdev->dev,
  2252. "%s: SCIC Controller starting task from invalid "
  2253. "state\n",
  2254. __func__);
  2255. return SCI_TASK_FAILURE_INVALID_STATE;
  2256. }
  2257. status = sci_remote_device_start_task(ihost, idev, ireq);
  2258. switch (status) {
  2259. case SCI_FAILURE_RESET_DEVICE_PARTIAL_SUCCESS:
  2260. set_bit(IREQ_ACTIVE, &ireq->flags);
  2261. /*
  2262. * We will let framework know this task request started successfully,
  2263. * although core is still woring on starting the request (to post tc when
  2264. * RNC is resumed.)
  2265. */
  2266. return SCI_SUCCESS;
  2267. case SCI_SUCCESS:
  2268. set_bit(IREQ_ACTIVE, &ireq->flags);
  2269. sci_controller_post_request(ihost, ireq->post_context);
  2270. break;
  2271. default:
  2272. break;
  2273. }
  2274. return status;
  2275. }