?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Enable VFP unit as early as possible. This has to be so since e.g. gcc9 uses vfp...
[AROS.git] / rom / devs / ahci / ahci_scsi.c
blob2e204f4b54a1656b72b667a947024bb63ecd23f5
1 /*
2 * Copyright (C) 2012, The AROS Development Team. All rights reserved.
3 * Author: Jason S. McMullan <jason.mcmullan@gmail.com>
4 *
5 * Licensed under the AROS PUBLIC LICENSE (APL) Version 1.1
6 */
7
8 #include <exec/errors.h>
9 #include <devices/scsidisk.h>
10 #include <devices/trackdisk.h>
11 #include <scsi/commands.h>
12 #include <scsi/values.h>
13
14 #include "ahci.h"
15 #include "ahci_scsi.h"
16
17 #undef offsetof
18 #undef container_of
19
20 #define offsetof(TYPE, MEMBER) ((IPTR) &((TYPE *)0)->MEMBER)
21 #define container_of(ptr, type, member) ({ \
22 const typeof(((type *)0)->member) *__mptr = (ptr); \
23 (type *)((char *)__mptr - offsetof(type, member)); })
24
25
26 static inline UQUAD scsi_8btou64(UBYTE *addr)
27 {
28 UQUAD res = 0;
29 int i;
30
31 for (i = 0; i < 8; i++, res <<= 8, res |= *(addr++));
32 return res;
33 }
34
35 static inline ULONG scsi_4btoul(UBYTE *addr)
36 {
37 ULONG res = 0;
38 int i;
39
40 for (i = 0; i < 4; i++, res <<= 8, res |= *(addr++));
41 return res;
42 }
43
44 static inline ULONG scsi_3btoul(UBYTE *addr)
45 {
46 ULONG res = 0;
47 int i;
48
49 for (i = 0; i < 3; i++, res <<= 8, res |= *(addr++));
50 return res;
51 }
52
53 static inline ULONG scsi_2btoul(UBYTE *addr)
54 {
55 UWORD res = 0;
56 int i;
57
58 for (i = 0; i < 2; i++, res <<= 8, res |= *(addr++));
59 return res;
60 }
61
62 static inline void scsi_ulto4b(ULONG val, UBYTE *addr)
63 {
64 int i;
65 for (i = 3; i >= 0; i--, val >>= 8)
66 addr[i] = val & 0xff;
67 }
68
69 /*
70 * Construct dummy sense data for disks, and ATAPI devices
71 * that do not support extended status
72 *
73 * In the io_complete, there should a REQUEST SENSE command
74 * for ATAPI devices
75 */
76 static void ahci_ata_sense(struct ata_xfer *xa,
77 struct scsi_sense_data *sense_data)
78 {
79 struct ata_fis_d2h *rfis = &xa->rfis;
80 UBYTE asc = 0, asq = 0, key = 0;
81
82 if ((rfis->status & ATA_D2H_STATUS_BSY)) {
83 key = SSD_KEY_ABORTED_COMMAND;
84 } else {
85 /* Decode error bits */
86 switch (rfis->error & 0xff) {
87 case ATA_D2H_ERROR_BBK|ATA_D2H_ERROR_UNK|ATA_D2H_ERROR_IDNF:
88 case ATA_D2H_ERROR_BBK|ATA_D2H_ERROR_UNK|ATA_D2H_ERROR_IDNF|ATA_D2H_ERROR_AMNF:
89 /* Device busy, aborted command */
90 case ATA_D2H_ERROR_ABRT:
91 /* Aborted command */
92 key = SSD_KEY_ABORTED_COMMAND;
93 asc = 0x00; asq = 0x00; /* no additional sense code */
94 break;
95 case ATA_D2H_ERROR_UNK|ATA_D2H_ERROR_MC|ATA_D2H_ERROR_AMNF:
96 /* Hardware fault */
97 key = SSD_KEY_HARDWARE_ERROR;
98 asc = 0x44; asq = 0x00; /* internal target failure */
99 break;
100 case ATA_D2H_ERROR_BBK|ATA_D2H_ERROR_ABRT:
101 /* Data partiy error */
102 key = SSD_KEY_ABORTED_COMMAND;
103 asc = 0x4b; asq = 0x00; /* data phase error */
104 break;
105 case ATA_D2H_ERROR_MC:
106 /* No media */
107 key = SSD_KEY_NOT_READY;
108 asc = 0x3a; asq = 0x00; /* medium not present */
109 break;
110 case ATA_D2H_ERROR_MCR:
111 /* Media change request */
112 key = SSD_KEY_NOT_READY;
113 asc = 0x04; asq = 0x03; /* manual intervention required */
114 break;
115 case ATA_D2H_ERROR_MC|ATA_D2H_ERROR_IDNF|ATA_D2H_ERROR_ABRT|ATA_D2H_ERROR_TK0NF|ATA_D2H_ERROR_AMNF:
116 case ATA_D2H_ERROR_MCR|ATA_D2H_ERROR_AMNF:
117 /* Unit offline or not ready */
118 key = SSD_KEY_NOT_READY;
119 asc = 0x04; asq = 0x00; /* unknown reason */
120 break;
121 case ATA_D2H_ERROR_AMNF:
122 /* No address mark found */
123 key = SSD_KEY_MEDIUM_ERROR;
124 asc = 0x31; asq = 0x00; /* medium format corrupted */
125 break;
126 case ATA_D2H_ERROR_TK0NF:
127 /* Track 0 not found */
128 key = SSD_KEY_HARDWARE_ERROR;
129 asc = 0x02; asq = 0x00; /* no seek complete */
130 break;
131 case ATA_D2H_ERROR_IDNF:
132 /* Sector not found */
133 key = SSD_KEY_ILLEGAL_REQUEST;
134 asc = 0x21; asq = 0x00; /* LBA out of range */
135 break;
136 case ATA_D2H_ERROR_BBK:
137 /* Bad block (now defined as interface CRC in ATA8-ACS) */
138 key = SSD_KEY_ABORTED_COMMAND;
139 asc = 0x47; asq = 0x00; /* SCSI partity error */
140 break;
141 case ATA_D2H_ERROR_UNK:
142 /* ECC failure */
143 key = SSD_KEY_MEDIUM_ERROR;
144 if ((xa->fis->flags & ATA_H2D_FEATURES_DIR) == ATA_H2D_FEATURES_DIR_WRITE) {
145 asc = 0x10; asq = 0x00; /* write fault */
146 } else {
147 asc = 0x11; asq = 0x00; /* read fault */
148 }
149 break;
150 default:
151 D(bug("ahci.device: No sense translation for ATA Error 0x%02x\n", rfis->error));
152 switch (rfis->status) {
153 case ATA_D2H_STATUS_DF:
154 key = SSD_KEY_HARDWARE_ERROR;
155 asc = 0x44; asq = 0x00; /* Internal target failure */
156 break;
157 case ATA_D2H_STATUS_DRQ:
158 key = SSD_KEY_ABORTED_COMMAND;
159 asc = 0x4B; asq = 0x00; /* Data phase error */
160 break;
161 case ATA_D2H_STATUS_CORR:
162 if ((xa->fis->flags & ATA_H2D_FEATURES_DIR) == ATA_H2D_FEATURES_DIR_WRITE) {
163 key = SSD_KEY_RECOVERED_ERROR;
164 asc = 0x0c; asq = 0x01; /* Recovered write with realloc */
165 } else {
166 key = SSD_KEY_RECOVERED_ERROR;
167 asc = 0x18; asq = 0x02; /* Recovered read with realloc */
168 }
169 break;
170 default:
171 D(bug("ahci.device: No sense translation for ATA Status 0x%02x\n", rfis->status));
172 key = SSD_KEY_ABORTED_COMMAND;
173 break;
174 }
175 break;
176 }
177 }
178
179 memset(sense_data, 0, sizeof(*sense_data));
180
181 sense_data->error_code = SSD_ERRCODE_VALID | SSD_CURRENT_ERROR;
182
183 sense_data->flags = ((rfis->error & 0xF0) >> 4) | key;
184 if (rfis->error & ATA_D2H_ERROR_AMNF)
185 sense_data->flags |= SSD_ILI;
186 sense_data->add_sense_code = asc;
187 sense_data->add_sense_qual = asq;
188 }
189
190 static void ahci_io_complete(struct ata_xfer *xa)
191 {
192 struct IORequest *io = xa->atascsi_private;
193 const int sense_length = offsetof(struct scsi_sense_data, extra_bytes[0]);
194 struct cam_sim *unit = (struct cam_sim *)io->io_Unit;
195
196 switch (xa->state) {
197 case ATA_S_COMPLETE:
198 if (io->io_Command == HD_SCSICMD) {
199 struct SCSICmd *scsi = IOStdReq(io)->io_Data;
200 scsi->scsi_Status = SCSI_GOOD;
201 scsi->scsi_Actual = xa->datalen;
202 IOStdReq(io)->io_Actual = sizeof(*scsi);
203 } else {
204 IOStdReq(io)->io_Actual = xa->datalen;
205 }
206 break;
207 case ATA_S_ERROR:
208 if (io->io_Command == HD_SCSICMD) {
209 struct SCSICmd *scsi = IOStdReq(io)->io_Data;
210 D(bug("Error on HD_SCSICMD\n"));
211 scsi->scsi_Status = SCSI_CHECK_CONDITION;
212 scsi->scsi_Actual = 0;
213 IOStdReq(io)->io_Actual = sizeof(*scsi);
214 if (scsi->scsi_Flags & (SCSIF_AUTOSENSE | SCSIF_OLDAUTOSENSE)) {
215 D(bug("SCSIF_AUTOSENSE desired\n"));
216 if (scsi->scsi_SenseData && scsi->scsi_SenseLength >= sense_length) {
217 ahci_ata_sense(xa, (void *)scsi->scsi_SenseData);
218 scsi->scsi_SenseActual = sense_length;
219 D(bug("SCSI Sense: KCQ = 0x%02x 0x%02x 0x%02x\n",
220 scsi->scsi_SenseData[2],
221 scsi->scsi_SenseData[12],
222 scsi->scsi_SenseData[13]));
223 }
224 }
225 } else {
226 io->io_Error = TDERR_SeekError;
227 IOStdReq(io)->io_Actual = 0;
228 }
229 break;
230 case ATA_S_TIMEOUT:
231 if (io->io_Command == HD_SCSICMD) {
232 struct SCSICmd *scsi = IOStdReq(io)->io_Data;
233 scsi->scsi_Status = SCSI_BUSY;
234 scsi->scsi_Actual = 0;
235 IOStdReq(io)->io_Actual = sizeof(*scsi);
236 } else {
237 io->io_Error = IOERR_UNITBUSY;
238 IOStdReq(io)->io_Actual = 0;
239 }
240 break;
241 default:
242 io->io_Error = IOERR_NOCMD;
243 break;
244 }
245
246 ahci_ata_put_xfer(xa);
247
248 ObtainSemaphore(&unit->sim_Lock);
249 Remove(&io->io_Message.mn_Node);
250 ReleaseSemaphore(&unit->sim_Lock);
251
252 ASSERT(!(io->io_Flags & IOF_QUICK));
253
254 D(bug("[AHCI%02ld] IO %p Final, io_Flags = %d, io_Error = %d\n", unit->sim_Unit, io, io->io_Flags, io->io_Error));
255
256 ReplyMsg(&io->io_Message);
257 }
258
259
260 /*
261 * Simulate page inquiries for disk attachments.
262 */
263 static BYTE ahci_scsi_page_inquiry(struct ahci_port *ap, struct ata_port *at, struct SCSICmd *scsi)
264 {
265 union {
266 struct scsi_vpd_supported_page_list list;
267 struct scsi_vpd_unit_serial_number serno;
268 UBYTE buf[256];
269 } page;
270 scsi_cdb_t cdb;
271 int i;
272 int j;
273 int len;
274
275 cdb = (APTR)scsi->scsi_Command;
276
277 switch(cdb->inquiry.page_code) {
278 case SVPD_SUPPORTED_PAGE_LIST:
279 i = 0;
280 page.list.device = T_DIRECT;
281 page.list.page_code = SVPD_SUPPORTED_PAGE_LIST;
282 page.list.list[i++] = SVPD_SUPPORTED_PAGE_LIST;
283 page.list.list[i++] = SVPD_UNIT_SERIAL_NUMBER;
284 page.list.length = i;
285 len = offsetof(struct scsi_vpd_supported_page_list, list[3]);
286 break;
287 case SVPD_UNIT_SERIAL_NUMBER:
288 i = 0;
289 j = sizeof(at->at_identify.serial);
290 for (i = 0; i < j && at->at_identify.serial[i] == ' '; ++i)
291 ;
292 while (j > i && at->at_identify.serial[j-1] == ' ')
293 --j;
294 page.serno.device = T_DIRECT;
295 page.serno.page_code = SVPD_UNIT_SERIAL_NUMBER;
296 page.serno.length = j - i;
297 CopyMem(at->at_identify.serial + i,
298 page.serno.serial_num, j - i);
299 len = offsetof(struct scsi_vpd_unit_serial_number,
300 serial_num[j-i]);
301 break;
302 default:
303 return IOERR_NOCMD;
304 break;
305 }
306
307 if (len > scsi->scsi_Length)
308 return IOERR_BADLENGTH;
309
310 memset(scsi->scsi_Data + len, 0, scsi->scsi_Length - len);
311 CopyMem(&page, scsi->scsi_Data, len);
312 scsi->scsi_Actual = len;
313
314 return 0;
315 }
316
317
318 /*
319 * Convert the SCSI command to an ata_xfer command in xa
320 * for ATA_PORT_T_DISK operations. Set the completion function
321 * to convert the response back, then dispatch to the OpenBSD AHCI
322 * layer.
323 *
324 * AHCI DISK commands only support a limited command set, and we
325 * fake additional commands to make it play nice.
326 *
327 * Return TRUE if no need to wait for a reply
328 */
329 BOOL ahci_scsi_disk_io(struct IORequest *io, struct SCSICmd *scsi)
330 {
331 struct cam_sim *unit = (struct cam_sim *)io->io_Unit;
332 struct ahci_port *ap = unit->sim_Port;
333 struct ata_port *at = ap->ap_ata[0];
334 struct ata_xfer *xa;
335 struct ata_fis_h2d *fis;
336 union {
337 struct scsi_inquiry_data inquiry_data;
338 struct scsi_read_capacity_data read_capacity_data;
339 } *rdata = (APTR)scsi->scsi_Command;
340 ULONG rdata_len = scsi->scsi_CmdLength;
341 u_int64_t capacity;
342 u_int64_t lba;
343 u_int32_t count;
344 BOOL done = FALSE;
345 scsi_cdb_t cdb = (APTR)scsi->scsi_Command;
346
347 xa = ahci_ata_get_xfer(ap, at);
348
349 switch(cdb->generic.opcode) {
350 case SCSI_REQUEST_SENSE:
351 /*
352 * Auto-sense everything, so explicit sense requests
353 * return no-sense.
354 */
355 io->io_Error = HFERR_BadStatus;
356 done = TRUE;
357 break;
358 case SCSI_INQUIRY:
359 done = TRUE;
360 /*
361 * Inquiry supported features
362 *
363 * [opcode, byte2, page_code, length, control]
364 */
365 if (cdb->inquiry.byte2 & SI_EVPD) {
366 io->io_Error = ahci_scsi_page_inquiry(ap, at, scsi);
367 } else {
368 memset(rdata, 0, rdata_len);
369 if (rdata_len < SHORT_INQUIRY_LENGTH) {
370 io->io_Error = IOERR_BADLENGTH;
371 break;
372 }
373 if (rdata_len > sizeof(rdata->inquiry_data))
374 rdata_len = sizeof(rdata->inquiry_data);
375 rdata->inquiry_data.device = T_DIRECT;
376 /* Mark as removable if ATA has the 'removable' tag */
377 rdata->inquiry_data.dev_qual2 = (at->at_identify.config ? 0x80 : 0);
378 rdata->inquiry_data.version = SCSI_REV_SPC2;
379 rdata->inquiry_data.response_format = 2;
380 rdata->inquiry_data.additional_length = 32;
381
382 /*
383 * Use the vendor specific area to set the TRIM status
384 */
385 if (at->at_identify.support_dsm) {
386 rdata->inquiry_data.vendor_specific[0] =
387 at->at_identify.support_dsm &ATA_SUPPORT_DSM_TRIM;
388 rdata->inquiry_data.vendor_specific[1] =
389 at->at_identify.max_dsm_blocks;
390 }
391 CopyMem("SATA ", rdata->inquiry_data.vendor, 8);
392 CopyMem(at->at_identify.model,
393 rdata->inquiry_data.product,
394 sizeof(rdata->inquiry_data.product));
395 CopyMem(at->at_identify.firmware,
396 rdata->inquiry_data.revision,
397 sizeof(rdata->inquiry_data.revision));
398 }
399 break;
400 case SCSI_DA_READ_CAPACITY:
401 done = TRUE;
402 if (rdata_len < sizeof(rdata->read_capacity_data)) {
403 io->io_Error = IOERR_BADLENGTH;
404 break;
405 }
406
407 capacity = at->at_capacity;
408
409 memset(rdata, 0, rdata_len);
410 rdata_len = sizeof(rdata->read_capacity_data);
411 if (capacity > 0xFFFFFFFFU)
412 capacity = 0xFFFFFFFFU;
413 memset(&rdata->read_capacity_data, 0, rdata_len);
414 scsi_ulto4b((u_int32_t)capacity - 1,
415 rdata->read_capacity_data.addr);
416 scsi_ulto4b(512, rdata->read_capacity_data.length);
417 break;
418 case SCSI_DA_SYNCHRONIZE_CACHE:
419 /*
420 * Synchronize cache. Specification says this can take
421 * greater then 30 seconds so give it at least 45.
422 */
423 fis = xa->fis;
424 fis->flags = ATA_H2D_FLAGS_CMD;
425 fis->command = ATA_C_FLUSH_CACHE;
426 fis->device = 0;
427 if (xa->timeout < 45000)
428 xa->timeout = 45000;
429 xa->datalen = 0;
430 xa->flags = 0;
431 xa->complete = ahci_io_complete;
432 break;
433 case SCSI_TEST_UNIT_READY:
434 /*
435 * Just silently return success
436 */
437 done = TRUE;
438 rdata_len = 0;
439 break;
440 default:
441 switch(cdb->generic.opcode) {
442 case SCSI_DA_READ_6:
443 lba = scsi_3btoul(cdb->rw_6.addr) & 0x1FFFFF;
444 count = cdb->rw_6.length ? cdb->rw_6.length : 0x100;
445 xa->flags = ATA_F_READ;
446 break;
447 case SCSI_DA_READ_10:
448 lba = scsi_4btoul(cdb->rw_10.addr);
449 count = scsi_2btoul(cdb->rw_10.length);
450 xa->flags = ATA_F_READ;
451 break;
452 case SCSI_DA_READ_12:
453 lba = scsi_4btoul(cdb->rw_12.addr);
454 count = scsi_4btoul(cdb->rw_12.length);
455 xa->flags = ATA_F_READ;
456 break;
457 case SCSI_DA_READ_16:
458 lba = scsi_8btou64(cdb->rw_16.addr);
459 count = scsi_4btoul(cdb->rw_16.length);
460 xa->flags = ATA_F_READ;
461 break;
462 case SCSI_DA_WRITE_6:
463 lba = scsi_3btoul(cdb->rw_6.addr) & 0x1FFFFF;
464 count = cdb->rw_6.length ? cdb->rw_6.length : 0x100;
465 xa->flags = ATA_F_WRITE;
466 break;
467 case SCSI_DA_WRITE_10:
468 lba = scsi_4btoul(cdb->rw_10.addr);
469 count = scsi_2btoul(cdb->rw_10.length);
470 xa->flags = ATA_F_WRITE;
471 break;
472 case SCSI_DA_WRITE_12:
473 lba = scsi_4btoul(cdb->rw_12.addr);
474 count = scsi_4btoul(cdb->rw_12.length);
475 xa->flags = ATA_F_WRITE;
476 break;
477 case SCSI_DA_WRITE_16:
478 lba = scsi_8btou64(cdb->rw_16.addr);
479 count = scsi_4btoul(cdb->rw_16.length);
480 xa->flags = ATA_F_WRITE;
481 break;
482 default:
483 io->io_Error = IOERR_NOCMD;
484 done = TRUE;
485 break;
486 }
487 if (done)
488 break;
489
490 fis = xa->fis;
491 fis->flags = ATA_H2D_FLAGS_CMD;
492 fis->lba_low = (u_int8_t)lba;
493 fis->lba_mid = (u_int8_t)(lba >> 8);
494 fis->lba_high = (u_int8_t)(lba >> 16);
495 fis->device = ATA_H2D_DEVICE_LBA;
496
497 /*
498 * NCQ only for direct-attached disks, do not currently
499 * try to use NCQ with port multipliers.
500 */
501 if (at->at_ncqdepth > 1 &&
502 ap->ap_type == ATA_PORT_T_DISK &&
503 (ap->ap_sc->sc_cap & AHCI_REG_CAP_SNCQ)) {
504 /*
505 * Use NCQ - always uses 48 bit addressing
506 */
507 xa->flags |= ATA_F_NCQ;
508 fis->command = (xa->flags & ATA_F_WRITE) ?
509 ATA_C_WRITE_FPDMA : ATA_C_READ_FPDMA;
510 fis->lba_low_exp = (u_int8_t)(lba >> 24);
511 fis->lba_mid_exp = (u_int8_t)(lba >> 32);
512 fis->lba_high_exp = (u_int8_t)(lba >> 40);
513 fis->sector_count = xa->tag << 3;
514 fis->features = (u_int8_t)count;
515 fis->features_exp = (u_int8_t)(count >> 8);
516 } else if (count > 0x100 || lba > 0x0FFFFFFFU) {
517 /*
518 * Use LBA48
519 */
520 fis->command = (xa->flags & ATA_F_WRITE) ?
521 ATA_C_WRITEDMA_EXT : ATA_C_READDMA_EXT;
522 fis->lba_low_exp = (u_int8_t)(lba >> 24);
523 fis->lba_mid_exp = (u_int8_t)(lba >> 32);
524 fis->lba_high_exp = (u_int8_t)(lba >> 40);
525 fis->sector_count = (u_int8_t)count;
526 fis->sector_count_exp = (u_int8_t)(count >> 8);
527 } else {
528 /*
529 * Use LBA
530 *
531 * NOTE: 256 sectors is supported, stored as 0.
532 */
533 fis->command = (xa->flags & ATA_F_WRITE) ?
534 ATA_C_WRITEDMA : ATA_C_READDMA;
535 fis->device |= (u_int8_t)(lba >> 24) & 0x0F;
536 fis->sector_count = (u_int8_t)count;
537 }
538
539 xa->data = scsi->scsi_Data;
540 xa->datalen = scsi->scsi_Length;
541 xa->complete = ahci_io_complete;
542 xa->timeout = 1500; /* milliseconds */
543 #if 0
544 if (xa->timeout > 10000) /* XXX - debug */
545 xa->timeout = 10000;
546 #endif
547 break;
548 }
549
550 /*
551 * If the request is still in progress the xa and FIS have
552 * been set up (except for the PM target), and must be dispatched.
553 * Otherwise the request was completed.
554 */
555 if (!done) {
556 io->io_Flags &= ~IOF_QUICK;
557 KKASSERT(xa->complete != NULL);
558 xa->atascsi_private = io;
559 ahci_os_lock_port(ap);
560 xa->fis->flags |= at->at_target;
561 ahci_ata_cmd(xa);
562 ahci_os_unlock_port(ap);
563 } else {
564 IOStdReq(io)->io_Actual = sizeof(*scsi);
565 ahci_ata_put_xfer(xa);
566 }
567
568 return done;
569 }
570
571 /*
572 * Convert the SCSI command in ccb to an ata_xfer command in xa
573 * for ATA_PORT_T_ATAPI operations. Set the completion function
574 * to convert the response back, then dispatch to the OpenBSD AHCI
575 * layer.
576 */
577 BOOL ahci_scsi_atapi_io(struct IORequest *io, struct SCSICmd *scsi)
578 {
579 struct cam_sim *unit = (struct cam_sim *)io->io_Unit;
580 struct ahci_port *ap = unit->sim_Port;
581 struct ata_port *at = ap->ap_ata[0];
582 struct ata_xfer *xa;
583 struct ata_fis_h2d *fis;
584 scsi_cdb_t cdbs;
585 scsi_cdb_t cdbd;
586 uint32_t offset, len;
587 int flags;
588
589 if (scsi->scsi_Flags & SCSIF_READ) {
590 flags = ATA_F_PACKET | ATA_F_READ;
591 } else {
592 flags = ATA_F_PACKET | ATA_F_WRITE;
593 }
594
595 /*
596 * Special handling to get the rfis back into host memory while
597 * still allowing the chip to run commands in parallel to
598 * ATAPI devices behind a PM.
599 */
600 if (scsi->scsi_Flags & (SCSIF_AUTOSENSE | SCSIF_OLDAUTOSENSE))
601 flags |= ATA_F_AUTOSENSE;
602
603 /*
604 * The command has to fit in the packet command buffer.
605 */
606 if (scsi->scsi_CmdLength < 6 || scsi->scsi_CmdLength > 16) {
607 io->io_Error = IOERR_NOCMD;
608 return TRUE;
609 }
610
611 /*
612 * Initialize the XA and FIS. It is unclear how much of
613 * this has to mimic the equivalent ATA command.
614 *
615 * XXX not passing NULL at for direct attach!
616 */
617 xa = ahci_ata_get_xfer(ap, at);
618 if (xa == NULL) {
619 io->io_Error = IOERR_UNITBUSY;
620 return TRUE;
621 }
622 fis = xa->fis;
623
624 fis->flags = ATA_H2D_FLAGS_CMD | at->at_target;
625 fis->command = ATA_C_PACKET;
626 fis->device = ATA_H2D_DEVICE_LBA;
627 fis->sector_count = xa->tag << 3;
628 if (flags & (ATA_F_READ | ATA_F_WRITE)) {
629 if (flags & ATA_F_WRITE) {
630 fis->features = ATA_H2D_FEATURES_DMA |
631 ATA_H2D_FEATURES_DIR_WRITE;
632 } else {
633 fis->features = ATA_H2D_FEATURES_DMA |
634 ATA_H2D_FEATURES_DIR_READ;
635 }
636 } else {
637 fis->lba_mid = 0;
638 fis->lba_high = 0;
639 }
640 fis->control = ATA_FIS_CONTROL_4BIT;
641
642 xa->flags = flags;
643 xa->data = scsi->scsi_Data;
644 xa->datalen = scsi->scsi_Length;
645 xa->timeout = 5000; /* milliseconds - longer timeout for ATAPI devices */
646
647 /*
648 * Copy the cdb to the packetcmd buffer in the FIS using a
649 * convenient pointer in the xa.
650 *
651 * Zero-out any trailing bytes in case the ATAPI device cares.
652 */
653 cdbs = (void *)scsi->scsi_Command;
654 CopyMem(cdbs, xa->packetcmd, scsi->scsi_CmdLength);
655 if (scsi->scsi_CmdLength < 16)
656 memset(xa->packetcmd + scsi->scsi_CmdLength, 0, 16 - scsi->scsi_CmdLength);
657
658 #if 0
659 kprintf("opcode %d cdb_len %d dxfer_len %d\n",
660 cdbs->generic.opcode,
661 scsi->scsi_CmdLength, scsi->scsi_Length);
662 #endif
663
664 /*
665 * Some ATAPI commands do not actually follow the SCSI standard.
666 */
667 cdbd = (void *)xa->packetcmd;
668
669 switch(cdbd->generic.opcode) {
670 case SCSI_REQUEST_SENSE:
671 /*
672 * Force SENSE requests to the ATAPI sense length.
673 *
674 * It is unclear if this is needed or not.
675 */
676 if (cdbd->sense.length == SSD_FULL_SIZE) {
677 if (bootverbose) {
678 kprintf("%s: Shortening sense request\n",
679 PORTNAME(ap));
680 }
681 cdbd->sense.length = offsetof(struct scsi_sense_data,
682 extra_bytes[0]);
683 }
684 break;
685 case SCSI_INQUIRY:
686 /*
687 * Some ATAPI devices can't handle long inquiry lengths,
688 * don't ask me why. Truncate the inquiry length.
689 */
690 if (cdbd->inquiry.page_code == 0 &&
691 cdbd->inquiry.length > SHORT_INQUIRY_LENGTH) {
692 cdbd->inquiry.length = SHORT_INQUIRY_LENGTH;
693 }
694 break;
695 case SCSI_DA_READ_6:
696 case SCSI_DA_WRITE_6:
697 offset = (cdbd->rw_6.addr[0] << 16) |
698 (cdbd->rw_6.addr[1] << 8) |
699 (cdbd->rw_6.addr[2]);
700 len = cdbd->rw_6.length ? cdbd->rw_6.length : 0x100;
701 /*
702 * Convert *_6 to *_10 commands. Most ATAPI devices
703 * cannot handle the SCSI READ_6 and WRITE_6 commands.
704 */
705 cdbd->rw_10.opcode |= 0x20;
706 cdbd->rw_10.control = cdbs->rw_6.control;
707 cdbd->rw_10.byte2 = 0;
708 cdbd->rw_10.reserved = 0;
709
710 cdbd->rw_10.addr[0] = (offset >> 24) & 0xff;
711 cdbd->rw_10.addr[1] = (offset >> 16) & 0xff;
712 cdbd->rw_10.addr[2] = (offset >> 8) & 0xff;
713 cdbd->rw_10.addr[3] = (offset >> 0) & 0xff;
714
715 cdbd->rw_10.length[0] = (len >> 8) & 0xff;
716 cdbd->rw_10.length[1] = (len >> 0) & 0xff;
717 break;
718 default:
719 break;
720 }
721
722 /*
723 * And dispatch
724 */
725 io->io_Flags &= ~IOF_QUICK;
726 xa->complete = ahci_io_complete;
727 xa->atascsi_private = io;
728 ahci_os_lock_port(ap);
729 ahci_ata_cmd(xa);
730 ahci_os_unlock_port(ap);
731
732 return FALSE;
733 }
734
Mirror of AROS' svn.