2021-01-21 12:19:07 +00:00
|
|
|
//! Bindings for libsgutils2
|
|
|
|
//!
|
|
|
|
//! Incomplete, but we currently do not need more.
|
|
|
|
//!
|
|
|
|
//! See: `/usr/include/scsi/sg_pt.h`
|
2020-12-23 08:44:53 +00:00
|
|
|
|
|
|
|
use std::os::unix::io::AsRawFd;
|
2021-01-25 13:54:33 +00:00
|
|
|
use std::ptr::NonNull;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-25 09:14:56 +00:00
|
|
|
use anyhow::{bail, format_err, Error};
|
|
|
|
use endian_trait::Endian;
|
2021-01-25 13:54:25 +00:00
|
|
|
use libc::{c_char, c_int};
|
2021-01-25 09:14:56 +00:00
|
|
|
|
|
|
|
use proxmox::tools::io::ReadExt;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
// Opaque wrapper for sg_pt_base
|
2020-12-23 08:44:53 +00:00
|
|
|
#[repr(C)]
|
2021-01-21 15:38:24 +00:00
|
|
|
struct SgPtBase { _private: [u8; 0] }
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-25 13:48:27 +00:00
|
|
|
#[repr(transparent)]
|
|
|
|
struct SgPt {
|
2021-01-25 13:54:33 +00:00
|
|
|
raw: NonNull<SgPtBase>,
|
2021-01-25 13:48:27 +00:00
|
|
|
}
|
|
|
|
|
2021-01-25 13:54:33 +00:00
|
|
|
impl Drop for SgPt {
|
2020-12-23 08:44:53 +00:00
|
|
|
fn drop(&mut self) {
|
2021-01-25 13:54:33 +00:00
|
|
|
unsafe { destruct_scsi_pt_obj(self.as_mut_ptr()) };
|
2021-01-25 13:48:27 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
impl SgPt {
|
|
|
|
fn new() -> Result<Self, Error> {
|
2021-01-25 13:54:33 +00:00
|
|
|
Ok(Self {
|
|
|
|
raw: NonNull::new(unsafe { construct_scsi_pt_obj() })
|
|
|
|
.ok_or_else(|| format_err!("construct_scsi_pt_ob failed"))?,
|
|
|
|
})
|
2021-01-25 13:48:27 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
fn as_ptr(&self) -> *const SgPtBase {
|
2021-01-25 13:54:33 +00:00
|
|
|
self.raw.as_ptr()
|
2021-01-25 13:48:27 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
fn as_mut_ptr(&mut self) -> *mut SgPtBase {
|
2021-01-25 13:54:33 +00:00
|
|
|
self.raw.as_ptr()
|
2020-12-23 08:44:53 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-01-25 09:14:56 +00:00
|
|
|
/// Peripheral device type text (see `inquiry` command)
|
|
|
|
///
|
|
|
|
/// see [https://en.wikipedia.org/wiki/SCSI_Peripheral_Device_Type]
|
|
|
|
pub const PERIPHERAL_DEVICE_TYPE_TEXT: [&'static str; 32] = [
|
|
|
|
"Disk Drive",
|
|
|
|
"Tape Drive",
|
|
|
|
"Printer",
|
|
|
|
"Processor",
|
|
|
|
"Write-once",
|
|
|
|
"CD-ROM", // 05h
|
|
|
|
"Scanner",
|
|
|
|
"Optical",
|
|
|
|
"Medium Changer", // 08h
|
|
|
|
"Communications",
|
|
|
|
"ASC IT8",
|
|
|
|
"ASC IT8",
|
|
|
|
"RAID Array",
|
|
|
|
"Enclosure Services",
|
|
|
|
"Simplified direct-access",
|
|
|
|
"Optical card reader/writer",
|
|
|
|
"Bridging Expander",
|
|
|
|
"Object-based Storage",
|
|
|
|
"Automation/Drive Interface",
|
|
|
|
"Security manager",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Reserved",
|
|
|
|
"Unknown",
|
|
|
|
];
|
|
|
|
|
|
|
|
#[repr(C, packed)]
|
|
|
|
#[derive(Endian)]
|
|
|
|
struct InquiryPage {
|
|
|
|
peripheral_type: u8,
|
|
|
|
rmb: u8,
|
|
|
|
version: u8,
|
|
|
|
flags3: u8,
|
|
|
|
additional_length: u8,
|
|
|
|
flags5: u8,
|
|
|
|
flags6: u8,
|
|
|
|
flags7: u8,
|
|
|
|
vendor: [u8; 8],
|
|
|
|
product: [u8; 16],
|
|
|
|
revision: [u8; 4],
|
|
|
|
// additional data follows, but we do not need that
|
|
|
|
}
|
|
|
|
|
|
|
|
/// Inquiry result
|
|
|
|
#[derive(Debug)]
|
|
|
|
pub struct InquiryInfo {
|
|
|
|
/// Peripheral device type (0-31)
|
|
|
|
pub peripheral_type: u8,
|
|
|
|
/// Peripheral device type as string
|
|
|
|
pub peripheral_type_text: String,
|
|
|
|
/// Vendor
|
|
|
|
pub vendor: String,
|
|
|
|
/// Product
|
|
|
|
pub product: String,
|
|
|
|
/// Revision
|
|
|
|
pub revision: String,
|
|
|
|
}
|
|
|
|
|
2021-01-16 14:15:54 +00:00
|
|
|
pub const SCSI_PT_RESULT_GOOD:c_int = 0;
|
|
|
|
pub const SCSI_PT_RESULT_STATUS:c_int = 1;
|
|
|
|
pub const SCSI_PT_RESULT_SENSE:c_int = 2;
|
|
|
|
pub const SCSI_PT_RESULT_TRANSPORT_ERR:c_int = 3;
|
|
|
|
pub const SCSI_PT_RESULT_OS_ERR:c_int = 4;
|
|
|
|
|
2020-12-23 08:44:53 +00:00
|
|
|
#[link(name = "sgutils2")]
|
2021-01-25 13:54:25 +00:00
|
|
|
extern "C" {
|
2021-01-25 09:14:56 +00:00
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
#[allow(dead_code)]
|
|
|
|
fn scsi_pt_open_device(
|
2020-12-23 08:44:53 +00:00
|
|
|
device_name: * const c_char,
|
|
|
|
read_only: bool,
|
|
|
|
verbose: c_int,
|
|
|
|
) -> c_int;
|
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn sg_is_scsi_cdb(
|
2020-12-23 08:44:53 +00:00
|
|
|
cdbp: *const u8,
|
|
|
|
clen: c_int,
|
|
|
|
) -> bool;
|
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn construct_scsi_pt_obj() -> *mut SgPtBase;
|
|
|
|
fn destruct_scsi_pt_obj(objp: *mut SgPtBase);
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn set_scsi_pt_data_in(
|
2020-12-23 08:44:53 +00:00
|
|
|
objp: *mut SgPtBase,
|
2021-01-25 13:33:38 +00:00
|
|
|
dxferp: *mut u8,
|
2020-12-23 08:44:53 +00:00
|
|
|
dxfer_ilen: c_int,
|
|
|
|
);
|
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn set_scsi_pt_data_out(
|
2021-01-16 14:15:54 +00:00
|
|
|
objp: *mut SgPtBase,
|
|
|
|
dxferp: *const u8,
|
|
|
|
dxfer_olen: c_int,
|
|
|
|
);
|
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn set_scsi_pt_cdb(
|
2020-12-23 08:44:53 +00:00
|
|
|
objp: *mut SgPtBase,
|
|
|
|
cdb: *const u8,
|
|
|
|
cdb_len: c_int,
|
|
|
|
);
|
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn set_scsi_pt_sense(
|
2020-12-23 08:44:53 +00:00
|
|
|
objp: *mut SgPtBase,
|
2021-01-25 13:33:38 +00:00
|
|
|
sense: *mut u8,
|
2020-12-23 08:44:53 +00:00
|
|
|
max_sense_len: c_int,
|
|
|
|
);
|
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn do_scsi_pt(
|
2020-12-23 08:44:53 +00:00
|
|
|
objp: *mut SgPtBase,
|
|
|
|
fd: c_int,
|
|
|
|
timeout_secs: c_int,
|
|
|
|
verbose: c_int,
|
|
|
|
) -> c_int;
|
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn get_scsi_pt_resid(objp: *const SgPtBase) -> c_int;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn get_scsi_pt_sense_len(objp: *const SgPtBase) -> c_int;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
fn get_scsi_pt_status_response(objp: *const SgPtBase) -> c_int;
|
2021-01-16 14:15:54 +00:00
|
|
|
|
2021-01-21 15:38:24 +00:00
|
|
|
#[allow(dead_code)]
|
|
|
|
fn get_scsi_pt_result_category(objp: *const SgPtBase) -> c_int;
|
2020-12-23 08:44:53 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/// Safe interface to run RAW SCSI commands
|
|
|
|
pub struct SgRaw<'a, F> {
|
|
|
|
file: &'a mut F,
|
|
|
|
buffer: Box<[u8]>,
|
|
|
|
sense_buffer: [u8; 32],
|
2021-01-24 13:54:30 +00:00
|
|
|
timeout: i32,
|
2020-12-23 08:44:53 +00:00
|
|
|
}
|
|
|
|
|
2021-01-21 12:19:07 +00:00
|
|
|
/// Allocate a page aligned buffer
|
|
|
|
///
|
|
|
|
/// SG RAWIO commands needs page aligned transfer buffers.
|
2021-01-16 14:15:54 +00:00
|
|
|
pub fn alloc_page_aligned_buffer(buffer_size: usize) -> Result<Box<[u8]> , Error> {
|
|
|
|
let page_size = unsafe { libc::sysconf(libc::_SC_PAGESIZE) } as usize;
|
|
|
|
let layout = std::alloc::Layout::from_size_align(buffer_size, page_size)?;
|
|
|
|
let dinp = unsafe { std::alloc::alloc_zeroed(layout) };
|
|
|
|
if dinp.is_null() {
|
|
|
|
bail!("alloc SCSI output buffer failed");
|
|
|
|
}
|
|
|
|
|
|
|
|
let buffer_slice = unsafe { std::slice::from_raw_parts_mut(dinp, buffer_size)};
|
|
|
|
Ok(unsafe { Box::from_raw(buffer_slice) })
|
|
|
|
}
|
|
|
|
|
2020-12-23 08:44:53 +00:00
|
|
|
impl <'a, F: AsRawFd> SgRaw<'a, F> {
|
|
|
|
|
|
|
|
/// Create a new instance to run commands
|
|
|
|
///
|
|
|
|
/// The file must be a handle to a SCSI device.
|
|
|
|
pub fn new(file: &'a mut F, buffer_size: usize) -> Result<Self, Error> {
|
|
|
|
|
2021-01-16 14:15:54 +00:00
|
|
|
let buffer;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-16 14:15:54 +00:00
|
|
|
if buffer_size > 0 {
|
|
|
|
buffer = alloc_page_aligned_buffer(buffer_size)?;
|
|
|
|
} else {
|
|
|
|
buffer = Box::new([]);
|
|
|
|
}
|
2020-12-23 08:44:53 +00:00
|
|
|
|
|
|
|
let sense_buffer = [0u8; 32];
|
|
|
|
|
2021-01-24 13:54:30 +00:00
|
|
|
Ok(Self { file, buffer, sense_buffer, timeout: 0 })
|
|
|
|
}
|
|
|
|
|
|
|
|
/// Set the command timeout in seconds (0 means default (60 seconds))
|
|
|
|
pub fn set_timeout(&mut self, seconds: usize) {
|
|
|
|
if seconds > (i32::MAX as usize) {
|
|
|
|
self.timeout = i32::MAX; // don't care about larger values
|
|
|
|
} else {
|
|
|
|
self.timeout = seconds as i32;
|
|
|
|
}
|
2020-12-23 08:44:53 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
// create new object with initialized data_in and sense buffer
|
2021-01-25 14:05:51 +00:00
|
|
|
fn create_scsi_pt_obj(&mut self) -> Result<SgPt, Error> {
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-25 13:48:27 +00:00
|
|
|
let mut ptvp = SgPt::new()?;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-16 14:15:54 +00:00
|
|
|
if self.buffer.len() > 0 {
|
|
|
|
unsafe {
|
|
|
|
set_scsi_pt_data_in(
|
2021-01-25 13:48:27 +00:00
|
|
|
ptvp.as_mut_ptr(),
|
2021-01-25 13:33:38 +00:00
|
|
|
self.buffer.as_mut_ptr(),
|
2021-01-16 14:15:54 +00:00
|
|
|
self.buffer.len() as c_int,
|
|
|
|
)
|
|
|
|
};
|
|
|
|
}
|
2020-12-23 08:44:53 +00:00
|
|
|
|
|
|
|
unsafe {
|
|
|
|
set_scsi_pt_sense(
|
2021-01-25 13:48:27 +00:00
|
|
|
ptvp.as_mut_ptr(),
|
2021-01-25 13:33:38 +00:00
|
|
|
self.sense_buffer.as_mut_ptr(),
|
2020-12-23 08:44:53 +00:00
|
|
|
self.sense_buffer.len() as c_int,
|
|
|
|
)
|
|
|
|
};
|
|
|
|
|
|
|
|
Ok(ptvp)
|
|
|
|
}
|
|
|
|
|
|
|
|
/// Run the specified RAW SCSI command
|
|
|
|
pub fn do_command(&mut self, cmd: &[u8]) -> Result<&[u8], Error> {
|
|
|
|
|
|
|
|
if !unsafe { sg_is_scsi_cdb(cmd.as_ptr(), cmd.len() as c_int) } {
|
|
|
|
bail!("no valid SCSI command");
|
|
|
|
}
|
|
|
|
|
2021-01-16 14:15:54 +00:00
|
|
|
if self.buffer.len() < 16 {
|
|
|
|
bail!("output buffer too small");
|
|
|
|
}
|
|
|
|
|
2021-01-25 14:05:51 +00:00
|
|
|
let mut ptvp = self.create_scsi_pt_obj()?;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
|
|
|
unsafe {
|
|
|
|
set_scsi_pt_cdb(
|
2021-01-25 13:48:27 +00:00
|
|
|
ptvp.as_mut_ptr(),
|
2020-12-23 08:44:53 +00:00
|
|
|
cmd.as_ptr(),
|
|
|
|
cmd.len() as c_int,
|
|
|
|
)
|
|
|
|
};
|
|
|
|
|
2021-01-25 13:48:27 +00:00
|
|
|
let res = unsafe { do_scsi_pt(ptvp.as_mut_ptr(), self.file.as_raw_fd(), self.timeout, 0) };
|
2020-12-23 08:44:53 +00:00
|
|
|
if res < 0 {
|
|
|
|
let err = nix::Error::last();
|
|
|
|
bail!("do_scsi_pt failed - {}", err);
|
|
|
|
}
|
|
|
|
if res != 0 {
|
|
|
|
bail!("do_scsi_pt failed {}", res);
|
|
|
|
}
|
|
|
|
|
|
|
|
// todo: what about sense data?
|
2021-01-25 13:48:27 +00:00
|
|
|
let _sense_len = unsafe { get_scsi_pt_sense_len(ptvp.as_ptr()) };
|
2020-12-23 08:44:53 +00:00
|
|
|
|
2021-01-25 13:48:27 +00:00
|
|
|
let status = unsafe { get_scsi_pt_status_response(ptvp.as_ptr()) };
|
2020-12-23 08:44:53 +00:00
|
|
|
if status != 0 {
|
|
|
|
// toto: improve error reporting
|
|
|
|
bail!("unknown scsi error - status response {}", status);
|
|
|
|
}
|
|
|
|
|
2021-01-25 13:48:27 +00:00
|
|
|
let resid = unsafe { get_scsi_pt_resid(ptvp.as_ptr()) } as usize;
|
2021-01-24 14:19:43 +00:00
|
|
|
if resid > self.buffer.len() {
|
|
|
|
bail!("do_scsi_pt failed - got strange resid (value too big)");
|
2020-12-23 08:44:53 +00:00
|
|
|
}
|
2021-01-24 14:19:43 +00:00
|
|
|
let data_len = self.buffer.len() - resid;
|
2020-12-23 08:44:53 +00:00
|
|
|
|
|
|
|
Ok(&self.buffer[..data_len])
|
|
|
|
}
|
2021-01-16 14:15:54 +00:00
|
|
|
|
|
|
|
/// Run dataout command
|
|
|
|
///
|
|
|
|
/// Note: use alloc_page_aligned_buffer to alloc data transfer buffer
|
|
|
|
pub fn do_out_command(&mut self, cmd: &[u8], data: &[u8]) -> Result<(), Error> {
|
|
|
|
|
|
|
|
if !unsafe { sg_is_scsi_cdb(cmd.as_ptr(), cmd.len() as c_int) } {
|
|
|
|
bail!("no valid SCSI command");
|
|
|
|
}
|
|
|
|
|
|
|
|
let page_size = unsafe { libc::sysconf(libc::_SC_PAGESIZE) } as usize;
|
|
|
|
if ((data.as_ptr() as usize) & (page_size -1)) != 0 {
|
|
|
|
bail!("wrong transfer buffer alignment");
|
|
|
|
}
|
|
|
|
|
2021-01-25 14:05:51 +00:00
|
|
|
let mut ptvp = self.create_scsi_pt_obj()?;
|
2021-01-16 14:15:54 +00:00
|
|
|
|
|
|
|
unsafe {
|
|
|
|
set_scsi_pt_data_out(
|
2021-01-25 13:48:27 +00:00
|
|
|
ptvp.as_mut_ptr(),
|
2021-01-16 14:15:54 +00:00
|
|
|
data.as_ptr(),
|
|
|
|
data.len() as c_int,
|
|
|
|
);
|
|
|
|
|
|
|
|
set_scsi_pt_cdb(
|
2021-01-25 13:48:27 +00:00
|
|
|
ptvp.as_mut_ptr(),
|
2021-01-16 14:15:54 +00:00
|
|
|
cmd.as_ptr(),
|
|
|
|
cmd.len() as c_int,
|
|
|
|
);
|
|
|
|
};
|
|
|
|
|
2021-01-25 13:48:27 +00:00
|
|
|
let res = unsafe { do_scsi_pt(ptvp.as_mut_ptr(), self.file.as_raw_fd(), self.timeout, 0) };
|
2021-01-16 14:15:54 +00:00
|
|
|
if res < 0 {
|
|
|
|
let err = nix::Error::last();
|
|
|
|
bail!("do_scsi_pt failed - {}", err);
|
|
|
|
}
|
|
|
|
if res != 0 {
|
|
|
|
bail!("do_scsi_pt failed {}", res);
|
|
|
|
}
|
|
|
|
|
|
|
|
// todo: what about sense data?
|
2021-01-25 13:48:27 +00:00
|
|
|
let _sense_len = unsafe { get_scsi_pt_sense_len(ptvp.as_ptr()) };
|
2021-01-16 14:15:54 +00:00
|
|
|
|
2021-01-25 13:48:27 +00:00
|
|
|
let status = unsafe { get_scsi_pt_status_response(ptvp.as_ptr()) };
|
2021-01-16 14:15:54 +00:00
|
|
|
if status != 0 {
|
|
|
|
// toto: improve error reporting
|
|
|
|
bail!("unknown scsi error - status response {}", status);
|
|
|
|
}
|
|
|
|
|
|
|
|
Ok(())
|
|
|
|
}
|
2020-12-23 08:44:53 +00:00
|
|
|
}
|
2021-01-25 09:14:56 +00:00
|
|
|
|
|
|
|
// Useful helpers
|
|
|
|
|
|
|
|
/// Converts SCSI ASCII text into String, trim zero and spaces
|
|
|
|
pub fn scsi_ascii_to_string(data: &[u8]) -> String {
|
|
|
|
String::from_utf8_lossy(data)
|
|
|
|
.trim_matches(char::from(0))
|
|
|
|
.trim()
|
|
|
|
.to_string()
|
|
|
|
}
|
|
|
|
|
|
|
|
/// Read SCSI Inquiry page
|
|
|
|
///
|
|
|
|
/// Returns Product/Vendor/Revision and device type.
|
|
|
|
pub fn scsi_inquiry<F: AsRawFd>(
|
|
|
|
file: &mut F,
|
|
|
|
) -> Result<InquiryInfo, Error> {
|
|
|
|
|
|
|
|
let allocation_len: u8 = u8::MAX;
|
|
|
|
let mut sg_raw = SgRaw::new(file, allocation_len as usize)?;
|
|
|
|
sg_raw.set_timeout(30); // use short timeout
|
|
|
|
|
|
|
|
let mut cmd = Vec::new();
|
|
|
|
cmd.extend(&[0x12, 0, 0, 0, allocation_len, 0]); // INQUIRY
|
|
|
|
|
|
|
|
let data = sg_raw.do_command(&cmd)
|
|
|
|
.map_err(|err| format_err!("SCSI inquiry failed - {}", err))?;
|
|
|
|
|
|
|
|
proxmox::try_block!({
|
|
|
|
let mut reader = &data[..];
|
|
|
|
|
|
|
|
let page: InquiryPage = unsafe { reader.read_be_value()? };
|
|
|
|
|
|
|
|
let peripheral_type = page.peripheral_type & 31;
|
|
|
|
|
|
|
|
let info = InquiryInfo {
|
|
|
|
peripheral_type,
|
|
|
|
peripheral_type_text: PERIPHERAL_DEVICE_TYPE_TEXT[peripheral_type as usize].to_string(),
|
|
|
|
vendor: scsi_ascii_to_string(&page.vendor),
|
|
|
|
product: scsi_ascii_to_string(&page.product),
|
|
|
|
revision: scsi_ascii_to_string(&page.revision),
|
|
|
|
};
|
|
|
|
|
|
|
|
Ok(info)
|
|
|
|
}).map_err(|err: Error| format_err!("decode inquiry page failed - {}", err))
|
|
|
|
}
|