2008-08-27 15:05:00 +00:00
|
|
|
|
/* scsi.c - scsi support. */
|
|
|
|
|
/*
|
|
|
|
|
* GRUB -- GRand Unified Bootloader
|
2010-01-03 22:05:07 +00:00
|
|
|
|
* Copyright (C) 2008,2009 Free Software Foundation, Inc.
|
2008-08-27 15:05:00 +00:00
|
|
|
|
*
|
|
|
|
|
* GRUB is free software: you can redistribute it and/or modify
|
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
|
|
|
* (at your option) any later version.
|
|
|
|
|
*
|
|
|
|
|
* GRUB is distributed in the hope that it will be useful,
|
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
|
*
|
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
|
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include <grub/disk.h>
|
|
|
|
|
#include <grub/dl.h>
|
|
|
|
|
#include <grub/kernel.h>
|
|
|
|
|
#include <grub/misc.h>
|
|
|
|
|
#include <grub/mm.h>
|
|
|
|
|
#include <grub/types.h>
|
|
|
|
|
#include <grub/scsi.h>
|
|
|
|
|
#include <grub/scsicmd.h>
|
2010-05-31 12:11:41 +00:00
|
|
|
|
#include <grub/time.h>
|
2012-02-12 14:25:25 +00:00
|
|
|
|
#include <grub/i18n.h>
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
2011-04-11 21:01:51 +00:00
|
|
|
|
GRUB_MOD_LICENSE ("GPLv3+");
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
static grub_scsi_dev_t grub_scsi_dev_list;
|
|
|
|
|
|
2011-06-23 22:07:55 +00:00
|
|
|
|
const char grub_scsi_names[GRUB_SCSI_NUM_SUBSYSTEMS][5] = {
|
2010-12-24 15:07:53 +00:00
|
|
|
|
[GRUB_SCSI_SUBSYSTEM_USBMS] = "usb",
|
|
|
|
|
[GRUB_SCSI_SUBSYSTEM_PATA] = "ata",
|
|
|
|
|
[GRUB_SCSI_SUBSYSTEM_AHCI] = "ahci"
|
|
|
|
|
};
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
void
|
|
|
|
|
grub_scsi_dev_register (grub_scsi_dev_t dev)
|
|
|
|
|
{
|
|
|
|
|
dev->next = grub_scsi_dev_list;
|
|
|
|
|
grub_scsi_dev_list = dev;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void
|
|
|
|
|
grub_scsi_dev_unregister (grub_scsi_dev_t dev)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_dev_t *p, q;
|
2009-01-27 18:26:09 +00:00
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
for (p = &grub_scsi_dev_list, q = *p; q; p = &(q->next), q = q->next)
|
|
|
|
|
if (q == dev)
|
|
|
|
|
{
|
|
|
|
|
*p = q->next;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
2010-05-31 12:11:41 +00:00
|
|
|
|
/* Check result of previous operation. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_request_sense (grub_scsi_t scsi)
|
|
|
|
|
{
|
|
|
|
|
struct grub_scsi_request_sense rs;
|
|
|
|
|
struct grub_scsi_request_sense_data rsd;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
|
|
|
|
|
rs.opcode = grub_scsi_cmd_request_sense;
|
|
|
|
|
rs.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
rs.reserved1 = 0;
|
|
|
|
|
rs.reserved2 = 0;
|
|
|
|
|
rs.alloc_length = 0x12; /* XXX: Hardcoded for now */
|
|
|
|
|
rs.control = 0;
|
|
|
|
|
grub_memset (rs.pad, 0, sizeof(rs.pad));
|
|
|
|
|
|
|
|
|
|
err = scsi->dev->read (scsi, sizeof (rs), (char *) &rs,
|
|
|
|
|
sizeof (rsd), (char *) &rsd);
|
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
|
}
|
|
|
|
|
/* Self commenting... */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_test_unit_ready (grub_scsi_t scsi)
|
|
|
|
|
{
|
|
|
|
|
struct grub_scsi_test_unit_ready tur;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
|
|
|
|
|
|
|
|
|
tur.opcode = grub_scsi_cmd_test_unit_ready;
|
|
|
|
|
tur.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
tur.reserved1 = 0;
|
|
|
|
|
tur.reserved2 = 0;
|
|
|
|
|
tur.reserved3 = 0;
|
|
|
|
|
tur.control = 0;
|
|
|
|
|
grub_memset (tur.pad, 0, sizeof(tur.pad));
|
|
|
|
|
|
|
|
|
|
err = scsi->dev->read (scsi, sizeof (tur), (char *) &tur,
|
|
|
|
|
0, NULL);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Determine if the device is removable and the type of the device
|
2009-01-27 18:26:09 +00:00
|
|
|
|
SCSI. */
|
2008-08-27 15:05:00 +00:00
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_inquiry (grub_scsi_t scsi)
|
|
|
|
|
{
|
|
|
|
|
struct grub_scsi_inquiry iq;
|
|
|
|
|
struct grub_scsi_inquiry_data iqd;
|
|
|
|
|
grub_err_t err;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
grub_err_t err_sense;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
iq.opcode = grub_scsi_cmd_inquiry;
|
|
|
|
|
iq.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
iq.page = 0;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
iq.reserved = 0;
|
|
|
|
|
iq.alloc_length = 0x24; /* XXX: Hardcoded for now */
|
2010-05-31 12:11:41 +00:00
|
|
|
|
iq.control = 0;
|
|
|
|
|
grub_memset (iq.pad, 0, sizeof(iq.pad));
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
err = scsi->dev->read (scsi, sizeof (iq), (char *) &iq,
|
|
|
|
|
sizeof (iqd), (char *) &iqd);
|
2010-05-31 12:11:41 +00:00
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
|
|
|
|
|
scsi->devtype = iqd.devtype & GRUB_SCSI_DEVTYPE_MASK;
|
|
|
|
|
scsi->removable = iqd.rmb >> GRUB_SCSI_REMOVABLE_BIT;
|
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Read the capacity and block size of SCSI. */
|
|
|
|
|
static grub_err_t
|
2012-01-30 17:33:11 +00:00
|
|
|
|
grub_scsi_read_capacity10 (grub_scsi_t scsi)
|
2008-08-27 15:05:00 +00:00
|
|
|
|
{
|
2012-01-30 17:33:11 +00:00
|
|
|
|
struct grub_scsi_read_capacity10 rc;
|
|
|
|
|
struct grub_scsi_read_capacity10_data rcd;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
grub_err_t err;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
grub_err_t err_sense;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
2012-01-30 17:33:11 +00:00
|
|
|
|
rc.opcode = grub_scsi_cmd_read_capacity10;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
rc.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
rc.logical_block_addr = 0;
|
|
|
|
|
rc.reserved1 = 0;
|
|
|
|
|
rc.reserved2 = 0;
|
|
|
|
|
rc.PMI = 0;
|
|
|
|
|
rc.control = 0;
|
|
|
|
|
rc.pad = 0;
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
err = scsi->dev->read (scsi, sizeof (rc), (char *) &rc,
|
|
|
|
|
sizeof (rcd), (char *) &rcd);
|
2010-05-31 12:11:41 +00:00
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
|
2012-01-30 17:33:11 +00:00
|
|
|
|
scsi->last_block = grub_be_to_cpu32 (rcd.last_block);
|
|
|
|
|
scsi->blocksize = grub_be_to_cpu32 (rcd.blocksize);
|
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Read the capacity and block size of SCSI. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_read_capacity16 (grub_scsi_t scsi)
|
|
|
|
|
{
|
|
|
|
|
struct grub_scsi_read_capacity16 rc;
|
|
|
|
|
struct grub_scsi_read_capacity16_data rcd;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
|
|
|
|
|
|
|
|
|
rc.opcode = grub_scsi_cmd_read_capacity16;
|
|
|
|
|
rc.lun = (scsi->lun << GRUB_SCSI_LUN_SHIFT) | 0x10;
|
|
|
|
|
rc.logical_block_addr = 0;
|
|
|
|
|
rc.alloc_len = grub_cpu_to_be32 (sizeof (rcd));
|
|
|
|
|
rc.PMI = 0;
|
|
|
|
|
rc.control = 0;
|
|
|
|
|
|
|
|
|
|
err = scsi->dev->read (scsi, sizeof (rc), (char *) &rc,
|
|
|
|
|
sizeof (rcd), (char *) &rcd);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
|
|
|
|
|
scsi->last_block = grub_be_to_cpu64 (rcd.last_block);
|
2008-08-27 15:05:00 +00:00
|
|
|
|
scsi->blocksize = grub_be_to_cpu32 (rcd.blocksize);
|
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Send a SCSI request for DISK: read SIZE sectors starting with
|
|
|
|
|
sector SECTOR to BUF. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_read10 (grub_disk_t disk, grub_disk_addr_t sector,
|
|
|
|
|
grub_size_t size, char *buf)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
struct grub_scsi_read10 rd;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
|
|
|
|
rd.opcode = grub_scsi_cmd_read10;
|
|
|
|
|
rd.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
rd.lba = grub_cpu_to_be32 (sector);
|
|
|
|
|
rd.reserved = 0;
|
|
|
|
|
rd.size = grub_cpu_to_be16 (size);
|
|
|
|
|
rd.reserved2 = 0;
|
|
|
|
|
rd.pad = 0;
|
|
|
|
|
|
2010-05-31 12:11:41 +00:00
|
|
|
|
err = scsi->dev->read (scsi, sizeof (rd), (char *) &rd, size * scsi->blocksize, buf);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
|
|
|
|
return err;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Send a SCSI request for DISK: read SIZE sectors starting with
|
|
|
|
|
sector SECTOR to BUF. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_read12 (grub_disk_t disk, grub_disk_addr_t sector,
|
|
|
|
|
grub_size_t size, char *buf)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
struct grub_scsi_read12 rd;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
|
|
|
|
rd.opcode = grub_scsi_cmd_read12;
|
|
|
|
|
rd.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
rd.lba = grub_cpu_to_be32 (sector);
|
|
|
|
|
rd.size = grub_cpu_to_be32 (size);
|
|
|
|
|
rd.reserved = 0;
|
|
|
|
|
rd.control = 0;
|
|
|
|
|
|
2010-05-31 12:11:41 +00:00
|
|
|
|
err = scsi->dev->read (scsi, sizeof (rd), (char *) &rd, size * scsi->blocksize, buf);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
|
|
|
|
return err;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
2012-01-30 11:47:26 +00:00
|
|
|
|
/* Send a SCSI request for DISK: read SIZE sectors starting with
|
|
|
|
|
sector SECTOR to BUF. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_read16 (grub_disk_t disk, grub_disk_addr_t sector,
|
|
|
|
|
grub_size_t size, char *buf)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
struct grub_scsi_read16 rd;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
|
|
|
|
rd.opcode = grub_scsi_cmd_read16;
|
|
|
|
|
rd.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
rd.lba = grub_cpu_to_be64 (sector);
|
|
|
|
|
rd.size = grub_cpu_to_be32 (size);
|
|
|
|
|
rd.reserved = 0;
|
|
|
|
|
rd.control = 0;
|
|
|
|
|
|
|
|
|
|
err = scsi->dev->read (scsi, sizeof (rd), (char *) &rd, size * scsi->blocksize, buf);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
|
|
|
|
return err;
|
|
|
|
|
}
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
/* Send a SCSI request for DISK: write the data stored in BUF to SIZE
|
|
|
|
|
sectors starting with SECTOR. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_write10 (grub_disk_t disk, grub_disk_addr_t sector,
|
2012-01-30 11:26:11 +00:00
|
|
|
|
grub_size_t size, const char *buf)
|
2008-08-27 15:05:00 +00:00
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
struct grub_scsi_write10 wr;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
|
|
|
|
wr.opcode = grub_scsi_cmd_write10;
|
|
|
|
|
wr.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
wr.lba = grub_cpu_to_be32 (sector);
|
|
|
|
|
wr.reserved = 0;
|
|
|
|
|
wr.size = grub_cpu_to_be16 (size);
|
|
|
|
|
wr.reserved2 = 0;
|
|
|
|
|
wr.pad = 0;
|
|
|
|
|
|
2010-05-31 12:11:41 +00:00
|
|
|
|
err = scsi->dev->write (scsi, sizeof (wr), (char *) &wr, size * scsi->blocksize, buf);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
|
|
|
|
return err;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
2012-01-30 11:26:11 +00:00
|
|
|
|
#if 0
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
/* Send a SCSI request for DISK: write the data stored in BUF to SIZE
|
|
|
|
|
sectors starting with SECTOR. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_write12 (grub_disk_t disk, grub_disk_addr_t sector,
|
|
|
|
|
grub_size_t size, char *buf)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
struct grub_scsi_write12 wr;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
|
|
|
|
wr.opcode = grub_scsi_cmd_write12;
|
|
|
|
|
wr.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
wr.lba = grub_cpu_to_be32 (sector);
|
|
|
|
|
wr.size = grub_cpu_to_be32 (size);
|
|
|
|
|
wr.reserved = 0;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
wr.control = 0;
|
|
|
|
|
|
|
|
|
|
err = scsi->dev->write (scsi, sizeof (wr), (char *) &wr, size * scsi->blocksize, buf);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
2010-05-31 12:11:41 +00:00
|
|
|
|
return err;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
2012-01-30 11:47:26 +00:00
|
|
|
|
/* Send a SCSI request for DISK: write the data stored in BUF to SIZE
|
|
|
|
|
sectors starting with SECTOR. */
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_write16 (grub_disk_t disk, grub_disk_addr_t sector,
|
|
|
|
|
grub_size_t size, const char *buf)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
struct grub_scsi_write16 wr;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
grub_err_t err_sense;
|
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
|
|
|
|
wr.opcode = grub_scsi_cmd_write16;
|
|
|
|
|
wr.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
|
|
|
|
|
wr.lba = grub_cpu_to_be64 (sector);
|
|
|
|
|
wr.size = grub_cpu_to_be32 (size);
|
|
|
|
|
wr.reserved = 0;
|
|
|
|
|
wr.control = 0;
|
|
|
|
|
|
|
|
|
|
err = scsi->dev->write (scsi, sizeof (wr), (char *) &wr, size * scsi->blocksize, buf);
|
|
|
|
|
|
|
|
|
|
/* Each SCSI command should be followed by Request Sense.
|
|
|
|
|
If not so, many devices STALLs or definitely freezes. */
|
|
|
|
|
err_sense = grub_scsi_request_sense (scsi);
|
|
|
|
|
if (err_sense != GRUB_ERR_NONE)
|
|
|
|
|
grub_errno = err;
|
|
|
|
|
/* err_sense is ignored for now and Request Sense Data also... */
|
|
|
|
|
|
|
|
|
|
return err;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
static int
|
2011-04-21 22:09:07 +00:00
|
|
|
|
grub_scsi_iterate (int (*hook) (const char *name),
|
|
|
|
|
grub_disk_pull_t pull)
|
2008-08-27 15:05:00 +00:00
|
|
|
|
{
|
|
|
|
|
grub_scsi_dev_t p;
|
|
|
|
|
|
2010-12-24 16:09:56 +00:00
|
|
|
|
auto int NESTED_FUNC_ATTR scsi_iterate (int id, int bus, int luns);
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
2010-12-24 16:09:56 +00:00
|
|
|
|
int NESTED_FUNC_ATTR scsi_iterate (int id, int bus, int luns)
|
2008-08-27 15:05:00 +00:00
|
|
|
|
{
|
|
|
|
|
int i;
|
|
|
|
|
|
|
|
|
|
/* In case of a single LUN, just return `usbX'. */
|
|
|
|
|
if (luns == 1)
|
2010-07-10 00:59:33 +00:00
|
|
|
|
{
|
|
|
|
|
char *sname;
|
|
|
|
|
int ret;
|
2010-12-24 15:07:53 +00:00
|
|
|
|
sname = grub_xasprintf ("%s%d", grub_scsi_names[id], bus);
|
2010-07-10 00:59:33 +00:00
|
|
|
|
if (!sname)
|
|
|
|
|
return 1;
|
|
|
|
|
ret = hook (sname);
|
|
|
|
|
grub_free (sname);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
|
|
|
|
/* In case of multiple LUNs, every LUN will get a prefix to
|
|
|
|
|
distinguish it. */
|
|
|
|
|
for (i = 0; i < luns; i++)
|
|
|
|
|
{
|
2009-12-29 09:04:06 +00:00
|
|
|
|
char *sname;
|
2010-03-05 14:29:28 +00:00
|
|
|
|
int ret;
|
2010-12-24 15:07:53 +00:00
|
|
|
|
sname = grub_xasprintf ("%s%d%c", grub_scsi_names[id], bus, 'a' + i);
|
2009-12-29 09:04:06 +00:00
|
|
|
|
if (!sname)
|
|
|
|
|
return 1;
|
2010-03-05 14:29:28 +00:00
|
|
|
|
ret = hook (sname);
|
2009-12-29 09:04:06 +00:00
|
|
|
|
grub_free (sname);
|
2010-03-05 14:29:28 +00:00
|
|
|
|
if (ret)
|
|
|
|
|
return 1;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (p = grub_scsi_dev_list; p; p = p->next)
|
2011-07-07 10:21:53 +00:00
|
|
|
|
if (p->iterate && (p->iterate) (scsi_iterate, pull))
|
2008-08-27 15:05:00 +00:00
|
|
|
|
return 1;
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static grub_err_t
|
2011-07-07 19:46:25 +00:00
|
|
|
|
grub_scsi_open (const char *name, grub_disk_t disk)
|
2008-08-27 15:05:00 +00:00
|
|
|
|
{
|
|
|
|
|
grub_scsi_dev_t p;
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
grub_err_t err;
|
2010-07-10 00:59:33 +00:00
|
|
|
|
int lun, bus;
|
2010-05-31 12:11:41 +00:00
|
|
|
|
grub_uint64_t maxtime;
|
2010-07-10 00:59:33 +00:00
|
|
|
|
const char *nameend;
|
2010-12-24 15:07:53 +00:00
|
|
|
|
unsigned id;
|
2009-01-27 18:26:09 +00:00
|
|
|
|
|
2010-07-10 00:59:33 +00:00
|
|
|
|
nameend = name + grub_strlen (name) - 1;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
/* Try to detect a LUN ('a'-'z'), otherwise just use the first
|
|
|
|
|
LUN. */
|
2010-07-10 00:59:33 +00:00
|
|
|
|
if (nameend >= name && *nameend >= 'a' && *nameend <= 'z')
|
|
|
|
|
{
|
|
|
|
|
lun = *nameend - 'a';
|
|
|
|
|
nameend--;
|
|
|
|
|
}
|
|
|
|
|
else
|
2008-08-27 15:05:00 +00:00
|
|
|
|
lun = 0;
|
|
|
|
|
|
2010-07-10 00:59:33 +00:00
|
|
|
|
while (nameend >= name && grub_isdigit (*nameend))
|
|
|
|
|
nameend--;
|
|
|
|
|
|
|
|
|
|
if (!nameend[1] || !grub_isdigit (nameend[1]))
|
|
|
|
|
return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "not a SCSI disk");
|
|
|
|
|
|
|
|
|
|
bus = grub_strtoul (nameend + 1, 0, 0);
|
|
|
|
|
|
|
|
|
|
scsi = grub_malloc (sizeof (*scsi));
|
|
|
|
|
if (! scsi)
|
|
|
|
|
return grub_errno;
|
|
|
|
|
|
2010-12-24 15:07:53 +00:00
|
|
|
|
for (id = 0; id < ARRAY_SIZE (grub_scsi_names); id++)
|
|
|
|
|
if (grub_strncmp (grub_scsi_names[id], name, nameend - name) == 0)
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
if (id == ARRAY_SIZE (grub_scsi_names))
|
2008-08-27 15:05:00 +00:00
|
|
|
|
{
|
2010-12-24 15:07:53 +00:00
|
|
|
|
grub_free (scsi);
|
|
|
|
|
return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "not a SCSI disk");
|
|
|
|
|
}
|
2010-07-10 00:59:33 +00:00
|
|
|
|
|
2010-12-24 15:07:53 +00:00
|
|
|
|
for (p = grub_scsi_dev_list; p; p = p->next)
|
|
|
|
|
{
|
|
|
|
|
if (p->open (id, bus, scsi))
|
|
|
|
|
{
|
|
|
|
|
grub_errno = GRUB_ERR_NONE;
|
|
|
|
|
continue;
|
|
|
|
|
}
|
2009-07-16 15:36:43 +00:00
|
|
|
|
|
2010-12-24 15:07:53 +00:00
|
|
|
|
disk->id = grub_make_scsi_id (id, bus, lun);
|
2009-06-19 17:38:27 +00:00
|
|
|
|
disk->data = scsi;
|
|
|
|
|
scsi->dev = p;
|
|
|
|
|
scsi->lun = lun;
|
2010-07-10 00:59:33 +00:00
|
|
|
|
scsi->bus = bus;
|
2009-06-19 17:38:27 +00:00
|
|
|
|
|
|
|
|
|
grub_dprintf ("scsi", "dev opened\n");
|
|
|
|
|
|
|
|
|
|
err = grub_scsi_inquiry (scsi);
|
|
|
|
|
if (err)
|
|
|
|
|
{
|
|
|
|
|
grub_free (scsi);
|
|
|
|
|
grub_dprintf ("scsi", "inquiry failed\n");
|
2009-07-16 15:36:43 +00:00
|
|
|
|
return err;
|
2009-06-19 17:38:27 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
grub_dprintf ("scsi", "inquiry: devtype=0x%02x removable=%d\n",
|
|
|
|
|
scsi->devtype, scsi->removable);
|
|
|
|
|
|
|
|
|
|
/* Try to be conservative about the device types
|
|
|
|
|
supported. */
|
|
|
|
|
if (scsi->devtype != grub_scsi_devtype_direct
|
|
|
|
|
&& scsi->devtype != grub_scsi_devtype_cdrom)
|
|
|
|
|
{
|
|
|
|
|
grub_free (scsi);
|
|
|
|
|
return grub_error (GRUB_ERR_UNKNOWN_DEVICE,
|
|
|
|
|
"unknown SCSI device");
|
|
|
|
|
}
|
|
|
|
|
|
2010-05-31 12:11:41 +00:00
|
|
|
|
/* According to USB MS tests specification, issue Test Unit Ready
|
|
|
|
|
* until OK */
|
2010-06-01 00:10:19 +00:00
|
|
|
|
maxtime = grub_get_time_ms () + 5000; /* It is safer value */
|
2010-05-31 12:11:41 +00:00
|
|
|
|
do
|
|
|
|
|
{
|
|
|
|
|
/* Timeout is necessary - for example in case when we have
|
|
|
|
|
* universal card reader with more LUNs and we have only
|
|
|
|
|
* one card inserted (or none), so only one LUN (or none)
|
|
|
|
|
* will be ready - and we want not to hang... */
|
|
|
|
|
if (grub_get_time_ms () > maxtime)
|
|
|
|
|
{
|
|
|
|
|
err = GRUB_ERR_READ_ERROR;
|
|
|
|
|
grub_free (scsi);
|
|
|
|
|
grub_dprintf ("scsi", "LUN is not ready - timeout\n");
|
|
|
|
|
return err;
|
|
|
|
|
}
|
|
|
|
|
err = grub_scsi_test_unit_ready (scsi);
|
|
|
|
|
}
|
|
|
|
|
while (err == GRUB_ERR_READ_ERROR);
|
|
|
|
|
/* Reset grub_errno !
|
|
|
|
|
* It is set to some error code in loop before... */
|
|
|
|
|
grub_errno = GRUB_ERR_NONE;
|
|
|
|
|
|
|
|
|
|
/* Read capacity of media */
|
2012-01-30 17:33:11 +00:00
|
|
|
|
err = grub_scsi_read_capacity10 (scsi);
|
2009-06-19 17:38:27 +00:00
|
|
|
|
if (err)
|
|
|
|
|
{
|
|
|
|
|
grub_free (scsi);
|
2012-01-30 17:33:11 +00:00
|
|
|
|
grub_dprintf ("scsi", "READ CAPACITY10 failed\n");
|
2009-07-16 15:36:43 +00:00
|
|
|
|
return err;
|
2009-06-19 17:38:27 +00:00
|
|
|
|
}
|
|
|
|
|
|
2012-01-30 17:33:11 +00:00
|
|
|
|
if (scsi->last_block == 0xffffffff)
|
|
|
|
|
{
|
|
|
|
|
err = grub_scsi_read_capacity16 (scsi);
|
|
|
|
|
if (err)
|
|
|
|
|
{
|
|
|
|
|
grub_free (scsi);
|
|
|
|
|
grub_dprintf ("scsi", "READ CAPACITY16 failed\n");
|
|
|
|
|
return err;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
disk->total_sectors = scsi->last_block + 1;
|
2011-03-29 00:02:55 +00:00
|
|
|
|
if (scsi->blocksize & (scsi->blocksize - 1) || !scsi->blocksize)
|
|
|
|
|
{
|
|
|
|
|
grub_free (scsi);
|
|
|
|
|
return grub_error (GRUB_ERR_IO, "invalid sector size %d",
|
|
|
|
|
scsi->blocksize);
|
|
|
|
|
}
|
|
|
|
|
for (disk->log_sector_size = 0;
|
2012-01-30 17:33:11 +00:00
|
|
|
|
(1U << disk->log_sector_size) < scsi->blocksize;
|
2011-03-29 00:02:55 +00:00
|
|
|
|
disk->log_sector_size++);
|
2010-05-31 12:11:41 +00:00
|
|
|
|
|
2012-01-30 17:33:11 +00:00
|
|
|
|
grub_dprintf ("scsi", "last_block=%" PRIuGRUB_UINT64_T ", blocksize=%u\n",
|
|
|
|
|
scsi->last_block, scsi->blocksize);
|
2011-03-29 00:02:55 +00:00
|
|
|
|
grub_dprintf ("scsi", "Disk total sectors = %llu\n",
|
2010-06-02 14:46:55 +00:00
|
|
|
|
(unsigned long long) disk->total_sectors);
|
2009-06-19 17:38:27 +00:00
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
2009-03-29 21:21:19 +00:00
|
|
|
|
grub_free (scsi);
|
2008-08-27 15:05:00 +00:00
|
|
|
|
return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "not a SCSI disk");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void
|
|
|
|
|
grub_scsi_close (grub_disk_t disk)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
2010-07-10 00:59:33 +00:00
|
|
|
|
if (scsi->dev->close)
|
|
|
|
|
scsi->dev->close (scsi);
|
2009-02-27 21:27:01 +00:00
|
|
|
|
grub_free (scsi);
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_read (grub_disk_t disk, grub_disk_addr_t sector,
|
|
|
|
|
grub_size_t size, char *buf)
|
|
|
|
|
{
|
|
|
|
|
grub_scsi_t scsi;
|
|
|
|
|
|
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
2011-06-27 08:12:35 +00:00
|
|
|
|
while (size)
|
2008-08-27 15:05:00 +00:00
|
|
|
|
{
|
2011-06-27 08:12:35 +00:00
|
|
|
|
/* PATA doesn't support more than 32K reads.
|
|
|
|
|
Not sure about AHCI and USB. If it's confirmed that either of
|
|
|
|
|
them can do bigger reads reliably this value can be moved to 'scsi'
|
|
|
|
|
structure. */
|
|
|
|
|
grub_size_t len = 32768 >> disk->log_sector_size;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
if (len > size)
|
|
|
|
|
len = size;
|
|
|
|
|
/* Depending on the type, select a read function. */
|
|
|
|
|
switch (scsi->devtype)
|
|
|
|
|
{
|
|
|
|
|
case grub_scsi_devtype_direct:
|
2012-01-30 11:47:26 +00:00
|
|
|
|
if (sector >> 32)
|
|
|
|
|
err = grub_scsi_read16 (disk, sector, len, buf);
|
|
|
|
|
else
|
|
|
|
|
err = grub_scsi_read10 (disk, sector, len, buf);
|
2011-06-27 08:12:35 +00:00
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case grub_scsi_devtype_cdrom:
|
2012-01-30 11:47:26 +00:00
|
|
|
|
if (sector >> 32)
|
|
|
|
|
err = grub_scsi_read16 (disk, sector, len, buf);
|
|
|
|
|
else
|
|
|
|
|
err = grub_scsi_read12 (disk, sector, len, buf);
|
2011-06-27 08:12:35 +00:00
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
size -= len;
|
|
|
|
|
sector += len;
|
|
|
|
|
buf += len << disk->log_sector_size;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
2010-06-01 00:10:19 +00:00
|
|
|
|
|
|
|
|
|
#if 0 /* Workaround - it works - but very slowly, from some reason
|
|
|
|
|
* unknown to me (specially on OHCI). Do not use it. */
|
|
|
|
|
/* Split transfer requests to device sector size because */
|
|
|
|
|
/* some devices are not able to transfer more than 512-1024 bytes */
|
|
|
|
|
grub_err_t err = GRUB_ERR_NONE;
|
|
|
|
|
|
|
|
|
|
for ( ; size; size--)
|
|
|
|
|
{
|
|
|
|
|
/* Depending on the type, select a read function. */
|
|
|
|
|
switch (scsi->devtype)
|
|
|
|
|
{
|
|
|
|
|
case grub_scsi_devtype_direct:
|
|
|
|
|
err = grub_scsi_read10 (disk, sector, 1, buf);
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case grub_scsi_devtype_cdrom:
|
|
|
|
|
err = grub_scsi_read12 (disk, sector, 1, buf);
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default: /* This should not happen */
|
|
|
|
|
return GRUB_ERR_READ_ERROR;
|
|
|
|
|
}
|
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
sector++;
|
|
|
|
|
buf += scsi->blocksize;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return err;
|
|
|
|
|
#endif
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static grub_err_t
|
|
|
|
|
grub_scsi_write (grub_disk_t disk __attribute((unused)),
|
|
|
|
|
grub_disk_addr_t sector __attribute((unused)),
|
|
|
|
|
grub_size_t size __attribute((unused)),
|
|
|
|
|
const char *buf __attribute((unused)))
|
|
|
|
|
{
|
2012-01-30 11:26:11 +00:00
|
|
|
|
grub_scsi_t scsi;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
|
2012-01-30 11:26:11 +00:00
|
|
|
|
scsi = disk->data;
|
|
|
|
|
|
|
|
|
|
if (scsi->devtype == grub_scsi_devtype_cdrom)
|
2012-02-12 14:25:25 +00:00
|
|
|
|
return grub_error (GRUB_ERR_IO, N_("cannot write to cdrom"));
|
2012-01-30 11:26:11 +00:00
|
|
|
|
|
|
|
|
|
while (size)
|
|
|
|
|
{
|
|
|
|
|
/* PATA doesn't support more than 32K reads.
|
|
|
|
|
Not sure about AHCI and USB. If it's confirmed that either of
|
|
|
|
|
them can do bigger reads reliably this value can be moved to 'scsi'
|
|
|
|
|
structure. */
|
|
|
|
|
grub_size_t len = 32768 >> disk->log_sector_size;
|
|
|
|
|
grub_err_t err;
|
|
|
|
|
if (len > size)
|
|
|
|
|
len = size;
|
|
|
|
|
/* Depending on the type, select a read function. */
|
|
|
|
|
switch (scsi->devtype)
|
|
|
|
|
{
|
|
|
|
|
case grub_scsi_devtype_direct:
|
2012-01-30 11:47:26 +00:00
|
|
|
|
if (sector >> 32)
|
|
|
|
|
err = grub_scsi_write16 (disk, sector, len, buf);
|
|
|
|
|
else
|
|
|
|
|
err = grub_scsi_write10 (disk, sector, len, buf);
|
2012-01-30 11:26:11 +00:00
|
|
|
|
if (err)
|
|
|
|
|
return err;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
size -= len;
|
|
|
|
|
sector += len;
|
|
|
|
|
buf += len << disk->log_sector_size;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
2008-08-27 15:05:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static struct grub_disk_dev grub_scsi_dev =
|
|
|
|
|
{
|
|
|
|
|
.name = "scsi",
|
|
|
|
|
.id = GRUB_DISK_DEVICE_SCSI_ID,
|
|
|
|
|
.iterate = grub_scsi_iterate,
|
|
|
|
|
.open = grub_scsi_open,
|
|
|
|
|
.close = grub_scsi_close,
|
|
|
|
|
.read = grub_scsi_read,
|
|
|
|
|
.write = grub_scsi_write,
|
|
|
|
|
.next = 0
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
GRUB_MOD_INIT(scsi)
|
|
|
|
|
{
|
|
|
|
|
grub_disk_dev_register (&grub_scsi_dev);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GRUB_MOD_FINI(scsi)
|
|
|
|
|
{
|
|
|
|
|
grub_disk_dev_unregister (&grub_scsi_dev);
|
|
|
|
|
}
|