mirror of
https://github.com/akuker/RASCSI.git
synced 2024-06-15 06:29:29 +00:00
192 lines
4.3 KiB
C++
192 lines
4.3 KiB
C++
//---------------------------------------------------------------------------
|
|
//
|
|
// SCSI Target Emulator RaSCSI (*^..^*)
|
|
// for Raspberry Pi
|
|
//
|
|
// Copyright (C) 2022 Uwe Seimet
|
|
//
|
|
// Host Services with realtime clock and shutdown support
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
//
|
|
// Features of the host services device:
|
|
//
|
|
// 1. Vendor-specific mode page 0x20 returns the current date and time (realtime clock)
|
|
//
|
|
// typedef struct {
|
|
// // Major and minor version of this data structure
|
|
// uint8_t major_version;
|
|
// uint8_t minor_version;
|
|
// // Current date and time, with daylight savings time adjustment applied
|
|
// uint8_t year; // year - 1900
|
|
// uint8_t month; // 0-11
|
|
// uint8_t day; // 1-31
|
|
// uint8_t hour; // 0-23
|
|
// uint8_t minute; // 0-59
|
|
// uint8_t second; // 0-59
|
|
// } mode_page_datetime;
|
|
//
|
|
// 2. START/STOP UNIT shuts down RaSCSI or shuts down/reboots the Raspberry Pi
|
|
// a) !start && !load (STOP): Shut down RaSCSI
|
|
// b) !start && load (EJECT): Shut down the Raspberry Pi
|
|
// c) start && load (LOAD): Reboot the Raspberry Pi
|
|
//
|
|
|
|
#include "controllers/scsidev_ctrl.h"
|
|
#include "disk.h"
|
|
#include "host_services.h"
|
|
|
|
using namespace scsi_defs;
|
|
|
|
HostServices::HostServices() : ModePageDevice("SCHS")
|
|
{
|
|
dispatcher.AddCommand(eCmdTestUnitReady, "TestUnitReady", &HostServices::TestUnitReady);
|
|
dispatcher.AddCommand(eCmdStartStop, "StartStopUnit", &HostServices::StartStopUnit);
|
|
}
|
|
|
|
bool HostServices::Dispatch(SCSIDEV *controller)
|
|
{
|
|
// The superclass class handles the less specific commands
|
|
return dispatcher.Dispatch(this, controller) ? true : super::Dispatch(controller);
|
|
}
|
|
|
|
void HostServices::TestUnitReady(SCSIDEV *controller)
|
|
{
|
|
// Always successful
|
|
controller->Status();
|
|
}
|
|
|
|
vector<BYTE> HostServices::Inquiry() const
|
|
{
|
|
return PrimaryDevice::Inquiry(device_type::PROCESSOR, scsi_level::SPC_3, false);
|
|
}
|
|
|
|
void HostServices::StartStopUnit(SCSIDEV *controller)
|
|
{
|
|
bool start = ctrl->cmd[4] & 0x01;
|
|
bool load = ctrl->cmd[4] & 0x02;
|
|
|
|
if (!start) {
|
|
// Flush any caches
|
|
for (Device *device : devices) {
|
|
Disk *disk = dynamic_cast<Disk *>(device);
|
|
if (disk) {
|
|
disk->FlushCache();
|
|
}
|
|
}
|
|
|
|
if (load) {
|
|
controller->ScheduleShutDown(SCSIDEV::rascsi_shutdown_mode::STOP_PI);
|
|
}
|
|
else {
|
|
controller->ScheduleShutDown(SCSIDEV::rascsi_shutdown_mode::STOP_RASCSI);
|
|
}
|
|
|
|
controller->Status();
|
|
return;
|
|
}
|
|
else {
|
|
if (load) {
|
|
controller->ScheduleShutDown(SCSIDEV::rascsi_shutdown_mode::RESTART_PI);
|
|
|
|
controller->Status();
|
|
return;
|
|
}
|
|
}
|
|
|
|
controller->Error(sense_key::ILLEGAL_REQUEST, asc::INVALID_FIELD_IN_CDB);
|
|
}
|
|
|
|
int HostServices::ModeSense6(const DWORD *cdb, BYTE *buf)
|
|
{
|
|
// Block descriptors cannot be returned
|
|
if (!(cdb[1] & 0x08)) {
|
|
return 0;
|
|
}
|
|
|
|
int length = (int)cdb[4];
|
|
memset(buf, 0, length);
|
|
|
|
// Basic information
|
|
int size = 4;
|
|
|
|
int pages_size = super::AddModePages(cdb, &buf[size], length - size);
|
|
if (!pages_size) {
|
|
return 0;
|
|
}
|
|
size += pages_size;
|
|
|
|
// Do not return more than ALLOCATION LENGTH bytes
|
|
if (size > length) {
|
|
size = length;
|
|
}
|
|
|
|
buf[0] = size;
|
|
|
|
return size;
|
|
}
|
|
|
|
int HostServices::ModeSense10(const DWORD *cdb, BYTE *buf, int max_length)
|
|
{
|
|
// Block descriptors cannot be returned
|
|
if (!(cdb[1] & 0x08)) {
|
|
return 0;
|
|
}
|
|
|
|
int length = (cdb[7] << 8) | cdb[8];
|
|
if (length > max_length) {
|
|
length = max_length;
|
|
}
|
|
memset(buf, 0, length);
|
|
|
|
// Basic information
|
|
int size = 8;
|
|
|
|
int pages_size = super::AddModePages(cdb, &buf[size], length - size);
|
|
if (!pages_size) {
|
|
return 0;
|
|
}
|
|
size += pages_size;
|
|
|
|
// Do not return more than ALLOCATION LENGTH bytes
|
|
if (size > length) {
|
|
size = length;
|
|
}
|
|
|
|
buf[0] = size >> 8;
|
|
buf[1] = size;
|
|
|
|
return size;
|
|
}
|
|
|
|
void HostServices::AddModePages(map<int, vector<BYTE>>& pages, int page, bool changeable) const
|
|
{
|
|
if (page == 0x20 || page == 0x3f) {
|
|
AddRealtimeClockPage(pages, changeable);
|
|
}
|
|
}
|
|
|
|
void HostServices::AddRealtimeClockPage(map<int, vector<BYTE>>& pages, bool changeable) const
|
|
{
|
|
if (!changeable) {
|
|
vector<BYTE> buf(10);
|
|
|
|
// Data structure version 1.0
|
|
buf[2] = 0x01;
|
|
buf[3] = 0x00;
|
|
|
|
std::time_t t = std::time(NULL);
|
|
std::tm tm = *std::localtime(&t);
|
|
buf[4] = tm.tm_year;
|
|
buf[5] = tm.tm_mon;
|
|
buf[6] = tm.tm_mday;
|
|
buf[7] = tm.tm_hour;
|
|
buf[8] = tm.tm_min;
|
|
// Ignore leap second for simplicity
|
|
buf[9] = tm.tm_sec < 60 ? tm.tm_sec : 59;
|
|
|
|
pages[32] = buf;
|
|
}
|
|
}
|