Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Libata driver for the highpoint 37x and 30x UDMA66 ATA controllers.
4 *
5 * This driver is heavily based upon:
6 *
7 * linux/drivers/ide/pci/hpt366.c Version 0.36 April 25, 2003
8 *
9 * Copyright (C) 1999-2003 Andre Hedrick <andre@linux-ide.org>
10 * Portions Copyright (C) 2001 Sun Microsystems, Inc.
11 * Portions Copyright (C) 2003 Red Hat Inc
12 * Portions Copyright (C) 2005-2010 MontaVista Software, Inc.
13 *
14 * TODO
15 * Look into engine reset on timeout errors. Should not be required.
16 */
17#include <linux/kernel.h>
18#include <linux/module.h>
19#include <linux/pci.h>
20#include <linux/blkdev.h>
21#include <linux/delay.h>
22#include <scsi/scsi_host.h>
23#include <linux/libata.h>
24
25#define DRV_NAME "pata_hpt37x"
26#define DRV_VERSION "0.6.30"
27
28struct hpt_clock {
29 u8 xfer_speed;
30 u32 timing;
31};
32
33struct hpt_chip {
34 const char *name;
35 unsigned int base;
36 struct hpt_clock const *clocks[4];
37};
38
39/* key for bus clock timings
40 * bit
41 * 0:3 data_high_time. Inactive time of DIOW_/DIOR_ for PIO and MW DMA.
42 * cycles = value + 1
43 * 4:8 data_low_time. Active time of DIOW_/DIOR_ for PIO and MW DMA.
44 * cycles = value + 1
45 * 9:12 cmd_high_time. Inactive time of DIOW_/DIOR_ during task file
46 * register access.
47 * 13:17 cmd_low_time. Active time of DIOW_/DIOR_ during task file
48 * register access.
49 * 18:20 udma_cycle_time. Clock cycles for UDMA xfer.
50 * 21 CLK frequency for UDMA: 0=ATA clock, 1=dual ATA clock.
51 * 22:24 pre_high_time. Time to initialize 1st cycle for PIO and MW DMA xfer.
52 * 25:27 cmd_pre_high_time. Time to initialize 1st PIO cycle for task file
53 * register access.
54 * 28 UDMA enable.
55 * 29 DMA enable.
56 * 30 PIO_MST enable. If set, the chip is in bus master mode during
57 * PIO xfer.
58 * 31 FIFO enable. Only for PIO.
59 */
60
61static struct hpt_clock hpt37x_timings_33[] = {
62 { XFER_UDMA_6, 0x12446231 }, /* 0x12646231 ?? */
63 { XFER_UDMA_5, 0x12446231 },
64 { XFER_UDMA_4, 0x12446231 },
65 { XFER_UDMA_3, 0x126c6231 },
66 { XFER_UDMA_2, 0x12486231 },
67 { XFER_UDMA_1, 0x124c6233 },
68 { XFER_UDMA_0, 0x12506297 },
69
70 { XFER_MW_DMA_2, 0x22406c31 },
71 { XFER_MW_DMA_1, 0x22406c33 },
72 { XFER_MW_DMA_0, 0x22406c97 },
73
74 { XFER_PIO_4, 0x06414e31 },
75 { XFER_PIO_3, 0x06414e42 },
76 { XFER_PIO_2, 0x06414e53 },
77 { XFER_PIO_1, 0x06814e93 },
78 { XFER_PIO_0, 0x06814ea7 }
79};
80
81static struct hpt_clock hpt37x_timings_50[] = {
82 { XFER_UDMA_6, 0x12848242 },
83 { XFER_UDMA_5, 0x12848242 },
84 { XFER_UDMA_4, 0x12ac8242 },
85 { XFER_UDMA_3, 0x128c8242 },
86 { XFER_UDMA_2, 0x120c8242 },
87 { XFER_UDMA_1, 0x12148254 },
88 { XFER_UDMA_0, 0x121882ea },
89
90 { XFER_MW_DMA_2, 0x22808242 },
91 { XFER_MW_DMA_1, 0x22808254 },
92 { XFER_MW_DMA_0, 0x228082ea },
93
94 { XFER_PIO_4, 0x0a81f442 },
95 { XFER_PIO_3, 0x0a81f443 },
96 { XFER_PIO_2, 0x0a81f454 },
97 { XFER_PIO_1, 0x0ac1f465 },
98 { XFER_PIO_0, 0x0ac1f48a }
99};
100
101static struct hpt_clock hpt37x_timings_66[] = {
102 { XFER_UDMA_6, 0x1c869c62 },
103 { XFER_UDMA_5, 0x1cae9c62 }, /* 0x1c8a9c62 */
104 { XFER_UDMA_4, 0x1c8a9c62 },
105 { XFER_UDMA_3, 0x1c8e9c62 },
106 { XFER_UDMA_2, 0x1c929c62 },
107 { XFER_UDMA_1, 0x1c9a9c62 },
108 { XFER_UDMA_0, 0x1c829c62 },
109
110 { XFER_MW_DMA_2, 0x2c829c62 },
111 { XFER_MW_DMA_1, 0x2c829c66 },
112 { XFER_MW_DMA_0, 0x2c829d2e },
113
114 { XFER_PIO_4, 0x0c829c62 },
115 { XFER_PIO_3, 0x0c829c84 },
116 { XFER_PIO_2, 0x0c829ca6 },
117 { XFER_PIO_1, 0x0d029d26 },
118 { XFER_PIO_0, 0x0d029d5e }
119};
120
121
122static const struct hpt_chip hpt370 = {
123 "HPT370",
124 48,
125 {
126 hpt37x_timings_33,
127 NULL,
128 NULL,
129 NULL
130 }
131};
132
133static const struct hpt_chip hpt370a = {
134 "HPT370A",
135 48,
136 {
137 hpt37x_timings_33,
138 NULL,
139 hpt37x_timings_50,
140 NULL
141 }
142};
143
144static const struct hpt_chip hpt372 = {
145 "HPT372",
146 55,
147 {
148 hpt37x_timings_33,
149 NULL,
150 hpt37x_timings_50,
151 hpt37x_timings_66
152 }
153};
154
155static const struct hpt_chip hpt302 = {
156 "HPT302",
157 66,
158 {
159 hpt37x_timings_33,
160 NULL,
161 hpt37x_timings_50,
162 hpt37x_timings_66
163 }
164};
165
166static const struct hpt_chip hpt371 = {
167 "HPT371",
168 66,
169 {
170 hpt37x_timings_33,
171 NULL,
172 hpt37x_timings_50,
173 hpt37x_timings_66
174 }
175};
176
177static const struct hpt_chip hpt372a = {
178 "HPT372A",
179 66,
180 {
181 hpt37x_timings_33,
182 NULL,
183 hpt37x_timings_50,
184 hpt37x_timings_66
185 }
186};
187
188static const struct hpt_chip hpt374 = {
189 "HPT374",
190 48,
191 {
192 hpt37x_timings_33,
193 NULL,
194 NULL,
195 NULL
196 }
197};
198
199/**
200 * hpt37x_find_mode - reset the hpt37x bus
201 * @ap: ATA port
202 * @speed: transfer mode
203 *
204 * Return the 32bit register programming information for this channel
205 * that matches the speed provided.
206 */
207
208static u32 hpt37x_find_mode(struct ata_port *ap, int speed)
209{
210 struct hpt_clock *clocks = ap->host->private_data;
211
212 while (clocks->xfer_speed) {
213 if (clocks->xfer_speed == speed)
214 return clocks->timing;
215 clocks++;
216 }
217 BUG();
218 return 0xffffffffU; /* silence compiler warning */
219}
220
221static int hpt_dma_blacklisted(const struct ata_device *dev, char *modestr,
222 const char * const list[])
223{
224 unsigned char model_num[ATA_ID_PROD_LEN + 1];
225 int i;
226
227 ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
228
229 i = match_string(list, -1, model_num);
230 if (i >= 0) {
231 ata_dev_warn(dev, "%s is not supported for %s\n",
232 modestr, list[i]);
233 return 1;
234 }
235 return 0;
236}
237
238static const char * const bad_ata33[] = {
239 "Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3",
240 "Maxtor 90845U3", "Maxtor 90650U2",
241 "Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5",
242 "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
243 "Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6",
244 "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
245 "Maxtor 90510D4",
246 "Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
247 "Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7",
248 "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
249 "Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5",
250 "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
251 NULL
252};
253
254static const char * const bad_ata100_5[] = {
255 "IBM-DTLA-307075",
256 "IBM-DTLA-307060",
257 "IBM-DTLA-307045",
258 "IBM-DTLA-307030",
259 "IBM-DTLA-307020",
260 "IBM-DTLA-307015",
261 "IBM-DTLA-305040",
262 "IBM-DTLA-305030",
263 "IBM-DTLA-305020",
264 "IC35L010AVER07-0",
265 "IC35L020AVER07-0",
266 "IC35L030AVER07-0",
267 "IC35L040AVER07-0",
268 "IC35L060AVER07-0",
269 "WDC AC310200R",
270 NULL
271};
272
273/**
274 * hpt370_filter - mode selection filter
275 * @adev: ATA device
276 * @mask: mode mask
277 *
278 * Block UDMA on devices that cause trouble with this controller.
279 */
280
281static unsigned int hpt370_filter(struct ata_device *adev, unsigned int mask)
282{
283 if (adev->class == ATA_DEV_ATA) {
284 if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33))
285 mask &= ~ATA_MASK_UDMA;
286 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
287 mask &= ~(0xE0 << ATA_SHIFT_UDMA);
288 }
289 return mask;
290}
291
292/**
293 * hpt370a_filter - mode selection filter
294 * @adev: ATA device
295 * @mask: mode mask
296 *
297 * Block UDMA on devices that cause trouble with this controller.
298 */
299
300static unsigned int hpt370a_filter(struct ata_device *adev, unsigned int mask)
301{
302 if (adev->class == ATA_DEV_ATA) {
303 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
304 mask &= ~(0xE0 << ATA_SHIFT_UDMA);
305 }
306 return mask;
307}
308
309/**
310 * hpt372_filter - mode selection filter
311 * @adev: ATA device
312 * @mask: mode mask
313 *
314 * The Marvell bridge chips used on the HighPoint SATA cards do not seem
315 * to support the UltraDMA modes 1, 2, and 3 as well as any MWDMA modes...
316 */
317static unsigned int hpt372_filter(struct ata_device *adev, unsigned int mask)
318{
319 if (ata_id_is_sata(adev->id))
320 mask &= ~((0xE << ATA_SHIFT_UDMA) | ATA_MASK_MWDMA);
321
322 return mask;
323}
324
325/**
326 * hpt37x_cable_detect - Detect the cable type
327 * @ap: ATA port to detect on
328 *
329 * Return the cable type attached to this port
330 */
331
332static int hpt37x_cable_detect(struct ata_port *ap)
333{
334 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
335 u8 scr2, ata66;
336
337 pci_read_config_byte(pdev, 0x5B, &scr2);
338 pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
339
340 udelay(10); /* debounce */
341
342 /* Cable register now active */
343 pci_read_config_byte(pdev, 0x5A, &ata66);
344 /* Restore state */
345 pci_write_config_byte(pdev, 0x5B, scr2);
346
347 if (ata66 & (2 >> ap->port_no))
348 return ATA_CBL_PATA40;
349 else
350 return ATA_CBL_PATA80;
351}
352
353/**
354 * hpt374_fn1_cable_detect - Detect the cable type
355 * @ap: ATA port to detect on
356 *
357 * Return the cable type attached to this port
358 */
359
360static int hpt374_fn1_cable_detect(struct ata_port *ap)
361{
362 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
363 unsigned int mcrbase = 0x50 + 4 * ap->port_no;
364 u16 mcr3;
365 u8 ata66;
366
367 /* Do the extra channel work */
368 pci_read_config_word(pdev, mcrbase + 2, &mcr3);
369 /* Set bit 15 of 0x52 to enable TCBLID as input */
370 pci_write_config_word(pdev, mcrbase + 2, mcr3 | 0x8000);
371 pci_read_config_byte(pdev, 0x5A, &ata66);
372 /* Reset TCBLID/FCBLID to output */
373 pci_write_config_word(pdev, mcrbase + 2, mcr3);
374
375 if (ata66 & (2 >> ap->port_no))
376 return ATA_CBL_PATA40;
377 else
378 return ATA_CBL_PATA80;
379}
380
381/**
382 * hpt37x_pre_reset - reset the hpt37x bus
383 * @link: ATA link to reset
384 * @deadline: deadline jiffies for the operation
385 *
386 * Perform the initial reset handling for the HPT37x.
387 */
388
389static int hpt37x_pre_reset(struct ata_link *link, unsigned long deadline)
390{
391 struct ata_port *ap = link->ap;
392 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
393 static const struct pci_bits hpt37x_enable_bits[] = {
394 { 0x50, 1, 0x04, 0x04 },
395 { 0x54, 1, 0x04, 0x04 }
396 };
397 u8 mcr2;
398
399 if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
400 return -ENOENT;
401
402 /* Reset the state machine */
403 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
404 udelay(100);
405
406 /*
407 * Disable the "fast interrupt" prediction. Don't hold off
408 * on interrupts. (== 0x01 despite what the docs say)
409 */
410 pci_read_config_byte(pdev, 0x51 + 4 * ap->port_no, &mcr2);
411 /* Is it HPT370/A? */
412 if (pdev->device == PCI_DEVICE_ID_TTI_HPT366 && pdev->revision < 5) {
413 mcr2 &= ~0x02;
414 mcr2 |= 0x01;
415 } else {
416 mcr2 &= ~0x07;
417 }
418 pci_write_config_byte(pdev, 0x51 + 4 * ap->port_no, mcr2);
419
420 return ata_sff_prereset(link, deadline);
421}
422
423static void hpt37x_set_mode(struct ata_port *ap, struct ata_device *adev,
424 u8 mode)
425{
426 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
427 int addr = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
428 u32 reg, timing, mask;
429
430 /* Determine timing mask and find matching mode entry */
431 if (mode < XFER_MW_DMA_0)
432 mask = 0xcfc3ffff;
433 else if (mode < XFER_UDMA_0)
434 mask = 0x31c001ff;
435 else
436 mask = 0x303c0000;
437
438 timing = hpt37x_find_mode(ap, mode);
439
440 pci_read_config_dword(pdev, addr, ®);
441 reg = (reg & ~mask) | (timing & mask);
442 pci_write_config_dword(pdev, addr, reg);
443}
444/**
445 * hpt37x_set_piomode - PIO setup
446 * @ap: ATA interface
447 * @adev: device on the interface
448 *
449 * Perform PIO mode setup.
450 */
451
452static void hpt37x_set_piomode(struct ata_port *ap, struct ata_device *adev)
453{
454 hpt37x_set_mode(ap, adev, adev->pio_mode);
455}
456
457/**
458 * hpt37x_set_dmamode - DMA timing setup
459 * @ap: ATA interface
460 * @adev: Device being configured
461 *
462 * Set up the channel for MWDMA or UDMA modes.
463 */
464
465static void hpt37x_set_dmamode(struct ata_port *ap, struct ata_device *adev)
466{
467 hpt37x_set_mode(ap, adev, adev->dma_mode);
468}
469
470/**
471 * hpt370_bmdma_stop - DMA engine stop
472 * @qc: ATA command
473 *
474 * Work around the HPT370 DMA engine.
475 */
476
477static void hpt370_bmdma_stop(struct ata_queued_cmd *qc)
478{
479 struct ata_port *ap = qc->ap;
480 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
481 void __iomem *bmdma = ap->ioaddr.bmdma_addr;
482 u8 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
483 u8 dma_cmd;
484
485 if (dma_stat & ATA_DMA_ACTIVE) {
486 udelay(20);
487 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
488 }
489 if (dma_stat & ATA_DMA_ACTIVE) {
490 /* Clear the engine */
491 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
492 udelay(10);
493 /* Stop DMA */
494 dma_cmd = ioread8(bmdma + ATA_DMA_CMD);
495 iowrite8(dma_cmd & ~ATA_DMA_START, bmdma + ATA_DMA_CMD);
496 /* Clear Error */
497 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
498 iowrite8(dma_stat | ATA_DMA_INTR | ATA_DMA_ERR,
499 bmdma + ATA_DMA_STATUS);
500 /* Clear the engine */
501 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
502 udelay(10);
503 }
504 ata_bmdma_stop(qc);
505}
506
507/**
508 * hpt37x_bmdma_stop - DMA engine stop
509 * @qc: ATA command
510 *
511 * Clean up after the HPT372 and later DMA engine
512 */
513
514static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
515{
516 struct ata_port *ap = qc->ap;
517 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
518 int mscreg = 0x50 + 4 * ap->port_no;
519 u8 bwsr_stat, msc_stat;
520
521 pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
522 pci_read_config_byte(pdev, mscreg, &msc_stat);
523 if (bwsr_stat & (1 << ap->port_no))
524 pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
525 ata_bmdma_stop(qc);
526}
527
528
529static const struct scsi_host_template hpt37x_sht = {
530 ATA_BMDMA_SHT(DRV_NAME),
531};
532
533/*
534 * Configuration for HPT370
535 */
536
537static struct ata_port_operations hpt370_port_ops = {
538 .inherits = &ata_bmdma_port_ops,
539
540 .bmdma_stop = hpt370_bmdma_stop,
541
542 .mode_filter = hpt370_filter,
543 .cable_detect = hpt37x_cable_detect,
544 .set_piomode = hpt37x_set_piomode,
545 .set_dmamode = hpt37x_set_dmamode,
546 .prereset = hpt37x_pre_reset,
547};
548
549/*
550 * Configuration for HPT370A. Close to 370 but less filters
551 */
552
553static struct ata_port_operations hpt370a_port_ops = {
554 .inherits = &hpt370_port_ops,
555 .mode_filter = hpt370a_filter,
556};
557
558/*
559 * Configuration for HPT371 and HPT302.
560 */
561
562static struct ata_port_operations hpt302_port_ops = {
563 .inherits = &ata_bmdma_port_ops,
564
565 .bmdma_stop = hpt37x_bmdma_stop,
566
567 .cable_detect = hpt37x_cable_detect,
568 .set_piomode = hpt37x_set_piomode,
569 .set_dmamode = hpt37x_set_dmamode,
570 .prereset = hpt37x_pre_reset,
571};
572
573/*
574 * Configuration for HPT372. Mode setting works like 371 and 302
575 * but we have a mode filter.
576 */
577
578static struct ata_port_operations hpt372_port_ops = {
579 .inherits = &hpt302_port_ops,
580 .mode_filter = hpt372_filter,
581};
582
583/*
584 * Configuration for HPT374. Mode setting and filtering works like 372
585 * but we have a different cable detection procedure for function 1.
586 */
587
588static struct ata_port_operations hpt374_fn1_port_ops = {
589 .inherits = &hpt372_port_ops,
590 .cable_detect = hpt374_fn1_cable_detect,
591};
592
593/**
594 * hpt37x_clock_slot - Turn timing to PC clock entry
595 * @freq: Reported frequency in MHz
596 *
597 * Turn the timing data into a clock slot (0 for 33, 1 for 40, 2 for 50
598 * and 3 for 66Mhz)
599 */
600
601static int hpt37x_clock_slot(unsigned int freq)
602{
603 if (freq < 40)
604 return 0; /* 33Mhz slot */
605 if (freq < 45)
606 return 1; /* 40Mhz slot */
607 if (freq < 55)
608 return 2; /* 50Mhz slot */
609 return 3; /* 60Mhz slot */
610}
611
612/**
613 * hpt37x_calibrate_dpll - Calibrate the DPLL loop
614 * @dev: PCI device
615 *
616 * Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
617 * succeeds
618 */
619
620static int hpt37x_calibrate_dpll(struct pci_dev *dev)
621{
622 u8 reg5b;
623 u32 reg5c;
624 int tries;
625
626 for (tries = 0; tries < 0x5000; tries++) {
627 udelay(50);
628 pci_read_config_byte(dev, 0x5b, ®5b);
629 if (reg5b & 0x80) {
630 /* See if it stays set */
631 for (tries = 0; tries < 0x1000; tries++) {
632 pci_read_config_byte(dev, 0x5b, ®5b);
633 /* Failed ? */
634 if ((reg5b & 0x80) == 0)
635 return 0;
636 }
637 /* Turn off tuning, we have the DPLL set */
638 pci_read_config_dword(dev, 0x5c, ®5c);
639 pci_write_config_dword(dev, 0x5c, reg5c & ~0x100);
640 return 1;
641 }
642 }
643 /* Never went stable */
644 return 0;
645}
646
647static int hpt37x_pci_clock(struct pci_dev *pdev, unsigned int base)
648{
649 unsigned int freq;
650 u32 fcnt;
651
652 /*
653 * Some devices do not let this value be accessed via PCI space
654 * according to the old driver. In addition we must use the value
655 * from FN 0 on the HPT374.
656 */
657 if (pdev->device == PCI_DEVICE_ID_TTI_HPT374 &&
658 (PCI_FUNC(pdev->devfn) & 1)) {
659 struct pci_dev *pdev_fn0;
660
661 pdev_fn0 = pci_get_slot(pdev->bus, pdev->devfn - 1);
662 /* Someone hot plugged the controller on us? */
663 if (!pdev_fn0)
664 return 0;
665 fcnt = inl(pci_resource_start(pdev_fn0, 4) + 0x90);
666 pci_dev_put(pdev_fn0);
667 } else {
668 fcnt = inl(pci_resource_start(pdev, 4) + 0x90);
669 }
670
671 if ((fcnt >> 12) != 0xABCDE) {
672 u32 total = 0;
673 int i;
674 u16 sr;
675
676 dev_warn(&pdev->dev, "BIOS clock data not set\n");
677
678 /* This is the process the HPT371 BIOS is reported to use */
679 for (i = 0; i < 128; i++) {
680 pci_read_config_word(pdev, 0x78, &sr);
681 total += sr & 0x1FF;
682 udelay(15);
683 }
684 fcnt = total / 128;
685 }
686 fcnt &= 0x1FF;
687
688 freq = (fcnt * base) / 192; /* in MHz */
689
690 /* Clamp to bands */
691 if (freq < 40)
692 return 33;
693 if (freq < 45)
694 return 40;
695 if (freq < 55)
696 return 50;
697 return 66;
698}
699
700/**
701 * hpt37x_init_one - Initialise an HPT37X/302
702 * @dev: PCI device
703 * @id: Entry in match table
704 *
705 * Initialise an HPT37x device. There are some interesting complications
706 * here. Firstly the chip may report 366 and be one of several variants.
707 * Secondly all the timings depend on the clock for the chip which we must
708 * detect and look up
709 *
710 * This is the known chip mappings. It may be missing a couple of later
711 * releases.
712 *
713 * Chip version PCI Rev Notes
714 * HPT366 4 (HPT366) 0 Other driver
715 * HPT366 4 (HPT366) 1 Other driver
716 * HPT368 4 (HPT366) 2 Other driver
717 * HPT370 4 (HPT366) 3 UDMA100
718 * HPT370A 4 (HPT366) 4 UDMA100
719 * HPT372 4 (HPT366) 5 UDMA133 (1)
720 * HPT372N 4 (HPT366) 6 Other driver
721 * HPT372A 5 (HPT372) 1 UDMA133 (1)
722 * HPT372N 5 (HPT372) 2 Other driver
723 * HPT302 6 (HPT302) 1 UDMA133
724 * HPT302N 6 (HPT302) 2 Other driver
725 * HPT371 7 (HPT371) * UDMA133
726 * HPT374 8 (HPT374) * UDMA133 4 channel
727 * HPT372N 9 (HPT372N) * Other driver
728 *
729 * (1) UDMA133 support depends on the bus clock
730 */
731
732static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
733{
734 /* HPT370 - UDMA100 */
735 static const struct ata_port_info info_hpt370 = {
736 .flags = ATA_FLAG_SLAVE_POSS,
737 .pio_mask = ATA_PIO4,
738 .mwdma_mask = ATA_MWDMA2,
739 .udma_mask = ATA_UDMA5,
740 .port_ops = &hpt370_port_ops
741 };
742 /* HPT370A - UDMA100 */
743 static const struct ata_port_info info_hpt370a = {
744 .flags = ATA_FLAG_SLAVE_POSS,
745 .pio_mask = ATA_PIO4,
746 .mwdma_mask = ATA_MWDMA2,
747 .udma_mask = ATA_UDMA5,
748 .port_ops = &hpt370a_port_ops
749 };
750 /* HPT370 - UDMA66 */
751 static const struct ata_port_info info_hpt370_33 = {
752 .flags = ATA_FLAG_SLAVE_POSS,
753 .pio_mask = ATA_PIO4,
754 .mwdma_mask = ATA_MWDMA2,
755 .udma_mask = ATA_UDMA4,
756 .port_ops = &hpt370_port_ops
757 };
758 /* HPT370A - UDMA66 */
759 static const struct ata_port_info info_hpt370a_33 = {
760 .flags = ATA_FLAG_SLAVE_POSS,
761 .pio_mask = ATA_PIO4,
762 .mwdma_mask = ATA_MWDMA2,
763 .udma_mask = ATA_UDMA4,
764 .port_ops = &hpt370a_port_ops
765 };
766 /* HPT372 - UDMA133 */
767 static const struct ata_port_info info_hpt372 = {
768 .flags = ATA_FLAG_SLAVE_POSS,
769 .pio_mask = ATA_PIO4,
770 .mwdma_mask = ATA_MWDMA2,
771 .udma_mask = ATA_UDMA6,
772 .port_ops = &hpt372_port_ops
773 };
774 /* HPT371, 302 - UDMA133 */
775 static const struct ata_port_info info_hpt302 = {
776 .flags = ATA_FLAG_SLAVE_POSS,
777 .pio_mask = ATA_PIO4,
778 .mwdma_mask = ATA_MWDMA2,
779 .udma_mask = ATA_UDMA6,
780 .port_ops = &hpt302_port_ops
781 };
782 /* HPT374 - UDMA100, function 1 uses different cable_detect method */
783 static const struct ata_port_info info_hpt374_fn0 = {
784 .flags = ATA_FLAG_SLAVE_POSS,
785 .pio_mask = ATA_PIO4,
786 .mwdma_mask = ATA_MWDMA2,
787 .udma_mask = ATA_UDMA5,
788 .port_ops = &hpt372_port_ops
789 };
790 static const struct ata_port_info info_hpt374_fn1 = {
791 .flags = ATA_FLAG_SLAVE_POSS,
792 .pio_mask = ATA_PIO4,
793 .mwdma_mask = ATA_MWDMA2,
794 .udma_mask = ATA_UDMA5,
795 .port_ops = &hpt374_fn1_port_ops
796 };
797
798 static const int MHz[4] = { 33, 40, 50, 66 };
799 void *private_data = NULL;
800 const struct ata_port_info *ppi[] = { NULL, NULL };
801 u8 rev = dev->revision;
802 u8 irqmask;
803 u8 mcr1;
804 unsigned int freq; /* MHz */
805 int prefer_dpll = 1;
806
807 unsigned long iobase = pci_resource_start(dev, 4);
808
809 const struct hpt_chip *chip_table;
810 int clock_slot;
811 int rc;
812
813 rc = pcim_enable_device(dev);
814 if (rc)
815 return rc;
816
817 switch (dev->device) {
818 case PCI_DEVICE_ID_TTI_HPT366:
819 /* May be a later chip in disguise. Check */
820 /* Older chips are in the HPT366 driver. Ignore them */
821 if (rev < 3)
822 return -ENODEV;
823 /* N series chips have their own driver. Ignore */
824 if (rev == 6)
825 return -ENODEV;
826
827 switch (rev) {
828 case 3:
829 ppi[0] = &info_hpt370;
830 chip_table = &hpt370;
831 prefer_dpll = 0;
832 break;
833 case 4:
834 ppi[0] = &info_hpt370a;
835 chip_table = &hpt370a;
836 prefer_dpll = 0;
837 break;
838 case 5:
839 ppi[0] = &info_hpt372;
840 chip_table = &hpt372;
841 break;
842 default:
843 dev_err(&dev->dev,
844 "Unknown HPT366 subtype, please report (%d)\n",
845 rev);
846 return -ENODEV;
847 }
848 break;
849 case PCI_DEVICE_ID_TTI_HPT372:
850 /* 372N if rev >= 2 */
851 if (rev >= 2)
852 return -ENODEV;
853 ppi[0] = &info_hpt372;
854 chip_table = &hpt372a;
855 break;
856 case PCI_DEVICE_ID_TTI_HPT302:
857 /* 302N if rev > 1 */
858 if (rev > 1)
859 return -ENODEV;
860 ppi[0] = &info_hpt302;
861 /* Check this */
862 chip_table = &hpt302;
863 break;
864 case PCI_DEVICE_ID_TTI_HPT371:
865 if (rev > 1)
866 return -ENODEV;
867 ppi[0] = &info_hpt302;
868 chip_table = &hpt371;
869 /*
870 * Single channel device, master is not present but the BIOS
871 * (or us for non x86) must mark it absent
872 */
873 pci_read_config_byte(dev, 0x50, &mcr1);
874 mcr1 &= ~0x04;
875 pci_write_config_byte(dev, 0x50, mcr1);
876 break;
877 case PCI_DEVICE_ID_TTI_HPT374:
878 chip_table = &hpt374;
879 if (!(PCI_FUNC(dev->devfn) & 1))
880 *ppi = &info_hpt374_fn0;
881 else
882 *ppi = &info_hpt374_fn1;
883 break;
884 default:
885 dev_err(&dev->dev, "PCI table is bogus, please report (%d)\n",
886 dev->device);
887 return -ENODEV;
888 }
889 /* Ok so this is a chip we support */
890
891 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
892 pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
893 pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
894 pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
895
896 pci_read_config_byte(dev, 0x5A, &irqmask);
897 irqmask &= ~0x10;
898 pci_write_config_byte(dev, 0x5a, irqmask);
899
900 /*
901 * HPT371 chips physically have only one channel, the secondary one,
902 * but the primary channel registers do exist! Go figure...
903 * So, we manually disable the non-existing channel here
904 * (if the BIOS hasn't done this already).
905 */
906 if (dev->device == PCI_DEVICE_ID_TTI_HPT371) {
907 u8 mcr1;
908
909 pci_read_config_byte(dev, 0x50, &mcr1);
910 mcr1 &= ~0x04;
911 pci_write_config_byte(dev, 0x50, mcr1);
912 }
913
914 /*
915 * default to pci clock. make sure MA15/16 are set to output
916 * to prevent drives having problems with 40-pin cables. Needed
917 * for some drives such as IBM-DTLA which will not enter ready
918 * state on reset when PDIAG is a input.
919 */
920
921 pci_write_config_byte(dev, 0x5b, 0x23);
922
923 /*
924 * HighPoint does this for HPT372A.
925 * NOTE: This register is only writeable via I/O space.
926 */
927 if (chip_table == &hpt372a)
928 outb(0x0e, iobase + 0x9c);
929
930 freq = hpt37x_pci_clock(dev, chip_table->base);
931 if (!freq)
932 return -ENODEV;
933
934 /*
935 * Turn the frequency check into a band and then find a timing
936 * table to match it.
937 */
938
939 clock_slot = hpt37x_clock_slot(freq);
940 if (chip_table->clocks[clock_slot] == NULL || prefer_dpll) {
941 /*
942 * We need to try PLL mode instead
943 *
944 * For non UDMA133 capable devices we should
945 * use a 50MHz DPLL by choice
946 */
947 unsigned int f_low, f_high;
948 int dpll, adjust;
949
950 /* Compute DPLL */
951 dpll = (ppi[0]->udma_mask & 0xC0) ? 3 : 2;
952
953 f_low = (MHz[clock_slot] * 48) / MHz[dpll];
954 f_high = f_low + 2;
955 if (clock_slot > 1)
956 f_high += 2;
957
958 /* Select the DPLL clock. */
959 pci_write_config_byte(dev, 0x5b, 0x21);
960 pci_write_config_dword(dev, 0x5C,
961 (f_high << 16) | f_low | 0x100);
962
963 for (adjust = 0; adjust < 8; adjust++) {
964 if (hpt37x_calibrate_dpll(dev))
965 break;
966 /*
967 * See if it'll settle at a fractionally
968 * different clock
969 */
970 if (adjust & 1)
971 f_low -= adjust >> 1;
972 else
973 f_high += adjust >> 1;
974 pci_write_config_dword(dev, 0x5C,
975 (f_high << 16) | f_low | 0x100);
976 }
977 if (adjust == 8) {
978 dev_err(&dev->dev, "DPLL did not stabilize!\n");
979 return -ENODEV;
980 }
981 if (dpll == 3)
982 private_data = (void *)hpt37x_timings_66;
983 else
984 private_data = (void *)hpt37x_timings_50;
985
986 dev_info(&dev->dev, "bus clock %dMHz, using %dMHz DPLL\n",
987 MHz[clock_slot], MHz[dpll]);
988 } else {
989 private_data = (void *)chip_table->clocks[clock_slot];
990 /*
991 * Perform a final fixup. Note that we will have used the
992 * DPLL on the HPT372 which means we don't have to worry
993 * about lack of UDMA133 support on lower clocks
994 */
995
996 if (clock_slot < 2 && ppi[0] == &info_hpt370)
997 ppi[0] = &info_hpt370_33;
998 if (clock_slot < 2 && ppi[0] == &info_hpt370a)
999 ppi[0] = &info_hpt370a_33;
1000
1001 dev_info(&dev->dev, "%s using %dMHz bus clock\n",
1002 chip_table->name, MHz[clock_slot]);
1003 }
1004
1005 /* Now kick off ATA set up */
1006 return ata_pci_bmdma_init_one(dev, ppi, &hpt37x_sht, private_data, 0);
1007}
1008
1009static const struct pci_device_id hpt37x[] = {
1010 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT366), },
1011 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT371), },
1012 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT372), },
1013 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT374), },
1014 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT302), },
1015
1016 { },
1017};
1018
1019static struct pci_driver hpt37x_pci_driver = {
1020 .name = DRV_NAME,
1021 .id_table = hpt37x,
1022 .probe = hpt37x_init_one,
1023 .remove = ata_pci_remove_one
1024};
1025
1026module_pci_driver(hpt37x_pci_driver);
1027
1028MODULE_AUTHOR("Alan Cox");
1029MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
1030MODULE_LICENSE("GPL");
1031MODULE_DEVICE_TABLE(pci, hpt37x);
1032MODULE_VERSION(DRV_VERSION);
1/*
2 * Libata driver for the highpoint 37x and 30x UDMA66 ATA controllers.
3 *
4 * This driver is heavily based upon:
5 *
6 * linux/drivers/ide/pci/hpt366.c Version 0.36 April 25, 2003
7 *
8 * Copyright (C) 1999-2003 Andre Hedrick <andre@linux-ide.org>
9 * Portions Copyright (C) 2001 Sun Microsystems, Inc.
10 * Portions Copyright (C) 2003 Red Hat Inc
11 * Portions Copyright (C) 2005-2010 MontaVista Software, Inc.
12 *
13 * TODO
14 * Look into engine reset on timeout errors. Should not be required.
15 */
16
17#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
18
19#include <linux/kernel.h>
20#include <linux/module.h>
21#include <linux/pci.h>
22#include <linux/init.h>
23#include <linux/blkdev.h>
24#include <linux/delay.h>
25#include <scsi/scsi_host.h>
26#include <linux/libata.h>
27
28#define DRV_NAME "pata_hpt37x"
29#define DRV_VERSION "0.6.23"
30
31struct hpt_clock {
32 u8 xfer_speed;
33 u32 timing;
34};
35
36struct hpt_chip {
37 const char *name;
38 unsigned int base;
39 struct hpt_clock const *clocks[4];
40};
41
42/* key for bus clock timings
43 * bit
44 * 0:3 data_high_time. Inactive time of DIOW_/DIOR_ for PIO and MW DMA.
45 * cycles = value + 1
46 * 4:8 data_low_time. Active time of DIOW_/DIOR_ for PIO and MW DMA.
47 * cycles = value + 1
48 * 9:12 cmd_high_time. Inactive time of DIOW_/DIOR_ during task file
49 * register access.
50 * 13:17 cmd_low_time. Active time of DIOW_/DIOR_ during task file
51 * register access.
52 * 18:20 udma_cycle_time. Clock cycles for UDMA xfer.
53 * 21 CLK frequency for UDMA: 0=ATA clock, 1=dual ATA clock.
54 * 22:24 pre_high_time. Time to initialize 1st cycle for PIO and MW DMA xfer.
55 * 25:27 cmd_pre_high_time. Time to initialize 1st PIO cycle for task file
56 * register access.
57 * 28 UDMA enable.
58 * 29 DMA enable.
59 * 30 PIO_MST enable. If set, the chip is in bus master mode during
60 * PIO xfer.
61 * 31 FIFO enable. Only for PIO.
62 */
63
64static struct hpt_clock hpt37x_timings_33[] = {
65 { XFER_UDMA_6, 0x12446231 }, /* 0x12646231 ?? */
66 { XFER_UDMA_5, 0x12446231 },
67 { XFER_UDMA_4, 0x12446231 },
68 { XFER_UDMA_3, 0x126c6231 },
69 { XFER_UDMA_2, 0x12486231 },
70 { XFER_UDMA_1, 0x124c6233 },
71 { XFER_UDMA_0, 0x12506297 },
72
73 { XFER_MW_DMA_2, 0x22406c31 },
74 { XFER_MW_DMA_1, 0x22406c33 },
75 { XFER_MW_DMA_0, 0x22406c97 },
76
77 { XFER_PIO_4, 0x06414e31 },
78 { XFER_PIO_3, 0x06414e42 },
79 { XFER_PIO_2, 0x06414e53 },
80 { XFER_PIO_1, 0x06814e93 },
81 { XFER_PIO_0, 0x06814ea7 }
82};
83
84static struct hpt_clock hpt37x_timings_50[] = {
85 { XFER_UDMA_6, 0x12848242 },
86 { XFER_UDMA_5, 0x12848242 },
87 { XFER_UDMA_4, 0x12ac8242 },
88 { XFER_UDMA_3, 0x128c8242 },
89 { XFER_UDMA_2, 0x120c8242 },
90 { XFER_UDMA_1, 0x12148254 },
91 { XFER_UDMA_0, 0x121882ea },
92
93 { XFER_MW_DMA_2, 0x22808242 },
94 { XFER_MW_DMA_1, 0x22808254 },
95 { XFER_MW_DMA_0, 0x228082ea },
96
97 { XFER_PIO_4, 0x0a81f442 },
98 { XFER_PIO_3, 0x0a81f443 },
99 { XFER_PIO_2, 0x0a81f454 },
100 { XFER_PIO_1, 0x0ac1f465 },
101 { XFER_PIO_0, 0x0ac1f48a }
102};
103
104static struct hpt_clock hpt37x_timings_66[] = {
105 { XFER_UDMA_6, 0x1c869c62 },
106 { XFER_UDMA_5, 0x1cae9c62 }, /* 0x1c8a9c62 */
107 { XFER_UDMA_4, 0x1c8a9c62 },
108 { XFER_UDMA_3, 0x1c8e9c62 },
109 { XFER_UDMA_2, 0x1c929c62 },
110 { XFER_UDMA_1, 0x1c9a9c62 },
111 { XFER_UDMA_0, 0x1c829c62 },
112
113 { XFER_MW_DMA_2, 0x2c829c62 },
114 { XFER_MW_DMA_1, 0x2c829c66 },
115 { XFER_MW_DMA_0, 0x2c829d2e },
116
117 { XFER_PIO_4, 0x0c829c62 },
118 { XFER_PIO_3, 0x0c829c84 },
119 { XFER_PIO_2, 0x0c829ca6 },
120 { XFER_PIO_1, 0x0d029d26 },
121 { XFER_PIO_0, 0x0d029d5e }
122};
123
124
125static const struct hpt_chip hpt370 = {
126 "HPT370",
127 48,
128 {
129 hpt37x_timings_33,
130 NULL,
131 NULL,
132 NULL
133 }
134};
135
136static const struct hpt_chip hpt370a = {
137 "HPT370A",
138 48,
139 {
140 hpt37x_timings_33,
141 NULL,
142 hpt37x_timings_50,
143 NULL
144 }
145};
146
147static const struct hpt_chip hpt372 = {
148 "HPT372",
149 55,
150 {
151 hpt37x_timings_33,
152 NULL,
153 hpt37x_timings_50,
154 hpt37x_timings_66
155 }
156};
157
158static const struct hpt_chip hpt302 = {
159 "HPT302",
160 66,
161 {
162 hpt37x_timings_33,
163 NULL,
164 hpt37x_timings_50,
165 hpt37x_timings_66
166 }
167};
168
169static const struct hpt_chip hpt371 = {
170 "HPT371",
171 66,
172 {
173 hpt37x_timings_33,
174 NULL,
175 hpt37x_timings_50,
176 hpt37x_timings_66
177 }
178};
179
180static const struct hpt_chip hpt372a = {
181 "HPT372A",
182 66,
183 {
184 hpt37x_timings_33,
185 NULL,
186 hpt37x_timings_50,
187 hpt37x_timings_66
188 }
189};
190
191static const struct hpt_chip hpt374 = {
192 "HPT374",
193 48,
194 {
195 hpt37x_timings_33,
196 NULL,
197 NULL,
198 NULL
199 }
200};
201
202/**
203 * hpt37x_find_mode - reset the hpt37x bus
204 * @ap: ATA port
205 * @speed: transfer mode
206 *
207 * Return the 32bit register programming information for this channel
208 * that matches the speed provided.
209 */
210
211static u32 hpt37x_find_mode(struct ata_port *ap, int speed)
212{
213 struct hpt_clock *clocks = ap->host->private_data;
214
215 while (clocks->xfer_speed) {
216 if (clocks->xfer_speed == speed)
217 return clocks->timing;
218 clocks++;
219 }
220 BUG();
221 return 0xffffffffU; /* silence compiler warning */
222}
223
224static int hpt_dma_blacklisted(const struct ata_device *dev, char *modestr,
225 const char * const list[])
226{
227 unsigned char model_num[ATA_ID_PROD_LEN + 1];
228 int i = 0;
229
230 ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
231
232 while (list[i] != NULL) {
233 if (!strcmp(list[i], model_num)) {
234 pr_warn("%s is not supported for %s\n",
235 modestr, list[i]);
236 return 1;
237 }
238 i++;
239 }
240 return 0;
241}
242
243static const char * const bad_ata33[] = {
244 "Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3",
245 "Maxtor 90845U3", "Maxtor 90650U2",
246 "Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5",
247 "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
248 "Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6",
249 "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
250 "Maxtor 90510D4",
251 "Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
252 "Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7",
253 "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
254 "Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5",
255 "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
256 NULL
257};
258
259static const char * const bad_ata100_5[] = {
260 "IBM-DTLA-307075",
261 "IBM-DTLA-307060",
262 "IBM-DTLA-307045",
263 "IBM-DTLA-307030",
264 "IBM-DTLA-307020",
265 "IBM-DTLA-307015",
266 "IBM-DTLA-305040",
267 "IBM-DTLA-305030",
268 "IBM-DTLA-305020",
269 "IC35L010AVER07-0",
270 "IC35L020AVER07-0",
271 "IC35L030AVER07-0",
272 "IC35L040AVER07-0",
273 "IC35L060AVER07-0",
274 "WDC AC310200R",
275 NULL
276};
277
278/**
279 * hpt370_filter - mode selection filter
280 * @adev: ATA device
281 *
282 * Block UDMA on devices that cause trouble with this controller.
283 */
284
285static unsigned long hpt370_filter(struct ata_device *adev, unsigned long mask)
286{
287 if (adev->class == ATA_DEV_ATA) {
288 if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33))
289 mask &= ~ATA_MASK_UDMA;
290 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
291 mask &= ~(0xE0 << ATA_SHIFT_UDMA);
292 }
293 return mask;
294}
295
296/**
297 * hpt370a_filter - mode selection filter
298 * @adev: ATA device
299 *
300 * Block UDMA on devices that cause trouble with this controller.
301 */
302
303static unsigned long hpt370a_filter(struct ata_device *adev, unsigned long mask)
304{
305 if (adev->class == ATA_DEV_ATA) {
306 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
307 mask &= ~(0xE0 << ATA_SHIFT_UDMA);
308 }
309 return mask;
310}
311
312/**
313 * hpt372_filter - mode selection filter
314 * @adev: ATA device
315 * @mask: mode mask
316 *
317 * The Marvell bridge chips used on the HighPoint SATA cards do not seem
318 * to support the UltraDMA modes 1, 2, and 3 as well as any MWDMA modes...
319 */
320static unsigned long hpt372_filter(struct ata_device *adev, unsigned long mask)
321{
322 if (ata_id_is_sata(adev->id))
323 mask &= ~((0xE << ATA_SHIFT_UDMA) | ATA_MASK_MWDMA);
324
325 return mask;
326}
327
328/**
329 * hpt37x_cable_detect - Detect the cable type
330 * @ap: ATA port to detect on
331 *
332 * Return the cable type attached to this port
333 */
334
335static int hpt37x_cable_detect(struct ata_port *ap)
336{
337 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
338 u8 scr2, ata66;
339
340 pci_read_config_byte(pdev, 0x5B, &scr2);
341 pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
342
343 udelay(10); /* debounce */
344
345 /* Cable register now active */
346 pci_read_config_byte(pdev, 0x5A, &ata66);
347 /* Restore state */
348 pci_write_config_byte(pdev, 0x5B, scr2);
349
350 if (ata66 & (2 >> ap->port_no))
351 return ATA_CBL_PATA40;
352 else
353 return ATA_CBL_PATA80;
354}
355
356/**
357 * hpt374_fn1_cable_detect - Detect the cable type
358 * @ap: ATA port to detect on
359 *
360 * Return the cable type attached to this port
361 */
362
363static int hpt374_fn1_cable_detect(struct ata_port *ap)
364{
365 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
366 unsigned int mcrbase = 0x50 + 4 * ap->port_no;
367 u16 mcr3;
368 u8 ata66;
369
370 /* Do the extra channel work */
371 pci_read_config_word(pdev, mcrbase + 2, &mcr3);
372 /* Set bit 15 of 0x52 to enable TCBLID as input */
373 pci_write_config_word(pdev, mcrbase + 2, mcr3 | 0x8000);
374 pci_read_config_byte(pdev, 0x5A, &ata66);
375 /* Reset TCBLID/FCBLID to output */
376 pci_write_config_word(pdev, mcrbase + 2, mcr3);
377
378 if (ata66 & (2 >> ap->port_no))
379 return ATA_CBL_PATA40;
380 else
381 return ATA_CBL_PATA80;
382}
383
384/**
385 * hpt37x_pre_reset - reset the hpt37x bus
386 * @link: ATA link to reset
387 * @deadline: deadline jiffies for the operation
388 *
389 * Perform the initial reset handling for the HPT37x.
390 */
391
392static int hpt37x_pre_reset(struct ata_link *link, unsigned long deadline)
393{
394 struct ata_port *ap = link->ap;
395 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
396 static const struct pci_bits hpt37x_enable_bits[] = {
397 { 0x50, 1, 0x04, 0x04 },
398 { 0x54, 1, 0x04, 0x04 }
399 };
400
401 if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
402 return -ENOENT;
403
404 /* Reset the state machine */
405 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
406 udelay(100);
407
408 return ata_sff_prereset(link, deadline);
409}
410
411static void hpt370_set_mode(struct ata_port *ap, struct ata_device *adev,
412 u8 mode)
413{
414 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
415 u32 addr1, addr2;
416 u32 reg, timing, mask;
417 u8 fast;
418
419 addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
420 addr2 = 0x51 + 4 * ap->port_no;
421
422 /* Fast interrupt prediction disable, hold off interrupt disable */
423 pci_read_config_byte(pdev, addr2, &fast);
424 fast &= ~0x02;
425 fast |= 0x01;
426 pci_write_config_byte(pdev, addr2, fast);
427
428 /* Determine timing mask and find matching mode entry */
429 if (mode < XFER_MW_DMA_0)
430 mask = 0xcfc3ffff;
431 else if (mode < XFER_UDMA_0)
432 mask = 0x31c001ff;
433 else
434 mask = 0x303c0000;
435
436 timing = hpt37x_find_mode(ap, mode);
437
438 pci_read_config_dword(pdev, addr1, ®);
439 reg = (reg & ~mask) | (timing & mask);
440 pci_write_config_dword(pdev, addr1, reg);
441}
442/**
443 * hpt370_set_piomode - PIO setup
444 * @ap: ATA interface
445 * @adev: device on the interface
446 *
447 * Perform PIO mode setup.
448 */
449
450static void hpt370_set_piomode(struct ata_port *ap, struct ata_device *adev)
451{
452 hpt370_set_mode(ap, adev, adev->pio_mode);
453}
454
455/**
456 * hpt370_set_dmamode - DMA timing setup
457 * @ap: ATA interface
458 * @adev: Device being configured
459 *
460 * Set up the channel for MWDMA or UDMA modes.
461 */
462
463static void hpt370_set_dmamode(struct ata_port *ap, struct ata_device *adev)
464{
465 hpt370_set_mode(ap, adev, adev->dma_mode);
466}
467
468/**
469 * hpt370_bmdma_end - DMA engine stop
470 * @qc: ATA command
471 *
472 * Work around the HPT370 DMA engine.
473 */
474
475static void hpt370_bmdma_stop(struct ata_queued_cmd *qc)
476{
477 struct ata_port *ap = qc->ap;
478 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
479 void __iomem *bmdma = ap->ioaddr.bmdma_addr;
480 u8 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
481 u8 dma_cmd;
482
483 if (dma_stat & ATA_DMA_ACTIVE) {
484 udelay(20);
485 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
486 }
487 if (dma_stat & ATA_DMA_ACTIVE) {
488 /* Clear the engine */
489 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
490 udelay(10);
491 /* Stop DMA */
492 dma_cmd = ioread8(bmdma + ATA_DMA_CMD);
493 iowrite8(dma_cmd & ~ATA_DMA_START, bmdma + ATA_DMA_CMD);
494 /* Clear Error */
495 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
496 iowrite8(dma_stat | ATA_DMA_INTR | ATA_DMA_ERR,
497 bmdma + ATA_DMA_STATUS);
498 /* Clear the engine */
499 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
500 udelay(10);
501 }
502 ata_bmdma_stop(qc);
503}
504
505static void hpt372_set_mode(struct ata_port *ap, struct ata_device *adev,
506 u8 mode)
507{
508 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
509 u32 addr1, addr2;
510 u32 reg, timing, mask;
511 u8 fast;
512
513 addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
514 addr2 = 0x51 + 4 * ap->port_no;
515
516 /* Fast interrupt prediction disable, hold off interrupt disable */
517 pci_read_config_byte(pdev, addr2, &fast);
518 fast &= ~0x07;
519 pci_write_config_byte(pdev, addr2, fast);
520
521 /* Determine timing mask and find matching mode entry */
522 if (mode < XFER_MW_DMA_0)
523 mask = 0xcfc3ffff;
524 else if (mode < XFER_UDMA_0)
525 mask = 0x31c001ff;
526 else
527 mask = 0x303c0000;
528
529 timing = hpt37x_find_mode(ap, mode);
530
531 pci_read_config_dword(pdev, addr1, ®);
532 reg = (reg & ~mask) | (timing & mask);
533 pci_write_config_dword(pdev, addr1, reg);
534}
535
536/**
537 * hpt372_set_piomode - PIO setup
538 * @ap: ATA interface
539 * @adev: device on the interface
540 *
541 * Perform PIO mode setup.
542 */
543
544static void hpt372_set_piomode(struct ata_port *ap, struct ata_device *adev)
545{
546 hpt372_set_mode(ap, adev, adev->pio_mode);
547}
548
549/**
550 * hpt372_set_dmamode - DMA timing setup
551 * @ap: ATA interface
552 * @adev: Device being configured
553 *
554 * Set up the channel for MWDMA or UDMA modes.
555 */
556
557static void hpt372_set_dmamode(struct ata_port *ap, struct ata_device *adev)
558{
559 hpt372_set_mode(ap, adev, adev->dma_mode);
560}
561
562/**
563 * hpt37x_bmdma_end - DMA engine stop
564 * @qc: ATA command
565 *
566 * Clean up after the HPT372 and later DMA engine
567 */
568
569static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
570{
571 struct ata_port *ap = qc->ap;
572 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
573 int mscreg = 0x50 + 4 * ap->port_no;
574 u8 bwsr_stat, msc_stat;
575
576 pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
577 pci_read_config_byte(pdev, mscreg, &msc_stat);
578 if (bwsr_stat & (1 << ap->port_no))
579 pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
580 ata_bmdma_stop(qc);
581}
582
583
584static struct scsi_host_template hpt37x_sht = {
585 ATA_BMDMA_SHT(DRV_NAME),
586};
587
588/*
589 * Configuration for HPT370
590 */
591
592static struct ata_port_operations hpt370_port_ops = {
593 .inherits = &ata_bmdma_port_ops,
594
595 .bmdma_stop = hpt370_bmdma_stop,
596
597 .mode_filter = hpt370_filter,
598 .cable_detect = hpt37x_cable_detect,
599 .set_piomode = hpt370_set_piomode,
600 .set_dmamode = hpt370_set_dmamode,
601 .prereset = hpt37x_pre_reset,
602};
603
604/*
605 * Configuration for HPT370A. Close to 370 but less filters
606 */
607
608static struct ata_port_operations hpt370a_port_ops = {
609 .inherits = &hpt370_port_ops,
610 .mode_filter = hpt370a_filter,
611};
612
613/*
614 * Configuration for HPT371 and HPT302. Slightly different PIO and DMA
615 * mode setting functionality.
616 */
617
618static struct ata_port_operations hpt302_port_ops = {
619 .inherits = &ata_bmdma_port_ops,
620
621 .bmdma_stop = hpt37x_bmdma_stop,
622
623 .cable_detect = hpt37x_cable_detect,
624 .set_piomode = hpt372_set_piomode,
625 .set_dmamode = hpt372_set_dmamode,
626 .prereset = hpt37x_pre_reset,
627};
628
629/*
630 * Configuration for HPT372. Mode setting works like 371 and 302
631 * but we have a mode filter.
632 */
633
634static struct ata_port_operations hpt372_port_ops = {
635 .inherits = &hpt302_port_ops,
636 .mode_filter = hpt372_filter,
637};
638
639/*
640 * Configuration for HPT374. Mode setting and filtering works like 372
641 * but we have a different cable detection procedure for function 1.
642 */
643
644static struct ata_port_operations hpt374_fn1_port_ops = {
645 .inherits = &hpt372_port_ops,
646 .cable_detect = hpt374_fn1_cable_detect,
647};
648
649/**
650 * hpt37x_clock_slot - Turn timing to PC clock entry
651 * @freq: Reported frequency timing
652 * @base: Base timing
653 *
654 * Turn the timing data intoa clock slot (0 for 33, 1 for 40, 2 for 50
655 * and 3 for 66Mhz)
656 */
657
658static int hpt37x_clock_slot(unsigned int freq, unsigned int base)
659{
660 unsigned int f = (base * freq) / 192; /* Mhz */
661 if (f < 40)
662 return 0; /* 33Mhz slot */
663 if (f < 45)
664 return 1; /* 40Mhz slot */
665 if (f < 55)
666 return 2; /* 50Mhz slot */
667 return 3; /* 60Mhz slot */
668}
669
670/**
671 * hpt37x_calibrate_dpll - Calibrate the DPLL loop
672 * @dev: PCI device
673 *
674 * Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
675 * succeeds
676 */
677
678static int hpt37x_calibrate_dpll(struct pci_dev *dev)
679{
680 u8 reg5b;
681 u32 reg5c;
682 int tries;
683
684 for (tries = 0; tries < 0x5000; tries++) {
685 udelay(50);
686 pci_read_config_byte(dev, 0x5b, ®5b);
687 if (reg5b & 0x80) {
688 /* See if it stays set */
689 for (tries = 0; tries < 0x1000; tries++) {
690 pci_read_config_byte(dev, 0x5b, ®5b);
691 /* Failed ? */
692 if ((reg5b & 0x80) == 0)
693 return 0;
694 }
695 /* Turn off tuning, we have the DPLL set */
696 pci_read_config_dword(dev, 0x5c, ®5c);
697 pci_write_config_dword(dev, 0x5c, reg5c & ~0x100);
698 return 1;
699 }
700 }
701 /* Never went stable */
702 return 0;
703}
704
705static u32 hpt374_read_freq(struct pci_dev *pdev)
706{
707 u32 freq;
708 unsigned long io_base = pci_resource_start(pdev, 4);
709
710 if (PCI_FUNC(pdev->devfn) & 1) {
711 struct pci_dev *pdev_0;
712
713 pdev_0 = pci_get_slot(pdev->bus, pdev->devfn - 1);
714 /* Someone hot plugged the controller on us ? */
715 if (pdev_0 == NULL)
716 return 0;
717 io_base = pci_resource_start(pdev_0, 4);
718 freq = inl(io_base + 0x90);
719 pci_dev_put(pdev_0);
720 } else
721 freq = inl(io_base + 0x90);
722 return freq;
723}
724
725/**
726 * hpt37x_init_one - Initialise an HPT37X/302
727 * @dev: PCI device
728 * @id: Entry in match table
729 *
730 * Initialise an HPT37x device. There are some interesting complications
731 * here. Firstly the chip may report 366 and be one of several variants.
732 * Secondly all the timings depend on the clock for the chip which we must
733 * detect and look up
734 *
735 * This is the known chip mappings. It may be missing a couple of later
736 * releases.
737 *
738 * Chip version PCI Rev Notes
739 * HPT366 4 (HPT366) 0 Other driver
740 * HPT366 4 (HPT366) 1 Other driver
741 * HPT368 4 (HPT366) 2 Other driver
742 * HPT370 4 (HPT366) 3 UDMA100
743 * HPT370A 4 (HPT366) 4 UDMA100
744 * HPT372 4 (HPT366) 5 UDMA133 (1)
745 * HPT372N 4 (HPT366) 6 Other driver
746 * HPT372A 5 (HPT372) 1 UDMA133 (1)
747 * HPT372N 5 (HPT372) 2 Other driver
748 * HPT302 6 (HPT302) 1 UDMA133
749 * HPT302N 6 (HPT302) 2 Other driver
750 * HPT371 7 (HPT371) * UDMA133
751 * HPT374 8 (HPT374) * UDMA133 4 channel
752 * HPT372N 9 (HPT372N) * Other driver
753 *
754 * (1) UDMA133 support depends on the bus clock
755 */
756
757static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
758{
759 /* HPT370 - UDMA100 */
760 static const struct ata_port_info info_hpt370 = {
761 .flags = ATA_FLAG_SLAVE_POSS,
762 .pio_mask = ATA_PIO4,
763 .mwdma_mask = ATA_MWDMA2,
764 .udma_mask = ATA_UDMA5,
765 .port_ops = &hpt370_port_ops
766 };
767 /* HPT370A - UDMA100 */
768 static const struct ata_port_info info_hpt370a = {
769 .flags = ATA_FLAG_SLAVE_POSS,
770 .pio_mask = ATA_PIO4,
771 .mwdma_mask = ATA_MWDMA2,
772 .udma_mask = ATA_UDMA5,
773 .port_ops = &hpt370a_port_ops
774 };
775 /* HPT370 - UDMA66 */
776 static const struct ata_port_info info_hpt370_33 = {
777 .flags = ATA_FLAG_SLAVE_POSS,
778 .pio_mask = ATA_PIO4,
779 .mwdma_mask = ATA_MWDMA2,
780 .udma_mask = ATA_UDMA4,
781 .port_ops = &hpt370_port_ops
782 };
783 /* HPT370A - UDMA66 */
784 static const struct ata_port_info info_hpt370a_33 = {
785 .flags = ATA_FLAG_SLAVE_POSS,
786 .pio_mask = ATA_PIO4,
787 .mwdma_mask = ATA_MWDMA2,
788 .udma_mask = ATA_UDMA4,
789 .port_ops = &hpt370a_port_ops
790 };
791 /* HPT372 - UDMA133 */
792 static const struct ata_port_info info_hpt372 = {
793 .flags = ATA_FLAG_SLAVE_POSS,
794 .pio_mask = ATA_PIO4,
795 .mwdma_mask = ATA_MWDMA2,
796 .udma_mask = ATA_UDMA6,
797 .port_ops = &hpt372_port_ops
798 };
799 /* HPT371, 302 - UDMA133 */
800 static const struct ata_port_info info_hpt302 = {
801 .flags = ATA_FLAG_SLAVE_POSS,
802 .pio_mask = ATA_PIO4,
803 .mwdma_mask = ATA_MWDMA2,
804 .udma_mask = ATA_UDMA6,
805 .port_ops = &hpt302_port_ops
806 };
807 /* HPT374 - UDMA100, function 1 uses different cable_detect method */
808 static const struct ata_port_info info_hpt374_fn0 = {
809 .flags = ATA_FLAG_SLAVE_POSS,
810 .pio_mask = ATA_PIO4,
811 .mwdma_mask = ATA_MWDMA2,
812 .udma_mask = ATA_UDMA5,
813 .port_ops = &hpt372_port_ops
814 };
815 static const struct ata_port_info info_hpt374_fn1 = {
816 .flags = ATA_FLAG_SLAVE_POSS,
817 .pio_mask = ATA_PIO4,
818 .mwdma_mask = ATA_MWDMA2,
819 .udma_mask = ATA_UDMA5,
820 .port_ops = &hpt374_fn1_port_ops
821 };
822
823 static const int MHz[4] = { 33, 40, 50, 66 };
824 void *private_data = NULL;
825 const struct ata_port_info *ppi[] = { NULL, NULL };
826 u8 rev = dev->revision;
827 u8 irqmask;
828 u8 mcr1;
829 u32 freq;
830 int prefer_dpll = 1;
831
832 unsigned long iobase = pci_resource_start(dev, 4);
833
834 const struct hpt_chip *chip_table;
835 int clock_slot;
836 int rc;
837
838 rc = pcim_enable_device(dev);
839 if (rc)
840 return rc;
841
842 switch (dev->device) {
843 case PCI_DEVICE_ID_TTI_HPT366:
844 /* May be a later chip in disguise. Check */
845 /* Older chips are in the HPT366 driver. Ignore them */
846 if (rev < 3)
847 return -ENODEV;
848 /* N series chips have their own driver. Ignore */
849 if (rev == 6)
850 return -ENODEV;
851
852 switch (rev) {
853 case 3:
854 ppi[0] = &info_hpt370;
855 chip_table = &hpt370;
856 prefer_dpll = 0;
857 break;
858 case 4:
859 ppi[0] = &info_hpt370a;
860 chip_table = &hpt370a;
861 prefer_dpll = 0;
862 break;
863 case 5:
864 ppi[0] = &info_hpt372;
865 chip_table = &hpt372;
866 break;
867 default:
868 pr_err("Unknown HPT366 subtype, please report (%d)\n",
869 rev);
870 return -ENODEV;
871 }
872 break;
873 case PCI_DEVICE_ID_TTI_HPT372:
874 /* 372N if rev >= 2 */
875 if (rev >= 2)
876 return -ENODEV;
877 ppi[0] = &info_hpt372;
878 chip_table = &hpt372a;
879 break;
880 case PCI_DEVICE_ID_TTI_HPT302:
881 /* 302N if rev > 1 */
882 if (rev > 1)
883 return -ENODEV;
884 ppi[0] = &info_hpt302;
885 /* Check this */
886 chip_table = &hpt302;
887 break;
888 case PCI_DEVICE_ID_TTI_HPT371:
889 if (rev > 1)
890 return -ENODEV;
891 ppi[0] = &info_hpt302;
892 chip_table = &hpt371;
893 /*
894 * Single channel device, master is not present but the BIOS
895 * (or us for non x86) must mark it absent
896 */
897 pci_read_config_byte(dev, 0x50, &mcr1);
898 mcr1 &= ~0x04;
899 pci_write_config_byte(dev, 0x50, mcr1);
900 break;
901 case PCI_DEVICE_ID_TTI_HPT374:
902 chip_table = &hpt374;
903 if (!(PCI_FUNC(dev->devfn) & 1))
904 *ppi = &info_hpt374_fn0;
905 else
906 *ppi = &info_hpt374_fn1;
907 break;
908 default:
909 pr_err("PCI table is bogus, please report (%d)\n", dev->device);
910 return -ENODEV;
911 }
912 /* Ok so this is a chip we support */
913
914 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
915 pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
916 pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
917 pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
918
919 pci_read_config_byte(dev, 0x5A, &irqmask);
920 irqmask &= ~0x10;
921 pci_write_config_byte(dev, 0x5a, irqmask);
922
923 /*
924 * default to pci clock. make sure MA15/16 are set to output
925 * to prevent drives having problems with 40-pin cables. Needed
926 * for some drives such as IBM-DTLA which will not enter ready
927 * state on reset when PDIAG is a input.
928 */
929
930 pci_write_config_byte(dev, 0x5b, 0x23);
931
932 /*
933 * HighPoint does this for HPT372A.
934 * NOTE: This register is only writeable via I/O space.
935 */
936 if (chip_table == &hpt372a)
937 outb(0x0e, iobase + 0x9c);
938
939 /*
940 * Some devices do not let this value be accessed via PCI space
941 * according to the old driver. In addition we must use the value
942 * from FN 0 on the HPT374.
943 */
944
945 if (chip_table == &hpt374) {
946 freq = hpt374_read_freq(dev);
947 if (freq == 0)
948 return -ENODEV;
949 } else
950 freq = inl(iobase + 0x90);
951
952 if ((freq >> 12) != 0xABCDE) {
953 int i;
954 u8 sr;
955 u32 total = 0;
956
957 pr_warn("BIOS has not set timing clocks\n");
958
959 /* This is the process the HPT371 BIOS is reported to use */
960 for (i = 0; i < 128; i++) {
961 pci_read_config_byte(dev, 0x78, &sr);
962 total += sr & 0x1FF;
963 udelay(15);
964 }
965 freq = total / 128;
966 }
967 freq &= 0x1FF;
968
969 /*
970 * Turn the frequency check into a band and then find a timing
971 * table to match it.
972 */
973
974 clock_slot = hpt37x_clock_slot(freq, chip_table->base);
975 if (chip_table->clocks[clock_slot] == NULL || prefer_dpll) {
976 /*
977 * We need to try PLL mode instead
978 *
979 * For non UDMA133 capable devices we should
980 * use a 50MHz DPLL by choice
981 */
982 unsigned int f_low, f_high;
983 int dpll, adjust;
984
985 /* Compute DPLL */
986 dpll = (ppi[0]->udma_mask & 0xC0) ? 3 : 2;
987
988 f_low = (MHz[clock_slot] * 48) / MHz[dpll];
989 f_high = f_low + 2;
990 if (clock_slot > 1)
991 f_high += 2;
992
993 /* Select the DPLL clock. */
994 pci_write_config_byte(dev, 0x5b, 0x21);
995 pci_write_config_dword(dev, 0x5C,
996 (f_high << 16) | f_low | 0x100);
997
998 for (adjust = 0; adjust < 8; adjust++) {
999 if (hpt37x_calibrate_dpll(dev))
1000 break;
1001 /*
1002 * See if it'll settle at a fractionally
1003 * different clock
1004 */
1005 if (adjust & 1)
1006 f_low -= adjust >> 1;
1007 else
1008 f_high += adjust >> 1;
1009 pci_write_config_dword(dev, 0x5C,
1010 (f_high << 16) | f_low | 0x100);
1011 }
1012 if (adjust == 8) {
1013 pr_err("DPLL did not stabilize!\n");
1014 return -ENODEV;
1015 }
1016 if (dpll == 3)
1017 private_data = (void *)hpt37x_timings_66;
1018 else
1019 private_data = (void *)hpt37x_timings_50;
1020
1021 pr_info("bus clock %dMHz, using %dMHz DPLL\n",
1022 MHz[clock_slot], MHz[dpll]);
1023 } else {
1024 private_data = (void *)chip_table->clocks[clock_slot];
1025 /*
1026 * Perform a final fixup. Note that we will have used the
1027 * DPLL on the HPT372 which means we don't have to worry
1028 * about lack of UDMA133 support on lower clocks
1029 */
1030
1031 if (clock_slot < 2 && ppi[0] == &info_hpt370)
1032 ppi[0] = &info_hpt370_33;
1033 if (clock_slot < 2 && ppi[0] == &info_hpt370a)
1034 ppi[0] = &info_hpt370a_33;
1035
1036 pr_info("%s using %dMHz bus clock\n",
1037 chip_table->name, MHz[clock_slot]);
1038 }
1039
1040 /* Now kick off ATA set up */
1041 return ata_pci_bmdma_init_one(dev, ppi, &hpt37x_sht, private_data, 0);
1042}
1043
1044static const struct pci_device_id hpt37x[] = {
1045 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT366), },
1046 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT371), },
1047 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT372), },
1048 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT374), },
1049 { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT302), },
1050
1051 { },
1052};
1053
1054static struct pci_driver hpt37x_pci_driver = {
1055 .name = DRV_NAME,
1056 .id_table = hpt37x,
1057 .probe = hpt37x_init_one,
1058 .remove = ata_pci_remove_one
1059};
1060
1061static int __init hpt37x_init(void)
1062{
1063 return pci_register_driver(&hpt37x_pci_driver);
1064}
1065
1066static void __exit hpt37x_exit(void)
1067{
1068 pci_unregister_driver(&hpt37x_pci_driver);
1069}
1070
1071MODULE_AUTHOR("Alan Cox");
1072MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
1073MODULE_LICENSE("GPL");
1074MODULE_DEVICE_TABLE(pci, hpt37x);
1075MODULE_VERSION(DRV_VERSION);
1076
1077module_init(hpt37x_init);
1078module_exit(hpt37x_exit);