ref: 5611a46d8fb04ec3fd60c05a1486743cea98a311
dir: /os/pc/sdscsi.c/
#include "u.h" #include "../port/lib.h" #include "mem.h" #include "dat.h" #include "fns.h" #include "io.h" #include "ureg.h" #include "../port/error.h" #include "../port/sd.h" static int scsitest(SDreq* r) { r->write = 0; memset(r->cmd, 0, sizeof(r->cmd)); r->cmd[1] = r->lun<<5; r->clen = 6; r->data = nil; r->dlen = 0; r->flags = 0; r->status = ~0; return r->unit->dev->ifc->rio(r); } int scsiverify(SDunit* unit) { SDreq *r; int i, status; uchar *inquiry; if((r = malloc(sizeof(SDreq))) == nil) return 0; if((inquiry = sdmalloc(sizeof(unit->inquiry))) == nil){ free(r); return 0; } r->unit = unit; r->lun = 0; /* ??? */ memset(unit->inquiry, 0, sizeof(unit->inquiry)); r->write = 0; r->cmd[0] = 0x12; r->cmd[1] = r->lun<<5; r->cmd[4] = sizeof(unit->inquiry)-1; r->clen = 6; r->data = inquiry; r->dlen = sizeof(unit->inquiry)-1; r->flags = 0; r->status = ~0; if(unit->dev->ifc->rio(r) != SDok){ free(r); return 0; } memmove(unit->inquiry, inquiry, r->dlen); free(inquiry); SET(status); for(i = 0; i < 3; i++){ while((status = scsitest(r)) == SDbusy) ; if(status == SDok || status != SDcheck) break; if(!(r->flags & SDvalidsense)) break; if((r->sense[2] & 0x0F) != 0x02) continue; /* * Unit is 'not ready'. * If it is in the process of becoming ready or needs * an initialising command, set status so it will be spun-up * below. * If there's no medium, that's OK too, but don't * try to spin it up. */ if(r->sense[12] == 0x04){ if(r->sense[13] == 0x02 || r->sense[13] == 0x01){ status = SDok; break; } } if(r->sense[12] == 0x3A) break; } if(status == SDok){ /* * Try to ensure a direct-access device is spinning. * Don't wait for completion, ignore the result. */ if((unit->inquiry[0] & 0x1F) == 0){ memset(r->cmd, 0, sizeof(r->cmd)); r->write = 0; r->cmd[0] = 0x1B; r->cmd[1] = (r->lun<<5)|0x01; r->cmd[4] = 1; r->clen = 6; r->data = nil; r->dlen = 0; r->flags = 0; r->status = ~0; unit->dev->ifc->rio(r); } } free(r); if(status == SDok || status == SDcheck) return 1; return 0; } static int scsirio(SDreq* r) { /* * Perform an I/O request, returning * -1 failure * 0 ok * 1 no medium present * 2 retry * The contents of r may be altered so the * caller should re-initialise if necesary. */ r->status = ~0; switch(r->unit->dev->ifc->rio(r)){ default: return -1; case SDcheck: if(!(r->flags & SDvalidsense)) return -1; switch(r->sense[2] & 0x0F){ case 0x00: /* no sense */ case 0x01: /* recovered error */ return 2; case 0x06: /* check condition */ /* * 0x28 - not ready to ready transition, * medium may have changed. * 0x29 - power on or some type of reset. */ if(r->sense[12] == 0x28 && r->sense[13] == 0) return 2; if(r->sense[12] == 0x29) return 2; return -1; case 0x02: /* not ready */ /* * If no medium present, bail out. * If unit is becoming ready, rather than not * not ready, wait a little then poke it again. */ if(r->sense[12] == 0x3A) return 1; if(r->sense[12] != 0x04 || r->sense[13] != 0x01) return -1; while(waserror()) ; tsleep(&up->sleep, return0, 0, 500); poperror(); scsitest(r); return 2; default: return -1; } return -1; case SDok: return 0; } return -1; } int scsionline(SDunit* unit) { SDreq *r; uchar *p; int ok, retries; if((r = malloc(sizeof(SDreq))) == nil) return 0; if((p = sdmalloc(8)) == nil){ free(r); return 0; } ok = 0; r->unit = unit; r->lun = 0; /* ??? */ for(retries = 0; retries < 10; retries++){ /* * Read-capacity is mandatory for DA, WORM, CD-ROM and * MO. It may return 'not ready' if type DA is not * spun up, type MO or type CD-ROM are not loaded or just * plain slow getting their act together after a reset. */ r->write = 0; memset(r->cmd, 0, sizeof(r->cmd)); r->cmd[0] = 0x25; r->cmd[1] = r->lun<<5; r->clen = 10; r->data = p; r->dlen = 8; r->flags = 0; r->status = ~0; switch(scsirio(r)){ default: break; case 0: unit->sectors = (p[0]<<24)|(p[1]<<16)|(p[2]<<8)|p[3]; if(unit->sectors == 0) continue; /* * Read-capacity returns the LBA of the last sector, * therefore the number of sectors must be incremented. */ unit->sectors++; unit->secsize = (p[4]<<24)|(p[5]<<16)|(p[6]<<8)|p[7]; /* * Some ATAPI CD readers lie about the block size. * Since we don't read audio via this interface * it's okay to always fudge this. */ if(unit->secsize == 2352) unit->secsize = 2048; ok = 1; break; case 1: ok = 1; break; case 2: continue; } break; } free(p); free(r); if(ok) return ok+retries; else return 0; } int scsiexec(SDunit* unit, int write, uchar* cmd, int clen, void* data, int* dlen) { SDreq *r; int status; if((r = malloc(sizeof(SDreq))) == nil) return SDmalloc; r->unit = unit; r->lun = cmd[1]>>5; /* ??? */ r->write = write; memmove(r->cmd, cmd, clen); r->clen = clen; r->data = data; if(dlen) r->dlen = *dlen; r->flags = 0; r->status = ~0; /* * Call the device-specific I/O routine. * There should be no calls to 'error()' below this * which percolate back up. */ switch(status = unit->dev->ifc->rio(r)){ case SDok: if(dlen) *dlen = r->rlen; /*FALLTHROUGH*/ case SDcheck: /*FALLTHROUGH*/ default: /* * It's more complicated than this. There are conditions * which are 'ok' but for which the returned status code * is not 'SDok'. * Also, not all conditions require a reqsense, might * need to do a reqsense here and make it available to the * caller somehow. * * Mañana. */ break; } sdfree(r); return status; } long scsibio(SDunit* unit, int lun, int write, void* data, long nb, long bno) { SDreq *r; long rlen; if((r = malloc(sizeof(SDreq))) == nil) error(Enomem); r->unit = unit; r->lun = lun; again: r->write = write; if(write == 0) r->cmd[0] = 0x28; else r->cmd[0] = 0x2A; r->cmd[1] = (lun<<5); r->cmd[2] = bno>>24; r->cmd[3] = bno>>16; r->cmd[4] = bno>>8; r->cmd[5] = bno; r->cmd[6] = 0; r->cmd[7] = nb>>8; r->cmd[8] = nb; r->cmd[9] = 0; r->clen = 10; r->data = data; r->dlen = nb*unit->secsize; r->flags = 0; r->status = ~0; switch(scsirio(r)){ default: rlen = -1; break; case 0: rlen = r->rlen; break; case 2: rlen = -1; if(!(r->flags & SDvalidsense)) break; switch(r->sense[2] & 0x0F){ default: break; case 0x06: /* check condition */ /* * Check for a removeable media change. * If so, mark it by zapping the geometry info * to force an online request. */ if(r->sense[12] != 0x28 || r->sense[13] != 0) break; if(unit->inquiry[1] & 0x80) unit->sectors = 0; break; case 0x02: /* not ready */ /* * If unit is becoming ready, * rather than not not ready, try again. */ if(r->sense[12] == 0x04 && r->sense[13] == 0x01) goto again; break; } break; } free(r); return rlen; } SDev* scsiid(SDev* sdev, SDifc* ifc) { char name[32]; static char idno[16] = "0123456789abcdef"; static char *p = idno; while(sdev){ if(sdev->ifc == ifc){ sdev->idno = *p++; snprint(name, sizeof(name), "sd%c", sdev->idno); kstrdup(&sdev->name, name); if(p >= &idno[sizeof(idno)]) break; } sdev = sdev->next; } return nil; }