sis5513.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636
  1. /*
  2. * Copyright (C) 1999-2000 Andre Hedrick <andre@linux-ide.org>
  3. * Copyright (C) 2002 Lionel Bouton <Lionel.Bouton@inet6.fr>, Maintainer
  4. * Copyright (C) 2003 Vojtech Pavlik <vojtech@suse.cz>
  5. * Copyright (C) 2007-2009 Bartlomiej Zolnierkiewicz
  6. *
  7. * May be copied or modified under the terms of the GNU General Public License
  8. *
  9. *
  10. * Thanks :
  11. *
  12. * SiS Taiwan : for direct support and hardware.
  13. * Daniela Engert : for initial ATA100 advices and numerous others.
  14. * John Fremlin, Manfred Spraul, Dave Morgan, Peter Kjellerstedt :
  15. * for checking code correctness, providing patches.
  16. *
  17. *
  18. * Original tests and design on the SiS620 chipset.
  19. * ATA100 tests and design on the SiS735 chipset.
  20. * ATA16/33 support from specs
  21. * ATA133 support for SiS961/962 by L.C. Chang <lcchang@sis.com.tw>
  22. * ATA133 961/962/963 fixes by Vojtech Pavlik <vojtech@suse.cz>
  23. *
  24. * Documentation:
  25. * SiS chipset documentation available under NDA to companies only
  26. * (not to individuals).
  27. */
  28. /*
  29. * The original SiS5513 comes from a SiS5511/55112/5513 chipset. The original
  30. * SiS5513 was also used in the SiS5596/5513 chipset. Thus if we see a SiS5511
  31. * or SiS5596, we can assume we see the first MWDMA-16 capable SiS5513 chip.
  32. *
  33. * Later SiS chipsets integrated the 5513 functionality into the NorthBridge,
  34. * starting with SiS5571 and up to SiS745. The PCI ID didn't change, though. We
  35. * can figure out that we have a more modern and more capable 5513 by looking
  36. * for the respective NorthBridge IDs.
  37. *
  38. * Even later (96x family) SiS chipsets use the MuTIOL link and place the 5513
  39. * into the SouthBrige. Here we cannot rely on looking up the NorthBridge PCI
  40. * ID, while the now ATA-133 capable 5513 still has the same PCI ID.
  41. * Fortunately the 5513 can be 'unmasked' by fiddling with some config space
  42. * bits, changing its device id to the true one - 5517 for 961 and 5518 for
  43. * 962/963.
  44. */
  45. #include <linux/types.h>
  46. #include <linux/module.h>
  47. #include <linux/kernel.h>
  48. #include <linux/pci.h>
  49. #include <linux/init.h>
  50. #include <linux/ide.h>
  51. #define DRV_NAME "sis5513"
  52. /* registers layout and init values are chipset family dependent */
  53. #define ATA_16 0x01
  54. #define ATA_33 0x02
  55. #define ATA_66 0x03
  56. #define ATA_100a 0x04 /* SiS730/SiS550 is ATA100 with ATA66 layout */
  57. #define ATA_100 0x05
  58. #define ATA_133a 0x06 /* SiS961b with 133 support */
  59. #define ATA_133 0x07 /* SiS962/963 */
  60. static u8 chipset_family;
  61. /*
  62. * Devices supported
  63. */
  64. static const struct {
  65. const char *name;
  66. u16 host_id;
  67. u8 chipset_family;
  68. u8 flags;
  69. } SiSHostChipInfo[] = {
  70. { "SiS968", PCI_DEVICE_ID_SI_968, ATA_133 },
  71. { "SiS966", PCI_DEVICE_ID_SI_966, ATA_133 },
  72. { "SiS965", PCI_DEVICE_ID_SI_965, ATA_133 },
  73. { "SiS745", PCI_DEVICE_ID_SI_745, ATA_100 },
  74. { "SiS735", PCI_DEVICE_ID_SI_735, ATA_100 },
  75. { "SiS733", PCI_DEVICE_ID_SI_733, ATA_100 },
  76. { "SiS635", PCI_DEVICE_ID_SI_635, ATA_100 },
  77. { "SiS633", PCI_DEVICE_ID_SI_633, ATA_100 },
  78. { "SiS730", PCI_DEVICE_ID_SI_730, ATA_100a },
  79. { "SiS550", PCI_DEVICE_ID_SI_550, ATA_100a },
  80. { "SiS640", PCI_DEVICE_ID_SI_640, ATA_66 },
  81. { "SiS630", PCI_DEVICE_ID_SI_630, ATA_66 },
  82. { "SiS620", PCI_DEVICE_ID_SI_620, ATA_66 },
  83. { "SiS540", PCI_DEVICE_ID_SI_540, ATA_66 },
  84. { "SiS530", PCI_DEVICE_ID_SI_530, ATA_66 },
  85. { "SiS5600", PCI_DEVICE_ID_SI_5600, ATA_33 },
  86. { "SiS5598", PCI_DEVICE_ID_SI_5598, ATA_33 },
  87. { "SiS5597", PCI_DEVICE_ID_SI_5597, ATA_33 },
  88. { "SiS5591/2", PCI_DEVICE_ID_SI_5591, ATA_33 },
  89. { "SiS5582", PCI_DEVICE_ID_SI_5582, ATA_33 },
  90. { "SiS5581", PCI_DEVICE_ID_SI_5581, ATA_33 },
  91. { "SiS5596", PCI_DEVICE_ID_SI_5596, ATA_16 },
  92. { "SiS5571", PCI_DEVICE_ID_SI_5571, ATA_16 },
  93. { "SiS5517", PCI_DEVICE_ID_SI_5517, ATA_16 },
  94. { "SiS551x", PCI_DEVICE_ID_SI_5511, ATA_16 },
  95. };
  96. /* Cycle time bits and values vary across chip dma capabilities
  97. These three arrays hold the register layout and the values to set.
  98. Indexed by chipset_family and (dma_mode - XFER_UDMA_0) */
  99. /* {0, ATA_16, ATA_33, ATA_66, ATA_100a, ATA_100, ATA_133} */
  100. static u8 cycle_time_offset[] = { 0, 0, 5, 4, 4, 0, 0 };
  101. static u8 cycle_time_range[] = { 0, 0, 2, 3, 3, 4, 4 };
  102. static u8 cycle_time_value[][XFER_UDMA_6 - XFER_UDMA_0 + 1] = {
  103. { 0, 0, 0, 0, 0, 0, 0 }, /* no UDMA */
  104. { 0, 0, 0, 0, 0, 0, 0 }, /* no UDMA */
  105. { 3, 2, 1, 0, 0, 0, 0 }, /* ATA_33 */
  106. { 7, 5, 3, 2, 1, 0, 0 }, /* ATA_66 */
  107. { 7, 5, 3, 2, 1, 0, 0 }, /* ATA_100a (730 specific),
  108. different cycle_time range and offset */
  109. { 11, 7, 5, 4, 2, 1, 0 }, /* ATA_100 */
  110. { 15, 10, 7, 5, 3, 2, 1 }, /* ATA_133a (earliest 691 southbridges) */
  111. { 15, 10, 7, 5, 3, 2, 1 }, /* ATA_133 */
  112. };
  113. /* CRC Valid Setup Time vary across IDE clock setting 33/66/100/133
  114. See SiS962 data sheet for more detail */
  115. static u8 cvs_time_value[][XFER_UDMA_6 - XFER_UDMA_0 + 1] = {
  116. { 0, 0, 0, 0, 0, 0, 0 }, /* no UDMA */
  117. { 0, 0, 0, 0, 0, 0, 0 }, /* no UDMA */
  118. { 2, 1, 1, 0, 0, 0, 0 },
  119. { 4, 3, 2, 1, 0, 0, 0 },
  120. { 4, 3, 2, 1, 0, 0, 0 },
  121. { 6, 4, 3, 1, 1, 1, 0 },
  122. { 9, 6, 4, 2, 2, 2, 2 },
  123. { 9, 6, 4, 2, 2, 2, 2 },
  124. };
  125. /* Initialize time, Active time, Recovery time vary across
  126. IDE clock settings. These 3 arrays hold the register value
  127. for PIO0/1/2/3/4 and DMA0/1/2 mode in order */
  128. static u8 ini_time_value[][8] = {
  129. { 0, 0, 0, 0, 0, 0, 0, 0 },
  130. { 0, 0, 0, 0, 0, 0, 0, 0 },
  131. { 2, 1, 0, 0, 0, 1, 0, 0 },
  132. { 4, 3, 1, 1, 1, 3, 1, 1 },
  133. { 4, 3, 1, 1, 1, 3, 1, 1 },
  134. { 6, 4, 2, 2, 2, 4, 2, 2 },
  135. { 9, 6, 3, 3, 3, 6, 3, 3 },
  136. { 9, 6, 3, 3, 3, 6, 3, 3 },
  137. };
  138. static u8 act_time_value[][8] = {
  139. { 0, 0, 0, 0, 0, 0, 0, 0 },
  140. { 0, 0, 0, 0, 0, 0, 0, 0 },
  141. { 9, 9, 9, 2, 2, 7, 2, 2 },
  142. { 19, 19, 19, 5, 4, 14, 5, 4 },
  143. { 19, 19, 19, 5, 4, 14, 5, 4 },
  144. { 28, 28, 28, 7, 6, 21, 7, 6 },
  145. { 38, 38, 38, 10, 9, 28, 10, 9 },
  146. { 38, 38, 38, 10, 9, 28, 10, 9 },
  147. };
  148. static u8 rco_time_value[][8] = {
  149. { 0, 0, 0, 0, 0, 0, 0, 0 },
  150. { 0, 0, 0, 0, 0, 0, 0, 0 },
  151. { 9, 2, 0, 2, 0, 7, 1, 1 },
  152. { 19, 5, 1, 5, 2, 16, 3, 2 },
  153. { 19, 5, 1, 5, 2, 16, 3, 2 },
  154. { 30, 9, 3, 9, 4, 25, 6, 4 },
  155. { 40, 12, 4, 12, 5, 34, 12, 5 },
  156. { 40, 12, 4, 12, 5, 34, 12, 5 },
  157. };
  158. /*
  159. * Printing configuration
  160. */
  161. /* Used for chipset type printing at boot time */
  162. static char *chipset_capability[] = {
  163. "ATA", "ATA 16",
  164. "ATA 33", "ATA 66",
  165. "ATA 100 (1st gen)", "ATA 100 (2nd gen)",
  166. "ATA 133 (1st gen)", "ATA 133 (2nd gen)"
  167. };
  168. /*
  169. * Configuration functions
  170. */
  171. static u8 sis_ata133_get_base(ide_drive_t *drive)
  172. {
  173. struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
  174. u32 reg54 = 0;
  175. pci_read_config_dword(dev, 0x54, &reg54);
  176. return ((reg54 & 0x40000000) ? 0x70 : 0x40) + drive->dn * 4;
  177. }
  178. static void sis_ata16_program_timings(ide_drive_t *drive, const u8 mode)
  179. {
  180. struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
  181. u16 t1 = 0;
  182. u8 drive_pci = 0x40 + drive->dn * 2;
  183. const u16 pio_timings[] = { 0x000, 0x607, 0x404, 0x303, 0x301 };
  184. const u16 mwdma_timings[] = { 0x008, 0x302, 0x301 };
  185. pci_read_config_word(dev, drive_pci, &t1);
  186. /* clear active/recovery timings */
  187. t1 &= ~0x070f;
  188. if (mode >= XFER_MW_DMA_0) {
  189. if (chipset_family > ATA_16)
  190. t1 &= ~0x8000; /* disable UDMA */
  191. t1 |= mwdma_timings[mode - XFER_MW_DMA_0];
  192. } else
  193. t1 |= pio_timings[mode - XFER_PIO_0];
  194. pci_write_config_word(dev, drive_pci, t1);
  195. }
  196. static void sis_ata100_program_timings(ide_drive_t *drive, const u8 mode)
  197. {
  198. struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
  199. u8 t1, drive_pci = 0x40 + drive->dn * 2;
  200. /* timing bits: 7:4 active 3:0 recovery */
  201. const u8 pio_timings[] = { 0x00, 0x67, 0x44, 0x33, 0x31 };
  202. const u8 mwdma_timings[] = { 0x08, 0x32, 0x31 };
  203. if (mode >= XFER_MW_DMA_0) {
  204. u8 t2 = 0;
  205. pci_read_config_byte(dev, drive_pci, &t2);
  206. t2 &= ~0x80; /* disable UDMA */
  207. pci_write_config_byte(dev, drive_pci, t2);
  208. t1 = mwdma_timings[mode - XFER_MW_DMA_0];
  209. } else
  210. t1 = pio_timings[mode - XFER_PIO_0];
  211. pci_write_config_byte(dev, drive_pci + 1, t1);
  212. }
  213. static void sis_ata133_program_timings(ide_drive_t *drive, const u8 mode)
  214. {
  215. struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
  216. u32 t1 = 0;
  217. u8 drive_pci = sis_ata133_get_base(drive), clk, idx;
  218. pci_read_config_dword(dev, drive_pci, &t1);
  219. t1 &= 0xc0c00fff;
  220. clk = (t1 & 0x08) ? ATA_133 : ATA_100;
  221. if (mode >= XFER_MW_DMA_0) {
  222. t1 &= ~0x04; /* disable UDMA */
  223. idx = mode - XFER_MW_DMA_0 + 5;
  224. } else
  225. idx = mode - XFER_PIO_0;
  226. t1 |= ini_time_value[clk][idx] << 12;
  227. t1 |= act_time_value[clk][idx] << 16;
  228. t1 |= rco_time_value[clk][idx] << 24;
  229. pci_write_config_dword(dev, drive_pci, t1);
  230. }
  231. static void sis_program_timings(ide_drive_t *drive, const u8 mode)
  232. {
  233. if (chipset_family < ATA_100) /* ATA_16/33/66/100a */
  234. sis_ata16_program_timings(drive, mode);
  235. else if (chipset_family < ATA_133) /* ATA_100/133a */
  236. sis_ata100_program_timings(drive, mode);
  237. else /* ATA_133 */
  238. sis_ata133_program_timings(drive, mode);
  239. }
  240. static void config_drive_art_rwp(ide_drive_t *drive)
  241. {
  242. ide_hwif_t *hwif = drive->hwif;
  243. struct pci_dev *dev = to_pci_dev(hwif->dev);
  244. u8 reg4bh = 0;
  245. u8 rw_prefetch = 0;
  246. pci_read_config_byte(dev, 0x4b, &reg4bh);
  247. rw_prefetch = reg4bh & ~(0x11 << drive->dn);
  248. if (drive->media == ide_disk)
  249. rw_prefetch |= 0x11 << drive->dn;
  250. if (reg4bh != rw_prefetch)
  251. pci_write_config_byte(dev, 0x4b, rw_prefetch);
  252. }
  253. static void sis_set_pio_mode(ide_hwif_t *hwif, ide_drive_t *drive)
  254. {
  255. config_drive_art_rwp(drive);
  256. sis_program_timings(drive, drive->pio_mode);
  257. }
  258. static void sis_ata133_program_udma_timings(ide_drive_t *drive, const u8 mode)
  259. {
  260. struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
  261. u32 regdw = 0;
  262. u8 drive_pci = sis_ata133_get_base(drive), clk, idx;
  263. pci_read_config_dword(dev, drive_pci, &regdw);
  264. regdw |= 0x04;
  265. regdw &= 0xfffff00f;
  266. /* check if ATA133 enable */
  267. clk = (regdw & 0x08) ? ATA_133 : ATA_100;
  268. idx = mode - XFER_UDMA_0;
  269. regdw |= cycle_time_value[clk][idx] << 4;
  270. regdw |= cvs_time_value[clk][idx] << 8;
  271. pci_write_config_dword(dev, drive_pci, regdw);
  272. }
  273. static void sis_ata33_program_udma_timings(ide_drive_t *drive, const u8 mode)
  274. {
  275. struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
  276. u8 drive_pci = 0x40 + drive->dn * 2, reg = 0, i = chipset_family;
  277. pci_read_config_byte(dev, drive_pci + 1, &reg);
  278. /* force the UDMA bit on if we want to use UDMA */
  279. reg |= 0x80;
  280. /* clean reg cycle time bits */
  281. reg &= ~((0xff >> (8 - cycle_time_range[i])) << cycle_time_offset[i]);
  282. /* set reg cycle time bits */
  283. reg |= cycle_time_value[i][mode - XFER_UDMA_0] << cycle_time_offset[i];
  284. pci_write_config_byte(dev, drive_pci + 1, reg);
  285. }
  286. static void sis_program_udma_timings(ide_drive_t *drive, const u8 mode)
  287. {
  288. if (chipset_family >= ATA_133) /* ATA_133 */
  289. sis_ata133_program_udma_timings(drive, mode);
  290. else /* ATA_33/66/100a/100/133a */
  291. sis_ata33_program_udma_timings(drive, mode);
  292. }
  293. static void sis_set_dma_mode(ide_hwif_t *hwif, ide_drive_t *drive)
  294. {
  295. const u8 speed = drive->dma_mode;
  296. if (speed >= XFER_UDMA_0)
  297. sis_program_udma_timings(drive, speed);
  298. else
  299. sis_program_timings(drive, speed);
  300. }
  301. static u8 sis_ata133_udma_filter(ide_drive_t *drive)
  302. {
  303. struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
  304. u32 regdw = 0;
  305. u8 drive_pci = sis_ata133_get_base(drive);
  306. pci_read_config_dword(dev, drive_pci, &regdw);
  307. /* if ATA133 disable, we should not set speed above UDMA5 */
  308. return (regdw & 0x08) ? ATA_UDMA6 : ATA_UDMA5;
  309. }
  310. static int sis_find_family(struct pci_dev *dev)
  311. {
  312. struct pci_dev *host;
  313. int i = 0;
  314. chipset_family = 0;
  315. for (i = 0; i < ARRAY_SIZE(SiSHostChipInfo) && !chipset_family; i++) {
  316. host = pci_get_device(PCI_VENDOR_ID_SI, SiSHostChipInfo[i].host_id, NULL);
  317. if (!host)
  318. continue;
  319. chipset_family = SiSHostChipInfo[i].chipset_family;
  320. /* Special case for SiS630 : 630S/ET is ATA_100a */
  321. if (SiSHostChipInfo[i].host_id == PCI_DEVICE_ID_SI_630) {
  322. if (host->revision >= 0x30)
  323. chipset_family = ATA_100a;
  324. }
  325. pci_dev_put(host);
  326. printk(KERN_INFO DRV_NAME " %s: %s %s controller\n",
  327. pci_name(dev), SiSHostChipInfo[i].name,
  328. chipset_capability[chipset_family]);
  329. }
  330. if (!chipset_family) { /* Belongs to pci-quirks */
  331. u32 idemisc;
  332. u16 trueid;
  333. /* Disable ID masking and register remapping */
  334. pci_read_config_dword(dev, 0x54, &idemisc);
  335. pci_write_config_dword(dev, 0x54, (idemisc & 0x7fffffff));
  336. pci_read_config_word(dev, PCI_DEVICE_ID, &trueid);
  337. pci_write_config_dword(dev, 0x54, idemisc);
  338. if (trueid == 0x5518) {
  339. printk(KERN_INFO DRV_NAME " %s: SiS 962/963 MuTIOL IDE UDMA133 controller\n",
  340. pci_name(dev));
  341. chipset_family = ATA_133;
  342. /* Check for 5513 compatibility mapping
  343. * We must use this, else the port enabled code will fail,
  344. * as it expects the enablebits at 0x4a.
  345. */
  346. if ((idemisc & 0x40000000) == 0) {
  347. pci_write_config_dword(dev, 0x54, idemisc | 0x40000000);
  348. printk(KERN_INFO DRV_NAME " %s: Switching to 5513 register mapping\n",
  349. pci_name(dev));
  350. }
  351. }
  352. }
  353. if (!chipset_family) { /* Belongs to pci-quirks */
  354. struct pci_dev *lpc_bridge;
  355. u16 trueid;
  356. u8 prefctl;
  357. u8 idecfg;
  358. pci_read_config_byte(dev, 0x4a, &idecfg);
  359. pci_write_config_byte(dev, 0x4a, idecfg | 0x10);
  360. pci_read_config_word(dev, PCI_DEVICE_ID, &trueid);
  361. pci_write_config_byte(dev, 0x4a, idecfg);
  362. if (trueid == 0x5517) { /* SiS 961/961B */
  363. lpc_bridge = pci_get_slot(dev->bus, 0x10); /* Bus 0, Dev 2, Fn 0 */
  364. pci_read_config_byte(dev, 0x49, &prefctl);
  365. pci_dev_put(lpc_bridge);
  366. if (lpc_bridge->revision == 0x10 && (prefctl & 0x80)) {
  367. printk(KERN_INFO DRV_NAME " %s: SiS 961B MuTIOL IDE UDMA133 controller\n",
  368. pci_name(dev));
  369. chipset_family = ATA_133a;
  370. } else {
  371. printk(KERN_INFO DRV_NAME " %s: SiS 961 MuTIOL IDE UDMA100 controller\n",
  372. pci_name(dev));
  373. chipset_family = ATA_100;
  374. }
  375. }
  376. }
  377. return chipset_family;
  378. }
  379. static int init_chipset_sis5513(struct pci_dev *dev)
  380. {
  381. /* Make general config ops here
  382. 1/ tell IDE channels to operate in Compatibility mode only
  383. 2/ tell old chips to allow per drive IDE timings */
  384. u8 reg;
  385. u16 regw;
  386. switch (chipset_family) {
  387. case ATA_133:
  388. /* SiS962 operation mode */
  389. pci_read_config_word(dev, 0x50, &regw);
  390. if (regw & 0x08)
  391. pci_write_config_word(dev, 0x50, regw&0xfff7);
  392. pci_read_config_word(dev, 0x52, &regw);
  393. if (regw & 0x08)
  394. pci_write_config_word(dev, 0x52, regw&0xfff7);
  395. break;
  396. case ATA_133a:
  397. case ATA_100:
  398. /* Fixup latency */
  399. pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x80);
  400. /* Set compatibility bit */
  401. pci_read_config_byte(dev, 0x49, &reg);
  402. if (!(reg & 0x01))
  403. pci_write_config_byte(dev, 0x49, reg|0x01);
  404. break;
  405. case ATA_100a:
  406. case ATA_66:
  407. /* Fixup latency */
  408. pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x10);
  409. /* On ATA_66 chips the bit was elsewhere */
  410. pci_read_config_byte(dev, 0x52, &reg);
  411. if (!(reg & 0x04))
  412. pci_write_config_byte(dev, 0x52, reg|0x04);
  413. break;
  414. case ATA_33:
  415. /* On ATA_33 we didn't have a single bit to set */
  416. pci_read_config_byte(dev, 0x09, &reg);
  417. if ((reg & 0x0f) != 0x00)
  418. pci_write_config_byte(dev, 0x09, reg&0xf0);
  419. case ATA_16:
  420. /* force per drive recovery and active timings
  421. needed on ATA_33 and below chips */
  422. pci_read_config_byte(dev, 0x52, &reg);
  423. if (!(reg & 0x08))
  424. pci_write_config_byte(dev, 0x52, reg|0x08);
  425. break;
  426. }
  427. return 0;
  428. }
  429. struct sis_laptop {
  430. u16 device;
  431. u16 subvendor;
  432. u16 subdevice;
  433. };
  434. static const struct sis_laptop sis_laptop[] = {
  435. /* devid, subvendor, subdev */
  436. { 0x5513, 0x1043, 0x1107 }, /* ASUS A6K */
  437. { 0x5513, 0x1734, 0x105f }, /* FSC Amilo A1630 */
  438. { 0x5513, 0x1071, 0x8640 }, /* EasyNote K5305 */
  439. /* end marker */
  440. { 0, }
  441. };
  442. static u8 sis_cable_detect(ide_hwif_t *hwif)
  443. {
  444. struct pci_dev *pdev = to_pci_dev(hwif->dev);
  445. const struct sis_laptop *lap = &sis_laptop[0];
  446. u8 ata66 = 0;
  447. while (lap->device) {
  448. if (lap->device == pdev->device &&
  449. lap->subvendor == pdev->subsystem_vendor &&
  450. lap->subdevice == pdev->subsystem_device)
  451. return ATA_CBL_PATA40_SHORT;
  452. lap++;
  453. }
  454. if (chipset_family >= ATA_133) {
  455. u16 regw = 0;
  456. u16 reg_addr = hwif->channel ? 0x52: 0x50;
  457. pci_read_config_word(pdev, reg_addr, &regw);
  458. ata66 = (regw & 0x8000) ? 0 : 1;
  459. } else if (chipset_family >= ATA_66) {
  460. u8 reg48h = 0;
  461. u8 mask = hwif->channel ? 0x20 : 0x10;
  462. pci_read_config_byte(pdev, 0x48, &reg48h);
  463. ata66 = (reg48h & mask) ? 0 : 1;
  464. }
  465. return ata66 ? ATA_CBL_PATA80 : ATA_CBL_PATA40;
  466. }
  467. static const struct ide_port_ops sis_port_ops = {
  468. .set_pio_mode = sis_set_pio_mode,
  469. .set_dma_mode = sis_set_dma_mode,
  470. .cable_detect = sis_cable_detect,
  471. };
  472. static const struct ide_port_ops sis_ata133_port_ops = {
  473. .set_pio_mode = sis_set_pio_mode,
  474. .set_dma_mode = sis_set_dma_mode,
  475. .udma_filter = sis_ata133_udma_filter,
  476. .cable_detect = sis_cable_detect,
  477. };
  478. static const struct ide_port_info sis5513_chipset = {
  479. .name = DRV_NAME,
  480. .init_chipset = init_chipset_sis5513,
  481. .enablebits = { {0x4a, 0x02, 0x02}, {0x4a, 0x04, 0x04} },
  482. .host_flags = IDE_HFLAG_NO_AUTODMA,
  483. .pio_mask = ATA_PIO4,
  484. .mwdma_mask = ATA_MWDMA2,
  485. };
  486. static int sis5513_init_one(struct pci_dev *dev, const struct pci_device_id *id)
  487. {
  488. struct ide_port_info d = sis5513_chipset;
  489. u8 udma_rates[] = { 0x00, 0x00, 0x07, 0x1f, 0x3f, 0x3f, 0x7f, 0x7f };
  490. int rc;
  491. rc = pci_enable_device(dev);
  492. if (rc)
  493. return rc;
  494. if (sis_find_family(dev) == 0)
  495. return -ENOTSUPP;
  496. if (chipset_family >= ATA_133)
  497. d.port_ops = &sis_ata133_port_ops;
  498. else
  499. d.port_ops = &sis_port_ops;
  500. d.udma_mask = udma_rates[chipset_family];
  501. return ide_pci_init_one(dev, &d, NULL);
  502. }
  503. static void sis5513_remove(struct pci_dev *dev)
  504. {
  505. ide_pci_remove(dev);
  506. pci_disable_device(dev);
  507. }
  508. static const struct pci_device_id sis5513_pci_tbl[] = {
  509. { PCI_VDEVICE(SI, PCI_DEVICE_ID_SI_5513), 0 },
  510. { PCI_VDEVICE(SI, PCI_DEVICE_ID_SI_5518), 0 },
  511. { PCI_VDEVICE(SI, PCI_DEVICE_ID_SI_1180), 0 },
  512. { 0, },
  513. };
  514. MODULE_DEVICE_TABLE(pci, sis5513_pci_tbl);
  515. static struct pci_driver sis5513_pci_driver = {
  516. .name = "SIS_IDE",
  517. .id_table = sis5513_pci_tbl,
  518. .probe = sis5513_init_one,
  519. .remove = sis5513_remove,
  520. .suspend = ide_pci_suspend,
  521. .resume = ide_pci_resume,
  522. };
  523. static int __init sis5513_ide_init(void)
  524. {
  525. return ide_pci_register_driver(&sis5513_pci_driver);
  526. }
  527. static void __exit sis5513_ide_exit(void)
  528. {
  529. pci_unregister_driver(&sis5513_pci_driver);
  530. }
  531. module_init(sis5513_ide_init);
  532. module_exit(sis5513_ide_exit);
  533. MODULE_AUTHOR("Lionel Bouton, L C Chang, Andre Hedrick, Vojtech Pavlik");
  534. MODULE_DESCRIPTION("PCI driver module for SIS IDE");
  535. MODULE_LICENSE("GPL");