Blame view

drivers/ata/pata_hpt37x.c 25 KB
669a5db41   Jeff Garzik   [libata] Add a bu...
1
2
3
4
5
6
7
8
9
10
  /*
   * Libata driver for the highpoint 37x and 30x UDMA66 ATA controllers.
   *
   * This driver is heavily based upon:
   *
   * linux/drivers/ide/pci/hpt366.c		Version 0.36	April 25, 2003
   *
   * Copyright (C) 1999-2003		Andre Hedrick <andre@linux-ide.org>
   * Portions Copyright (C) 2001	        Sun Microsystems, Inc.
   * Portions Copyright (C) 2003		Red Hat Inc
265b7215a   Sergei Shtylyov   pata_hpt37x: fix ...
11
   * Portions Copyright (C) 2005-2009	MontaVista Software, Inc.
669a5db41   Jeff Garzik   [libata] Add a bu...
12
13
   *
   * TODO
d44a65f7b   Sergei Shtylyov   pata_hpt37x: actu...
14
   *	Look into engine reset on timeout errors. Should not be	required.
669a5db41   Jeff Garzik   [libata] Add a bu...
15
16
17
18
19
20
21
22
23
24
25
26
   */
  
  #include <linux/kernel.h>
  #include <linux/module.h>
  #include <linux/pci.h>
  #include <linux/init.h>
  #include <linux/blkdev.h>
  #include <linux/delay.h>
  #include <scsi/scsi_host.h>
  #include <linux/libata.h>
  
  #define DRV_NAME	"pata_hpt37x"
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
27
  #define DRV_VERSION	"0.6.15"
669a5db41   Jeff Garzik   [libata] Add a bu...
28
29
30
31
32
33
34
35
36
37
38
39
40
41
  
  struct hpt_clock {
  	u8	xfer_speed;
  	u32	timing;
  };
  
  struct hpt_chip {
  	const char *name;
  	unsigned int base;
  	struct hpt_clock const *clocks[4];
  };
  
  /* key for bus clock timings
   * bit
fd5e62e22   Sergei Shtylyov   pata_hpt{37x|3x2n...
42
43
44
45
46
   * 0:3    data_high_time. Inactive time of DIOW_/DIOR_ for PIO and MW DMA.
   *        cycles = value + 1
   * 4:8    data_low_time. Active time of DIOW_/DIOR_ for PIO and MW DMA.
   *        cycles = value + 1
   * 9:12   cmd_high_time. Inactive time of DIOW_/DIOR_ during task file
669a5db41   Jeff Garzik   [libata] Add a bu...
47
   *        register access.
fd5e62e22   Sergei Shtylyov   pata_hpt{37x|3x2n...
48
   * 13:17  cmd_low_time. Active time of DIOW_/DIOR_ during task file
669a5db41   Jeff Garzik   [libata] Add a bu...
49
   *        register access.
fd5e62e22   Sergei Shtylyov   pata_hpt{37x|3x2n...
50
51
52
53
   * 18:20  udma_cycle_time. Clock cycles for UDMA xfer.
   * 21     CLK frequency for UDMA: 0=ATA clock, 1=dual ATA clock.
   * 22:24  pre_high_time. Time to initialize 1st cycle for PIO and MW DMA xfer.
   * 25:27  cmd_pre_high_time. Time to initialize 1st PIO cycle for task file
669a5db41   Jeff Garzik   [libata] Add a bu...
54
   *        register access.
fd5e62e22   Sergei Shtylyov   pata_hpt{37x|3x2n...
55
56
57
58
59
   * 28     UDMA enable.
   * 29     DMA  enable.
   * 30     PIO_MST enable. If set, the chip is in bus master mode during
   *        PIO xfer.
   * 31     FIFO enable. Only for PIO.
669a5db41   Jeff Garzik   [libata] Add a bu...
60
   */
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
  static struct hpt_clock hpt37x_timings_33[] = {
  	{ XFER_UDMA_6,		0x12446231 },	/* 0x12646231 ?? */
  	{ XFER_UDMA_5,		0x12446231 },
  	{ XFER_UDMA_4,		0x12446231 },
  	{ XFER_UDMA_3,		0x126c6231 },
  	{ XFER_UDMA_2,		0x12486231 },
  	{ XFER_UDMA_1,		0x124c6233 },
  	{ XFER_UDMA_0,		0x12506297 },
  
  	{ XFER_MW_DMA_2,	0x22406c31 },
  	{ XFER_MW_DMA_1,	0x22406c33 },
  	{ XFER_MW_DMA_0,	0x22406c97 },
  
  	{ XFER_PIO_4,		0x06414e31 },
  	{ XFER_PIO_3,		0x06414e42 },
  	{ XFER_PIO_2,		0x06414e53 },
  	{ XFER_PIO_1,		0x06814e93 },
  	{ XFER_PIO_0,		0x06814ea7 }
669a5db41   Jeff Garzik   [libata] Add a bu...
79
  };
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
  static struct hpt_clock hpt37x_timings_50[] = {
  	{ XFER_UDMA_6,		0x12848242 },
  	{ XFER_UDMA_5,		0x12848242 },
  	{ XFER_UDMA_4,		0x12ac8242 },
  	{ XFER_UDMA_3,		0x128c8242 },
  	{ XFER_UDMA_2,		0x120c8242 },
  	{ XFER_UDMA_1,		0x12148254 },
  	{ XFER_UDMA_0,		0x121882ea },
  
  	{ XFER_MW_DMA_2,	0x22808242 },
  	{ XFER_MW_DMA_1,	0x22808254 },
  	{ XFER_MW_DMA_0,	0x228082ea },
  
  	{ XFER_PIO_4,		0x0a81f442 },
  	{ XFER_PIO_3,		0x0a81f443 },
  	{ XFER_PIO_2,		0x0a81f454 },
  	{ XFER_PIO_1,		0x0ac1f465 },
  	{ XFER_PIO_0,		0x0ac1f48a }
669a5db41   Jeff Garzik   [libata] Add a bu...
98
  };
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
  static struct hpt_clock hpt37x_timings_66[] = {
  	{ XFER_UDMA_6,		0x1c869c62 },
  	{ XFER_UDMA_5,		0x1cae9c62 },	/* 0x1c8a9c62 */
  	{ XFER_UDMA_4,		0x1c8a9c62 },
  	{ XFER_UDMA_3,		0x1c8e9c62 },
  	{ XFER_UDMA_2,		0x1c929c62 },
  	{ XFER_UDMA_1,		0x1c9a9c62 },
  	{ XFER_UDMA_0,		0x1c829c62 },
  
  	{ XFER_MW_DMA_2,	0x2c829c62 },
  	{ XFER_MW_DMA_1,	0x2c829c66 },
  	{ XFER_MW_DMA_0,	0x2c829d2e },
  
  	{ XFER_PIO_4,		0x0c829c62 },
  	{ XFER_PIO_3,		0x0c829c84 },
  	{ XFER_PIO_2,		0x0c829ca6 },
  	{ XFER_PIO_1,		0x0d029d26 },
  	{ XFER_PIO_0,		0x0d029d5e }
669a5db41   Jeff Garzik   [libata] Add a bu...
117
  };
669a5db41   Jeff Garzik   [libata] Add a bu...
118
119
120
121
122
  
  static const struct hpt_chip hpt370 = {
  	"HPT370",
  	48,
  	{
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
123
  		hpt37x_timings_33,
669a5db41   Jeff Garzik   [libata] Add a bu...
124
125
  		NULL,
  		NULL,
a47344685   Alan Cox   pata_hpt37x: Furt...
126
  		NULL
669a5db41   Jeff Garzik   [libata] Add a bu...
127
128
129
130
131
132
133
  	}
  };
  
  static const struct hpt_chip hpt370a = {
  	"HPT370A",
  	48,
  	{
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
134
  		hpt37x_timings_33,
669a5db41   Jeff Garzik   [libata] Add a bu...
135
  		NULL,
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
136
  		hpt37x_timings_50,
a47344685   Alan Cox   pata_hpt37x: Furt...
137
  		NULL
669a5db41   Jeff Garzik   [libata] Add a bu...
138
139
140
141
142
143
144
  	}
  };
  
  static const struct hpt_chip hpt372 = {
  	"HPT372",
  	55,
  	{
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
145
  		hpt37x_timings_33,
669a5db41   Jeff Garzik   [libata] Add a bu...
146
  		NULL,
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
147
148
  		hpt37x_timings_50,
  		hpt37x_timings_66
669a5db41   Jeff Garzik   [libata] Add a bu...
149
150
151
152
153
154
155
  	}
  };
  
  static const struct hpt_chip hpt302 = {
  	"HPT302",
  	66,
  	{
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
156
  		hpt37x_timings_33,
669a5db41   Jeff Garzik   [libata] Add a bu...
157
  		NULL,
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
158
159
  		hpt37x_timings_50,
  		hpt37x_timings_66
669a5db41   Jeff Garzik   [libata] Add a bu...
160
161
162
163
164
165
166
  	}
  };
  
  static const struct hpt_chip hpt371 = {
  	"HPT371",
  	66,
  	{
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
167
  		hpt37x_timings_33,
669a5db41   Jeff Garzik   [libata] Add a bu...
168
  		NULL,
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
169
170
  		hpt37x_timings_50,
  		hpt37x_timings_66
669a5db41   Jeff Garzik   [libata] Add a bu...
171
172
173
174
175
176
177
  	}
  };
  
  static const struct hpt_chip hpt372a = {
  	"HPT372A",
  	66,
  	{
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
178
  		hpt37x_timings_33,
669a5db41   Jeff Garzik   [libata] Add a bu...
179
  		NULL,
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
180
181
  		hpt37x_timings_50,
  		hpt37x_timings_66
669a5db41   Jeff Garzik   [libata] Add a bu...
182
183
184
185
186
187
188
  	}
  };
  
  static const struct hpt_chip hpt374 = {
  	"HPT374",
  	48,
  	{
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
189
  		hpt37x_timings_33,
669a5db41   Jeff Garzik   [libata] Add a bu...
190
191
192
193
194
195
196
197
198
199
200
201
202
203
  		NULL,
  		NULL,
  		NULL
  	}
  };
  
  /**
   *	hpt37x_find_mode	-	reset the hpt37x bus
   *	@ap: ATA port
   *	@speed: transfer mode
   *
   *	Return the 32bit register programming information for this channel
   *	that matches the speed provided.
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
204

669a5db41   Jeff Garzik   [libata] Add a bu...
205
206
207
  static u32 hpt37x_find_mode(struct ata_port *ap, int speed)
  {
  	struct hpt_clock *clocks = ap->host->private_data;
85cd7251b   Jeff Garzik   [libata #pata-dri...
208

669a5db41   Jeff Garzik   [libata] Add a bu...
209
210
211
212
213
214
215
216
217
218
219
  	while(clocks->xfer_speed) {
  		if (clocks->xfer_speed == speed)
  			return clocks->timing;
  		clocks++;
  	}
  	BUG();
  	return 0xffffffffU;	/* silence compiler warning */
  }
  
  static int hpt_dma_blacklisted(const struct ata_device *dev, char *modestr, const char *list[])
  {
8bfa79fcb   Tejun Heo   libata: use ata_i...
220
  	unsigned char model_num[ATA_ID_PROD_LEN + 1];
669a5db41   Jeff Garzik   [libata] Add a bu...
221
  	int i = 0;
8bfa79fcb   Tejun Heo   libata: use ata_i...
222
  	ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
669a5db41   Jeff Garzik   [libata] Add a bu...
223

8bfa79fcb   Tejun Heo   libata: use ata_i...
224
225
  	while (list[i] != NULL) {
  		if (!strcmp(list[i], model_num)) {
85cd7251b   Jeff Garzik   [libata #pata-dri...
226
227
  			printk(KERN_WARNING DRV_NAME ": %s is not supported for %s.
  ",
669a5db41   Jeff Garzik   [libata] Add a bu...
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
  				modestr, list[i]);
  			return 1;
  		}
  		i++;
  	}
  	return 0;
  }
  
  static const char *bad_ata33[] = {
  	"Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3", "Maxtor 90845U3", "Maxtor 90650U2",
  	"Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5", "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
  	"Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6", "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
  	"Maxtor 90510D4",
  	"Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
  	"Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7", "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
  	"Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5", "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
  	NULL
  };
  
  static const char *bad_ata100_5[] = {
  	"IBM-DTLA-307075",
  	"IBM-DTLA-307060",
  	"IBM-DTLA-307045",
  	"IBM-DTLA-307030",
  	"IBM-DTLA-307020",
  	"IBM-DTLA-307015",
  	"IBM-DTLA-305040",
  	"IBM-DTLA-305030",
  	"IBM-DTLA-305020",
  	"IC35L010AVER07-0",
  	"IC35L020AVER07-0",
  	"IC35L030AVER07-0",
  	"IC35L040AVER07-0",
  	"IC35L060AVER07-0",
  	"WDC AC310200R",
  	NULL
  };
  
  /**
   *	hpt370_filter	-	mode selection filter
669a5db41   Jeff Garzik   [libata] Add a bu...
268
269
270
271
   *	@adev: ATA device
   *
   *	Block UDMA on devices that cause trouble with this controller.
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
272

a76b62ca7   Alan Cox   libata: Change pr...
273
  static unsigned long hpt370_filter(struct ata_device *adev, unsigned long mask)
669a5db41   Jeff Garzik   [libata] Add a bu...
274
  {
6929da442   Alan Cox   [PATCH] hpt37x: T...
275
  	if (adev->class == ATA_DEV_ATA) {
669a5db41   Jeff Garzik   [libata] Add a bu...
276
277
278
  		if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33))
  			mask &= ~ATA_MASK_UDMA;
  		if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
6ddd68615   Alan Cox   pata_hpt*, pata_s...
279
  			mask &= ~(0xE0 << ATA_SHIFT_UDMA);
669a5db41   Jeff Garzik   [libata] Add a bu...
280
  	}
c7087652e   Tejun Heo   libata-sff: clean...
281
  	return mask;
669a5db41   Jeff Garzik   [libata] Add a bu...
282
283
284
285
  }
  
  /**
   *	hpt370a_filter	-	mode selection filter
669a5db41   Jeff Garzik   [libata] Add a bu...
286
287
288
289
   *	@adev: ATA device
   *
   *	Block UDMA on devices that cause trouble with this controller.
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
290

a76b62ca7   Alan Cox   libata: Change pr...
291
  static unsigned long hpt370a_filter(struct ata_device *adev, unsigned long mask)
669a5db41   Jeff Garzik   [libata] Add a bu...
292
  {
73946f9fc   Alan Cox   pata_hpt37x: Fix ...
293
  	if (adev->class == ATA_DEV_ATA) {
669a5db41   Jeff Garzik   [libata] Add a bu...
294
  		if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
6ddd68615   Alan Cox   pata_hpt*, pata_s...
295
  			mask &= ~(0xE0 << ATA_SHIFT_UDMA);
669a5db41   Jeff Garzik   [libata] Add a bu...
296
  	}
c7087652e   Tejun Heo   libata-sff: clean...
297
  	return mask;
669a5db41   Jeff Garzik   [libata] Add a bu...
298
  }
85cd7251b   Jeff Garzik   [libata #pata-dri...
299

669a5db41   Jeff Garzik   [libata] Add a bu...
300
  /**
9e87be9ed   Bartlomiej Zolnierkiewicz   pata_hpt37x: add ...
301
302
303
304
305
306
307
308
309
310
311
312
313
   *	hpt37x_cable_detect	-	Detect the cable type
   *	@ap: ATA port to detect on
   *
   *	Return the cable type attached to this port
   */
  
  static int hpt37x_cable_detect(struct ata_port *ap)
  {
  	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  	u8 scr2, ata66;
  
  	pci_read_config_byte(pdev, 0x5B, &scr2);
  	pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
10a9c9692   Bartlomiej Zolnierkiewicz   pata_hpt{37x,3x2n...
314
315
  
  	udelay(10); /* debounce */
9e87be9ed   Bartlomiej Zolnierkiewicz   pata_hpt37x: add ...
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
  	/* Cable register now active */
  	pci_read_config_byte(pdev, 0x5A, &ata66);
  	/* Restore state */
  	pci_write_config_byte(pdev, 0x5B, scr2);
  
  	if (ata66 & (2 >> ap->port_no))
  		return ATA_CBL_PATA40;
  	else
  		return ATA_CBL_PATA80;
  }
  
  /**
   *	hpt374_fn1_cable_detect	-	Detect the cable type
   *	@ap: ATA port to detect on
   *
   *	Return the cable type attached to this port
   */
  
  static int hpt374_fn1_cable_detect(struct ata_port *ap)
  {
  	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  	unsigned int mcrbase = 0x50 + 4 * ap->port_no;
  	u16 mcr3;
  	u8 ata66;
  
  	/* Do the extra channel work */
  	pci_read_config_word(pdev, mcrbase + 2, &mcr3);
  	/* Set bit 15 of 0x52 to enable TCBLID as input */
  	pci_write_config_word(pdev, mcrbase + 2, mcr3 | 0x8000);
  	pci_read_config_byte(pdev, 0x5A, &ata66);
  	/* Reset TCBLID/FCBLID to output */
  	pci_write_config_word(pdev, mcrbase + 2, mcr3);
  
  	if (ata66 & (2 >> ap->port_no))
  		return ATA_CBL_PATA40;
  	else
  		return ATA_CBL_PATA80;
  }
  
  /**
669a5db41   Jeff Garzik   [libata] Add a bu...
356
   *	hpt37x_pre_reset	-	reset the hpt37x bus
cc0680a58   Tejun Heo   libata-link: link...
357
   *	@link: ATA link to reset
d4b2bab4f   Tejun Heo   libata: add deadl...
358
   *	@deadline: deadline jiffies for the operation
669a5db41   Jeff Garzik   [libata] Add a bu...
359
   *
ab81a505a   Bartlomiej Zolnierkiewicz   pata_hpt37x: unif...
360
   *	Perform the initial reset handling for the HPT37x.
669a5db41   Jeff Garzik   [libata] Add a bu...
361
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
362

cc0680a58   Tejun Heo   libata-link: link...
363
  static int hpt37x_pre_reset(struct ata_link *link, unsigned long deadline)
669a5db41   Jeff Garzik   [libata] Add a bu...
364
  {
cc0680a58   Tejun Heo   libata-link: link...
365
  	struct ata_port *ap = link->ap;
669a5db41   Jeff Garzik   [libata] Add a bu...
366
  	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
b5bf24b94   Alan Cox   [PATCH] hpt37x: C...
367
368
369
370
371
372
  	static const struct pci_bits hpt37x_enable_bits[] = {
  		{ 0x50, 1, 0x04, 0x04 },
  		{ 0x54, 1, 0x04, 0x04 }
  	};
  	if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
  		return -ENOENT;
f20b16ff7   Jeff Garzik   [libata] trim tra...
373

669a5db41   Jeff Garzik   [libata] Add a bu...
374
  	/* Reset the state machine */
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
375
  	pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
669a5db41   Jeff Garzik   [libata] Add a bu...
376
  	udelay(100);
85cd7251b   Jeff Garzik   [libata #pata-dri...
377

9363c3825   Tejun Heo   libata: rename SF...
378
  	return ata_sff_prereset(link, deadline);
669a5db41   Jeff Garzik   [libata] Add a bu...
379
  }
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
380
381
  static void hpt370_set_mode(struct ata_port *ap, struct ata_device *adev,
  			    u8 mode)
669a5db41   Jeff Garzik   [libata] Add a bu...
382
383
384
  {
  	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  	u32 addr1, addr2;
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
385
  	u32 reg, timing, mask;
669a5db41   Jeff Garzik   [libata] Add a bu...
386
387
388
389
  	u8 fast;
  
  	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
  	addr2 = 0x51 + 4 * ap->port_no;
85cd7251b   Jeff Garzik   [libata #pata-dri...
390

669a5db41   Jeff Garzik   [libata] Add a bu...
391
392
393
394
395
  	/* Fast interrupt prediction disable, hold off interrupt disable */
  	pci_read_config_byte(pdev, addr2, &fast);
  	fast &= ~0x02;
  	fast |= 0x01;
  	pci_write_config_byte(pdev, addr2, fast);
85cd7251b   Jeff Garzik   [libata #pata-dri...
396

1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
397
398
399
400
401
402
403
404
405
  	/* Determine timing mask and find matching mode entry */
  	if (mode < XFER_MW_DMA_0)
  		mask = 0xcfc3ffff;
  	else if (mode < XFER_UDMA_0)
  		mask = 0x31c001ff;
  	else
  		mask = 0x303c0000;
  
  	timing = hpt37x_find_mode(ap, mode);
669a5db41   Jeff Garzik   [libata] Add a bu...
406
  	pci_read_config_dword(pdev, addr1, &reg);
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
407
408
409
410
411
412
413
414
415
416
417
418
419
420
  	reg = (reg & ~mask) | (timing & mask);
  	pci_write_config_dword(pdev, addr1, reg);
  }
  /**
   *	hpt370_set_piomode		-	PIO setup
   *	@ap: ATA interface
   *	@adev: device on the interface
   *
   *	Perform PIO mode setup.
   */
  
  static void hpt370_set_piomode(struct ata_port *ap, struct ata_device *adev)
  {
  	hpt370_set_mode(ap, adev, adev->pio_mode);
669a5db41   Jeff Garzik   [libata] Add a bu...
421
422
423
424
425
426
427
  }
  
  /**
   *	hpt370_set_dmamode		-	DMA timing setup
   *	@ap: ATA interface
   *	@adev: Device being configured
   *
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
428
   *	Set up the channel for MWDMA or UDMA modes.
669a5db41   Jeff Garzik   [libata] Add a bu...
429
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
430

669a5db41   Jeff Garzik   [libata] Add a bu...
431
432
  static void hpt370_set_dmamode(struct ata_port *ap, struct ata_device *adev)
  {
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
433
  	hpt370_set_mode(ap, adev, adev->dma_mode);
669a5db41   Jeff Garzik   [libata] Add a bu...
434
435
436
  }
  
  /**
669a5db41   Jeff Garzik   [libata] Add a bu...
437
438
439
440
441
   *	hpt370_bmdma_end		-	DMA engine stop
   *	@qc: ATA command
   *
   *	Work around the HPT370 DMA engine.
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
442

669a5db41   Jeff Garzik   [libata] Add a bu...
443
444
445
446
  static void hpt370_bmdma_stop(struct ata_queued_cmd *qc)
  {
  	struct ata_port *ap = qc->ap;
  	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
0d5ff5667   Tejun Heo   libata: convert t...
447
  	void __iomem *bmdma = ap->ioaddr.bmdma_addr;
56f46f8c8   Sergei Shtylyov   pata_hpt37x: use ...
448
449
  	u8 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
  	u8 dma_cmd;
85cd7251b   Jeff Garzik   [libata #pata-dri...
450

56f46f8c8   Sergei Shtylyov   pata_hpt37x: use ...
451
  	if (dma_stat & ATA_DMA_ACTIVE) {
669a5db41   Jeff Garzik   [libata] Add a bu...
452
  		udelay(20);
56f46f8c8   Sergei Shtylyov   pata_hpt37x: use ...
453
  		dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
669a5db41   Jeff Garzik   [libata] Add a bu...
454
  	}
56f46f8c8   Sergei Shtylyov   pata_hpt37x: use ...
455
  	if (dma_stat & ATA_DMA_ACTIVE) {
669a5db41   Jeff Garzik   [libata] Add a bu...
456
457
458
459
  		/* Clear the engine */
  		pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
  		udelay(10);
  		/* Stop DMA */
56f46f8c8   Sergei Shtylyov   pata_hpt37x: use ...
460
461
  		dma_cmd = ioread8(bmdma + ATA_DMA_CMD);
  		iowrite8(dma_cmd & ~ATA_DMA_START, bmdma + ATA_DMA_CMD);
669a5db41   Jeff Garzik   [libata] Add a bu...
462
  		/* Clear Error */
56f46f8c8   Sergei Shtylyov   pata_hpt37x: use ...
463
464
465
  		dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
  		iowrite8(dma_stat | ATA_DMA_INTR | ATA_DMA_ERR,
  			 bmdma + ATA_DMA_STATUS);
669a5db41   Jeff Garzik   [libata] Add a bu...
466
467
468
469
470
471
  		/* Clear the engine */
  		pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
  		udelay(10);
  	}
  	ata_bmdma_stop(qc);
  }
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
472
473
  static void hpt372_set_mode(struct ata_port *ap, struct ata_device *adev,
  			    u8 mode)
669a5db41   Jeff Garzik   [libata] Add a bu...
474
475
476
  {
  	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  	u32 addr1, addr2;
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
477
  	u32 reg, timing, mask;
669a5db41   Jeff Garzik   [libata] Add a bu...
478
479
480
481
  	u8 fast;
  
  	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
  	addr2 = 0x51 + 4 * ap->port_no;
85cd7251b   Jeff Garzik   [libata #pata-dri...
482

669a5db41   Jeff Garzik   [libata] Add a bu...
483
484
485
486
  	/* Fast interrupt prediction disable, hold off interrupt disable */
  	pci_read_config_byte(pdev, addr2, &fast);
  	fast &= ~0x07;
  	pci_write_config_byte(pdev, addr2, fast);
85cd7251b   Jeff Garzik   [libata #pata-dri...
487

1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
488
489
490
491
492
493
494
495
496
  	/* Determine timing mask and find matching mode entry */
  	if (mode < XFER_MW_DMA_0)
  		mask = 0xcfc3ffff;
  	else if (mode < XFER_UDMA_0)
  		mask = 0x31c001ff;
  	else
  		mask = 0x303c0000;
  
  	timing = hpt37x_find_mode(ap, mode);
669a5db41   Jeff Garzik   [libata] Add a bu...
497
  	pci_read_config_dword(pdev, addr1, &reg);
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
498
499
500
  	reg = (reg & ~mask) | (timing & mask);
  	pci_write_config_dword(pdev, addr1, reg);
  }
85cd7251b   Jeff Garzik   [libata #pata-dri...
501

1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
502
503
504
505
506
507
508
509
510
511
512
  /**
   *	hpt372_set_piomode		-	PIO setup
   *	@ap: ATA interface
   *	@adev: device on the interface
   *
   *	Perform PIO mode setup.
   */
  
  static void hpt372_set_piomode(struct ata_port *ap, struct ata_device *adev)
  {
  	hpt372_set_mode(ap, adev, adev->pio_mode);
669a5db41   Jeff Garzik   [libata] Add a bu...
513
514
515
516
517
518
519
  }
  
  /**
   *	hpt372_set_dmamode		-	DMA timing setup
   *	@ap: ATA interface
   *	@adev: Device being configured
   *
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
520
   *	Set up the channel for MWDMA or UDMA modes.
669a5db41   Jeff Garzik   [libata] Add a bu...
521
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
522

669a5db41   Jeff Garzik   [libata] Add a bu...
523
524
  static void hpt372_set_dmamode(struct ata_port *ap, struct ata_device *adev)
  {
1a1b172b9   Sergei Shtylyov   pata_hpt{37x|3x2n...
525
  	hpt372_set_mode(ap, adev, adev->dma_mode);
669a5db41   Jeff Garzik   [libata] Add a bu...
526
527
528
529
530
531
532
533
  }
  
  /**
   *	hpt37x_bmdma_end		-	DMA engine stop
   *	@qc: ATA command
   *
   *	Clean up after the HPT372 and later DMA engine
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
534

669a5db41   Jeff Garzik   [libata] Add a bu...
535
536
537
538
  static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
  {
  	struct ata_port *ap = qc->ap;
  	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
6929da442   Alan Cox   [PATCH] hpt37x: T...
539
  	int mscreg = 0x50 + 4 * ap->port_no;
669a5db41   Jeff Garzik   [libata] Add a bu...
540
  	u8 bwsr_stat, msc_stat;
85cd7251b   Jeff Garzik   [libata #pata-dri...
541

669a5db41   Jeff Garzik   [libata] Add a bu...
542
543
544
545
546
547
548
549
550
  	pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
  	pci_read_config_byte(pdev, mscreg, &msc_stat);
  	if (bwsr_stat & (1 << ap->port_no))
  		pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
  	ata_bmdma_stop(qc);
  }
  
  
  static struct scsi_host_template hpt37x_sht = {
68d1d07b5   Tejun Heo   libata: implement...
551
  	ATA_BMDMA_SHT(DRV_NAME),
669a5db41   Jeff Garzik   [libata] Add a bu...
552
553
554
555
556
  };
  
  /*
   *	Configuration for HPT370
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
557

669a5db41   Jeff Garzik   [libata] Add a bu...
558
  static struct ata_port_operations hpt370_port_ops = {
029cfd6b7   Tejun Heo   libata: implement...
559
  	.inherits	= &ata_bmdma_port_ops,
669a5db41   Jeff Garzik   [libata] Add a bu...
560

669a5db41   Jeff Garzik   [libata] Add a bu...
561
  	.bmdma_stop	= hpt370_bmdma_stop,
669a5db41   Jeff Garzik   [libata] Add a bu...
562

029cfd6b7   Tejun Heo   libata: implement...
563
  	.mode_filter	= hpt370_filter,
9e87be9ed   Bartlomiej Zolnierkiewicz   pata_hpt37x: add ...
564
  	.cable_detect	= hpt37x_cable_detect,
029cfd6b7   Tejun Heo   libata: implement...
565
566
  	.set_piomode	= hpt370_set_piomode,
  	.set_dmamode	= hpt370_set_dmamode,
a1efdaba2   Tejun Heo   libata: make rese...
567
  	.prereset	= hpt37x_pre_reset,
85cd7251b   Jeff Garzik   [libata #pata-dri...
568
  };
669a5db41   Jeff Garzik   [libata] Add a bu...
569
570
571
572
  
  /*
   *	Configuration for HPT370A. Close to 370 but less filters
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
573

669a5db41   Jeff Garzik   [libata] Add a bu...
574
  static struct ata_port_operations hpt370a_port_ops = {
029cfd6b7   Tejun Heo   libata: implement...
575
  	.inherits	= &hpt370_port_ops,
669a5db41   Jeff Garzik   [libata] Add a bu...
576
  	.mode_filter	= hpt370a_filter,
85cd7251b   Jeff Garzik   [libata #pata-dri...
577
  };
669a5db41   Jeff Garzik   [libata] Add a bu...
578
579
580
581
582
  
  /*
   *	Configuration for HPT372, HPT371, HPT302. Slightly different PIO
   *	and DMA mode setting functionality.
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
583

669a5db41   Jeff Garzik   [libata] Add a bu...
584
  static struct ata_port_operations hpt372_port_ops = {
029cfd6b7   Tejun Heo   libata: implement...
585
  	.inherits	= &ata_bmdma_port_ops,
669a5db41   Jeff Garzik   [libata] Add a bu...
586

669a5db41   Jeff Garzik   [libata] Add a bu...
587
  	.bmdma_stop	= hpt37x_bmdma_stop,
669a5db41   Jeff Garzik   [libata] Add a bu...
588

9e87be9ed   Bartlomiej Zolnierkiewicz   pata_hpt37x: add ...
589
  	.cable_detect	= hpt37x_cable_detect,
029cfd6b7   Tejun Heo   libata: implement...
590
591
  	.set_piomode	= hpt372_set_piomode,
  	.set_dmamode	= hpt372_set_dmamode,
a1efdaba2   Tejun Heo   libata: make rese...
592
  	.prereset	= hpt37x_pre_reset,
85cd7251b   Jeff Garzik   [libata #pata-dri...
593
  };
669a5db41   Jeff Garzik   [libata] Add a bu...
594
595
596
  
  /*
   *	Configuration for HPT374. Mode setting works like 372 and friends
a1efdaba2   Tejun Heo   libata: make rese...
597
   *	but we have a different cable detection procedure for function 1.
669a5db41   Jeff Garzik   [libata] Add a bu...
598
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
599

a1efdaba2   Tejun Heo   libata: make rese...
600
  static struct ata_port_operations hpt374_fn1_port_ops = {
029cfd6b7   Tejun Heo   libata: implement...
601
  	.inherits	= &hpt372_port_ops,
9e87be9ed   Bartlomiej Zolnierkiewicz   pata_hpt37x: add ...
602
  	.cable_detect	= hpt374_fn1_cable_detect,
ab81a505a   Bartlomiej Zolnierkiewicz   pata_hpt37x: unif...
603
  	.prereset	= hpt37x_pre_reset,
85cd7251b   Jeff Garzik   [libata #pata-dri...
604
  };
669a5db41   Jeff Garzik   [libata] Add a bu...
605
606
  
  /**
ad452d64c   Krzysztof Halasa   trivial: fix comm...
607
   *	hpt37x_clock_slot	-	Turn timing to PC clock entry
669a5db41   Jeff Garzik   [libata] Add a bu...
608
609
610
611
612
613
   *	@freq: Reported frequency timing
   *	@base: Base timing
   *
   *	Turn the timing data intoa clock slot (0 for 33, 1 for 40, 2 for 50
   *	and 3 for 66Mhz)
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
614

669a5db41   Jeff Garzik   [libata] Add a bu...
615
616
617
618
619
620
621
622
623
624
625
626
627
628
  static int hpt37x_clock_slot(unsigned int freq, unsigned int base)
  {
  	unsigned int f = (base * freq) / 192;	/* Mhz */
  	if (f < 40)
  		return 0;	/* 33Mhz slot */
  	if (f < 45)
  		return 1;	/* 40Mhz slot */
  	if (f < 55)
  		return 2;	/* 50Mhz slot */
  	return 3;		/* 60Mhz slot */
  }
  
  /**
   *	hpt37x_calibrate_dpll		-	Calibrate the DPLL loop
85cd7251b   Jeff Garzik   [libata #pata-dri...
629
   *	@dev: PCI device
669a5db41   Jeff Garzik   [libata] Add a bu...
630
631
632
633
634
635
636
637
638
639
   *
   *	Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
   *	succeeds
   */
  
  static int hpt37x_calibrate_dpll(struct pci_dev *dev)
  {
  	u8 reg5b;
  	u32 reg5c;
  	int tries;
85cd7251b   Jeff Garzik   [libata #pata-dri...
640

669a5db41   Jeff Garzik   [libata] Add a bu...
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
  	for(tries = 0; tries < 0x5000; tries++) {
  		udelay(50);
  		pci_read_config_byte(dev, 0x5b, &reg5b);
  		if (reg5b & 0x80) {
  			/* See if it stays set */
  			for(tries = 0; tries < 0x1000; tries ++) {
  				pci_read_config_byte(dev, 0x5b, &reg5b);
  				/* Failed ? */
  				if ((reg5b & 0x80) == 0)
  					return 0;
  			}
  			/* Turn off tuning, we have the DPLL set */
  			pci_read_config_dword(dev, 0x5c, &reg5c);
  			pci_write_config_dword(dev, 0x5c, reg5c & ~ 0x100);
  			return 1;
  		}
  	}
  	/* Never went stable */
  	return 0;
  }
73946f9fc   Alan Cox   pata_hpt37x: Fix ...
661
662
663
664
665
666
  
  static u32 hpt374_read_freq(struct pci_dev *pdev)
  {
  	u32 freq;
  	unsigned long io_base = pci_resource_start(pdev, 4);
  	if (PCI_FUNC(pdev->devfn) & 1) {
40f46f178   Andrew Morton   pata_hpt37x: chec...
667
668
669
  		struct pci_dev *pdev_0;
  
  		pdev_0 = pci_get_slot(pdev->bus, pdev->devfn - 1);
73946f9fc   Alan Cox   pata_hpt37x: Fix ...
670
671
672
673
674
675
  		/* Someone hot plugged the controller on us ? */
  		if (pdev_0 == NULL)
  			return 0;
  		io_base = pci_resource_start(pdev_0, 4);
  		freq = inl(io_base + 0x90);
  		pci_dev_put(pdev_0);
40f46f178   Andrew Morton   pata_hpt37x: chec...
676
  	} else
73946f9fc   Alan Cox   pata_hpt37x: Fix ...
677
678
679
  		freq = inl(io_base + 0x90);
  	return freq;
  }
669a5db41   Jeff Garzik   [libata] Add a bu...
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
  /**
   *	hpt37x_init_one		-	Initialise an HPT37X/302
   *	@dev: PCI device
   *	@id: Entry in match table
   *
   *	Initialise an HPT37x device. There are some interesting complications
   *	here. Firstly the chip may report 366 and be one of several variants.
   *	Secondly all the timings depend on the clock for the chip which we must
   *	detect and look up
   *
   *	This is the known chip mappings. It may be missing a couple of later
   *	releases.
   *
   *	Chip version		PCI		Rev	Notes
   *	HPT366			4 (HPT366)	0	Other driver
   *	HPT366			4 (HPT366)	1	Other driver
   *	HPT368			4 (HPT366)	2	Other driver
   *	HPT370			4 (HPT366)	3	UDMA100
   *	HPT370A			4 (HPT366)	4	UDMA100
   *	HPT372			4 (HPT366)	5	UDMA133 (1)
   *	HPT372N			4 (HPT366)	6	Other driver
   *	HPT372A			5 (HPT372)	1	UDMA133 (1)
   *	HPT372N			5 (HPT372)	2	Other driver
   *	HPT302			6 (HPT302)	1	UDMA133
   *	HPT302N			6 (HPT302)	2	Other driver
   *	HPT371			7 (HPT371)	*	UDMA133
   *	HPT374			8 (HPT374)	*	UDMA133 4 channel
   *	HPT372N			9 (HPT372N)	*	Other driver
   *
   *	(1) UDMA133 support depends on the bus clock
   */
85cd7251b   Jeff Garzik   [libata #pata-dri...
711

669a5db41   Jeff Garzik   [libata] Add a bu...
712
713
714
  static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
  {
  	/* HPT370 - UDMA100 */
1626aeb88   Tejun Heo   libata: clean up ...
715
  	static const struct ata_port_info info_hpt370 = {
1d2808fd3   Jeff Garzik   [libata] PATA dri...
716
  		.flags = ATA_FLAG_SLAVE_POSS,
14bdef982   Erik Inge Bolsø   [libata] convert ...
717
718
  		.pio_mask = ATA_PIO4,
  		.mwdma_mask = ATA_MWDMA2,
bf6263a85   Jeff Garzik   [libata] Use ATA_...
719
  		.udma_mask = ATA_UDMA5,
669a5db41   Jeff Garzik   [libata] Add a bu...
720
721
722
  		.port_ops = &hpt370_port_ops
  	};
  	/* HPT370A - UDMA100 */
1626aeb88   Tejun Heo   libata: clean up ...
723
  	static const struct ata_port_info info_hpt370a = {
1d2808fd3   Jeff Garzik   [libata] PATA dri...
724
  		.flags = ATA_FLAG_SLAVE_POSS,
14bdef982   Erik Inge Bolsø   [libata] convert ...
725
726
  		.pio_mask = ATA_PIO4,
  		.mwdma_mask = ATA_MWDMA2,
bf6263a85   Jeff Garzik   [libata] Use ATA_...
727
  		.udma_mask = ATA_UDMA5,
669a5db41   Jeff Garzik   [libata] Add a bu...
728
729
  		.port_ops = &hpt370a_port_ops
  	};
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
730
  	/* HPT370 - UDMA100 */
1626aeb88   Tejun Heo   libata: clean up ...
731
  	static const struct ata_port_info info_hpt370_33 = {
1d2808fd3   Jeff Garzik   [libata] PATA dri...
732
  		.flags = ATA_FLAG_SLAVE_POSS,
14bdef982   Erik Inge Bolsø   [libata] convert ...
733
734
  		.pio_mask = ATA_PIO4,
  		.mwdma_mask = ATA_MWDMA2,
73946f9fc   Alan Cox   pata_hpt37x: Fix ...
735
  		.udma_mask = ATA_UDMA5,
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
736
737
738
  		.port_ops = &hpt370_port_ops
  	};
  	/* HPT370A - UDMA100 */
1626aeb88   Tejun Heo   libata: clean up ...
739
  	static const struct ata_port_info info_hpt370a_33 = {
1d2808fd3   Jeff Garzik   [libata] PATA dri...
740
  		.flags = ATA_FLAG_SLAVE_POSS,
14bdef982   Erik Inge Bolsø   [libata] convert ...
741
742
  		.pio_mask = ATA_PIO4,
  		.mwdma_mask = ATA_MWDMA2,
73946f9fc   Alan Cox   pata_hpt37x: Fix ...
743
  		.udma_mask = ATA_UDMA5,
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
744
745
  		.port_ops = &hpt370a_port_ops
  	};
669a5db41   Jeff Garzik   [libata] Add a bu...
746
  	/* HPT371, 372 and friends - UDMA133 */
1626aeb88   Tejun Heo   libata: clean up ...
747
  	static const struct ata_port_info info_hpt372 = {
1d2808fd3   Jeff Garzik   [libata] PATA dri...
748
  		.flags = ATA_FLAG_SLAVE_POSS,
14bdef982   Erik Inge Bolsø   [libata] convert ...
749
750
  		.pio_mask = ATA_PIO4,
  		.mwdma_mask = ATA_MWDMA2,
bf6263a85   Jeff Garzik   [libata] Use ATA_...
751
  		.udma_mask = ATA_UDMA6,
669a5db41   Jeff Garzik   [libata] Add a bu...
752
753
  		.port_ops = &hpt372_port_ops
  	};
a1efdaba2   Tejun Heo   libata: make rese...
754
755
756
  	/* HPT374 - UDMA100, function 1 uses different prereset method */
  	static const struct ata_port_info info_hpt374_fn0 = {
  		.flags = ATA_FLAG_SLAVE_POSS,
14bdef982   Erik Inge Bolsø   [libata] convert ...
757
758
  		.pio_mask = ATA_PIO4,
  		.mwdma_mask = ATA_MWDMA2,
a1efdaba2   Tejun Heo   libata: make rese...
759
760
761
762
  		.udma_mask = ATA_UDMA5,
  		.port_ops = &hpt372_port_ops
  	};
  	static const struct ata_port_info info_hpt374_fn1 = {
1d2808fd3   Jeff Garzik   [libata] PATA dri...
763
  		.flags = ATA_FLAG_SLAVE_POSS,
14bdef982   Erik Inge Bolsø   [libata] convert ...
764
765
  		.pio_mask = ATA_PIO4,
  		.mwdma_mask = ATA_MWDMA2,
bf6263a85   Jeff Garzik   [libata] Use ATA_...
766
  		.udma_mask = ATA_UDMA5,
a1efdaba2   Tejun Heo   libata: make rese...
767
  		.port_ops = &hpt374_fn1_port_ops
669a5db41   Jeff Garzik   [libata] Add a bu...
768
769
770
  	};
  
  	static const int MHz[4] = { 33, 40, 50, 66 };
1626aeb88   Tejun Heo   libata: clean up ...
771
  	void *private_data = NULL;
887125e37   Tejun Heo   libata: stop over...
772
  	const struct ata_port_info *ppi[] = { NULL, NULL };
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
773
  	u8 rev = dev->revision;
669a5db41   Jeff Garzik   [libata] Add a bu...
774
  	u8 irqmask;
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
775
  	u8 mcr1;
669a5db41   Jeff Garzik   [libata] Add a bu...
776
  	u32 freq;
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
777
  	int prefer_dpll = 1;
a617c09f6   Jeff Garzik   libata: Trim trai...
778

fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
779
  	unsigned long iobase = pci_resource_start(dev, 4);
669a5db41   Jeff Garzik   [libata] Add a bu...
780
781
782
  
  	const struct hpt_chip *chip_table;
  	int clock_slot;
f08048e94   Tejun Heo   libata: PCI devic...
783
784
785
786
787
  	int rc;
  
  	rc = pcim_enable_device(dev);
  	if (rc)
  		return rc;
669a5db41   Jeff Garzik   [libata] Add a bu...
788

669a5db41   Jeff Garzik   [libata] Add a bu...
789
790
791
  	if (dev->device == PCI_DEVICE_ID_TTI_HPT366) {
  		/* May be a later chip in disguise. Check */
  		/* Older chips are in the HPT366 driver. Ignore them */
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
792
  		if (rev < 3)
669a5db41   Jeff Garzik   [libata] Add a bu...
793
794
  			return -ENODEV;
  		/* N series chips have their own driver. Ignore */
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
795
  		if (rev == 6)
669a5db41   Jeff Garzik   [libata] Add a bu...
796
  			return -ENODEV;
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
797
  		switch(rev) {
669a5db41   Jeff Garzik   [libata] Add a bu...
798
  			case 3:
887125e37   Tejun Heo   libata: stop over...
799
  				ppi[0] = &info_hpt370;
669a5db41   Jeff Garzik   [libata] Add a bu...
800
  				chip_table = &hpt370;
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
801
  				prefer_dpll = 0;
669a5db41   Jeff Garzik   [libata] Add a bu...
802
803
  				break;
  			case 4:
887125e37   Tejun Heo   libata: stop over...
804
  				ppi[0] = &info_hpt370a;
669a5db41   Jeff Garzik   [libata] Add a bu...
805
  				chip_table = &hpt370a;
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
806
  				prefer_dpll = 0;
669a5db41   Jeff Garzik   [libata] Add a bu...
807
808
  				break;
  			case 5:
887125e37   Tejun Heo   libata: stop over...
809
  				ppi[0] = &info_hpt372;
669a5db41   Jeff Garzik   [libata] Add a bu...
810
811
812
  				chip_table = &hpt372;
  				break;
  			default:
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
813
814
815
  				printk(KERN_ERR "pata_hpt37x: Unknown HPT366 "
  				       "subtype, please report (%d).
  ", rev);
669a5db41   Jeff Garzik   [libata] Add a bu...
816
817
818
819
820
821
  				return -ENODEV;
  		}
  	} else {
  		switch(dev->device) {
  			case PCI_DEVICE_ID_TTI_HPT372:
  				/* 372N if rev >= 2*/
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
822
  				if (rev >= 2)
669a5db41   Jeff Garzik   [libata] Add a bu...
823
  					return -ENODEV;
887125e37   Tejun Heo   libata: stop over...
824
  				ppi[0] = &info_hpt372;
669a5db41   Jeff Garzik   [libata] Add a bu...
825
826
827
828
  				chip_table = &hpt372a;
  				break;
  			case PCI_DEVICE_ID_TTI_HPT302:
  				/* 302N if rev > 1 */
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
829
  				if (rev > 1)
669a5db41   Jeff Garzik   [libata] Add a bu...
830
  					return -ENODEV;
887125e37   Tejun Heo   libata: stop over...
831
  				ppi[0] = &info_hpt372;
669a5db41   Jeff Garzik   [libata] Add a bu...
832
833
834
835
  				/* Check this */
  				chip_table = &hpt302;
  				break;
  			case PCI_DEVICE_ID_TTI_HPT371:
89d3b3603   Sergei Shtylyov   ata: use pci_dev-...
836
  				if (rev > 1)
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
837
  					return -ENODEV;
887125e37   Tejun Heo   libata: stop over...
838
  				ppi[0] = &info_hpt372;
669a5db41   Jeff Garzik   [libata] Add a bu...
839
  				chip_table = &hpt371;
a47344685   Alan Cox   pata_hpt37x: Furt...
840
841
  				/* Single channel device, master is not present
  				   but the BIOS (or us for non x86) must mark it
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
842
843
844
845
  				   absent */
  				pci_read_config_byte(dev, 0x50, &mcr1);
  				mcr1 &= ~0x04;
  				pci_write_config_byte(dev, 0x50, mcr1);
669a5db41   Jeff Garzik   [libata] Add a bu...
846
847
848
  				break;
  			case PCI_DEVICE_ID_TTI_HPT374:
  				chip_table = &hpt374;
a1efdaba2   Tejun Heo   libata: make rese...
849
850
851
852
  				if (!(PCI_FUNC(dev->devfn) & 1))
  					*ppi = &info_hpt374_fn0;
  				else
  					*ppi = &info_hpt374_fn1;
669a5db41   Jeff Garzik   [libata] Add a bu...
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
  				break;
  			default:
  				printk(KERN_ERR "pata_hpt37x: PCI table is bogus please report (%d).
  ", dev->device);
  				return -ENODEV;
  		}
  	}
  	/* Ok so this is a chip we support */
  
  	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
  	pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
  	pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
  	pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
  
  	pci_read_config_byte(dev, 0x5A, &irqmask);
  	irqmask &= ~0x10;
  	pci_write_config_byte(dev, 0x5a, irqmask);
  
  	/*
  	 * default to pci clock. make sure MA15/16 are set to output
  	 * to prevent drives having problems with 40-pin cables. Needed
  	 * for some drives such as IBM-DTLA which will not enter ready
  	 * state on reset when PDIAG is a input.
  	 */
85cd7251b   Jeff Garzik   [libata #pata-dri...
877
  	pci_write_config_byte(dev, 0x5b, 0x23);
a617c09f6   Jeff Garzik   libata: Trim trai...
878

fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
879
880
881
882
883
884
  	/*
  	 * HighPoint does this for HPT372A.
  	 * NOTE: This register is only writeable via I/O space.
  	 */
  	if (chip_table == &hpt372a)
  		outb(0x0e, iobase + 0x9c);
85cd7251b   Jeff Garzik   [libata #pata-dri...
885

fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
886
  	/* Some devices do not let this value be accessed via PCI space
73946f9fc   Alan Cox   pata_hpt37x: Fix ...
887
888
889
890
891
892
893
894
895
  	   according to the old driver. In addition we must use the value
  	   from FN 0 on the HPT374 */
  
  	if (chip_table == &hpt374) {
  		freq = hpt374_read_freq(dev);
  		if (freq == 0)
  			return -ENODEV;
  	} else
  		freq = inl(iobase + 0x90);
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
896

669a5db41   Jeff Garzik   [libata] Add a bu...
897
898
899
900
  	if ((freq >> 12) != 0xABCDE) {
  		int i;
  		u8 sr;
  		u32 total = 0;
85cd7251b   Jeff Garzik   [libata #pata-dri...
901

669a5db41   Jeff Garzik   [libata] Add a bu...
902
903
  		printk(KERN_WARNING "pata_hpt37x: BIOS has not set timing clocks.
  ");
85cd7251b   Jeff Garzik   [libata #pata-dri...
904

669a5db41   Jeff Garzik   [libata] Add a bu...
905
906
907
  		/* This is the process the HPT371 BIOS is reported to use */
  		for(i = 0; i < 128; i++) {
  			pci_read_config_byte(dev, 0x78, &sr);
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
908
  			total += sr & 0x1FF;
669a5db41   Jeff Garzik   [libata] Add a bu...
909
910
911
912
913
  			udelay(15);
  		}
  		freq = total / 128;
  	}
  	freq &= 0x1FF;
85cd7251b   Jeff Garzik   [libata #pata-dri...
914

669a5db41   Jeff Garzik   [libata] Add a bu...
915
916
917
918
  	/*
  	 *	Turn the frequency check into a band and then find a timing
  	 *	table to match it.
  	 */
a617c09f6   Jeff Garzik   libata: Trim trai...
919

669a5db41   Jeff Garzik   [libata] Add a bu...
920
  	clock_slot = hpt37x_clock_slot(freq, chip_table->base);
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
921
  	if (chip_table->clocks[clock_slot] == NULL || prefer_dpll) {
669a5db41   Jeff Garzik   [libata] Add a bu...
922
923
  		/*
  		 *	We need to try PLL mode instead
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
924
925
926
  		 *
  		 *	For non UDMA133 capable devices we should
  		 *	use a 50MHz DPLL by choice
669a5db41   Jeff Garzik   [libata] Add a bu...
927
  		 */
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
928
  		unsigned int f_low, f_high;
960c8a10c   Alan Cox   pata_hpt37x: Furt...
929
  		int dpll, adjust;
a617c09f6   Jeff Garzik   libata: Trim trai...
930

960c8a10c   Alan Cox   pata_hpt37x: Furt...
931
  		/* Compute DPLL */
887125e37   Tejun Heo   libata: stop over...
932
  		dpll = (ppi[0]->udma_mask & 0xC0) ? 3 : 2;
a617c09f6   Jeff Garzik   libata: Trim trai...
933

960c8a10c   Alan Cox   pata_hpt37x: Furt...
934
  		f_low = (MHz[clock_slot] * 48) / MHz[dpll];
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
935
  		f_high = f_low + 2;
960c8a10c   Alan Cox   pata_hpt37x: Furt...
936
937
  		if (clock_slot > 1)
  			f_high += 2;
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
938
939
940
  
  		/* Select the DPLL clock. */
  		pci_write_config_byte(dev, 0x5b, 0x21);
64a817097   Alan Cox   pata_hpt37x: Fix ...
941
  		pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low | 0x100);
85cd7251b   Jeff Garzik   [libata #pata-dri...
942

669a5db41   Jeff Garzik   [libata] Add a bu...
943
944
945
946
  		for(adjust = 0; adjust < 8; adjust++) {
  			if (hpt37x_calibrate_dpll(dev))
  				break;
  			/* See if it'll settle at a fractionally different clock */
64a817097   Alan Cox   pata_hpt37x: Fix ...
947
948
949
950
951
  			if (adjust & 1)
  				f_low -= adjust >> 1;
  			else
  				f_high += adjust >> 1;
  			pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low | 0x100);
669a5db41   Jeff Garzik   [libata] Add a bu...
952
953
  		}
  		if (adjust == 8) {
80b8987c8   Sergei Shtylyov   pata_hpt{37x|3x2n...
954
955
  			printk(KERN_ERR "pata_hpt37x: DPLL did not stabilize!
  ");
669a5db41   Jeff Garzik   [libata] Add a bu...
956
957
  			return -ENODEV;
  		}
960c8a10c   Alan Cox   pata_hpt37x: Furt...
958
  		if (dpll == 3)
1626aeb88   Tejun Heo   libata: clean up ...
959
  			private_data = (void *)hpt37x_timings_66;
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
960
  		else
1626aeb88   Tejun Heo   libata: clean up ...
961
  			private_data = (void *)hpt37x_timings_50;
85cd7251b   Jeff Garzik   [libata #pata-dri...
962

80b8987c8   Sergei Shtylyov   pata_hpt{37x|3x2n...
963
964
965
  		printk(KERN_INFO "pata_hpt37x: bus clock %dMHz, using %dMHz DPLL.
  ",
  		       MHz[clock_slot], MHz[dpll]);
669a5db41   Jeff Garzik   [libata] Add a bu...
966
  	} else {
1626aeb88   Tejun Heo   libata: clean up ...
967
  		private_data = (void *)chip_table->clocks[clock_slot];
669a5db41   Jeff Garzik   [libata] Add a bu...
968
  		/*
a47344685   Alan Cox   pata_hpt37x: Furt...
969
970
971
972
  		 *	Perform a final fixup. Note that we will have used the
  		 *	DPLL on the HPT372 which means we don't have to worry
  		 *	about lack of UDMA133 support on lower clocks
   		 */
85cd7251b   Jeff Garzik   [libata #pata-dri...
973

887125e37   Tejun Heo   libata: stop over...
974
975
976
977
  		if (clock_slot < 2 && ppi[0] == &info_hpt370)
  			ppi[0] = &info_hpt370_33;
  		if (clock_slot < 2 && ppi[0] == &info_hpt370a)
  			ppi[0] = &info_hpt370a_33;
80b8987c8   Sergei Shtylyov   pata_hpt{37x|3x2n...
978
979
980
  		printk(KERN_INFO "pata_hpt37x: %s using %dMHz bus clock.
  ",
  		       chip_table->name, MHz[clock_slot]);
669a5db41   Jeff Garzik   [libata] Add a bu...
981
  	}
fcc2f69a6   Alan Cox   pata_hpt37x: Upda...
982

669a5db41   Jeff Garzik   [libata] Add a bu...
983
  	/* Now kick off ATA set up */
1c5afdf7a   Tejun Heo   libata-sff: separ...
984
  	return ata_pci_bmdma_init_one(dev, ppi, &hpt37x_sht, private_data, 0);
669a5db41   Jeff Garzik   [libata] Add a bu...
985
  }
2d2744fc8   Jeff Garzik   [libata] PCI ID t...
986
987
988
989
990
991
992
993
  static const struct pci_device_id hpt37x[] = {
  	{ PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT366), },
  	{ PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT371), },
  	{ PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT372), },
  	{ PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT374), },
  	{ PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT302), },
  
  	{ },
669a5db41   Jeff Garzik   [libata] Add a bu...
994
995
996
  };
  
  static struct pci_driver hpt37x_pci_driver = {
2d2744fc8   Jeff Garzik   [libata] PCI ID t...
997
  	.name 		= DRV_NAME,
669a5db41   Jeff Garzik   [libata] Add a bu...
998
999
1000
1001
1002
1003
1004
1005
1006
  	.id_table	= hpt37x,
  	.probe 		= hpt37x_init_one,
  	.remove		= ata_pci_remove_one
  };
  
  static int __init hpt37x_init(void)
  {
  	return pci_register_driver(&hpt37x_pci_driver);
  }
669a5db41   Jeff Garzik   [libata] Add a bu...
1007
1008
1009
1010
  static void __exit hpt37x_exit(void)
  {
  	pci_unregister_driver(&hpt37x_pci_driver);
  }
669a5db41   Jeff Garzik   [libata] Add a bu...
1011
1012
1013
1014
1015
1016
1017
1018
  MODULE_AUTHOR("Alan Cox");
  MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
  MODULE_LICENSE("GPL");
  MODULE_DEVICE_TABLE(pci, hpt37x);
  MODULE_VERSION(DRV_VERSION);
  
  module_init(hpt37x_init);
  module_exit(hpt37x_exit);