ata_piix.c 46 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700
  1. /*
  2. * ata_piix.c - Intel PATA/SATA controllers
  3. *
  4. * Maintained by: Jeff Garzik <jgarzik@pobox.com>
  5. * Please ALWAYS copy linux-ide@vger.kernel.org
  6. * on emails.
  7. *
  8. *
  9. * Copyright 2003-2005 Red Hat Inc
  10. * Copyright 2003-2005 Jeff Garzik
  11. *
  12. *
  13. * Copyright header from piix.c:
  14. *
  15. * Copyright (C) 1998-1999 Andrzej Krzysztofowicz, Author and Maintainer
  16. * Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org>
  17. * Copyright (C) 2003 Red Hat Inc <alan@redhat.com>
  18. *
  19. *
  20. * This program is free software; you can redistribute it and/or modify
  21. * it under the terms of the GNU General Public License as published by
  22. * the Free Software Foundation; either version 2, or (at your option)
  23. * any later version.
  24. *
  25. * This program is distributed in the hope that it will be useful,
  26. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  27. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  28. * GNU General Public License for more details.
  29. *
  30. * You should have received a copy of the GNU General Public License
  31. * along with this program; see the file COPYING. If not, write to
  32. * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
  33. *
  34. *
  35. * libata documentation is available via 'make {ps|pdf}docs',
  36. * as Documentation/DocBook/libata.*
  37. *
  38. * Hardware documentation available at http://developer.intel.com/
  39. *
  40. * Documentation
  41. * Publically available from Intel web site. Errata documentation
  42. * is also publically available. As an aide to anyone hacking on this
  43. * driver the list of errata that are relevant is below, going back to
  44. * PIIX4. Older device documentation is now a bit tricky to find.
  45. *
  46. * The chipsets all follow very much the same design. The orginal Triton
  47. * series chipsets do _not_ support independant device timings, but this
  48. * is fixed in Triton II. With the odd mobile exception the chips then
  49. * change little except in gaining more modes until SATA arrives. This
  50. * driver supports only the chips with independant timing (that is those
  51. * with SITRE and the 0x44 timing register). See pata_oldpiix and pata_mpiix
  52. * for the early chip drivers.
  53. *
  54. * Errata of note:
  55. *
  56. * Unfixable
  57. * PIIX4 errata #9 - Only on ultra obscure hw
  58. * ICH3 errata #13 - Not observed to affect real hw
  59. * by Intel
  60. *
  61. * Things we must deal with
  62. * PIIX4 errata #10 - BM IDE hang with non UDMA
  63. * (must stop/start dma to recover)
  64. * 440MX errata #15 - As PIIX4 errata #10
  65. * PIIX4 errata #15 - Must not read control registers
  66. * during a PIO transfer
  67. * 440MX errata #13 - As PIIX4 errata #15
  68. * ICH2 errata #21 - DMA mode 0 doesn't work right
  69. * ICH0/1 errata #55 - As ICH2 errata #21
  70. * ICH2 spec c #9 - Extra operations needed to handle
  71. * drive hotswap [NOT YET SUPPORTED]
  72. * ICH2 spec c #20 - IDE PRD must not cross a 64K boundary
  73. * and must be dword aligned
  74. * ICH2 spec c #24 - UDMA mode 4,5 t85/86 should be 6ns not 3.3
  75. *
  76. * Should have been BIOS fixed:
  77. * 450NX: errata #19 - DMA hangs on old 450NX
  78. * 450NX: errata #20 - DMA hangs on old 450NX
  79. * 450NX: errata #25 - Corruption with DMA on old 450NX
  80. * ICH3 errata #15 - IDE deadlock under high load
  81. * (BIOS must set dev 31 fn 0 bit 23)
  82. * ICH3 errata #18 - Don't use native mode
  83. */
  84. #include <linux/kernel.h>
  85. #include <linux/module.h>
  86. #include <linux/pci.h>
  87. #include <linux/init.h>
  88. #include <linux/blkdev.h>
  89. #include <linux/delay.h>
  90. #include <linux/device.h>
  91. #include <scsi/scsi_host.h>
  92. #include <linux/libata.h>
  93. #include <linux/dmi.h>
  94. #define DRV_NAME "ata_piix"
  95. #define DRV_VERSION "2.12"
  96. enum {
  97. PIIX_IOCFG = 0x54, /* IDE I/O configuration register */
  98. ICH5_PMR = 0x90, /* port mapping register */
  99. ICH5_PCS = 0x92, /* port control and status */
  100. PIIX_SCC = 0x0A, /* sub-class code register */
  101. PIIX_SIDPR_BAR = 5,
  102. PIIX_SIDPR_LEN = 16,
  103. PIIX_SIDPR_IDX = 0,
  104. PIIX_SIDPR_DATA = 4,
  105. PIIX_FLAG_AHCI = (1 << 27), /* AHCI possible */
  106. PIIX_FLAG_CHECKINTR = (1 << 28), /* make sure PCI INTx enabled */
  107. PIIX_FLAG_SIDPR = (1 << 29), /* SATA idx/data pair regs */
  108. PIIX_PATA_FLAGS = ATA_FLAG_SLAVE_POSS,
  109. PIIX_SATA_FLAGS = ATA_FLAG_SATA | PIIX_FLAG_CHECKINTR,
  110. PIIX_80C_PRI = (1 << 5) | (1 << 4),
  111. PIIX_80C_SEC = (1 << 7) | (1 << 6),
  112. /* constants for mapping table */
  113. P0 = 0, /* port 0 */
  114. P1 = 1, /* port 1 */
  115. P2 = 2, /* port 2 */
  116. P3 = 3, /* port 3 */
  117. IDE = -1, /* IDE */
  118. NA = -2, /* not avaliable */
  119. RV = -3, /* reserved */
  120. PIIX_AHCI_DEVICE = 6,
  121. /* host->flags bits */
  122. PIIX_HOST_BROKEN_SUSPEND = (1 << 24),
  123. };
  124. enum piix_controller_ids {
  125. /* controller IDs */
  126. piix_pata_mwdma, /* PIIX3 MWDMA only */
  127. piix_pata_33, /* PIIX4 at 33Mhz */
  128. ich_pata_33, /* ICH up to UDMA 33 only */
  129. ich_pata_66, /* ICH up to 66 Mhz */
  130. ich_pata_100, /* ICH up to UDMA 100 */
  131. ich5_sata,
  132. ich6_sata,
  133. ich6_sata_ahci,
  134. ich6m_sata_ahci,
  135. ich8_sata_ahci,
  136. ich8_2port_sata,
  137. ich8m_apple_sata_ahci, /* locks up on second port enable */
  138. tolapai_sata_ahci,
  139. piix_pata_vmw, /* PIIX4 for VMware, spurious DMA_ERR */
  140. };
  141. struct piix_map_db {
  142. const u32 mask;
  143. const u16 port_enable;
  144. const int map[][4];
  145. };
  146. struct piix_host_priv {
  147. const int *map;
  148. void __iomem *sidpr;
  149. };
  150. static int piix_init_one(struct pci_dev *pdev,
  151. const struct pci_device_id *ent);
  152. static void piix_pata_error_handler(struct ata_port *ap);
  153. static void piix_set_piomode(struct ata_port *ap, struct ata_device *adev);
  154. static void piix_set_dmamode(struct ata_port *ap, struct ata_device *adev);
  155. static void ich_set_dmamode(struct ata_port *ap, struct ata_device *adev);
  156. static int ich_pata_cable_detect(struct ata_port *ap);
  157. static u8 piix_vmw_bmdma_status(struct ata_port *ap);
  158. static int piix_sidpr_scr_read(struct ata_port *ap, unsigned int reg, u32 *val);
  159. static int piix_sidpr_scr_write(struct ata_port *ap, unsigned int reg, u32 val);
  160. static void piix_sidpr_error_handler(struct ata_port *ap);
  161. #ifdef CONFIG_PM
  162. static int piix_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg);
  163. static int piix_pci_device_resume(struct pci_dev *pdev);
  164. #endif
  165. static unsigned int in_module_init = 1;
  166. static const struct pci_device_id piix_pci_tbl[] = {
  167. /* Intel PIIX3 for the 430HX etc */
  168. { 0x8086, 0x7010, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_mwdma },
  169. /* VMware ICH4 */
  170. { 0x8086, 0x7111, 0x15ad, 0x1976, 0, 0, piix_pata_vmw },
  171. /* Intel PIIX4 for the 430TX/440BX/MX chipset: UDMA 33 */
  172. /* Also PIIX4E (fn3 rev 2) and PIIX4M (fn3 rev 3) */
  173. { 0x8086, 0x7111, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
  174. /* Intel PIIX4 */
  175. { 0x8086, 0x7199, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
  176. /* Intel PIIX4 */
  177. { 0x8086, 0x7601, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
  178. /* Intel PIIX */
  179. { 0x8086, 0x84CA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
  180. /* Intel ICH (i810, i815, i840) UDMA 66*/
  181. { 0x8086, 0x2411, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_66 },
  182. /* Intel ICH0 : UDMA 33*/
  183. { 0x8086, 0x2421, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_33 },
  184. /* Intel ICH2M */
  185. { 0x8086, 0x244A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  186. /* Intel ICH2 (i810E2, i845, 850, 860) UDMA 100 */
  187. { 0x8086, 0x244B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  188. /* Intel ICH3M */
  189. { 0x8086, 0x248A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  190. /* Intel ICH3 (E7500/1) UDMA 100 */
  191. { 0x8086, 0x248B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  192. /* Intel ICH4 (i845GV, i845E, i852, i855) UDMA 100 */
  193. { 0x8086, 0x24CA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  194. { 0x8086, 0x24CB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  195. /* Intel ICH5 */
  196. { 0x8086, 0x24DB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  197. /* C-ICH (i810E2) */
  198. { 0x8086, 0x245B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  199. /* ESB (855GME/875P + 6300ESB) UDMA 100 */
  200. { 0x8086, 0x25A2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  201. /* ICH6 (and 6) (i915) UDMA 100 */
  202. { 0x8086, 0x266F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  203. /* ICH7/7-R (i945, i975) UDMA 100*/
  204. { 0x8086, 0x27DF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  205. { 0x8086, 0x269E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  206. /* ICH8 Mobile PATA Controller */
  207. { 0x8086, 0x2850, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
  208. /* NOTE: The following PCI ids must be kept in sync with the
  209. * list in drivers/pci/quirks.c.
  210. */
  211. /* 82801EB (ICH5) */
  212. { 0x8086, 0x24d1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
  213. /* 82801EB (ICH5) */
  214. { 0x8086, 0x24df, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
  215. /* 6300ESB (ICH5 variant with broken PCS present bits) */
  216. { 0x8086, 0x25a3, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
  217. /* 6300ESB pretending RAID */
  218. { 0x8086, 0x25b0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
  219. /* 82801FB/FW (ICH6/ICH6W) */
  220. { 0x8086, 0x2651, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata },
  221. /* 82801FR/FRW (ICH6R/ICH6RW) */
  222. { 0x8086, 0x2652, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_ahci },
  223. /* 82801FBM ICH6M (ICH6R with only port 0 and 2 implemented) */
  224. { 0x8086, 0x2653, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6m_sata_ahci },
  225. /* 82801GB/GR/GH (ICH7, identical to ICH6) */
  226. { 0x8086, 0x27c0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_ahci },
  227. /* 2801GBM/GHM (ICH7M, identical to ICH6M) */
  228. { 0x8086, 0x27c4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6m_sata_ahci },
  229. /* Enterprise Southbridge 2 (631xESB/632xESB) */
  230. { 0x8086, 0x2680, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_ahci },
  231. /* SATA Controller 1 IDE (ICH8) */
  232. { 0x8086, 0x2820, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
  233. /* SATA Controller 2 IDE (ICH8) */
  234. { 0x8086, 0x2825, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
  235. /* Mobile SATA Controller IDE (ICH8M) */
  236. { 0x8086, 0x2828, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
  237. /* Mobile SATA Controller IDE (ICH8M), Apple */
  238. { 0x8086, 0x2828, 0x106b, 0x00a0, 0, 0, ich8m_apple_sata_ahci },
  239. /* SATA Controller IDE (ICH9) */
  240. { 0x8086, 0x2920, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
  241. /* SATA Controller IDE (ICH9) */
  242. { 0x8086, 0x2921, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
  243. /* SATA Controller IDE (ICH9) */
  244. { 0x8086, 0x2926, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
  245. /* SATA Controller IDE (ICH9M) */
  246. { 0x8086, 0x2928, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
  247. /* SATA Controller IDE (ICH9M) */
  248. { 0x8086, 0x292d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
  249. /* SATA Controller IDE (ICH9M) */
  250. { 0x8086, 0x292e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
  251. /* SATA Controller IDE (Tolapai) */
  252. { 0x8086, 0x5028, PCI_ANY_ID, PCI_ANY_ID, 0, 0, tolapai_sata_ahci },
  253. /* SATA Controller IDE (ICH10) */
  254. { 0x8086, 0x3a00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
  255. /* SATA Controller IDE (ICH10) */
  256. { 0x8086, 0x3a06, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
  257. /* SATA Controller IDE (ICH10) */
  258. { 0x8086, 0x3a20, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
  259. /* SATA Controller IDE (ICH10) */
  260. { 0x8086, 0x3a26, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
  261. { } /* terminate list */
  262. };
  263. static struct pci_driver piix_pci_driver = {
  264. .name = DRV_NAME,
  265. .id_table = piix_pci_tbl,
  266. .probe = piix_init_one,
  267. .remove = ata_pci_remove_one,
  268. #ifdef CONFIG_PM
  269. .suspend = piix_pci_device_suspend,
  270. .resume = piix_pci_device_resume,
  271. #endif
  272. };
  273. static struct scsi_host_template piix_sht = {
  274. ATA_BMDMA_SHT(DRV_NAME),
  275. };
  276. static const struct ata_port_operations piix_pata_ops = {
  277. .set_piomode = piix_set_piomode,
  278. .set_dmamode = piix_set_dmamode,
  279. .mode_filter = ata_pci_default_filter,
  280. .tf_load = ata_tf_load,
  281. .tf_read = ata_tf_read,
  282. .check_status = ata_check_status,
  283. .exec_command = ata_exec_command,
  284. .dev_select = ata_std_dev_select,
  285. .bmdma_setup = ata_bmdma_setup,
  286. .bmdma_start = ata_bmdma_start,
  287. .bmdma_stop = ata_bmdma_stop,
  288. .bmdma_status = ata_bmdma_status,
  289. .qc_prep = ata_qc_prep,
  290. .qc_issue = ata_qc_issue_prot,
  291. .data_xfer = ata_data_xfer,
  292. .freeze = ata_bmdma_freeze,
  293. .thaw = ata_bmdma_thaw,
  294. .error_handler = piix_pata_error_handler,
  295. .post_internal_cmd = ata_bmdma_post_internal_cmd,
  296. .cable_detect = ata_cable_40wire,
  297. .irq_clear = ata_bmdma_irq_clear,
  298. .irq_on = ata_irq_on,
  299. .port_start = ata_sff_port_start,
  300. };
  301. static const struct ata_port_operations ich_pata_ops = {
  302. .set_piomode = piix_set_piomode,
  303. .set_dmamode = ich_set_dmamode,
  304. .mode_filter = ata_pci_default_filter,
  305. .tf_load = ata_tf_load,
  306. .tf_read = ata_tf_read,
  307. .check_status = ata_check_status,
  308. .exec_command = ata_exec_command,
  309. .dev_select = ata_std_dev_select,
  310. .bmdma_setup = ata_bmdma_setup,
  311. .bmdma_start = ata_bmdma_start,
  312. .bmdma_stop = ata_bmdma_stop,
  313. .bmdma_status = ata_bmdma_status,
  314. .qc_prep = ata_qc_prep,
  315. .qc_issue = ata_qc_issue_prot,
  316. .data_xfer = ata_data_xfer,
  317. .freeze = ata_bmdma_freeze,
  318. .thaw = ata_bmdma_thaw,
  319. .error_handler = piix_pata_error_handler,
  320. .post_internal_cmd = ata_bmdma_post_internal_cmd,
  321. .cable_detect = ich_pata_cable_detect,
  322. .irq_clear = ata_bmdma_irq_clear,
  323. .irq_on = ata_irq_on,
  324. .port_start = ata_sff_port_start,
  325. };
  326. static const struct ata_port_operations piix_sata_ops = {
  327. .tf_load = ata_tf_load,
  328. .tf_read = ata_tf_read,
  329. .check_status = ata_check_status,
  330. .exec_command = ata_exec_command,
  331. .dev_select = ata_std_dev_select,
  332. .bmdma_setup = ata_bmdma_setup,
  333. .bmdma_start = ata_bmdma_start,
  334. .bmdma_stop = ata_bmdma_stop,
  335. .bmdma_status = ata_bmdma_status,
  336. .qc_prep = ata_qc_prep,
  337. .qc_issue = ata_qc_issue_prot,
  338. .data_xfer = ata_data_xfer,
  339. .mode_filter = ata_pci_default_filter,
  340. .freeze = ata_bmdma_freeze,
  341. .thaw = ata_bmdma_thaw,
  342. .error_handler = ata_bmdma_error_handler,
  343. .post_internal_cmd = ata_bmdma_post_internal_cmd,
  344. .irq_clear = ata_bmdma_irq_clear,
  345. .irq_on = ata_irq_on,
  346. .port_start = ata_sff_port_start,
  347. };
  348. static const struct ata_port_operations piix_vmw_ops = {
  349. .set_piomode = piix_set_piomode,
  350. .set_dmamode = piix_set_dmamode,
  351. .mode_filter = ata_pci_default_filter,
  352. .tf_load = ata_tf_load,
  353. .tf_read = ata_tf_read,
  354. .check_status = ata_check_status,
  355. .exec_command = ata_exec_command,
  356. .dev_select = ata_std_dev_select,
  357. .bmdma_setup = ata_bmdma_setup,
  358. .bmdma_start = ata_bmdma_start,
  359. .bmdma_stop = ata_bmdma_stop,
  360. .bmdma_status = piix_vmw_bmdma_status,
  361. .qc_prep = ata_qc_prep,
  362. .qc_issue = ata_qc_issue_prot,
  363. .data_xfer = ata_data_xfer,
  364. .freeze = ata_bmdma_freeze,
  365. .thaw = ata_bmdma_thaw,
  366. .error_handler = piix_pata_error_handler,
  367. .post_internal_cmd = ata_bmdma_post_internal_cmd,
  368. .cable_detect = ata_cable_40wire,
  369. .irq_handler = ata_interrupt,
  370. .irq_clear = ata_bmdma_irq_clear,
  371. .irq_on = ata_irq_on,
  372. .port_start = ata_sff_port_start,
  373. };
  374. static const struct ata_port_operations piix_sidpr_sata_ops = {
  375. .tf_load = ata_tf_load,
  376. .tf_read = ata_tf_read,
  377. .check_status = ata_check_status,
  378. .exec_command = ata_exec_command,
  379. .dev_select = ata_std_dev_select,
  380. .bmdma_setup = ata_bmdma_setup,
  381. .bmdma_start = ata_bmdma_start,
  382. .bmdma_stop = ata_bmdma_stop,
  383. .bmdma_status = ata_bmdma_status,
  384. .qc_prep = ata_qc_prep,
  385. .qc_issue = ata_qc_issue_prot,
  386. .data_xfer = ata_data_xfer,
  387. .scr_read = piix_sidpr_scr_read,
  388. .scr_write = piix_sidpr_scr_write,
  389. .mode_filter = ata_pci_default_filter,
  390. .freeze = ata_bmdma_freeze,
  391. .thaw = ata_bmdma_thaw,
  392. .error_handler = piix_sidpr_error_handler,
  393. .post_internal_cmd = ata_bmdma_post_internal_cmd,
  394. .irq_clear = ata_bmdma_irq_clear,
  395. .irq_on = ata_irq_on,
  396. .port_start = ata_sff_port_start,
  397. };
  398. static const struct piix_map_db ich5_map_db = {
  399. .mask = 0x7,
  400. .port_enable = 0x3,
  401. .map = {
  402. /* PM PS SM SS MAP */
  403. { P0, NA, P1, NA }, /* 000b */
  404. { P1, NA, P0, NA }, /* 001b */
  405. { RV, RV, RV, RV },
  406. { RV, RV, RV, RV },
  407. { P0, P1, IDE, IDE }, /* 100b */
  408. { P1, P0, IDE, IDE }, /* 101b */
  409. { IDE, IDE, P0, P1 }, /* 110b */
  410. { IDE, IDE, P1, P0 }, /* 111b */
  411. },
  412. };
  413. static const struct piix_map_db ich6_map_db = {
  414. .mask = 0x3,
  415. .port_enable = 0xf,
  416. .map = {
  417. /* PM PS SM SS MAP */
  418. { P0, P2, P1, P3 }, /* 00b */
  419. { IDE, IDE, P1, P3 }, /* 01b */
  420. { P0, P2, IDE, IDE }, /* 10b */
  421. { RV, RV, RV, RV },
  422. },
  423. };
  424. static const struct piix_map_db ich6m_map_db = {
  425. .mask = 0x3,
  426. .port_enable = 0x5,
  427. /* Map 01b isn't specified in the doc but some notebooks use
  428. * it anyway. MAP 01b have been spotted on both ICH6M and
  429. * ICH7M.
  430. */
  431. .map = {
  432. /* PM PS SM SS MAP */
  433. { P0, P2, NA, NA }, /* 00b */
  434. { IDE, IDE, P1, P3 }, /* 01b */
  435. { P0, P2, IDE, IDE }, /* 10b */
  436. { RV, RV, RV, RV },
  437. },
  438. };
  439. static const struct piix_map_db ich8_map_db = {
  440. .mask = 0x3,
  441. .port_enable = 0xf,
  442. .map = {
  443. /* PM PS SM SS MAP */
  444. { P0, P2, P1, P3 }, /* 00b (hardwired when in AHCI) */
  445. { RV, RV, RV, RV },
  446. { P0, P2, IDE, IDE }, /* 10b (IDE mode) */
  447. { RV, RV, RV, RV },
  448. },
  449. };
  450. static const struct piix_map_db ich8_2port_map_db = {
  451. .mask = 0x3,
  452. .port_enable = 0x3,
  453. .map = {
  454. /* PM PS SM SS MAP */
  455. { P0, NA, P1, NA }, /* 00b */
  456. { RV, RV, RV, RV }, /* 01b */
  457. { RV, RV, RV, RV }, /* 10b */
  458. { RV, RV, RV, RV },
  459. },
  460. };
  461. static const struct piix_map_db ich8m_apple_map_db = {
  462. .mask = 0x3,
  463. .port_enable = 0x1,
  464. .map = {
  465. /* PM PS SM SS MAP */
  466. { P0, NA, NA, NA }, /* 00b */
  467. { RV, RV, RV, RV },
  468. { P0, P2, IDE, IDE }, /* 10b */
  469. { RV, RV, RV, RV },
  470. },
  471. };
  472. static const struct piix_map_db tolapai_map_db = {
  473. .mask = 0x3,
  474. .port_enable = 0x3,
  475. .map = {
  476. /* PM PS SM SS MAP */
  477. { P0, NA, P1, NA }, /* 00b */
  478. { RV, RV, RV, RV }, /* 01b */
  479. { RV, RV, RV, RV }, /* 10b */
  480. { RV, RV, RV, RV },
  481. },
  482. };
  483. static const struct piix_map_db *piix_map_db_table[] = {
  484. [ich5_sata] = &ich5_map_db,
  485. [ich6_sata] = &ich6_map_db,
  486. [ich6_sata_ahci] = &ich6_map_db,
  487. [ich6m_sata_ahci] = &ich6m_map_db,
  488. [ich8_sata_ahci] = &ich8_map_db,
  489. [ich8_2port_sata] = &ich8_2port_map_db,
  490. [ich8m_apple_sata_ahci] = &ich8m_apple_map_db,
  491. [tolapai_sata_ahci] = &tolapai_map_db,
  492. };
  493. static struct ata_port_info piix_port_info[] = {
  494. [piix_pata_mwdma] = /* PIIX3 MWDMA only */
  495. {
  496. .flags = PIIX_PATA_FLAGS,
  497. .pio_mask = 0x1f, /* pio0-4 */
  498. .mwdma_mask = 0x06, /* mwdma1-2 ?? CHECK 0 should be ok but slow */
  499. .port_ops = &piix_pata_ops,
  500. },
  501. [piix_pata_33] = /* PIIX4 at 33MHz */
  502. {
  503. .flags = PIIX_PATA_FLAGS,
  504. .pio_mask = 0x1f, /* pio0-4 */
  505. .mwdma_mask = 0x06, /* mwdma1-2 ?? CHECK 0 should be ok but slow */
  506. .udma_mask = ATA_UDMA_MASK_40C,
  507. .port_ops = &piix_pata_ops,
  508. },
  509. [ich_pata_33] = /* ICH0 - ICH at 33Mhz*/
  510. {
  511. .flags = PIIX_PATA_FLAGS,
  512. .pio_mask = 0x1f, /* pio 0-4 */
  513. .mwdma_mask = 0x06, /* Check: maybe 0x07 */
  514. .udma_mask = ATA_UDMA2, /* UDMA33 */
  515. .port_ops = &ich_pata_ops,
  516. },
  517. [ich_pata_66] = /* ICH controllers up to 66MHz */
  518. {
  519. .flags = PIIX_PATA_FLAGS,
  520. .pio_mask = 0x1f, /* pio 0-4 */
  521. .mwdma_mask = 0x06, /* MWDMA0 is broken on chip */
  522. .udma_mask = ATA_UDMA4,
  523. .port_ops = &ich_pata_ops,
  524. },
  525. [ich_pata_100] =
  526. {
  527. .flags = PIIX_PATA_FLAGS | PIIX_FLAG_CHECKINTR,
  528. .pio_mask = 0x1f, /* pio0-4 */
  529. .mwdma_mask = 0x06, /* mwdma1-2 */
  530. .udma_mask = ATA_UDMA5, /* udma0-5 */
  531. .port_ops = &ich_pata_ops,
  532. },
  533. [ich5_sata] =
  534. {
  535. .flags = PIIX_SATA_FLAGS,
  536. .pio_mask = 0x1f, /* pio0-4 */
  537. .mwdma_mask = 0x07, /* mwdma0-2 */
  538. .udma_mask = ATA_UDMA6,
  539. .port_ops = &piix_sata_ops,
  540. },
  541. [ich6_sata] =
  542. {
  543. .flags = PIIX_SATA_FLAGS,
  544. .pio_mask = 0x1f, /* pio0-4 */
  545. .mwdma_mask = 0x07, /* mwdma0-2 */
  546. .udma_mask = ATA_UDMA6,
  547. .port_ops = &piix_sata_ops,
  548. },
  549. [ich6_sata_ahci] =
  550. {
  551. .flags = PIIX_SATA_FLAGS | PIIX_FLAG_AHCI,
  552. .pio_mask = 0x1f, /* pio0-4 */
  553. .mwdma_mask = 0x07, /* mwdma0-2 */
  554. .udma_mask = ATA_UDMA6,
  555. .port_ops = &piix_sata_ops,
  556. },
  557. [ich6m_sata_ahci] =
  558. {
  559. .flags = PIIX_SATA_FLAGS | PIIX_FLAG_AHCI,
  560. .pio_mask = 0x1f, /* pio0-4 */
  561. .mwdma_mask = 0x07, /* mwdma0-2 */
  562. .udma_mask = ATA_UDMA6,
  563. .port_ops = &piix_sata_ops,
  564. },
  565. [ich8_sata_ahci] =
  566. {
  567. .flags = PIIX_SATA_FLAGS | PIIX_FLAG_AHCI |
  568. PIIX_FLAG_SIDPR,
  569. .pio_mask = 0x1f, /* pio0-4 */
  570. .mwdma_mask = 0x07, /* mwdma0-2 */
  571. .udma_mask = ATA_UDMA6,
  572. .port_ops = &piix_sata_ops,
  573. },
  574. [ich8_2port_sata] =
  575. {
  576. .flags = PIIX_SATA_FLAGS | PIIX_FLAG_AHCI |
  577. PIIX_FLAG_SIDPR,
  578. .pio_mask = 0x1f, /* pio0-4 */
  579. .mwdma_mask = 0x07, /* mwdma0-2 */
  580. .udma_mask = ATA_UDMA6,
  581. .port_ops = &piix_sata_ops,
  582. },
  583. [tolapai_sata_ahci] =
  584. {
  585. .flags = PIIX_SATA_FLAGS | PIIX_FLAG_AHCI,
  586. .pio_mask = 0x1f, /* pio0-4 */
  587. .mwdma_mask = 0x07, /* mwdma0-2 */
  588. .udma_mask = ATA_UDMA6,
  589. .port_ops = &piix_sata_ops,
  590. },
  591. [ich8m_apple_sata_ahci] =
  592. {
  593. .flags = PIIX_SATA_FLAGS | PIIX_FLAG_AHCI |
  594. PIIX_FLAG_SIDPR,
  595. .pio_mask = 0x1f, /* pio0-4 */
  596. .mwdma_mask = 0x07, /* mwdma0-2 */
  597. .udma_mask = ATA_UDMA6,
  598. .port_ops = &piix_sata_ops,
  599. },
  600. [piix_pata_vmw] =
  601. {
  602. .flags = PIIX_PATA_FLAGS,
  603. .pio_mask = 0x1f, /* pio0-4 */
  604. .mwdma_mask = 0x06, /* mwdma1-2 ?? CHECK 0 should be ok but slow */
  605. .udma_mask = ATA_UDMA_MASK_40C,
  606. .port_ops = &piix_vmw_ops,
  607. },
  608. };
  609. static struct pci_bits piix_enable_bits[] = {
  610. { 0x41U, 1U, 0x80UL, 0x80UL }, /* port 0 */
  611. { 0x43U, 1U, 0x80UL, 0x80UL }, /* port 1 */
  612. };
  613. MODULE_AUTHOR("Andre Hedrick, Alan Cox, Andrzej Krzysztofowicz, Jeff Garzik");
  614. MODULE_DESCRIPTION("SCSI low-level driver for Intel PIIX/ICH ATA controllers");
  615. MODULE_LICENSE("GPL");
  616. MODULE_DEVICE_TABLE(pci, piix_pci_tbl);
  617. MODULE_VERSION(DRV_VERSION);
  618. struct ich_laptop {
  619. u16 device;
  620. u16 subvendor;
  621. u16 subdevice;
  622. };
  623. /*
  624. * List of laptops that use short cables rather than 80 wire
  625. */
  626. static const struct ich_laptop ich_laptop[] = {
  627. /* devid, subvendor, subdev */
  628. { 0x27DF, 0x0005, 0x0280 }, /* ICH7 on Acer 5602WLMi */
  629. { 0x27DF, 0x1025, 0x0102 }, /* ICH7 on Acer 5602aWLMi */
  630. { 0x27DF, 0x1025, 0x0110 }, /* ICH7 on Acer 3682WLMi */
  631. { 0x27DF, 0x1043, 0x1267 }, /* ICH7 on Asus W5F */
  632. { 0x27DF, 0x103C, 0x30A1 }, /* ICH7 on HP Compaq nc2400 */
  633. { 0x24CA, 0x1025, 0x0061 }, /* ICH4 on ACER Aspire 2023WLMi */
  634. /* end marker */
  635. { 0, }
  636. };
  637. /**
  638. * ich_pata_cable_detect - Probe host controller cable detect info
  639. * @ap: Port for which cable detect info is desired
  640. *
  641. * Read 80c cable indicator from ATA PCI device's PCI config
  642. * register. This register is normally set by firmware (BIOS).
  643. *
  644. * LOCKING:
  645. * None (inherited from caller).
  646. */
  647. static int ich_pata_cable_detect(struct ata_port *ap)
  648. {
  649. struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  650. const struct ich_laptop *lap = &ich_laptop[0];
  651. u8 tmp, mask;
  652. /* Check for specials - Acer Aspire 5602WLMi */
  653. while (lap->device) {
  654. if (lap->device == pdev->device &&
  655. lap->subvendor == pdev->subsystem_vendor &&
  656. lap->subdevice == pdev->subsystem_device)
  657. return ATA_CBL_PATA40_SHORT;
  658. lap++;
  659. }
  660. /* check BIOS cable detect results */
  661. mask = ap->port_no == 0 ? PIIX_80C_PRI : PIIX_80C_SEC;
  662. pci_read_config_byte(pdev, PIIX_IOCFG, &tmp);
  663. if ((tmp & mask) == 0)
  664. return ATA_CBL_PATA40;
  665. return ATA_CBL_PATA80;
  666. }
  667. /**
  668. * piix_pata_prereset - prereset for PATA host controller
  669. * @link: Target link
  670. * @deadline: deadline jiffies for the operation
  671. *
  672. * LOCKING:
  673. * None (inherited from caller).
  674. */
  675. static int piix_pata_prereset(struct ata_link *link, unsigned long deadline)
  676. {
  677. struct ata_port *ap = link->ap;
  678. struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  679. if (!pci_test_config_bits(pdev, &piix_enable_bits[ap->port_no]))
  680. return -ENOENT;
  681. return ata_std_prereset(link, deadline);
  682. }
  683. static void piix_pata_error_handler(struct ata_port *ap)
  684. {
  685. ata_bmdma_drive_eh(ap, piix_pata_prereset, ata_std_softreset, NULL,
  686. ata_std_postreset);
  687. }
  688. /**
  689. * piix_set_piomode - Initialize host controller PATA PIO timings
  690. * @ap: Port whose timings we are configuring
  691. * @adev: um
  692. *
  693. * Set PIO mode for device, in host controller PCI config space.
  694. *
  695. * LOCKING:
  696. * None (inherited from caller).
  697. */
  698. static void piix_set_piomode(struct ata_port *ap, struct ata_device *adev)
  699. {
  700. unsigned int pio = adev->pio_mode - XFER_PIO_0;
  701. struct pci_dev *dev = to_pci_dev(ap->host->dev);
  702. unsigned int is_slave = (adev->devno != 0);
  703. unsigned int master_port= ap->port_no ? 0x42 : 0x40;
  704. unsigned int slave_port = 0x44;
  705. u16 master_data;
  706. u8 slave_data;
  707. u8 udma_enable;
  708. int control = 0;
  709. /*
  710. * See Intel Document 298600-004 for the timing programing rules
  711. * for ICH controllers.
  712. */
  713. static const /* ISP RTC */
  714. u8 timings[][2] = { { 0, 0 },
  715. { 0, 0 },
  716. { 1, 0 },
  717. { 2, 1 },
  718. { 2, 3 }, };
  719. if (pio >= 2)
  720. control |= 1; /* TIME1 enable */
  721. if (ata_pio_need_iordy(adev))
  722. control |= 2; /* IE enable */
  723. /* Intel specifies that the PPE functionality is for disk only */
  724. if (adev->class == ATA_DEV_ATA)
  725. control |= 4; /* PPE enable */
  726. /* PIO configuration clears DTE unconditionally. It will be
  727. * programmed in set_dmamode which is guaranteed to be called
  728. * after set_piomode if any DMA mode is available.
  729. */
  730. pci_read_config_word(dev, master_port, &master_data);
  731. if (is_slave) {
  732. /* clear TIME1|IE1|PPE1|DTE1 */
  733. master_data &= 0xff0f;
  734. /* Enable SITRE (separate slave timing register) */
  735. master_data |= 0x4000;
  736. /* enable PPE1, IE1 and TIME1 as needed */
  737. master_data |= (control << 4);
  738. pci_read_config_byte(dev, slave_port, &slave_data);
  739. slave_data &= (ap->port_no ? 0x0f : 0xf0);
  740. /* Load the timing nibble for this slave */
  741. slave_data |= ((timings[pio][0] << 2) | timings[pio][1])
  742. << (ap->port_no ? 4 : 0);
  743. } else {
  744. /* clear ISP|RCT|TIME0|IE0|PPE0|DTE0 */
  745. master_data &= 0xccf0;
  746. /* Enable PPE, IE and TIME as appropriate */
  747. master_data |= control;
  748. /* load ISP and RCT */
  749. master_data |=
  750. (timings[pio][0] << 12) |
  751. (timings[pio][1] << 8);
  752. }
  753. pci_write_config_word(dev, master_port, master_data);
  754. if (is_slave)
  755. pci_write_config_byte(dev, slave_port, slave_data);
  756. /* Ensure the UDMA bit is off - it will be turned back on if
  757. UDMA is selected */
  758. if (ap->udma_mask) {
  759. pci_read_config_byte(dev, 0x48, &udma_enable);
  760. udma_enable &= ~(1 << (2 * ap->port_no + adev->devno));
  761. pci_write_config_byte(dev, 0x48, udma_enable);
  762. }
  763. }
  764. /**
  765. * do_pata_set_dmamode - Initialize host controller PATA PIO timings
  766. * @ap: Port whose timings we are configuring
  767. * @adev: Drive in question
  768. * @udma: udma mode, 0 - 6
  769. * @isich: set if the chip is an ICH device
  770. *
  771. * Set UDMA mode for device, in host controller PCI config space.
  772. *
  773. * LOCKING:
  774. * None (inherited from caller).
  775. */
  776. static void do_pata_set_dmamode(struct ata_port *ap, struct ata_device *adev, int isich)
  777. {
  778. struct pci_dev *dev = to_pci_dev(ap->host->dev);
  779. u8 master_port = ap->port_no ? 0x42 : 0x40;
  780. u16 master_data;
  781. u8 speed = adev->dma_mode;
  782. int devid = adev->devno + 2 * ap->port_no;
  783. u8 udma_enable = 0;
  784. static const /* ISP RTC */
  785. u8 timings[][2] = { { 0, 0 },
  786. { 0, 0 },
  787. { 1, 0 },
  788. { 2, 1 },
  789. { 2, 3 }, };
  790. pci_read_config_word(dev, master_port, &master_data);
  791. if (ap->udma_mask)
  792. pci_read_config_byte(dev, 0x48, &udma_enable);
  793. if (speed >= XFER_UDMA_0) {
  794. unsigned int udma = adev->dma_mode - XFER_UDMA_0;
  795. u16 udma_timing;
  796. u16 ideconf;
  797. int u_clock, u_speed;
  798. /*
  799. * UDMA is handled by a combination of clock switching and
  800. * selection of dividers
  801. *
  802. * Handy rule: Odd modes are UDMATIMx 01, even are 02
  803. * except UDMA0 which is 00
  804. */
  805. u_speed = min(2 - (udma & 1), udma);
  806. if (udma == 5)
  807. u_clock = 0x1000; /* 100Mhz */
  808. else if (udma > 2)
  809. u_clock = 1; /* 66Mhz */
  810. else
  811. u_clock = 0; /* 33Mhz */
  812. udma_enable |= (1 << devid);
  813. /* Load the CT/RP selection */
  814. pci_read_config_word(dev, 0x4A, &udma_timing);
  815. udma_timing &= ~(3 << (4 * devid));
  816. udma_timing |= u_speed << (4 * devid);
  817. pci_write_config_word(dev, 0x4A, udma_timing);
  818. if (isich) {
  819. /* Select a 33/66/100Mhz clock */
  820. pci_read_config_word(dev, 0x54, &ideconf);
  821. ideconf &= ~(0x1001 << devid);
  822. ideconf |= u_clock << devid;
  823. /* For ICH or later we should set bit 10 for better
  824. performance (WR_PingPong_En) */
  825. pci_write_config_word(dev, 0x54, ideconf);
  826. }
  827. } else {
  828. /*
  829. * MWDMA is driven by the PIO timings. We must also enable
  830. * IORDY unconditionally along with TIME1. PPE has already
  831. * been set when the PIO timing was set.
  832. */
  833. unsigned int mwdma = adev->dma_mode - XFER_MW_DMA_0;
  834. unsigned int control;
  835. u8 slave_data;
  836. const unsigned int needed_pio[3] = {
  837. XFER_PIO_0, XFER_PIO_3, XFER_PIO_4
  838. };
  839. int pio = needed_pio[mwdma] - XFER_PIO_0;
  840. control = 3; /* IORDY|TIME1 */
  841. /* If the drive MWDMA is faster than it can do PIO then
  842. we must force PIO into PIO0 */
  843. if (adev->pio_mode < needed_pio[mwdma])
  844. /* Enable DMA timing only */
  845. control |= 8; /* PIO cycles in PIO0 */
  846. if (adev->devno) { /* Slave */
  847. master_data &= 0xFF4F; /* Mask out IORDY|TIME1|DMAONLY */
  848. master_data |= control << 4;
  849. pci_read_config_byte(dev, 0x44, &slave_data);
  850. slave_data &= (ap->port_no ? 0x0f : 0xf0);
  851. /* Load the matching timing */
  852. slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->port_no ? 4 : 0);
  853. pci_write_config_byte(dev, 0x44, slave_data);
  854. } else { /* Master */
  855. master_data &= 0xCCF4; /* Mask out IORDY|TIME1|DMAONLY
  856. and master timing bits */
  857. master_data |= control;
  858. master_data |=
  859. (timings[pio][0] << 12) |
  860. (timings[pio][1] << 8);
  861. }
  862. if (ap->udma_mask) {
  863. udma_enable &= ~(1 << devid);
  864. pci_write_config_word(dev, master_port, master_data);
  865. }
  866. }
  867. /* Don't scribble on 0x48 if the controller does not support UDMA */
  868. if (ap->udma_mask)
  869. pci_write_config_byte(dev, 0x48, udma_enable);
  870. }
  871. /**
  872. * piix_set_dmamode - Initialize host controller PATA DMA timings
  873. * @ap: Port whose timings we are configuring
  874. * @adev: um
  875. *
  876. * Set MW/UDMA mode for device, in host controller PCI config space.
  877. *
  878. * LOCKING:
  879. * None (inherited from caller).
  880. */
  881. static void piix_set_dmamode(struct ata_port *ap, struct ata_device *adev)
  882. {
  883. do_pata_set_dmamode(ap, adev, 0);
  884. }
  885. /**
  886. * ich_set_dmamode - Initialize host controller PATA DMA timings
  887. * @ap: Port whose timings we are configuring
  888. * @adev: um
  889. *
  890. * Set MW/UDMA mode for device, in host controller PCI config space.
  891. *
  892. * LOCKING:
  893. * None (inherited from caller).
  894. */
  895. static void ich_set_dmamode(struct ata_port *ap, struct ata_device *adev)
  896. {
  897. do_pata_set_dmamode(ap, adev, 1);
  898. }
  899. /*
  900. * Serial ATA Index/Data Pair Superset Registers access
  901. *
  902. * Beginning from ICH8, there's a sane way to access SCRs using index
  903. * and data register pair located at BAR5. This creates an
  904. * interesting problem of mapping two SCRs to one port.
  905. *
  906. * Although they have separate SCRs, the master and slave aren't
  907. * independent enough to be treated as separate links - e.g. softreset
  908. * resets both. Also, there's no protocol defined for hard resetting
  909. * singled device sharing the virtual port (no defined way to acquire
  910. * device signature). This is worked around by merging the SCR values
  911. * into one sensible value and requesting follow-up SRST after
  912. * hardreset.
  913. *
  914. * SCR merging is perfomed in nibbles which is the unit contents in
  915. * SCRs are organized. If two values are equal, the value is used.
  916. * When they differ, merge table which lists precedence of possible
  917. * values is consulted and the first match or the last entry when
  918. * nothing matches is used. When there's no merge table for the
  919. * specific nibble, value from the first port is used.
  920. */
  921. static const int piix_sidx_map[] = {
  922. [SCR_STATUS] = 0,
  923. [SCR_ERROR] = 2,
  924. [SCR_CONTROL] = 1,
  925. };
  926. static void piix_sidpr_sel(struct ata_device *dev, unsigned int reg)
  927. {
  928. struct ata_port *ap = dev->link->ap;
  929. struct piix_host_priv *hpriv = ap->host->private_data;
  930. iowrite32(((ap->port_no * 2 + dev->devno) << 8) | piix_sidx_map[reg],
  931. hpriv->sidpr + PIIX_SIDPR_IDX);
  932. }
  933. static int piix_sidpr_read(struct ata_device *dev, unsigned int reg)
  934. {
  935. struct piix_host_priv *hpriv = dev->link->ap->host->private_data;
  936. piix_sidpr_sel(dev, reg);
  937. return ioread32(hpriv->sidpr + PIIX_SIDPR_DATA);
  938. }
  939. static void piix_sidpr_write(struct ata_device *dev, unsigned int reg, u32 val)
  940. {
  941. struct piix_host_priv *hpriv = dev->link->ap->host->private_data;
  942. piix_sidpr_sel(dev, reg);
  943. iowrite32(val, hpriv->sidpr + PIIX_SIDPR_DATA);
  944. }
  945. static u32 piix_merge_scr(u32 val0, u32 val1, const int * const *merge_tbl)
  946. {
  947. u32 val = 0;
  948. int i, mi;
  949. for (i = 0, mi = 0; i < 32 / 4; i++) {
  950. u8 c0 = (val0 >> (i * 4)) & 0xf;
  951. u8 c1 = (val1 >> (i * 4)) & 0xf;
  952. u8 merged = c0;
  953. const int *cur;
  954. /* if no merge preference, assume the first value */
  955. cur = merge_tbl[mi];
  956. if (!cur)
  957. goto done;
  958. mi++;
  959. /* if two values equal, use it */
  960. if (c0 == c1)
  961. goto done;
  962. /* choose the first match or the last from the merge table */
  963. while (*cur != -1) {
  964. if (c0 == *cur || c1 == *cur)
  965. break;
  966. cur++;
  967. }
  968. if (*cur == -1)
  969. cur--;
  970. merged = *cur;
  971. done:
  972. val |= merged << (i * 4);
  973. }
  974. return val;
  975. }
  976. static int piix_sidpr_scr_read(struct ata_port *ap, unsigned int reg, u32 *val)
  977. {
  978. const int * const sstatus_merge_tbl[] = {
  979. /* DET */ (const int []){ 1, 3, 0, 4, 3, -1 },
  980. /* SPD */ (const int []){ 2, 1, 0, -1 },
  981. /* IPM */ (const int []){ 6, 2, 1, 0, -1 },
  982. NULL,
  983. };
  984. const int * const scontrol_merge_tbl[] = {
  985. /* DET */ (const int []){ 1, 0, 4, 0, -1 },
  986. /* SPD */ (const int []){ 0, 2, 1, 0, -1 },
  987. /* IPM */ (const int []){ 0, 1, 2, 3, 0, -1 },
  988. NULL,
  989. };
  990. u32 v0, v1;
  991. if (reg >= ARRAY_SIZE(piix_sidx_map))
  992. return -EINVAL;
  993. if (!(ap->flags & ATA_FLAG_SLAVE_POSS)) {
  994. *val = piix_sidpr_read(&ap->link.device[0], reg);
  995. return 0;
  996. }
  997. v0 = piix_sidpr_read(&ap->link.device[0], reg);
  998. v1 = piix_sidpr_read(&ap->link.device[1], reg);
  999. switch (reg) {
  1000. case SCR_STATUS:
  1001. *val = piix_merge_scr(v0, v1, sstatus_merge_tbl);
  1002. break;
  1003. case SCR_ERROR:
  1004. *val = v0 | v1;
  1005. break;
  1006. case SCR_CONTROL:
  1007. *val = piix_merge_scr(v0, v1, scontrol_merge_tbl);
  1008. break;
  1009. }
  1010. return 0;
  1011. }
  1012. static int piix_sidpr_scr_write(struct ata_port *ap, unsigned int reg, u32 val)
  1013. {
  1014. if (reg >= ARRAY_SIZE(piix_sidx_map))
  1015. return -EINVAL;
  1016. piix_sidpr_write(&ap->link.device[0], reg, val);
  1017. if (ap->flags & ATA_FLAG_SLAVE_POSS)
  1018. piix_sidpr_write(&ap->link.device[1], reg, val);
  1019. return 0;
  1020. }
  1021. static int piix_sidpr_hardreset(struct ata_link *link, unsigned int *class,
  1022. unsigned long deadline)
  1023. {
  1024. const unsigned long *timing = sata_ehc_deb_timing(&link->eh_context);
  1025. int rc;
  1026. /* do hardreset */
  1027. rc = sata_link_hardreset(link, timing, deadline);
  1028. if (rc) {
  1029. ata_link_printk(link, KERN_ERR,
  1030. "COMRESET failed (errno=%d)\n", rc);
  1031. return rc;
  1032. }
  1033. /* TODO: phy layer with polling, timeouts, etc. */
  1034. if (ata_link_offline(link)) {
  1035. *class = ATA_DEV_NONE;
  1036. return 0;
  1037. }
  1038. return -EAGAIN;
  1039. }
  1040. static void piix_sidpr_error_handler(struct ata_port *ap)
  1041. {
  1042. ata_bmdma_drive_eh(ap, ata_std_prereset, ata_std_softreset,
  1043. piix_sidpr_hardreset, ata_std_postreset);
  1044. }
  1045. #ifdef CONFIG_PM
  1046. static int piix_broken_suspend(void)
  1047. {
  1048. static const struct dmi_system_id sysids[] = {
  1049. {
  1050. .ident = "TECRA M3",
  1051. .matches = {
  1052. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1053. DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M3"),
  1054. },
  1055. },
  1056. {
  1057. .ident = "TECRA M3",
  1058. .matches = {
  1059. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1060. DMI_MATCH(DMI_PRODUCT_NAME, "Tecra M3"),
  1061. },
  1062. },
  1063. {
  1064. .ident = "TECRA M4",
  1065. .matches = {
  1066. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1067. DMI_MATCH(DMI_PRODUCT_NAME, "Tecra M4"),
  1068. },
  1069. },
  1070. {
  1071. .ident = "TECRA M5",
  1072. .matches = {
  1073. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1074. DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M5"),
  1075. },
  1076. },
  1077. {
  1078. .ident = "TECRA M6",
  1079. .matches = {
  1080. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1081. DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M6"),
  1082. },
  1083. },
  1084. {
  1085. .ident = "TECRA M7",
  1086. .matches = {
  1087. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1088. DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M7"),
  1089. },
  1090. },
  1091. {
  1092. .ident = "TECRA A8",
  1093. .matches = {
  1094. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1095. DMI_MATCH(DMI_PRODUCT_NAME, "TECRA A8"),
  1096. },
  1097. },
  1098. {
  1099. .ident = "Satellite R20",
  1100. .matches = {
  1101. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1102. DMI_MATCH(DMI_PRODUCT_NAME, "Satellite R20"),
  1103. },
  1104. },
  1105. {
  1106. .ident = "Satellite R25",
  1107. .matches = {
  1108. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1109. DMI_MATCH(DMI_PRODUCT_NAME, "Satellite R25"),
  1110. },
  1111. },
  1112. {
  1113. .ident = "Satellite U200",
  1114. .matches = {
  1115. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1116. DMI_MATCH(DMI_PRODUCT_NAME, "Satellite U200"),
  1117. },
  1118. },
  1119. {
  1120. .ident = "Satellite U200",
  1121. .matches = {
  1122. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1123. DMI_MATCH(DMI_PRODUCT_NAME, "SATELLITE U200"),
  1124. },
  1125. },
  1126. {
  1127. .ident = "Satellite Pro U200",
  1128. .matches = {
  1129. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1130. DMI_MATCH(DMI_PRODUCT_NAME, "SATELLITE PRO U200"),
  1131. },
  1132. },
  1133. {
  1134. .ident = "Satellite U205",
  1135. .matches = {
  1136. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1137. DMI_MATCH(DMI_PRODUCT_NAME, "Satellite U205"),
  1138. },
  1139. },
  1140. {
  1141. .ident = "SATELLITE U205",
  1142. .matches = {
  1143. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1144. DMI_MATCH(DMI_PRODUCT_NAME, "SATELLITE U205"),
  1145. },
  1146. },
  1147. {
  1148. .ident = "Portege M500",
  1149. .matches = {
  1150. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  1151. DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M500"),
  1152. },
  1153. },
  1154. { } /* terminate list */
  1155. };
  1156. static const char *oemstrs[] = {
  1157. "Tecra M3,",
  1158. };
  1159. int i;
  1160. if (dmi_check_system(sysids))
  1161. return 1;
  1162. for (i = 0; i < ARRAY_SIZE(oemstrs); i++)
  1163. if (dmi_find_device(DMI_DEV_TYPE_OEM_STRING, oemstrs[i], NULL))
  1164. return 1;
  1165. return 0;
  1166. }
  1167. static int piix_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg)
  1168. {
  1169. struct ata_host *host = dev_get_drvdata(&pdev->dev);
  1170. unsigned long flags;
  1171. int rc = 0;
  1172. rc = ata_host_suspend(host, mesg);
  1173. if (rc)
  1174. return rc;
  1175. /* Some braindamaged ACPI suspend implementations expect the
  1176. * controller to be awake on entry; otherwise, it burns cpu
  1177. * cycles and power trying to do something to the sleeping
  1178. * beauty.
  1179. */
  1180. if (piix_broken_suspend() && (mesg.event & PM_EVENT_SLEEP)) {
  1181. pci_save_state(pdev);
  1182. /* mark its power state as "unknown", since we don't
  1183. * know if e.g. the BIOS will change its device state
  1184. * when we suspend.
  1185. */
  1186. if (pdev->current_state == PCI_D0)
  1187. pdev->current_state = PCI_UNKNOWN;
  1188. /* tell resume that it's waking up from broken suspend */
  1189. spin_lock_irqsave(&host->lock, flags);
  1190. host->flags |= PIIX_HOST_BROKEN_SUSPEND;
  1191. spin_unlock_irqrestore(&host->lock, flags);
  1192. } else
  1193. ata_pci_device_do_suspend(pdev, mesg);
  1194. return 0;
  1195. }
  1196. static int piix_pci_device_resume(struct pci_dev *pdev)
  1197. {
  1198. struct ata_host *host = dev_get_drvdata(&pdev->dev);
  1199. unsigned long flags;
  1200. int rc;
  1201. if (host->flags & PIIX_HOST_BROKEN_SUSPEND) {
  1202. spin_lock_irqsave(&host->lock, flags);
  1203. host->flags &= ~PIIX_HOST_BROKEN_SUSPEND;
  1204. spin_unlock_irqrestore(&host->lock, flags);
  1205. pci_set_power_state(pdev, PCI_D0);
  1206. pci_restore_state(pdev);
  1207. /* PCI device wasn't disabled during suspend. Use
  1208. * pci_reenable_device() to avoid affecting the enable
  1209. * count.
  1210. */
  1211. rc = pci_reenable_device(pdev);
  1212. if (rc)
  1213. dev_printk(KERN_ERR, &pdev->dev, "failed to enable "
  1214. "device after resume (%d)\n", rc);
  1215. } else
  1216. rc = ata_pci_device_do_resume(pdev);
  1217. if (rc == 0)
  1218. ata_host_resume(host);
  1219. return rc;
  1220. }
  1221. #endif
  1222. static u8 piix_vmw_bmdma_status(struct ata_port *ap)
  1223. {
  1224. return ata_bmdma_status(ap) & ~ATA_DMA_ERR;
  1225. }
  1226. #define AHCI_PCI_BAR 5
  1227. #define AHCI_GLOBAL_CTL 0x04
  1228. #define AHCI_ENABLE (1 << 31)
  1229. static int piix_disable_ahci(struct pci_dev *pdev)
  1230. {
  1231. void __iomem *mmio;
  1232. u32 tmp;
  1233. int rc = 0;
  1234. /* BUG: pci_enable_device has not yet been called. This
  1235. * works because this device is usually set up by BIOS.
  1236. */
  1237. if (!pci_resource_start(pdev, AHCI_PCI_BAR) ||
  1238. !pci_resource_len(pdev, AHCI_PCI_BAR))
  1239. return 0;
  1240. mmio = pci_iomap(pdev, AHCI_PCI_BAR, 64);
  1241. if (!mmio)
  1242. return -ENOMEM;
  1243. tmp = ioread32(mmio + AHCI_GLOBAL_CTL);
  1244. if (tmp & AHCI_ENABLE) {
  1245. tmp &= ~AHCI_ENABLE;
  1246. iowrite32(tmp, mmio + AHCI_GLOBAL_CTL);
  1247. tmp = ioread32(mmio + AHCI_GLOBAL_CTL);
  1248. if (tmp & AHCI_ENABLE)
  1249. rc = -EIO;
  1250. }
  1251. pci_iounmap(pdev, mmio);
  1252. return rc;
  1253. }
  1254. /**
  1255. * piix_check_450nx_errata - Check for problem 450NX setup
  1256. * @ata_dev: the PCI device to check
  1257. *
  1258. * Check for the present of 450NX errata #19 and errata #25. If
  1259. * they are found return an error code so we can turn off DMA
  1260. */
  1261. static int __devinit piix_check_450nx_errata(struct pci_dev *ata_dev)
  1262. {
  1263. struct pci_dev *pdev = NULL;
  1264. u16 cfg;
  1265. int no_piix_dma = 0;
  1266. while ((pdev = pci_get_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82454NX, pdev)) != NULL) {
  1267. /* Look for 450NX PXB. Check for problem configurations
  1268. A PCI quirk checks bit 6 already */
  1269. pci_read_config_word(pdev, 0x41, &cfg);
  1270. /* Only on the original revision: IDE DMA can hang */
  1271. if (pdev->revision == 0x00)
  1272. no_piix_dma = 1;
  1273. /* On all revisions below 5 PXB bus lock must be disabled for IDE */
  1274. else if (cfg & (1<<14) && pdev->revision < 5)
  1275. no_piix_dma = 2;
  1276. }
  1277. if (no_piix_dma)
  1278. dev_printk(KERN_WARNING, &ata_dev->dev, "450NX errata present, disabling IDE DMA.\n");
  1279. if (no_piix_dma == 2)
  1280. dev_printk(KERN_WARNING, &ata_dev->dev, "A BIOS update may resolve this.\n");
  1281. return no_piix_dma;
  1282. }
  1283. static void __devinit piix_init_pcs(struct ata_host *host,
  1284. const struct piix_map_db *map_db)
  1285. {
  1286. struct pci_dev *pdev = to_pci_dev(host->dev);
  1287. u16 pcs, new_pcs;
  1288. pci_read_config_word(pdev, ICH5_PCS, &pcs);
  1289. new_pcs = pcs | map_db->port_enable;
  1290. if (new_pcs != pcs) {
  1291. DPRINTK("updating PCS from 0x%x to 0x%x\n", pcs, new_pcs);
  1292. pci_write_config_word(pdev, ICH5_PCS, new_pcs);
  1293. msleep(150);
  1294. }
  1295. }
  1296. static const int *__devinit piix_init_sata_map(struct pci_dev *pdev,
  1297. struct ata_port_info *pinfo,
  1298. const struct piix_map_db *map_db)
  1299. {
  1300. const int *map;
  1301. int i, invalid_map = 0;
  1302. u8 map_value;
  1303. pci_read_config_byte(pdev, ICH5_PMR, &map_value);
  1304. map = map_db->map[map_value & map_db->mask];
  1305. dev_printk(KERN_INFO, &pdev->dev, "MAP [");
  1306. for (i = 0; i < 4; i++) {
  1307. switch (map[i]) {
  1308. case RV:
  1309. invalid_map = 1;
  1310. printk(" XX");
  1311. break;
  1312. case NA:
  1313. printk(" --");
  1314. break;
  1315. case IDE:
  1316. WARN_ON((i & 1) || map[i + 1] != IDE);
  1317. pinfo[i / 2] = piix_port_info[ich_pata_100];
  1318. i++;
  1319. printk(" IDE IDE");
  1320. break;
  1321. default:
  1322. printk(" P%d", map[i]);
  1323. if (i & 1)
  1324. pinfo[i / 2].flags |= ATA_FLAG_SLAVE_POSS;
  1325. break;
  1326. }
  1327. }
  1328. printk(" ]\n");
  1329. if (invalid_map)
  1330. dev_printk(KERN_ERR, &pdev->dev,
  1331. "invalid MAP value %u\n", map_value);
  1332. return map;
  1333. }
  1334. static void __devinit piix_init_sidpr(struct ata_host *host)
  1335. {
  1336. struct pci_dev *pdev = to_pci_dev(host->dev);
  1337. struct piix_host_priv *hpriv = host->private_data;
  1338. int i;
  1339. /* check for availability */
  1340. for (i = 0; i < 4; i++)
  1341. if (hpriv->map[i] == IDE)
  1342. return;
  1343. if (!(host->ports[0]->flags & PIIX_FLAG_SIDPR))
  1344. return;
  1345. if (pci_resource_start(pdev, PIIX_SIDPR_BAR) == 0 ||
  1346. pci_resource_len(pdev, PIIX_SIDPR_BAR) != PIIX_SIDPR_LEN)
  1347. return;
  1348. if (pcim_iomap_regions(pdev, 1 << PIIX_SIDPR_BAR, DRV_NAME))
  1349. return;
  1350. hpriv->sidpr = pcim_iomap_table(pdev)[PIIX_SIDPR_BAR];
  1351. host->ports[0]->ops = &piix_sidpr_sata_ops;
  1352. host->ports[1]->ops = &piix_sidpr_sata_ops;
  1353. }
  1354. static void piix_iocfg_bit18_quirk(struct pci_dev *pdev)
  1355. {
  1356. static const struct dmi_system_id sysids[] = {
  1357. {
  1358. /* Clevo M570U sets IOCFG bit 18 if the cdrom
  1359. * isn't used to boot the system which
  1360. * disables the channel.
  1361. */
  1362. .ident = "M570U",
  1363. .matches = {
  1364. DMI_MATCH(DMI_SYS_VENDOR, "Clevo Co."),
  1365. DMI_MATCH(DMI_PRODUCT_NAME, "M570U"),
  1366. },
  1367. },
  1368. { } /* terminate list */
  1369. };
  1370. u32 iocfg;
  1371. if (!dmi_check_system(sysids))
  1372. return;
  1373. /* The datasheet says that bit 18 is NOOP but certain systems
  1374. * seem to use it to disable a channel. Clear the bit on the
  1375. * affected systems.
  1376. */
  1377. pci_read_config_dword(pdev, PIIX_IOCFG, &iocfg);
  1378. if (iocfg & (1 << 18)) {
  1379. dev_printk(KERN_INFO, &pdev->dev,
  1380. "applying IOCFG bit18 quirk\n");
  1381. iocfg &= ~(1 << 18);
  1382. pci_write_config_dword(pdev, PIIX_IOCFG, iocfg);
  1383. }
  1384. }
  1385. /**
  1386. * piix_init_one - Register PIIX ATA PCI device with kernel services
  1387. * @pdev: PCI device to register
  1388. * @ent: Entry in piix_pci_tbl matching with @pdev
  1389. *
  1390. * Called from kernel PCI layer. We probe for combined mode (sigh),
  1391. * and then hand over control to libata, for it to do the rest.
  1392. *
  1393. * LOCKING:
  1394. * Inherited from PCI layer (may sleep).
  1395. *
  1396. * RETURNS:
  1397. * Zero on success, or -ERRNO value.
  1398. */
  1399. static int __devinit piix_init_one(struct pci_dev *pdev,
  1400. const struct pci_device_id *ent)
  1401. {
  1402. static int printed_version;
  1403. struct device *dev = &pdev->dev;
  1404. struct ata_port_info port_info[2];
  1405. const struct ata_port_info *ppi[] = { &port_info[0], &port_info[1] };
  1406. unsigned long port_flags;
  1407. struct ata_host *host;
  1408. struct piix_host_priv *hpriv;
  1409. int rc;
  1410. if (!printed_version++)
  1411. dev_printk(KERN_DEBUG, &pdev->dev,
  1412. "version " DRV_VERSION "\n");
  1413. /* no hotplugging support (FIXME) */
  1414. if (!in_module_init)
  1415. return -ENODEV;
  1416. port_info[0] = piix_port_info[ent->driver_data];
  1417. port_info[1] = piix_port_info[ent->driver_data];
  1418. port_flags = port_info[0].flags;
  1419. /* enable device and prepare host */
  1420. rc = pcim_enable_device(pdev);
  1421. if (rc)
  1422. return rc;
  1423. /* SATA map init can change port_info, do it before prepping host */
  1424. hpriv = devm_kzalloc(dev, sizeof(*hpriv), GFP_KERNEL);
  1425. if (!hpriv)
  1426. return -ENOMEM;
  1427. if (port_flags & ATA_FLAG_SATA)
  1428. hpriv->map = piix_init_sata_map(pdev, port_info,
  1429. piix_map_db_table[ent->driver_data]);
  1430. rc = ata_pci_prepare_sff_host(pdev, ppi, &host);
  1431. if (rc)
  1432. return rc;
  1433. host->private_data = hpriv;
  1434. /* initialize controller */
  1435. if (port_flags & PIIX_FLAG_AHCI) {
  1436. u8 tmp;
  1437. pci_read_config_byte(pdev, PIIX_SCC, &tmp);
  1438. if (tmp == PIIX_AHCI_DEVICE) {
  1439. rc = piix_disable_ahci(pdev);
  1440. if (rc)
  1441. return rc;
  1442. }
  1443. }
  1444. if (port_flags & ATA_FLAG_SATA) {
  1445. piix_init_pcs(host, piix_map_db_table[ent->driver_data]);
  1446. piix_init_sidpr(host);
  1447. }
  1448. /* apply IOCFG bit18 quirk */
  1449. piix_iocfg_bit18_quirk(pdev);
  1450. /* On ICH5, some BIOSen disable the interrupt using the
  1451. * PCI_COMMAND_INTX_DISABLE bit added in PCI 2.3.
  1452. * On ICH6, this bit has the same effect, but only when
  1453. * MSI is disabled (and it is disabled, as we don't use
  1454. * message-signalled interrupts currently).
  1455. */
  1456. if (port_flags & PIIX_FLAG_CHECKINTR)
  1457. pci_intx(pdev, 1);
  1458. if (piix_check_450nx_errata(pdev)) {
  1459. /* This writes into the master table but it does not
  1460. really matter for this errata as we will apply it to
  1461. all the PIIX devices on the board */
  1462. host->ports[0]->mwdma_mask = 0;
  1463. host->ports[0]->udma_mask = 0;
  1464. host->ports[1]->mwdma_mask = 0;
  1465. host->ports[1]->udma_mask = 0;
  1466. }
  1467. pci_set_master(pdev);
  1468. return ata_pci_activate_sff_host(host, ata_interrupt, &piix_sht);
  1469. }
  1470. static int __init piix_init(void)
  1471. {
  1472. int rc;
  1473. DPRINTK("pci_register_driver\n");
  1474. rc = pci_register_driver(&piix_pci_driver);
  1475. if (rc)
  1476. return rc;
  1477. in_module_init = 0;
  1478. DPRINTK("done\n");
  1479. return 0;
  1480. }
  1481. static void __exit piix_exit(void)
  1482. {
  1483. pci_unregister_driver(&piix_pci_driver);
  1484. }
  1485. module_init(piix_init);
  1486. module_exit(piix_exit);