Deleted Added
sdiff udiff text old ( 44566 ) new ( 45095 )
full compact
ata-all.c (44566) ata-all.c (45095)
1/*-
2 * Copyright (c) 1998,1999 S�ren Schmidt
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

--- 11 unchanged lines hidden (view full) ---

20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
1/*-
2 * Copyright (c) 1998,1999 S�ren Schmidt
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

--- 11 unchanged lines hidden (view full) ---

20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 * $Id: ata-all.c,v 1.3 1999/03/05 09:43:30 sos Exp $
28 * $Id: ata-all.c,v 1.4 1999/03/07 21:49:14 sos Exp $
29 */
30
31#include "ata.h"
32#if NATA > 0
33#include "isa.h"
34#include "pci.h"
35#include "atadisk.h"
36#include <sys/param.h>
37#include <sys/systm.h>
38#include <sys/kernel.h>
39#include <sys/interrupt.h>
40#include <sys/conf.h>
41#include <sys/buf.h>
42#include <sys/malloc.h>
43#include <sys/devicestat.h>
29 */
30
31#include "ata.h"
32#if NATA > 0
33#include "isa.h"
34#include "pci.h"
35#include "atadisk.h"
36#include <sys/param.h>
37#include <sys/systm.h>
38#include <sys/kernel.h>
39#include <sys/interrupt.h>
40#include <sys/conf.h>
41#include <sys/buf.h>
42#include <sys/malloc.h>
43#include <sys/devicestat.h>
44#include <vm/vm.h>
45#include <vm/pmap.h>
44#include <machine/clock.h>
46#include <machine/clock.h>
47#include <machine/smp.h>
45#include <pci/pcivar.h>
46#include <pci/pcireg.h>
47#include <i386/isa/icu.h>
48#include <i386/isa/isa.h>
49#include <i386/isa/isa_device.h>
50#include <dev/ata/ata-all.h>
51#include <dev/ata/ata-disk.h>
52#include <dev/ata/atapi-all.h>
53
54/* misc defines */
55#define UNIT(dev) (dev>>3 & 0x1f) /* assume 8 minor # per unit */
48#include <pci/pcivar.h>
49#include <pci/pcireg.h>
50#include <i386/isa/icu.h>
51#include <i386/isa/isa.h>
52#include <i386/isa/isa_device.h>
53#include <dev/ata/ata-all.h>
54#include <dev/ata/ata-disk.h>
55#include <dev/ata/atapi-all.h>
56
57/* misc defines */
58#define UNIT(dev) (dev>>3 & 0x1f) /* assume 8 minor # per unit */
59#define MIN(a,b) ((a)>(b)?(b):(a))
60#if NSMP == 0
61#define isa_apic_irq(x) x
62#endif
56
57/* prototypes */
58#if NISA > 0
59static int32_t ata_isaprobe(struct isa_device *);
60static int32_t ata_isaattach(struct isa_device *);
61#endif
62#if NPCI > 0
63static const char *ata_pciprobe(pcici_t, pcidi_t);
64static void ata_pciattach(pcici_t, int32_t);
65static void promise_intr(int32_t);
66#endif
63
64/* prototypes */
65#if NISA > 0
66static int32_t ata_isaprobe(struct isa_device *);
67static int32_t ata_isaattach(struct isa_device *);
68#endif
69#if NPCI > 0
70static const char *ata_pciprobe(pcici_t, pcidi_t);
71static void ata_pciattach(pcici_t, int32_t);
72static void promise_intr(int32_t);
73#endif
67static int32_t ata_probe(int32_t, int32_t, int32_t *);
74static int32_t ata_probe(int32_t, int32_t, int32_t, pcici_t, int32_t *);
68static void ataintr(int32_t);
69
70static int32_t atanlun = 0, sysctrl = 0;
71struct ata_softc *atadevices[MAXATA];
72struct isa_driver atadriver = { ata_isaprobe, ata_isaattach, "ata" };
73
74#if NISA > 0
75static int32_t
76ata_isaprobe(struct isa_device *devp)
77{
78 int32_t ctlr, res;
79
80 for (ctlr = 0; ctlr < atanlun; ctlr++) {
81 if (atadevices[ctlr]->ioaddr == devp->id_iobase) {
82 printf("ata-isa%d: already registered as ata%d\n",
83 devp->id_unit, ctlr);
84 return 0;
85 }
86 }
75static void ataintr(int32_t);
76
77static int32_t atanlun = 0, sysctrl = 0;
78struct ata_softc *atadevices[MAXATA];
79struct isa_driver atadriver = { ata_isaprobe, ata_isaattach, "ata" };
80
81#if NISA > 0
82static int32_t
83ata_isaprobe(struct isa_device *devp)
84{
85 int32_t ctlr, res;
86
87 for (ctlr = 0; ctlr < atanlun; ctlr++) {
88 if (atadevices[ctlr]->ioaddr == devp->id_iobase) {
89 printf("ata-isa%d: already registered as ata%d\n",
90 devp->id_unit, ctlr);
91 return 0;
92 }
93 }
87 res=ata_probe(devp->id_iobase, devp->id_iobase+ATA_ALTPORT, &devp->id_unit);
94 res = ata_probe(devp->id_iobase, devp->id_iobase + ATA_ALTPORT, 0, 0,
95 &devp->id_unit);
88 if (res)
89 devp->id_intr = (inthand2_t *)ataintr;
90 return res;
91}
92
93static int32_t
94ata_isaattach(struct isa_device *devp)
95{

--- 14 unchanged lines hidden (view full) ---

110{
111 u_int32_t data;
112
113 data = pci_conf_read(tag, PCI_CLASS_REG);
114 if ((data & PCI_CLASS_MASK) == PCI_CLASS_MASS_STORAGE &&
115 ((data & PCI_SUBCLASS_MASK) == 0x00010000 ||
116 ((data & PCI_SUBCLASS_MASK) == 0x00040000))) {
117 switch (type) {
96 if (res)
97 devp->id_intr = (inthand2_t *)ataintr;
98 return res;
99}
100
101static int32_t
102ata_isaattach(struct isa_device *devp)
103{

--- 14 unchanged lines hidden (view full) ---

118{
119 u_int32_t data;
120
121 data = pci_conf_read(tag, PCI_CLASS_REG);
122 if ((data & PCI_CLASS_MASK) == PCI_CLASS_MASS_STORAGE &&
123 ((data & PCI_SUBCLASS_MASK) == 0x00010000 ||
124 ((data & PCI_SUBCLASS_MASK) == 0x00040000))) {
125 switch (type) {
118 case 0x71118086:
119 return "Intel PIIX4 IDE controller";
120 case 0x70108086:
121 return "Intel PIIX3 IDE controller";
122 case 0x12308086:
123 return "Intel PIIX IDE controller";
126 case 0x12308086:
127 return "Intel PIIX IDE controller";
128 case 0x70108086:
129 return "Intel PIIX3 IDE controller";
130 case 0x71118086:
131 return "Intel PIIX4 IDE controller";
124 case 0x4d33105a:
125 return "Promise Ultra/33 IDE controller";
132 case 0x4d33105a:
133 return "Promise Ultra/33 IDE controller";
134 case 0x522910b9:
135 return "AcerLabs Aladdin IDE controller";
136#if 0
126 case 0x05711106:
127 return "VIA Apollo IDE controller";
128 case 0x01021078:
129 return "Cyrix 5530 IDE controller";
137 case 0x05711106:
138 return "VIA Apollo IDE controller";
139 case 0x01021078:
140 return "Cyrix 5530 IDE controller";
130 case 0x522910b9:
131 return "Acer Aladdin IV/V IDE controller";
141#endif
132 default:
133 return "Unknown PCI IDE controller";
134 }
135 }
136 return NULL;
137}
138
139static void
140ata_pciattach(pcici_t tag, int32_t unit)
141{
142 pcidi_t type, class, cmd;
142 default:
143 return "Unknown PCI IDE controller";
144 }
145 }
146 return NULL;
147}
148
149static void
150ata_pciattach(pcici_t tag, int32_t unit)
151{
152 pcidi_t type, class, cmd;
143 int32_t iobase_1, iobase_2, altiobase_1, altiobase_2, irq1, irq2;
153 int32_t iobase_1, iobase_2, altiobase_1, altiobase_2;
154 int32_t bmaddr_1 = 0, bmaddr_2 = 0, irq1, irq2;
144 int32_t lun;
145
146 /* set up vendor-specific stuff */
147 type = pci_conf_read(tag, PCI_ID_REG);
148 class = pci_conf_read(tag, PCI_CLASS_REG);
149 cmd = pci_conf_read(tag, PCI_COMMAND_STATUS_REG);
150
151#ifdef ATA_DEBUG
155 int32_t lun;
156
157 /* set up vendor-specific stuff */
158 type = pci_conf_read(tag, PCI_ID_REG);
159 class = pci_conf_read(tag, PCI_CLASS_REG);
160 cmd = pci_conf_read(tag, PCI_COMMAND_STATUS_REG);
161
162#ifdef ATA_DEBUG
152 printf("ata: type=%08x class=%08x cmd=%08x\n", type, class, cmd);
163 printf("ata%d: type=%08x class=%08x cmd=%08x\n", unit, type, class, cmd);
153#endif
154
164#endif
165
155 switch (type) {
156 case 0x71118086:
157 case 0x70108086:
158 case 0x12308086: /* Intel PIIX, PIIX3, PIIX4 */
159 break;
160
161 case 0x05711106: /* VIA Apollo chipset family */
162 break;
163
164 case 0x4d33105a: /* Promise controllers */
165 break;
166
167 case 0x01021078: /* Cyrix 5530 */
168 break;
169
170 case 0x522910B9: /* Acer Aladdin IV/V (M5229) */
171 break;
172 default:
173 /* everybody else */
174 break;
175 }
176
177 if (type == 0x4d33105a) { /* the Promise is special */
166 /* if this is at Promise controller handle it specially */
167 if (type == 0x4d33105a) {
178 iobase_1 = pci_conf_read(tag, 0x10) & 0xfffc;
179 altiobase_1 = pci_conf_read(tag, 0x14) & 0xfffc;
180 iobase_2 = pci_conf_read(tag, 0x18) & 0xfffc;
181 altiobase_2 = pci_conf_read(tag, 0x1c) & 0xfffc;
182 irq1 = irq2 = pci_conf_read(tag, PCI_INTERRUPT_REG) & 0xff;
168 iobase_1 = pci_conf_read(tag, 0x10) & 0xfffc;
169 altiobase_1 = pci_conf_read(tag, 0x14) & 0xfffc;
170 iobase_2 = pci_conf_read(tag, 0x18) & 0xfffc;
171 altiobase_2 = pci_conf_read(tag, 0x1c) & 0xfffc;
172 irq1 = irq2 = pci_conf_read(tag, PCI_INTERRUPT_REG) & 0xff;
173 bmaddr_1 = pci_conf_read(tag, 0x20) & 0xfffc;
174 bmaddr_2 = bmaddr_1 + ATA_BM_OFFSET1;
183 sysctrl = (pci_conf_read(tag, 0x20) & 0xfffc) + 0x1c;
175 sysctrl = (pci_conf_read(tag, 0x20) & 0xfffc) + 0x1c;
176 printf("ata-pci%d: Busmastering DMA supported\n", unit);
184 }
177 }
178 /* everybody else seems to do it this way */
185 else {
186 if ((class & 0x100) == 0) {
187 iobase_1 = IO_WD1;
188 altiobase_1 = iobase_1 + ATA_ALTPORT;
189 irq1 = 14;
190 }
191 else {
192 iobase_1 = pci_conf_read(tag, 0x10) & 0xfffc;

--- 5 unchanged lines hidden (view full) ---

198 altiobase_2 = iobase_2 + ATA_ALTPORT;
199 irq2 = 15;
200 }
201 else {
202 iobase_2 = pci_conf_read(tag, 0x18) & 0xfffc;
203 altiobase_2 = pci_conf_read(tag, 0x1c) & 0xfffc;
204 irq2 = pci_conf_read(tag, PCI_INTERRUPT_REG) & 0xff;
205 }
179 else {
180 if ((class & 0x100) == 0) {
181 iobase_1 = IO_WD1;
182 altiobase_1 = iobase_1 + ATA_ALTPORT;
183 irq1 = 14;
184 }
185 else {
186 iobase_1 = pci_conf_read(tag, 0x10) & 0xfffc;

--- 5 unchanged lines hidden (view full) ---

192 altiobase_2 = iobase_2 + ATA_ALTPORT;
193 irq2 = 15;
194 }
195 else {
196 iobase_2 = pci_conf_read(tag, 0x18) & 0xfffc;
197 altiobase_2 = pci_conf_read(tag, 0x1c) & 0xfffc;
198 irq2 = pci_conf_read(tag, PCI_INTERRUPT_REG) & 0xff;
199 }
200
201 /* is this controller busmaster capable ? */
202 if (pci_conf_read(tag, PCI_CLASS_REG) & 0x8000) {
203 /* is busmastering support turned on ? */
204 if ((pci_conf_read(tag, PCI_COMMAND_STATUS_REG) & 5) == 5) {
205 /* is there a valid port range to connect to ? */
206 if ((bmaddr_1 = pci_conf_read(tag, 0x20) & 0xfffc)) {
207 bmaddr_2 = bmaddr_1 + ATA_BM_OFFSET1;
208 printf("ata-pci%d: Busmastering DMA supported\n", unit);
209 }
210 else
211 printf("ata-pci%d: Busmastering DMA not configured\n",unit);
212 }
213 else
214 printf("ata-pci%d: Busmastering DMA not enabled\n", unit);
215 }
216 else
217 printf("ata-pci%d: Busmastering DMA not supported\n", unit);
206 }
207
208 /* now probe the addresse found for "real" ATA/ATAPI hardware */
218 }
219
220 /* now probe the addresse found for "real" ATA/ATAPI hardware */
209 if (ata_probe(iobase_1, altiobase_1, &lun)) {
221 lun = 0;
222 if (ata_probe(iobase_1, altiobase_1, bmaddr_1, tag, &lun)) {
210 if (iobase_1 == IO_WD1)
223 if (iobase_1 == IO_WD1)
211 register_intr(irq1, 0, 0, (inthand2_t *)ataintr, &bio_imask, lun);
224 register_intr(irq1, (int)"", 0, (inthand2_t *)ataintr,
225 &bio_imask, lun);
212 else {
213 if (sysctrl)
214 pci_map_int(tag, (inthand2_t *)promise_intr,
215 (void *)lun, &bio_imask);
216 else
217 pci_map_int(tag, (inthand2_t *)ataintr, (void *)lun,&bio_imask);
218 }
219 printf("ata%d at 0x%04x irq %d on ata-pci%d\n",
226 else {
227 if (sysctrl)
228 pci_map_int(tag, (inthand2_t *)promise_intr,
229 (void *)lun, &bio_imask);
230 else
231 pci_map_int(tag, (inthand2_t *)ataintr, (void *)lun,&bio_imask);
232 }
233 printf("ata%d at 0x%04x irq %d on ata-pci%d\n",
220 lun, iobase_1, irq1, unit);
234 lun, iobase_1, isa_apic_irq(irq1), unit);
221 }
235 }
222 if (ata_probe(iobase_2, altiobase_2, &lun)) {
236 lun = 1;
237 if (ata_probe(iobase_2, altiobase_2, bmaddr_2, tag, &lun)) {
223 if (iobase_2 == IO_WD2)
238 if (iobase_2 == IO_WD2)
224 register_intr(irq2, 0, 0, (inthand2_t *)ataintr, &bio_imask, lun);
239 register_intr(irq2, (int)"", 0, (inthand2_t *)ataintr,
240 &bio_imask, lun);
225 else {
226 if (!sysctrl)
227 pci_map_int(tag, (inthand2_t *)ataintr, (void *)lun,&bio_imask);
228 }
229 printf("ata%d at 0x%04x irq %d on ata-pci%d\n",
241 else {
242 if (!sysctrl)
243 pci_map_int(tag, (inthand2_t *)ataintr, (void *)lun,&bio_imask);
244 }
245 printf("ata%d at 0x%04x irq %d on ata-pci%d\n",
230 lun, iobase_2, irq2, unit);
246 lun, iobase_2, isa_apic_irq(irq2), unit);
231 }
232}
233
234static void
235promise_intr(int32_t unit)
236{
237 if (inl(sysctrl) & 0x00000400)
238 ataintr(unit);
239 if (inl(sysctrl) & 0x00004000)
240 ataintr(unit+1);
241}
242#endif
243
244static int32_t
247 }
248}
249
250static void
251promise_intr(int32_t unit)
252{
253 if (inl(sysctrl) & 0x00000400)
254 ataintr(unit);
255 if (inl(sysctrl) & 0x00004000)
256 ataintr(unit+1);
257}
258#endif
259
260static int32_t
245ata_probe(int32_t ioaddr, int32_t altioaddr, int32_t *unit)
261ata_probe(int32_t ioaddr, int32_t altioaddr, int32_t bmaddr,
262 pcici_t tag, int32_t *unit)
246{
247 struct ata_softc *scp = atadevices[atanlun];
248 int32_t mask = 0;
249 int32_t timeout;
250 int32_t lun = atanlun;
251 u_int8_t status0, status1;
252
253#ifdef ATA_STATIC_ID
254 atanlun++;
255#endif
256 if (lun > MAXATA) {
263{
264 struct ata_softc *scp = atadevices[atanlun];
265 int32_t mask = 0;
266 int32_t timeout;
267 int32_t lun = atanlun;
268 u_int8_t status0, status1;
269
270#ifdef ATA_STATIC_ID
271 atanlun++;
272#endif
273 if (lun > MAXATA) {
257 printf("ata: unit of of range(%d)\n", lun);
274 printf("ata: unit out of range(%d)\n", lun);
258 return 0;
259 }
260 if (scp) {
261 printf("ata%d: unit already attached\n", lun);
262 return 0;
263 }
264 scp = malloc(sizeof(struct ata_softc), M_DEVBUF, M_NOWAIT);
265 if (scp == NULL) {
266 printf("ata%d: failed to allocate driver storage\n", lun);
267 return 0;
268 }
269 bzero(scp, sizeof(struct ata_softc));
270
275 return 0;
276 }
277 if (scp) {
278 printf("ata%d: unit already attached\n", lun);
279 return 0;
280 }
281 scp = malloc(sizeof(struct ata_softc), M_DEVBUF, M_NOWAIT);
282 if (scp == NULL) {
283 printf("ata%d: failed to allocate driver storage\n", lun);
284 return 0;
285 }
286 bzero(scp, sizeof(struct ata_softc));
287
271 scp->unit = lun;
288 scp->unit = *unit;
289 scp->lun = lun;
272 scp->ioaddr = ioaddr;
273 scp->altioaddr = altioaddr;
274 scp->active = ATA_IDLE;
275
276#ifdef ATA_DEBUG
277 printf("ata%d: iobase=0x%04x altiobase=0x%04x\n",
290 scp->ioaddr = ioaddr;
291 scp->altioaddr = altioaddr;
292 scp->active = ATA_IDLE;
293
294#ifdef ATA_DEBUG
295 printf("ata%d: iobase=0x%04x altiobase=0x%04x\n",
278 scp->unit, scp->ioaddr, scp->altioaddr);
296 scp->lun, scp->ioaddr, scp->altioaddr);
279#endif
280
281 /* do we have any signs of ATA/ATAPI HW being present ? */
282 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
283 DELAY(1);
284 status0 = inb(scp->ioaddr + ATA_STATUS);
285 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_SLAVE);
286 DELAY(1);
287 status1 = inb(scp->ioaddr + ATA_STATUS);
288 if ((status0 & 0xf8) != 0xf8)
289 mask |= 0x01;
290 if ((status1 & 0xf8) != 0xf8)
291 mask |= 0x02;
292#ifdef ATA_DEBUG
293 printf("ata%d: mask=%02x status0=%02x status1=%02x\n",
297#endif
298
299 /* do we have any signs of ATA/ATAPI HW being present ? */
300 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
301 DELAY(1);
302 status0 = inb(scp->ioaddr + ATA_STATUS);
303 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_SLAVE);
304 DELAY(1);
305 status1 = inb(scp->ioaddr + ATA_STATUS);
306 if ((status0 & 0xf8) != 0xf8)
307 mask |= 0x01;
308 if ((status1 & 0xf8) != 0xf8)
309 mask |= 0x02;
310#ifdef ATA_DEBUG
311 printf("ata%d: mask=%02x status0=%02x status1=%02x\n",
294 scp->unit, mask, status0, status1);
312 scp->lun, mask, status0, status1);
295#endif
296 if (!mask) {
297 free(scp, M_DEVBUF);
298 return 0;
299 }
300 /* assert reset for devices and wait for completition */
301 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
302 DELAY(1);
303 outb(scp->altioaddr, ATA_A_IDS | ATA_A_RESET);
304 DELAY(1000);
305 outb(scp->altioaddr, ATA_A_IDS);
306 DELAY(1000);
307 inb(scp->ioaddr + ATA_ERROR);
313#endif
314 if (!mask) {
315 free(scp, M_DEVBUF);
316 return 0;
317 }
318 /* assert reset for devices and wait for completition */
319 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
320 DELAY(1);
321 outb(scp->altioaddr, ATA_A_IDS | ATA_A_RESET);
322 DELAY(1000);
323 outb(scp->altioaddr, ATA_A_IDS);
324 DELAY(1000);
325 inb(scp->ioaddr + ATA_ERROR);
326 DELAY(1);
308 outb(scp->altioaddr, ATA_A_4BIT);
309 DELAY(1);
310
311 /* wait for BUSY to go inactive */
312 for (timeout = 0; timeout < 30000*10; timeout++) {
313 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
314 DELAY(1);
315 status0 = inb(scp->ioaddr + ATA_STATUS);

--- 12 unchanged lines hidden (view full) ---

328 DELAY(100);
329 }
330 if (status0 & ATA_S_BSY)
331 mask &= ~0x01;
332 if (status1 & ATA_S_BSY)
333 mask &= ~0x02;
334#ifdef ATA_DEBUG
335 printf("ata%d: mask=%02x status0=%02x status1=%02x\n",
327 outb(scp->altioaddr, ATA_A_4BIT);
328 DELAY(1);
329
330 /* wait for BUSY to go inactive */
331 for (timeout = 0; timeout < 30000*10; timeout++) {
332 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
333 DELAY(1);
334 status0 = inb(scp->ioaddr + ATA_STATUS);

--- 12 unchanged lines hidden (view full) ---

347 DELAY(100);
348 }
349 if (status0 & ATA_S_BSY)
350 mask &= ~0x01;
351 if (status1 & ATA_S_BSY)
352 mask &= ~0x02;
353#ifdef ATA_DEBUG
354 printf("ata%d: mask=%02x status0=%02x status1=%02x\n",
336 scp->unit, mask, status0, status1);
355 scp->lun, mask, status0, status1);
337#endif
338 if (!mask) {
339 free(scp, M_DEVBUF);
340 return 0;
341 }
342 /*
343 * OK, we have at least one device on the chain,
344 * check for ATAPI signatures, if none check if its

--- 28 unchanged lines hidden (view full) ---

373 outb(scp->ioaddr + ATA_ERROR, 0x58);
374 outb(scp->ioaddr + ATA_CYL_LSB, 0xa5);
375 if (inb(scp->ioaddr + ATA_ERROR) != 0x58 &&
376 inb(scp->ioaddr + ATA_CYL_LSB) == 0xa5) {
377 scp->devices |= ATA_ATA_SLAVE;
378 }
379 }
380#ifdef ATA_DEBUG
356#endif
357 if (!mask) {
358 free(scp, M_DEVBUF);
359 return 0;
360 }
361 /*
362 * OK, we have at least one device on the chain,
363 * check for ATAPI signatures, if none check if its

--- 28 unchanged lines hidden (view full) ---

392 outb(scp->ioaddr + ATA_ERROR, 0x58);
393 outb(scp->ioaddr + ATA_CYL_LSB, 0xa5);
394 if (inb(scp->ioaddr + ATA_ERROR) != 0x58 &&
395 inb(scp->ioaddr + ATA_CYL_LSB) == 0xa5) {
396 scp->devices |= ATA_ATA_SLAVE;
397 }
398 }
399#ifdef ATA_DEBUG
381 printf("ata%d: devices = 0x%x\n", scp->unit, scp->devices);
400 printf("ata%d: devices = 0x%x\n", scp->lun, scp->devices);
382#endif
401#endif
383 if (!(scp->devices & (ATA_ATA_MASTER|ATA_ATAPI_MASTER)))
384 scp->flags |= ATA_F_SLAVE_ONLY;
385 if (!scp->devices) {
386 free(scp, M_DEVBUF);
387 return 0;
388 }
389 bufq_init(&scp->ata_queue);
390 TAILQ_INIT(&scp->atapi_queue);
402 if (!scp->devices) {
403 free(scp, M_DEVBUF);
404 return 0;
405 }
406 bufq_init(&scp->ata_queue);
407 TAILQ_INIT(&scp->atapi_queue);
391 *unit = scp->unit;
392 atadevices[scp->unit] = scp;
408 *unit = scp->lun;
409 scp->tag = tag;
410 if (bmaddr)
411 scp->bmaddr = bmaddr;
412 atadevices[scp->lun] = scp;
393#ifndef ATA_STATIC_ID
394 atanlun++;
395#endif
396 return ATA_IOSIZE;
397}
398
399static void
400ataintr(int32_t unit)
401{
402 struct ata_softc *scp;
403 struct atapi_request *atapi_request;
404 struct buf *ata_request;
413#ifndef ATA_STATIC_ID
414 atanlun++;
415#endif
416 return ATA_IOSIZE;
417}
418
419static void
420ataintr(int32_t unit)
421{
422 struct ata_softc *scp;
423 struct atapi_request *atapi_request;
424 struct buf *ata_request;
405
406 static int32_t intcount = 0;
407
425 static int32_t intcount = 0;
426
408#ifdef ATA_DEBUG
409 printf("ataintr: entered unit=%d\n", unit);
410#endif
411 if (unit < 0 || unit > atanlun) {
412 printf("ataintr: unit %d unusable\n", unit);
413 return;
414 }
415
416 scp = atadevices[unit];
417
418 /* find & call the responsible driver to process this interrupt */

--- 15 unchanged lines hidden (view full) ---

434 wakeup((caddr_t)scp);
435 break;
436
437 case ATA_IGNORE_INTR:
438 break;
439
440 default:
441 case ATA_IDLE:
427 if (unit < 0 || unit > atanlun) {
428 printf("ataintr: unit %d unusable\n", unit);
429 return;
430 }
431
432 scp = atadevices[unit];
433
434 /* find & call the responsible driver to process this interrupt */

--- 15 unchanged lines hidden (view full) ---

450 wakeup((caddr_t)scp);
451 break;
452
453 case ATA_IGNORE_INTR:
454 break;
455
456 default:
457 case ATA_IDLE:
442 if (intcount++ < 5)
443 printf("ata%d: unwanted interrupt\n", unit);
458 if (intcount++ < 10)
459 printf("ata%d: unwanted interrupt %d\n", unit, intcount);
460 inb(scp->ioaddr + ATA_STATUS);
444 return;
445 }
446 scp->active = ATA_IDLE;
447 ata_start(scp);
448}
449
450void
451ata_start(struct ata_softc *scp)
452{
453 struct buf *ata_request;
454 struct atapi_request *atapi_request;
455
456#ifdef ATA_DEBUG
457 printf("ata_start: entered\n");
458#endif
461 return;
462 }
463 scp->active = ATA_IDLE;
464 ata_start(scp);
465}
466
467void
468ata_start(struct ata_softc *scp)
469{
470 struct buf *ata_request;
471 struct atapi_request *atapi_request;
472
473#ifdef ATA_DEBUG
474 printf("ata_start: entered\n");
475#endif
459 if (scp->active) {
476 if (scp->active != ATA_IDLE) {
460 printf("ata: unwanted ata_start\n");
461 return;
462 }
463
477 printf("ata: unwanted ata_start\n");
478 return;
479 }
480
481#if NATADISK > 0
464 /* find & call the responsible driver if anything on ATA queue */
465 if ((ata_request = bufq_first(&scp->ata_queue))) {
466 scp->active = ATA_ACTIVE_ATA;
467 ad_transfer(ata_request);
482 /* find & call the responsible driver if anything on ATA queue */
483 if ((ata_request = bufq_first(&scp->ata_queue))) {
484 scp->active = ATA_ACTIVE_ATA;
485 ad_transfer(ata_request);
486#ifdef ATA_DEBUG
487 printf("ata_start: started ata, leaving\n");
488#endif
489 return;
468 }
490 }
491#endif
469
470 /* find & call the responsible driver if anything on ATAPI queue */
471 if ((atapi_request = TAILQ_FIRST(&scp->atapi_queue))) {
472 scp->active = ATA_ACTIVE_ATAPI;
473 atapi_transfer(atapi_request);
492
493 /* find & call the responsible driver if anything on ATAPI queue */
494 if ((atapi_request = TAILQ_FIRST(&scp->atapi_queue))) {
495 scp->active = ATA_ACTIVE_ATAPI;
496 atapi_transfer(atapi_request);
497#ifdef ATA_DEBUG
498 printf("ata_start: started atapi, leaving\n");
499#endif
500 return;
474 }
475}
476
477int32_t
501 }
502}
503
504int32_t
478ata_wait(struct ata_softc *scp, u_int8_t mask)
505ata_wait(struct ata_softc *scp, int32_t device, u_int8_t mask)
479{
480 u_int8_t status;
481 u_int32_t timeout = 0;
482
506{
507 u_int8_t status;
508 u_int32_t timeout = 0;
509
483 while (timeout++ <= 50000) { /* timeout 5 secs */
510 while (timeout++ <= 500000) { /* timeout 5 secs */
484 status = inb(scp->ioaddr + ATA_STATUS);
511 status = inb(scp->ioaddr + ATA_STATUS);
485 if ((status == 0xff) && (scp->flags & ATA_F_SLAVE_ONLY)) {
486 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_SLAVE);
512
513 /* if drive fails status, reselect the drive just to be sure */
514 if (status == 0xff) {
515 printf("ata%d: %s: no status, reselecting device\n",
516 scp->lun, device?"slave":"master");
517 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | device);
487 DELAY(1);
488 status = inb(scp->ioaddr + ATA_STATUS);
489 }
490 if (status == 0xff)
491 return -1;
492 scp->status = status;
493 if (!(status & ATA_S_BSY)) {
494 if (status & ATA_S_ERROR)

--- 7 unchanged lines hidden (view full) ---

502 DELAY(10);
503 }
504 return -1;
505}
506
507int32_t
508ata_command(struct ata_softc *scp, int32_t device, u_int32_t command,
509 u_int32_t cylinder, u_int32_t head, u_int32_t sector,
518 DELAY(1);
519 status = inb(scp->ioaddr + ATA_STATUS);
520 }
521 if (status == 0xff)
522 return -1;
523 scp->status = status;
524 if (!(status & ATA_S_BSY)) {
525 if (status & ATA_S_ERROR)

--- 7 unchanged lines hidden (view full) ---

533 DELAY(10);
534 }
535 return -1;
536}
537
538int32_t
539ata_command(struct ata_softc *scp, int32_t device, u_int32_t command,
540 u_int32_t cylinder, u_int32_t head, u_int32_t sector,
510 u_int32_t count, int32_t flags)
541 u_int32_t count, u_int32_t feature, int32_t flags)
511{
542{
543#ifdef ATA_DEBUG
544printf("ata_command: addr=%04x, device=%02x, cmd=%02x, c=%d, h=%d, s=%d, count=%d, flags=%02x\n", scp->ioaddr, device, command, cylinder, head, sector, count, flags);
545#endif
546
512 /* ready to issue command ? */
547 /* ready to issue command ? */
513 if (ata_wait(scp, 0) < 0) {
514 printf("ata_command: timeout waiting to give command");
515 return -1;
548 if (ata_wait(scp, device, 0) < 0) {
549 printf("ata%d: %s: timeout waiting to give command s=%02x e=%02x\n",
550 scp->lun, device?"slave":"master", scp->status, scp->error);
516 }
551 }
517 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | device | head);
518 outb(scp->ioaddr + ATA_PRECOMP, 0); /* no precompensation */
552 outb(scp->ioaddr + ATA_FEATURE, feature);
519 outb(scp->ioaddr + ATA_CYL_LSB, cylinder);
520 outb(scp->ioaddr + ATA_CYL_MSB, cylinder >> 8);
553 outb(scp->ioaddr + ATA_CYL_LSB, cylinder);
554 outb(scp->ioaddr + ATA_CYL_MSB, cylinder >> 8);
555 outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | device | head);
521 outb(scp->ioaddr + ATA_SECTOR, sector);
522 outb(scp->ioaddr + ATA_COUNT, count);
523
556 outb(scp->ioaddr + ATA_SECTOR, sector);
557 outb(scp->ioaddr + ATA_COUNT, count);
558
524 if (scp->active && flags != ATA_IMMEDIATE)
559 if (scp->active != ATA_IDLE && flags != ATA_IMMEDIATE)
525 printf("DANGER active=%d\n", scp->active);
526
527 switch (flags) {
528 case ATA_WAIT_INTR:
529 scp->active = ATA_WAIT_INTR;
530 outb(scp->ioaddr + ATA_CMD, command);
531 if (tsleep((caddr_t)scp, PRIBIO, "atacmd", 500)) {
532 printf("ata_command: timeout waiting for interrupt");

--- 7 unchanged lines hidden (view full) ---

540 outb(scp->ioaddr + ATA_CMD, command);
541 break;
542
543 case ATA_IMMEDIATE:
544 default:
545 outb(scp->ioaddr + ATA_CMD, command);
546 break;
547 }
560 printf("DANGER active=%d\n", scp->active);
561
562 switch (flags) {
563 case ATA_WAIT_INTR:
564 scp->active = ATA_WAIT_INTR;
565 outb(scp->ioaddr + ATA_CMD, command);
566 if (tsleep((caddr_t)scp, PRIBIO, "atacmd", 500)) {
567 printf("ata_command: timeout waiting for interrupt");

--- 7 unchanged lines hidden (view full) ---

575 outb(scp->ioaddr + ATA_CMD, command);
576 break;
577
578 case ATA_IMMEDIATE:
579 default:
580 outb(scp->ioaddr + ATA_CMD, command);
581 break;
582 }
583#ifdef ATA_DEBUG
584printf("ata_command: leaving\n");
585#endif
548 return 0;
549}
550
551void
552bswap(int8_t *buf, int32_t len)
553{
554 u_int16_t *p = (u_int16_t*)(buf + len);
555

--- 26 unchanged lines hidden (view full) ---

582 continue;
583 }
584 if (src[i] == ' ')
585 blank = 1;
586 dst[j++] = src[i];
587 }
588 dst[j] = 0x00;
589}
586 return 0;
587}
588
589void
590bswap(int8_t *buf, int32_t len)
591{
592 u_int16_t *p = (u_int16_t*)(buf + len);
593

--- 26 unchanged lines hidden (view full) ---

620 continue;
621 }
622 if (src[i] == ' ')
623 blank = 1;
624 dst[j++] = src[i];
625 }
626 dst[j] = 0x00;
627}
590#endif
628#endif /* NATA > 0 */