mirror of
https://github.com/akuker/RASCSI.git
synced 2024-11-20 03:34:27 +00:00
6e35577368
* Fixed TODOs, updated SCBR and SCDP * Introduced ByteWriter interface * Use accessors instead of directly accessing length/block fields
145 lines
4.0 KiB
C++
145 lines
4.0 KiB
C++
//---------------------------------------------------------------------------
|
|
//
|
|
// SCSI Target Emulator RaSCSI Reloaded
|
|
// for Raspberry Pi
|
|
//
|
|
// Copyright (C) 2022 Uwe Seimet
|
|
//
|
|
// A basic device with mode page support, to be used for subclassing
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
#include "log.h"
|
|
#include "rascsi_exceptions.h"
|
|
#include "scsi_command_util.h"
|
|
#include "dispatcher.h"
|
|
#include "mode_page_device.h"
|
|
#include <cstddef>
|
|
|
|
using namespace std;
|
|
using namespace scsi_defs;
|
|
using namespace scsi_command_util;
|
|
|
|
ModePageDevice::ModePageDevice(PbDeviceType type, int lun) : PrimaryDevice(type, lun)
|
|
{
|
|
dispatcher.Add(scsi_command::eCmdModeSense6, "ModeSense6", &ModePageDevice::ModeSense6);
|
|
dispatcher.Add(scsi_command::eCmdModeSense10, "ModeSense10", &ModePageDevice::ModeSense10);
|
|
dispatcher.Add(scsi_command::eCmdModeSelect6, "ModeSelect6", &ModePageDevice::ModeSelect6);
|
|
dispatcher.Add(scsi_command::eCmdModeSelect10, "ModeSelect10", &ModePageDevice::ModeSelect10);
|
|
}
|
|
|
|
bool ModePageDevice::Dispatch(scsi_command cmd)
|
|
{
|
|
// The superclass class handles the less specific commands
|
|
return dispatcher.Dispatch(this, cmd) ? true : super::Dispatch(cmd);
|
|
}
|
|
|
|
int ModePageDevice::AddModePages(const vector<int>& cdb, vector<BYTE>& buf, int offset, int length, int max_size) const
|
|
{
|
|
int max_length = length - offset;
|
|
if (max_length < 0) {
|
|
return length;
|
|
}
|
|
|
|
const bool changeable = (cdb[2] & 0xc0) == 0x40;
|
|
|
|
// Get page code (0x3f means all pages)
|
|
const int page = cdb[2] & 0x3f;
|
|
|
|
LOGTRACE("%s Requesting mode page $%02X", __PRETTY_FUNCTION__, page)
|
|
|
|
// Mode page data mapped to the respective page numbers, C++ maps are ordered by key
|
|
map<int, vector<byte>> pages;
|
|
SetUpModePages(pages, page, changeable);
|
|
|
|
if (pages.empty()) {
|
|
LOGTRACE("%s Unsupported mode page $%02X", __PRETTY_FUNCTION__, page)
|
|
throw scsi_exception(sense_key::ILLEGAL_REQUEST, asc::INVALID_FIELD_IN_CDB);
|
|
}
|
|
|
|
// Holds all mode page data
|
|
vector<byte> result;
|
|
|
|
vector<byte> page0;
|
|
for (auto const& [index, data] : pages) {
|
|
// The specification mandates that page 0 must be returned after all others
|
|
if (index) {
|
|
const size_t off = result.size();
|
|
|
|
// Page data
|
|
result.insert(result.end(), data.begin(), data.end());
|
|
// Page code, PS bit may already have been set
|
|
result[off] |= (byte)index;
|
|
// Page payload size
|
|
result[off + 1] = (byte)(data.size() - 2);
|
|
}
|
|
else {
|
|
page0 = data;
|
|
}
|
|
}
|
|
|
|
// Page 0 must be last
|
|
if (!page0.empty()) {
|
|
size_t off = result.size();
|
|
|
|
// Page data
|
|
result.insert(result.end(), page0.begin(), page0.end());
|
|
// Page payload size
|
|
result[off + 1] = (byte)(page0.size() - 2);
|
|
}
|
|
|
|
if ((int)result.size() > max_size) {
|
|
throw scsi_exception(sense_key::ILLEGAL_REQUEST, asc::INVALID_FIELD_IN_CDB);
|
|
}
|
|
|
|
auto size = (int)min((size_t)max_length, result.size());
|
|
memcpy(&buf.data()[offset], result.data(), size);
|
|
|
|
// Do not return more than the requested number of bytes
|
|
return size + offset < length ? size + offset : length;
|
|
}
|
|
|
|
void ModePageDevice::ModeSense6()
|
|
{
|
|
controller->SetLength(ModeSense6(ctrl->cmd, controller->GetBuffer()));
|
|
|
|
EnterDataInPhase();
|
|
}
|
|
|
|
void ModePageDevice::ModeSense10()
|
|
{
|
|
controller->SetLength(ModeSense10(ctrl->cmd, controller->GetBuffer()));
|
|
|
|
EnterDataInPhase();
|
|
}
|
|
|
|
void ModePageDevice::ModeSelect(scsi_command, const vector<int>&, const vector<BYTE>&, int) const
|
|
{
|
|
throw scsi_exception(sense_key::ILLEGAL_REQUEST, asc::INVALID_COMMAND_OPERATION_CODE);
|
|
}
|
|
|
|
void ModePageDevice::ModeSelect6()
|
|
{
|
|
controller->SetLength(SaveParametersCheck(ctrl->cmd[4]));
|
|
|
|
EnterDataOutPhase();
|
|
}
|
|
|
|
void ModePageDevice::ModeSelect10()
|
|
{
|
|
const size_t length = min(controller->GetBuffer().size(), (size_t)GetInt16(ctrl->cmd, 7));
|
|
|
|
controller->SetLength(SaveParametersCheck((uint32_t)length));
|
|
|
|
EnterDataOutPhase();
|
|
}
|
|
|
|
int ModePageDevice::SaveParametersCheck(int length) const
|
|
{
|
|
if (!SupportsSaveParameters() && (ctrl->cmd[1] & 0x01)) {
|
|
throw scsi_exception(sense_key::ILLEGAL_REQUEST, asc::INVALID_FIELD_IN_CDB);
|
|
}
|
|
|
|
return length;
|
|
}
|