]> CyberLeo.Net >> Repos - FreeBSD/releng/8.0.git/blob - sys/dev/ata/chipsets/ata-intel.c
Adjust to reflect 8.0-RELEASE.
[FreeBSD/releng/8.0.git] / sys / dev / ata / chipsets / ata-intel.c
1 /*-
2  * Copyright (c) 1998 - 2008 Søren Schmidt <sos@FreeBSD.org>
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer,
10  *    without modification, immediately at the beginning of the file.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25  */
26
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
29
30 #include "opt_ata.h"
31 #include <sys/param.h>
32 #include <sys/module.h>
33 #include <sys/systm.h>
34 #include <sys/kernel.h>
35 #include <sys/ata.h>
36 #include <sys/bus.h>
37 #include <sys/endian.h>
38 #include <sys/malloc.h>
39 #include <sys/lock.h>
40 #include <sys/mutex.h>
41 #include <sys/sema.h>
42 #include <sys/taskqueue.h>
43 #include <vm/uma.h>
44 #include <machine/stdarg.h>
45 #include <machine/resource.h>
46 #include <machine/bus.h>
47 #include <sys/rman.h>
48 #include <dev/pci/pcivar.h>
49 #include <dev/pci/pcireg.h>
50 #include <dev/ata/ata-all.h>
51 #include <dev/ata/ata-pci.h>
52 #include <ata_if.h>
53
54 /* local prototypes */
55 static int ata_intel_chipinit(device_t dev);
56 static int ata_intel_ch_attach(device_t dev);
57 static void ata_intel_reset(device_t dev);
58 static void ata_intel_old_setmode(device_t dev, int mode);
59 static void ata_intel_new_setmode(device_t dev, int mode);
60 static void ata_intel_sata_setmode(device_t dev, int mode);
61 static int ata_intel_31244_ch_attach(device_t dev);
62 static int ata_intel_31244_ch_detach(device_t dev);
63 static int ata_intel_31244_status(device_t dev);
64 static void ata_intel_31244_tf_write(struct ata_request *request);
65 static void ata_intel_31244_reset(device_t dev);
66
67 /* misc defines */
68 #define INTEL_AHCI      1
69
70
71 /*
72  * Intel chipset support functions
73  */
74 static int
75 ata_intel_probe(device_t dev)
76 {
77     struct ata_pci_controller *ctlr = device_get_softc(dev);
78     static struct ata_chip_id ids[] =
79     {{ ATA_I82371FB,     0,          0, 2, ATA_WDMA2, "PIIX" },
80      { ATA_I82371SB,     0,          0, 2, ATA_WDMA2, "PIIX3" },
81      { ATA_I82371AB,     0,          0, 2, ATA_UDMA2, "PIIX4" },
82      { ATA_I82443MX,     0,          0, 2, ATA_UDMA2, "PIIX4" },
83      { ATA_I82451NX,     0,          0, 2, ATA_UDMA2, "PIIX4" },
84      { ATA_I82801AB,     0,          0, 2, ATA_UDMA2, "ICH0" },
85      { ATA_I82801AA,     0,          0, 2, ATA_UDMA4, "ICH" },
86      { ATA_I82372FB,     0,          0, 2, ATA_UDMA4, "ICH" },
87      { ATA_I82801BA,     0,          0, 2, ATA_UDMA5, "ICH2" },
88      { ATA_I82801BA_1,   0,          0, 2, ATA_UDMA5, "ICH2" },
89      { ATA_I82801CA,     0,          0, 2, ATA_UDMA5, "ICH3" },
90      { ATA_I82801CA_1,   0,          0, 2, ATA_UDMA5, "ICH3" },
91      { ATA_I82801DB,     0,          0, 2, ATA_UDMA5, "ICH4" },
92      { ATA_I82801DB_1,   0,          0, 2, ATA_UDMA5, "ICH4" },
93      { ATA_I82801EB,     0,          0, 2, ATA_UDMA5, "ICH5" },
94      { ATA_I82801EB_S1,  0,          0, 2, ATA_SA150, "ICH5" },
95      { ATA_I82801EB_R1,  0,          0, 2, ATA_SA150, "ICH5" },
96      { ATA_I6300ESB,     0,          0, 2, ATA_UDMA5, "6300ESB" },
97      { ATA_I6300ESB_S1,  0,          0, 2, ATA_SA150, "6300ESB" },
98      { ATA_I6300ESB_R1,  0,          0, 2, ATA_SA150, "6300ESB" },
99      { ATA_I82801FB,     0,          0, 2, ATA_UDMA5, "ICH6" },
100      { ATA_I82801FB_S1,  0, INTEL_AHCI, 0, ATA_SA150, "ICH6" },
101      { ATA_I82801FB_R1,  0, INTEL_AHCI, 0, ATA_SA150, "ICH6" },
102      { ATA_I82801FBM,    0, INTEL_AHCI, 0, ATA_SA150, "ICH6M" },
103      { ATA_I82801GB,     0,          0, 1, ATA_UDMA5, "ICH7" },
104      { ATA_I82801GB_S1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH7" },
105      { ATA_I82801GB_R1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH7" },
106      { ATA_I82801GB_AH,  0, INTEL_AHCI, 0, ATA_SA300, "ICH7" },
107      { ATA_I82801GBM_S1, 0, INTEL_AHCI, 0, ATA_SA150, "ICH7M" },
108      { ATA_I82801GBM_R1, 0, INTEL_AHCI, 0, ATA_SA150, "ICH7M" },
109      { ATA_I82801GBM_AH, 0, INTEL_AHCI, 0, ATA_SA150, "ICH7M" },
110      { ATA_I63XXESB2,    0,          0, 1, ATA_UDMA5, "63XXESB2" },
111      { ATA_I63XXESB2_S1, 0, INTEL_AHCI, 0, ATA_SA300, "63XXESB2" },
112      { ATA_I63XXESB2_S2, 0, INTEL_AHCI, 0, ATA_SA300, "63XXESB2" },
113      { ATA_I63XXESB2_R1, 0, INTEL_AHCI, 0, ATA_SA300, "63XXESB2" },
114      { ATA_I63XXESB2_R2, 0, INTEL_AHCI, 0, ATA_SA300, "63XXESB2" },
115      { ATA_I82801HB_S1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH8" },
116      { ATA_I82801HB_S2,  0, INTEL_AHCI, 0, ATA_SA300, "ICH8" },
117      { ATA_I82801HB_R1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH8" },
118      { ATA_I82801HB_AH4, 0, INTEL_AHCI, 0, ATA_SA300, "ICH8" },
119      { ATA_I82801HB_AH6, 0, INTEL_AHCI, 0, ATA_SA300, "ICH8" },
120      { ATA_I82801HBM,    0,          0, 1, ATA_UDMA5, "ICH8M" },
121      { ATA_I82801HBM_S1, 0, INTEL_AHCI, 0, ATA_SA300, "ICH8M" },
122      { ATA_I82801HBM_S2, 0, INTEL_AHCI, 0, ATA_SA300, "ICH8M" },
123      { ATA_I82801HBM_S3, 0, INTEL_AHCI, 0, ATA_SA300, "ICH8M" },
124      { ATA_I82801IB_S1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH9" },
125      { ATA_I82801IB_S2,  0, INTEL_AHCI, 0, ATA_SA300, "ICH9" },
126      { ATA_I82801IB_AH2, 0, INTEL_AHCI, 0, ATA_SA300, "ICH9" },
127      { ATA_I82801IB_AH4, 0, INTEL_AHCI, 0, ATA_SA300, "ICH9" },
128      { ATA_I82801IB_AH6, 0, INTEL_AHCI, 0, ATA_SA300, "ICH9" },
129      { ATA_I82801IB_R1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH9" },
130      { ATA_I82801JIB_S1, 0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
131      { ATA_I82801JIB_AH, 0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
132      { ATA_I82801JIB_R1, 0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
133      { ATA_I82801JIB_S2, 0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
134      { ATA_I82801JD_S1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
135      { ATA_I82801JD_AH,  0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
136      { ATA_I82801JD_R1,  0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
137      { ATA_I82801JD_S2,  0, INTEL_AHCI, 0, ATA_SA300, "ICH10" },
138      { ATA_I31244,       0,          0, 2, ATA_SA150, "31244" },
139      { 0, 0, 0, 0, 0, 0}};
140
141     if (pci_get_vendor(dev) != ATA_INTEL_ID)
142         return ENXIO;
143
144     if (!(ctlr->chip = ata_match_chip(dev, ids)))
145         return ENXIO;
146
147     ata_set_desc(dev);
148     ctlr->chipinit = ata_intel_chipinit;
149     return (BUS_PROBE_DEFAULT);
150 }
151
152 static int
153 ata_intel_chipinit(device_t dev)
154 {
155     struct ata_pci_controller *ctlr = device_get_softc(dev);
156
157     if (ata_setup_interrupt(dev, ata_generic_intr))
158         return ENXIO;
159
160     /* good old PIIX needs special treatment (not implemented) */
161     if (ctlr->chip->chipid == ATA_I82371FB) {
162         ctlr->setmode = ata_intel_old_setmode;
163     }
164
165     /* the intel 31244 needs special care if in DPA mode */
166     else if (ctlr->chip->chipid == ATA_I31244) {
167         if (pci_get_subclass(dev) != PCIS_STORAGE_IDE) {
168             ctlr->r_type2 = SYS_RES_MEMORY;
169             ctlr->r_rid2 = PCIR_BAR(0);
170             if (!(ctlr->r_res2 = bus_alloc_resource_any(dev, ctlr->r_type2,
171                                                         &ctlr->r_rid2,
172                                                         RF_ACTIVE)))
173                 return ENXIO;
174             ctlr->channels = 4;
175             ctlr->ch_attach = ata_intel_31244_ch_attach;
176             ctlr->ch_detach = ata_intel_31244_ch_detach;
177             ctlr->reset = ata_intel_31244_reset;
178         }
179         ctlr->setmode = ata_sata_setmode;
180     }
181
182     /* non SATA intel chips goes here */
183     else if (ctlr->chip->max_dma < ATA_SA150) {
184         ctlr->channels = ctlr->chip->cfg2;
185         ctlr->ch_attach = ata_intel_ch_attach;
186         ctlr->ch_detach = ata_pci_ch_detach;
187         ctlr->setmode = ata_intel_new_setmode;
188     }
189
190     /* SATA parts can be either compat or AHCI */
191     else {
192         /* force all ports active "the legacy way" */
193         pci_write_config(dev, 0x92, pci_read_config(dev, 0x92, 2) | 0x0f, 2);
194
195         ctlr->ch_attach = ata_intel_ch_attach;
196         ctlr->ch_detach = ata_pci_ch_detach;
197         ctlr->reset = ata_intel_reset;
198
199         /* 
200          * if we have AHCI capability and AHCI or RAID mode enabled
201          * in BIOS we try for AHCI mode
202          */ 
203         if ((ctlr->chip->cfg1 == INTEL_AHCI) &&
204             (pci_read_config(dev, 0x90, 1) & 0xc0) &&
205             (ata_ahci_chipinit(dev) != ENXIO))
206             return 0;
207         
208         /* if BAR(5) is IO it should point to SATA interface registers */
209         ctlr->r_type2 = SYS_RES_IOPORT;
210         ctlr->r_rid2 = PCIR_BAR(5);
211         if ((ctlr->r_res2 = bus_alloc_resource_any(dev, ctlr->r_type2,
212                                                    &ctlr->r_rid2, RF_ACTIVE)))
213             ctlr->setmode = ata_intel_sata_setmode;
214         else
215             ctlr->setmode = ata_sata_setmode;
216     }
217     return 0;
218 }
219
220 static int
221 ata_intel_ch_attach(device_t dev)
222 {
223     struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev));
224     struct ata_channel *ch = device_get_softc(dev);
225
226     /* setup the usual register normal pci style */
227     if (ata_pci_ch_attach(dev))
228         return ENXIO;
229
230     /* if r_res2 is valid it points to SATA interface registers */
231     if (ctlr->r_res2) {
232         ch->r_io[ATA_IDX_ADDR].res = ctlr->r_res2;
233         ch->r_io[ATA_IDX_ADDR].offset = 0x00;
234         ch->r_io[ATA_IDX_DATA].res = ctlr->r_res2;
235         ch->r_io[ATA_IDX_DATA].offset = 0x04;
236     }
237
238     ch->flags |= ATA_ALWAYS_DMASTAT;
239     return 0;
240 }
241
242 static void
243 ata_intel_reset(device_t dev)
244 {
245     device_t parent = device_get_parent(dev);
246     struct ata_pci_controller *ctlr = device_get_softc(parent);
247     struct ata_channel *ch = device_get_softc(dev);
248     int mask, timeout;
249
250     /* ICH6 & ICH7 in compat mode has 4 SATA ports as master/slave on 2 ch's */
251     if (ctlr->chip->cfg1) {
252         mask = (0x0005 << ch->unit);
253     }
254     else {
255         /* ICH5 in compat mode has SATA ports as master/slave on 1 channel */
256         if (pci_read_config(parent, 0x90, 1) & 0x04)
257             mask = 0x0003;
258         else {
259             mask = (0x0001 << ch->unit);
260             /* XXX SOS should be in intel_ch_attach if we grow it */
261             ch->flags |= ATA_NO_SLAVE;
262         }
263     }
264     pci_write_config(parent, 0x92, pci_read_config(parent, 0x92, 2) & ~mask, 2);
265     DELAY(10);
266     pci_write_config(parent, 0x92, pci_read_config(parent, 0x92, 2) | mask, 2);
267
268     /* wait up to 1 sec for "connect well" */
269     for (timeout = 0; timeout < 100 ; timeout++) {
270         if (((pci_read_config(parent, 0x92, 2) & (mask << 4)) == (mask << 4)) &&
271             (ATA_IDX_INB(ch, ATA_STATUS) != 0xff))
272             break;
273         ata_udelay(10000);
274     }
275     ata_generic_reset(dev);
276 }
277
278 static void
279 ata_intel_old_setmode(device_t dev, int mode)
280 {
281     /* NOT YET */
282 }
283
284 static void
285 ata_intel_new_setmode(device_t dev, int mode)
286 {
287     device_t gparent = GRANDPARENT(dev);
288     struct ata_pci_controller *ctlr = device_get_softc(gparent);
289     struct ata_channel *ch = device_get_softc(device_get_parent(dev));
290     struct ata_device *atadev = device_get_softc(dev);
291     int devno = (ch->unit << 1) + atadev->unit;
292     u_int32_t reg40 = pci_read_config(gparent, 0x40, 4);
293     u_int8_t reg44 = pci_read_config(gparent, 0x44, 1);
294     u_int8_t reg48 = pci_read_config(gparent, 0x48, 1);
295     u_int16_t reg4a = pci_read_config(gparent, 0x4a, 2);
296     u_int16_t reg54 = pci_read_config(gparent, 0x54, 2);
297     u_int32_t mask40 = 0, new40 = 0;
298     u_int8_t mask44 = 0, new44 = 0;
299     int error;
300     u_int8_t timings[] = { 0x00, 0x00, 0x10, 0x21, 0x23, 0x10, 0x21, 0x23,
301                            0x23, 0x23, 0x23, 0x23, 0x23, 0x23 };
302
303     mode = ata_limit_mode(dev, mode, ctlr->chip->max_dma);
304
305     if ( mode > ATA_UDMA2 && !(reg54 & (0x10 << devno))) {
306         ata_print_cable(dev, "controller");
307         mode = ATA_UDMA2;
308     }
309
310     error = ata_controlcmd(dev, ATA_SETFEATURES, ATA_SF_SETXFER, 0, mode);
311
312     if (bootverbose)
313         device_printf(dev, "%ssetting %s on %s chip\n",
314                       (error) ? "FAILURE " : "",
315                       ata_mode2str(mode), ctlr->chip->text);
316     if (!error) {
317         if (mode >= ATA_UDMA0) {
318             u_int8_t utimings[] = { 0x00, 0x01, 0x10, 0x01, 0x10, 0x01, 0x10 };
319
320             pci_write_config(gparent, 0x48, reg48 | (0x0001 << devno), 2);
321             pci_write_config(gparent, 0x4a,
322                              (reg4a & ~(0x3 << (devno << 2))) |
323                              (utimings[mode & ATA_MODE_MASK] << (devno<<2)), 2);
324         }
325         else {
326             pci_write_config(gparent, 0x48, reg48 & ~(0x0001 << devno), 2);
327             pci_write_config(gparent, 0x4a, (reg4a & ~(0x3 << (devno << 2))),2);
328         }
329         reg54 |= 0x0400;
330         if (mode >= ATA_UDMA2)
331             reg54 |= (0x1 << devno);
332         else
333             reg54 &= ~(0x1 << devno);
334         if (mode >= ATA_UDMA5)
335             reg54 |= (0x1000 << devno);
336         else 
337             reg54 &= ~(0x1000 << devno);
338
339         pci_write_config(gparent, 0x54, reg54, 2);
340
341         reg40 &= ~0x00ff00ff;
342         reg40 |= 0x40774077;
343
344         if (atadev->unit == ATA_MASTER) {
345             mask40 = 0x3300;
346             new40 = timings[ata_mode2idx(mode)] << 8;
347         }
348         else {
349             mask44 = 0x0f;
350             new44 = ((timings[ata_mode2idx(mode)] & 0x30) >> 2) |
351                     (timings[ata_mode2idx(mode)] & 0x03);
352         }
353         if (ch->unit) {
354             mask40 <<= 16;
355             new40 <<= 16;
356             mask44 <<= 4;
357             new44 <<= 4;
358         }
359         pci_write_config(gparent, 0x40, (reg40 & ~mask40) | new40, 4);
360         pci_write_config(gparent, 0x44, (reg44 & ~mask44) | new44, 1);
361
362         atadev->mode = mode;
363     }
364 }
365
366 static void
367 ata_intel_sata_setmode(device_t dev, int mode)
368 {
369     struct ata_device *atadev = device_get_softc(dev);
370
371     if (atadev->param.satacapabilities != 0x0000 &&
372         atadev->param.satacapabilities != 0xffff) {
373
374         struct ata_channel *ch = device_get_softc(device_get_parent(dev));
375         int devno = (ch->unit << 1) + atadev->unit;
376
377         /* on some drives we need to set the transfer mode */
378         ata_controlcmd(dev, ATA_SETFEATURES, ATA_SF_SETXFER, 0,
379                        ata_limit_mode(dev, mode, ATA_UDMA6));
380
381         /* set ATA_SSTATUS register offset */
382         ATA_IDX_OUTL(ch, ATA_IDX_ADDR, devno * 0x100);
383
384         /* query SATA STATUS for the speed */
385         if ((ATA_IDX_INL(ch, ATA_IDX_DATA) & ATA_SS_CONWELL_MASK) ==
386             ATA_SS_CONWELL_GEN2)
387             atadev->mode = ATA_SA300;
388         else
389             atadev->mode = ATA_SA150;
390     }
391     else {
392         mode = ata_limit_mode(dev, mode, ATA_UDMA5);
393         if (!ata_controlcmd(dev, ATA_SETFEATURES, ATA_SF_SETXFER, 0, mode))
394             atadev->mode = mode;
395     }
396 }
397
398 static int
399 ata_intel_31244_ch_attach(device_t dev)
400 {
401     struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev));
402     struct ata_channel *ch = device_get_softc(dev);
403     int i;
404     int ch_offset;
405
406     ata_pci_dmainit(dev);
407
408     ch_offset = 0x200 + ch->unit * 0x200;
409
410     for (i = ATA_DATA; i < ATA_MAX_RES; i++)
411         ch->r_io[i].res = ctlr->r_res2;
412
413     /* setup ATA registers */
414     ch->r_io[ATA_DATA].offset = ch_offset + 0x00;
415     ch->r_io[ATA_FEATURE].offset = ch_offset + 0x06;
416     ch->r_io[ATA_COUNT].offset = ch_offset + 0x08;
417     ch->r_io[ATA_SECTOR].offset = ch_offset + 0x0c;
418     ch->r_io[ATA_CYL_LSB].offset = ch_offset + 0x10;
419     ch->r_io[ATA_CYL_MSB].offset = ch_offset + 0x14;
420     ch->r_io[ATA_DRIVE].offset = ch_offset + 0x18;
421     ch->r_io[ATA_COMMAND].offset = ch_offset + 0x1d;
422     ch->r_io[ATA_ERROR].offset = ch_offset + 0x04;
423     ch->r_io[ATA_STATUS].offset = ch_offset + 0x1c;
424     ch->r_io[ATA_ALTSTAT].offset = ch_offset + 0x28;
425     ch->r_io[ATA_CONTROL].offset = ch_offset + 0x29;
426
427     /* setup DMA registers */
428     ch->r_io[ATA_SSTATUS].offset = ch_offset + 0x100;
429     ch->r_io[ATA_SERROR].offset = ch_offset + 0x104;
430     ch->r_io[ATA_SCONTROL].offset = ch_offset + 0x108;
431
432     /* setup SATA registers */
433     ch->r_io[ATA_BMCMD_PORT].offset = ch_offset + 0x70;
434     ch->r_io[ATA_BMSTAT_PORT].offset = ch_offset + 0x72;
435     ch->r_io[ATA_BMDTP_PORT].offset = ch_offset + 0x74;
436
437     ch->flags |= ATA_NO_SLAVE;
438     ata_pci_hw(dev);
439     ch->hw.status = ata_intel_31244_status;
440     ch->hw.tf_write = ata_intel_31244_tf_write;
441
442     /* enable PHY state change interrupt */
443     ATA_OUTL(ctlr->r_res2, 0x4,
444              ATA_INL(ctlr->r_res2, 0x04) | (0x01 << (ch->unit << 3)));
445     return 0;
446 }
447
448 static int
449 ata_intel_31244_ch_detach(device_t dev)
450 {
451
452     ata_pci_dmafini(dev);
453     return (0);
454 }
455
456 static int
457 ata_intel_31244_status(device_t dev)
458 {
459     /* do we have any PHY events ? */
460     ata_sata_phy_check_events(dev);
461
462     /* any drive action to take care of ? */
463     return ata_pci_status(dev);
464 }
465
466 static void
467 ata_intel_31244_tf_write(struct ata_request *request)
468 {
469     struct ata_channel *ch = device_get_softc(device_get_parent(request->dev));
470     struct ata_device *atadev = device_get_softc(request->dev);
471
472     if (atadev->flags & ATA_D_48BIT_ACTIVE) {
473         ATA_IDX_OUTW(ch, ATA_FEATURE, request->u.ata.feature);
474         ATA_IDX_OUTW(ch, ATA_COUNT, request->u.ata.count);
475         ATA_IDX_OUTW(ch, ATA_SECTOR, ((request->u.ata.lba >> 16) & 0xff00) |
476                                       (request->u.ata.lba & 0x00ff));
477         ATA_IDX_OUTW(ch, ATA_CYL_LSB, ((request->u.ata.lba >> 24) & 0xff00) |
478                                        ((request->u.ata.lba >> 8) & 0x00ff));
479         ATA_IDX_OUTW(ch, ATA_CYL_MSB, ((request->u.ata.lba >> 32) & 0xff00) | 
480                                        ((request->u.ata.lba >> 16) & 0x00ff));
481         ATA_IDX_OUTW(ch, ATA_DRIVE, ATA_D_LBA | ATA_DEV(atadev->unit));
482     }
483     else {
484         ATA_IDX_OUTB(ch, ATA_FEATURE, request->u.ata.feature);
485         ATA_IDX_OUTB(ch, ATA_COUNT, request->u.ata.count);
486         if (atadev->flags & ATA_D_USE_CHS) {
487             int heads, sectors;
488     
489             if (atadev->param.atavalid & ATA_FLAG_54_58) {
490                 heads = atadev->param.current_heads;
491                 sectors = atadev->param.current_sectors;
492             }
493             else {
494                 heads = atadev->param.heads;
495                 sectors = atadev->param.sectors;
496             }
497             ATA_IDX_OUTB(ch, ATA_SECTOR, (request->u.ata.lba % sectors)+1);
498             ATA_IDX_OUTB(ch, ATA_CYL_LSB,
499                          (request->u.ata.lba / (sectors * heads)));
500             ATA_IDX_OUTB(ch, ATA_CYL_MSB,
501                          (request->u.ata.lba / (sectors * heads)) >> 8);
502             ATA_IDX_OUTB(ch, ATA_DRIVE, ATA_D_IBM | ATA_DEV(atadev->unit) | 
503                          (((request->u.ata.lba% (sectors * heads)) /
504                            sectors) & 0xf));
505         }
506         else {
507             ATA_IDX_OUTB(ch, ATA_SECTOR, request->u.ata.lba);
508             ATA_IDX_OUTB(ch, ATA_CYL_LSB, request->u.ata.lba >> 8);
509             ATA_IDX_OUTB(ch, ATA_CYL_MSB, request->u.ata.lba >> 16);
510             ATA_IDX_OUTB(ch, ATA_DRIVE,
511                          ATA_D_IBM | ATA_D_LBA | ATA_DEV(atadev->unit) |
512                          ((request->u.ata.lba >> 24) & 0x0f));
513         }
514     }
515 }
516
517 static void
518 ata_intel_31244_reset(device_t dev)
519 {
520     if (ata_sata_phy_reset(dev, -1, 1))
521         ata_generic_reset(dev);
522 }
523
524 ATA_DECLARE_DRIVER(ata_intel);
525 MODULE_DEPEND(ata_intel, ata_ahci, 1, 1, 1);