mirror of
https://github.com/akuker/RASCSI.git
synced 2024-09-26 23:55:05 +00:00
05db0e4688
* Fixing SonarCloud issues, first round * Fixing SonarCLoud issues, next round * Fixing SonarQube issues, next round * Fixed warning * Replaced empty constructors/destructors with = default; * Fixed warning * Replaced new * Use constants instead of macros * Use structured binding declarations * Use init statements for if * Use string views * Use enum class, use using instead of typedef * Fixed more SonarCloud warnings * Replaced redundant/duplicate types with auto * Devlared methods const * Memory management update * Fixed warning * Added missing const * Improved RaScsiResponse memory management * Improved memory management * Improved memory management * Replaced macros by constants, removed unused constants * Made member private * Fixed warning * Added comment * Fixed shadowing warnings * Cleanup * Cleanup * Cleanup * Fixed shadowing warning * Removed unused code * Fixed more warnings * Removed obsolete casts * Fixed warnings * Removed unused field * Removed library not needed by rasctl * Include cleanup * Updated platform check for better compatibility * Improved check for invalid option. This prevents rasctl to break on macos. * Updated option check * Fixed typo * Added TODO * Removed macro * Scope update * Replaced macro * Added TODO, update memory management * Fixed typo * Replaced NULL by nullptr * Use more structured bindings * Added TODO * Use calloc instead of mallco to not need memset * Fixed warnings * Fixed SonarQube initialization issues * Fixed warning * Cleaned up override/virtual/final * Fixed warnings * Constructor update * Fixed tests * Improved memory management * Added missing const * Added const * Fixed two bugs reported by SonarCloud * Fix SonarCloud hotspot * Fixed memory management * Memory management update * Addressing hotspot by using strncpy * Fixed SonarCloud issues * Fixed SonarQube issues * Added missing const * Added const * Added const * Suppress false positive * Added SonarQube suppressions for false positives * Added suppresoin * Fixed code smells * Reverted changes that is a SonarQube issue, but caused problems with -O3 * Removed TODO based on review
155 lines
4.0 KiB
C++
155 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 "mode_page_device.h"
|
|
|
|
using namespace std;
|
|
using namespace scsi_defs;
|
|
|
|
ModePageDevice::ModePageDevice(const string& id) : PrimaryDevice(id), dispatcher({})
|
|
{
|
|
dispatcher.AddCommand(eCmdModeSense6, "ModeSense6", &ModePageDevice::ModeSense6);
|
|
dispatcher.AddCommand(eCmdModeSense10, "ModeSense10", &ModePageDevice::ModeSense10);
|
|
dispatcher.AddCommand(eCmdModeSelect6, "ModeSelect6", &ModePageDevice::ModeSelect6);
|
|
dispatcher.AddCommand(eCmdModeSelect10, "ModeSelect10", &ModePageDevice::ModeSelect10);
|
|
}
|
|
|
|
bool ModePageDevice::Dispatch()
|
|
{
|
|
// The superclass class handles the less specific commands
|
|
return dispatcher.Dispatch(this, ctrl->cmd[0]) ? true : super::Dispatch();
|
|
}
|
|
|
|
int ModePageDevice::AddModePages(const DWORD *cdb, BYTE *buf, int max_length) const
|
|
{
|
|
if (max_length <= 0) {
|
|
return 0;
|
|
}
|
|
|
|
bool changeable = (cdb[2] & 0xc0) == 0x40;
|
|
|
|
// Get page code (0x3f means all pages)
|
|
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;
|
|
AddModePages(pages, page, changeable);
|
|
|
|
if (pages.empty()) {
|
|
LOGTRACE("%s Unsupported mode page $%02X", __PRETTY_FUNCTION__, page)
|
|
throw scsi_error_exception(sense_key::ILLEGAL_REQUEST, asc::INVALID_FIELD_IN_CDB);
|
|
}
|
|
|
|
// Holds all mode page data
|
|
vector<BYTE> result;
|
|
|
|
vector<BYTE> page0;
|
|
for (auto const& page : pages) {
|
|
// The specification mandates that page 0 must be returned after all others
|
|
if (page.first) {
|
|
size_t offset = result.size();
|
|
|
|
// Page data
|
|
result.insert(result.end(), page.second.begin(), page.second.end());
|
|
// Page code, PS bit may already have been set
|
|
result[offset] |= page.first;
|
|
// Page payload size
|
|
result[offset + 1] = page.second.size() - 2;
|
|
}
|
|
else {
|
|
page0 = page.second;
|
|
}
|
|
}
|
|
|
|
// Page 0 must be last
|
|
if (!page0.empty()) {
|
|
size_t offset = result.size();
|
|
|
|
// Page data
|
|
result.insert(result.end(), page0.begin(), page0.end());
|
|
// Page payload size
|
|
result[offset + 1] = page0.size() - 2;
|
|
}
|
|
|
|
// Do not return more than the requested number of bytes
|
|
size_t size = (size_t)max_length < result.size() ? max_length : result.size();
|
|
memcpy(buf, result.data(), size);
|
|
|
|
return size;
|
|
}
|
|
|
|
void ModePageDevice::ModeSense6()
|
|
{
|
|
ctrl->length = ModeSense6(ctrl->cmd, ctrl->buffer, ctrl->bufsize);
|
|
|
|
EnterDataInPhase();
|
|
}
|
|
|
|
void ModePageDevice::ModeSense10()
|
|
{
|
|
ctrl->length = ModeSense10(ctrl->cmd, ctrl->buffer, ctrl->bufsize);
|
|
|
|
EnterDataInPhase();
|
|
}
|
|
|
|
void ModePageDevice::ModeSelect(const DWORD*, const BYTE *, int)
|
|
{
|
|
throw scsi_error_exception(sense_key::ILLEGAL_REQUEST, asc::INVALID_COMMAND_OPERATION_CODE);
|
|
}
|
|
|
|
void ModePageDevice::ModeSelect6()
|
|
{
|
|
ctrl->length = ModeSelectCheck6();
|
|
|
|
EnterDataOutPhase();
|
|
}
|
|
|
|
void ModePageDevice::ModeSelect10()
|
|
{
|
|
ctrl->length = ModeSelectCheck10();
|
|
|
|
EnterDataOutPhase();
|
|
}
|
|
|
|
int ModePageDevice::ModeSelectCheck(int length)
|
|
{
|
|
// Error if save parameters are set for other types than of SCHD, SCRM or SCMO
|
|
// TODO The assumption above is not correct, and this code should be located elsewhere
|
|
if (GetType() != "SCHD" && GetType() != "SCRM" && GetType() != "SCMO" && (ctrl->cmd[1] & 0x01)) {
|
|
throw scsi_error_exception(sense_key::ILLEGAL_REQUEST, asc::INVALID_FIELD_IN_CDB);
|
|
}
|
|
|
|
return length;
|
|
}
|
|
|
|
int ModePageDevice::ModeSelectCheck6()
|
|
{
|
|
// Receive the data specified by the parameter length
|
|
return ModeSelectCheck(ctrl->cmd[4]);
|
|
}
|
|
|
|
int ModePageDevice::ModeSelectCheck10()
|
|
{
|
|
// Receive the data specified by the parameter length
|
|
int length = ctrl->cmd[7];
|
|
length <<= 8;
|
|
length |= ctrl->cmd[8];
|
|
if (length > ctrl->bufsize) {
|
|
length = ctrl->bufsize;
|
|
}
|
|
|
|
return ModeSelectCheck(length);
|
|
}
|