mirror of
https://github.com/Ylianst/MeshCentral.git
synced 2024-12-18 03:11:57 +03:00
c7d4d83e79
Buffer.from when used on arrays of integers returns `null` when running with meshagent (at least on linux, not sure if this happens elsewhere). This allows for meshcmd amtider to actually start, since otherwise the connection is just left hanging
601 lines
34 KiB
JavaScript
601 lines
34 KiB
JavaScript
/**
|
|
* @description IDER Handling Module
|
|
* @author Ylian Saint-Hilaire
|
|
*/
|
|
|
|
// meshservice meshcmd.js amtider --host 192.168.2.186 --pass P@ssw0rd --floppy msdos.img
|
|
|
|
// Construct a Intel AMT IDER object
|
|
module.exports = function CreateAmtRemoteIder() {
|
|
var obj = {};
|
|
obj.protocol = 3; // IDER
|
|
obj.bytesToAmt = 0;
|
|
obj.bytesFromAmt = 0;
|
|
obj.rx_timeout = 30000; // Default 30000
|
|
obj.tx_timeout = 0; // Default 0
|
|
obj.heartbeat = 20000; // Default 20000
|
|
obj.version = 1;
|
|
obj.acc = null;
|
|
obj.inSequence = 0;
|
|
obj.outSequence = 0;
|
|
obj.iderinfo = null;
|
|
obj.enabled = false;
|
|
obj.iderStart = 0; // OnReboot = 0, Graceful = 1, Now = 2
|
|
obj.floppy = null;
|
|
obj.cdrom = null;
|
|
obj.floppyReady = false;
|
|
obj.cdromReady = false;
|
|
//obj.pingTimer = null;
|
|
obj.sectorStats = null;
|
|
obj.debug = false;
|
|
|
|
// Mode Sense
|
|
var IDE_ModeSence_LS120Disk_Page_Array = new Buffer([0x00, 0x26, 0x31, 0x80, 0x00, 0x00, 0x00, 0x00, 0x05, 0x1E, 0x10, 0xA9, 0x08, 0x20, 0x02, 0x00, 0x03, 0xC3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00]);
|
|
var IDE_ModeSence_3F_LS120_Array = new Buffer([0x00, 0x5c, 0x24, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x0a, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x03, 0x16, 0x00, 0xa0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x12, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xa0, 0x00, 0x00, 0x00, 0x05, 0x1E, 0x10, 0xA9, 0x08, 0x20, 0x02, 0x00, 0x03, 0xC3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x08, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x11, 0x24, 0x31]);
|
|
var IDE_ModeSence_FloppyDisk_Page_Array = new Buffer([0x00, 0x26, 0x24, 0x80, 0x00, 0x00, 0x00, 0x00, 0x05, 0x1E, 0x04, 0xB0, 0x02, 0x12, 0x02, 0x00, 0x00, 0x50, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00]);
|
|
var IDE_ModeSence_3F_Floppy_Array = new Buffer([0x00, 0x5c, 0x24, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x0a, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x03, 0x16, 0x00, 0xa0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x12, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xa0, 0x00, 0x00, 0x00, 0x05, 0x1e, 0x04, 0xb0, 0x02, 0x12, 0x02, 0x00, 0x00, 0x50, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xd0, 0x00, 0x00, 0x08, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x11, 0x24, 0x31]);
|
|
var IDE_ModeSence_CD_1A_Array = new Buffer([0x00, 0x12, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x1A, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
|
|
//var IDE_ModeSence_CD_1B_Array = new Buffer([0x00, 0x12, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x1B, 0x0A, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
|
|
var IDE_ModeSence_CD_1D_Array = new Buffer([0x00, 0x12, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x1D, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
|
|
var IDE_ModeSence_CD_2A_Array = new Buffer([0x00, 0x20, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x2a, 0x18, 0x00, 0x00, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
|
|
//var IDE_ModeSence_CD_01_Array = new Buffer([0x00, 0x0E, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x06, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00]);
|
|
var IDE_ModeSence_3F_CD_Array = new Buffer([0x00, 0x28, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x06, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x2a, 0x18, 0x00, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
|
|
|
|
// 0x46 constant data
|
|
var IDE_CD_ConfigArrayHeader = new Buffer([0x00, 0x00,0x00, 0x28, 0x00, 0x00, 0x00, 0x08]);
|
|
var IDE_CD_ConfigArrayProfileList = new Buffer([0x00, 0x00, 0x03, 0x04, 0x00, 0x08, 0x01, 0x00]);
|
|
var IDE_CD_ConfigArrayCore = new Buffer([0x00, 0x01, 0x03, 0x04, 0x00, 0x00, 0x00, 0x02]);
|
|
var IDE_CD_Morphing = new Buffer([0x00, 0x02, 0x03, 0x04, 0x00, 0x00, 0x00, 0x00]);
|
|
var IDE_CD_ConfigArrayRemovable = new Buffer([0x00, 0x03, 0x03, 0x04, 0x29, 0x00, 0x00, 0x02]);
|
|
var IDE_CD_ConfigArrayRandom = new Buffer([0x00, 0x10, 0x01, 0x08, 0x00, 0x00, 0x08, 0x00, 0x00, 0x01, 0x00, 0x00]);
|
|
var IDE_CD_Read = new Buffer([0x00, 0x1E, 0x03, 0x00]);
|
|
var IDE_CD_PowerManagement = new Buffer([0x01, 0x00, 0x03, 0x00]);
|
|
var IDE_CD_Timeout = new Buffer([0x01, 0x05, 0x03, 0x00]);
|
|
|
|
// 0x01 constant data
|
|
var IDE_ModeSence_FloppyError_Recovery_Array = new Buffer([0x00, 0x12, 0x24, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x0A, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00]);
|
|
var IDE_ModeSence_Ls120Error_Recovery_Array = new Buffer([0x00, 0x12, 0x31, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x0A, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00]);
|
|
var IDE_ModeSence_CDError_Recovery_Array = new Buffer([0x00, 0x0E, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x06, 0x00, 0xFF, 0x00, 0x00, 0x00, 0x00]);
|
|
|
|
|
|
// Private method, called by parent when it change state
|
|
obj.xxStateChange = function (newstate) {
|
|
if (obj.debug) console.log("IDER-StateChange", newstate);
|
|
if (newstate == 0) { obj.Stop(); }
|
|
if (newstate == 3) { obj.Start(); }
|
|
}
|
|
|
|
obj.Start = function () {
|
|
if (obj.debug) { console.log("IDER-Start"); console.log(obj.floppy, obj.cdrom); }
|
|
obj.bytesToAmt = 0;
|
|
obj.bytesFromAmt = 0;
|
|
obj.inSequence = 0;
|
|
obj.outSequence = 0;
|
|
g_readQueue = [];
|
|
|
|
// Send first command, OPEN_SESSION
|
|
obj.SendCommand(0x40, Buffer.concat([ ShortToStrX(obj.rx_timeout), ShortToStrX(obj.tx_timeout), ShortToStrX(obj.heartbeat), IntToStrX(obj.version) ]));
|
|
|
|
// Send sector stats
|
|
if (obj.sectorStats) {
|
|
obj.sectorStats(0, 0, obj.floppy ? (obj.floppy.size >> 9) : 0);
|
|
obj.sectorStats(0, 1, obj.cdrom ? (obj.cdrom.size >> 11) : 0);
|
|
}
|
|
|
|
// Setup the ping timer
|
|
//obj.pingTimer = setInterval(function () { obj.SendCommand(0x44); }, 5000);
|
|
}
|
|
|
|
obj.Stop = function () {
|
|
if (obj.debug) console.log("IDER-Stop");
|
|
//if (obj.pingTimer) { clearInterval(obj.pingTimer); obj.pingTimer = null; }
|
|
obj.parent.Stop();
|
|
}
|
|
|
|
// Private method
|
|
obj.ProcessData = function (data) {
|
|
obj.bytesFromAmt += data.length;
|
|
if (obj.acc == null) { obj.acc = data; } else { obj.acc = Buffer.concat(obj.acc, data); }
|
|
if (obj.debug) console.log('IDER-ProcessData', obj.acc.length, obj.acc.toString('hex'));
|
|
|
|
// Process as many commands as possible
|
|
while (obj.acc != null) {
|
|
var len = obj.ProcessDataEx();
|
|
if (len == 0) return;
|
|
if (obj.inSequence != ReadIntX(obj.acc, 4)) {
|
|
if (obj.debug) console.log('ERROR: Out of sequence', obj.inSequence, ReadIntX(obj.acc, 4));
|
|
obj.Stop();
|
|
return;
|
|
}
|
|
obj.inSequence++;
|
|
if (len == obj.acc.length) { obj.acc = null; } else { obj.acc = obj.acc.slice(len); }
|
|
}
|
|
}
|
|
|
|
// Private method
|
|
obj.SendCommand = function (cmdid, data, completed, dma) {
|
|
if (data == null) { data = Buffer.alloc(0); }
|
|
var attributes = ((cmdid > 50) && (completed == true)) ? 2 : 0;
|
|
if (dma) { attributes += 1; }
|
|
var x = Buffer.concat([Buffer([cmdid, 0, 0, attributes]), IntToStrX(obj.outSequence++), data]);
|
|
obj.parent.xxSend(x);
|
|
obj.bytesToAmt += x.length;
|
|
//if (cmdid != 0x4B) { console.log('IDER-SendData', x.length, x.toString('hex')); }
|
|
}
|
|
|
|
// CommandEndResponse (SCSI_SENSE)
|
|
obj.SendCommandEndResponse = function (error, sense, device, asc, asq) {
|
|
if (error) { obj.SendCommand(0x51, new Buffer([0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0xc5, 0, 3, 0, 0, 0, device, 0x50, 0, 0, 0]), true); }
|
|
else { obj.SendCommand(0x51, new Buffer([0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x87, (sense << 4), 3, 0, 0, 0, device, 0x51, sense, asc, asq]), true); }
|
|
}
|
|
|
|
// DataToHost (SCSI_READ)
|
|
obj.SendDataToHost = function (device, completed, data, dma) {
|
|
var dmalen = (dma) ? 0 : data.length;
|
|
if (completed == true) {
|
|
obj.SendCommand(0x54, Buffer.concat([new Buffer([0, (data.length & 0xff), (data.length >> 8), 0, dma ? 0xb4 : 0xb5, 0, 2, 0, (dmalen & 0xff), (dmalen >> 8), device, 0x58, 0x85, 0, 3, 0, 0, 0, device, 0x50, 0, 0, 0, 0, 0, 0]), data ]), completed, dma);
|
|
} else {
|
|
obj.SendCommand(0x54, Buffer.concat([new Buffer([0, (data.length & 0xff), (data.length >> 8), 0, dma ? 0xb4 : 0xb5, 0, 2, 0, (dmalen & 0xff), (dmalen >> 8), device, 0x58, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]), data]), completed, dma);
|
|
}
|
|
}
|
|
|
|
// GetDataFromHost (SCSI_CHUNK)
|
|
obj.SendGetDataFromHost = function (device, chunksize) {
|
|
obj.SendCommand(0x52, new Buffer([0, (chunksize & 0xff), (chunksize >> 8), 0, 0xb5, 0, 0, 0, (chunksize & 0xff), (chunksize >> 8), device, 0x58, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]), false);
|
|
}
|
|
|
|
// DisableEnableFeatures (STATUS_DATA)
|
|
// If type is REGS_TOGGLE (3), 4 bytes of data must be provided.
|
|
obj.SendDisableEnableFeatures = function (type, data) { if (data == null) { data = ''; } obj.SendCommand(0x48, Buffer.concat([new Buffer([type]), data])); }
|
|
|
|
// Private method
|
|
obj.ProcessDataEx = function () {
|
|
if (obj.acc.length < 8) return 0;
|
|
|
|
// First 8 bytes are the header
|
|
// CommandID + 0x000000 + Sequence Number
|
|
//console.log('ProcessDataEx', obj.acc[0]);
|
|
|
|
switch(obj.acc[0]) {
|
|
case 0x41: // OPEN_SESSION
|
|
if (obj.acc.length < 30) return 0;
|
|
var len = obj.acc[29];
|
|
if (obj.acc.length < (30 + len)) return 0;
|
|
obj.iderinfo = {};
|
|
obj.iderinfo.major = obj.acc[8];
|
|
obj.iderinfo.minor = obj.acc[9];
|
|
obj.iderinfo.fwmajor = obj.acc[10];
|
|
obj.iderinfo.fwminor = obj.acc[11];
|
|
obj.iderinfo.readbfr = ReadShortX(obj.acc, 16);
|
|
obj.iderinfo.writebfr = ReadShortX(obj.acc, 18);
|
|
obj.iderinfo.proto = obj.acc[21];
|
|
obj.iderinfo.iana = ReadIntX(obj.acc, 25);
|
|
if (obj.debug) console.log(obj.iderinfo);
|
|
|
|
if (obj.iderinfo.proto != 0) {
|
|
if (obj.debug) console.log("Unknown proto", obj.iderinfo.proto);
|
|
obj.Stop();
|
|
}
|
|
if (obj.iderinfo.readbfr > 8192) {
|
|
if (obj.debug) console.log("Illegal read buffer size", obj.iderinfo.readbfr);
|
|
obj.Stop();
|
|
}
|
|
if (obj.iderinfo.writebfr > 8192) {
|
|
if (obj.debug) console.log("Illegal write buffer size", obj.iderinfo.writebfr);
|
|
obj.Stop();
|
|
}
|
|
|
|
if (obj.iderStart == 0) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x08)); } // OnReboot
|
|
else if (obj.iderStart == 1) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x10)); } // Graceful
|
|
else if (obj.iderStart == 2) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x18)); } // Now
|
|
//obj.SendDisableEnableFeatures(1); // GetSupportedFeatures
|
|
return 30 + len;
|
|
case 0x43: // CLOSE
|
|
if (obj.debug) console.log('CLOSE');
|
|
obj.Stop();
|
|
return 8;
|
|
case 0x44: // KEEPALIVEPING
|
|
obj.SendCommand(0x45); // Send PONG back
|
|
return 8;
|
|
case 0x45: // KEEPALIVEPONG
|
|
if (obj.debug) console.log('PONG');
|
|
return 8;
|
|
case 0x46: // RESETOCCURED
|
|
if (obj.acc.length < 9) return 0;
|
|
var resetMask = obj.acc[8];
|
|
if (g_media === null) {
|
|
// No operations are pending
|
|
obj.SendCommand(0x47); // Send ResetOccuredResponse
|
|
if (obj.debug) console.log('RESETOCCURED1', resetMask);
|
|
} else {
|
|
// Operations are being done, sent the reset once completed.
|
|
g_reset = true;
|
|
if (obj.debug) console.log('RESETOCCURED2', resetMask);
|
|
}
|
|
return 9;
|
|
case 0x49: // STATUS_DATA - DisableEnableFeaturesReply
|
|
if (obj.acc.length < 13) return 0;
|
|
var type = obj.acc[8];
|
|
var value = ReadIntX(obj.acc, 9);
|
|
if (obj.debug) console.log('STATUS_DATA', type, value);
|
|
switch (type)
|
|
{
|
|
case 1: // REGS_AVAIL
|
|
if (value & 1) {
|
|
if (obj.iderStart == 0) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x08)); } // OnReboot
|
|
else if (obj.iderStart == 1) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x10)); } // Graceful
|
|
else if (obj.iderStart == 2) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x18)); } // Now
|
|
}
|
|
break;
|
|
case 2: // REGS_STATUS
|
|
obj.enabled = (value & 2) ? true : false;
|
|
if (obj.debug) console.log("IDER Status: " + obj.enabled);
|
|
break;
|
|
case 3: // REGS_TOGGLE
|
|
if (value != 1) {
|
|
if (obj.debug) console.log("Register toggle failure");
|
|
} //else { obj.SendDisableEnableFeatures(2); }
|
|
break;
|
|
}
|
|
return 13;
|
|
case 0x4A: // ERROR OCCURED
|
|
if (obj.acc.length < 11) return 0;
|
|
if (obj.debug) console.log('IDER: ABORT', obj.acc[8]);
|
|
//obj.Stop();
|
|
return 11;
|
|
case 0x4B: // HEARTBEAT
|
|
//console.log('HEARTBEAT');
|
|
return 8;
|
|
case 0x50: // COMMAND WRITTEN
|
|
if (obj.acc.length < 28) return 0;
|
|
var device = (obj.acc[14] & 0x10) ? 0xB0 : 0xA0;
|
|
var deviceFlags = obj.acc[14];
|
|
var cdb = obj.acc.slice(16, 28);
|
|
var featureRegister = obj.acc[9];
|
|
if (obj.debug) console.log('SCSI_CMD', device, cdb.toString('hex'), featureRegister, deviceFlags);
|
|
handleSCSI(device, cdb, featureRegister, deviceFlags);
|
|
return 28;
|
|
case 0x53: // DATA FROM HOST
|
|
if (obj.acc.length < 14) return 0;
|
|
var len = ReadShortX(obj.acc, 9);
|
|
if (obj.acc.length < (14 + len)) return 0;
|
|
if (obj.debug) console.log('SCSI_WRITE, len = ' + (14 + len));
|
|
obj.SendCommand(0x51, new Buffer([0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x87, 0x70, 0x03, 0x00, 0x00, 0x00, 0xa0, 0x51, 0x07, 0x27, 0x00]), true);
|
|
return 14 + len;
|
|
default:
|
|
if (obj.debug) console.log('Unknown IDER command', obj.acc[0]);
|
|
obj.Stop();
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
function handleSCSI(dev, cdb, featureRegister, deviceFlags)
|
|
{
|
|
var lba;
|
|
var len;
|
|
|
|
switch(cdb[0])
|
|
{
|
|
case 0x00: // TEST_UNIT_READY:
|
|
if (obj.debug) console.log("SCSI: TEST_UNIT_READY", dev);
|
|
switch (dev) {
|
|
case 0xA0: // DEV_FLOPPY
|
|
if (obj.floppy == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
if (obj.floppyReady == false) { obj.floppyReady = true; obj.SendCommandEndResponse(1, 0x06, dev, 0x28, 0x00); return -1; } // Switch to ready
|
|
break;
|
|
case 0xB0: // DEV_CDDVD
|
|
if (obj.cdrom == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
if (obj.cdromReady == false) { obj.cdromReady = true; obj.SendCommandEndResponse(1, 0x06, dev, 0x28, 0x00); return -1; } // Switch to ready
|
|
break;
|
|
default:
|
|
if (obj.debug) console.log("SCSI Internal error 3", dev);
|
|
return -1;
|
|
}
|
|
obj.SendCommandEndResponse(1, 0x00, dev, 0x00, 0x00); // Indicate ready
|
|
break;
|
|
case 0x08: // READ_6
|
|
lba = ((cdb[1] & 0x1f) << 16) + (cdb[2] << 8) + cdb[3];
|
|
len = cdb[4];
|
|
if (len == 0) { len = 256; }
|
|
if (obj.debug) console.log("SCSI: READ_6", dev, lba, len);
|
|
sendDiskData(dev, lba, len, featureRegister);
|
|
break;
|
|
case 0x0a: // WRITE_6
|
|
lba = ((cdb[1] & 0x1f) << 16) + (cdb[2] << 8) + cdb[3];
|
|
len = cdb[4];
|
|
if (len == 0) { len = 256; }
|
|
if (obj.debug) console.log("SCSI: WRITE_6", dev, lba, len);
|
|
obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); // Write is not supported, remote no medium.
|
|
return -1;
|
|
/*
|
|
case 0x15: // MODE_SELECT_6:
|
|
console.log("SCSI ERROR: MODE_SELECT_6", dev);
|
|
obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00);
|
|
return -1;
|
|
*/
|
|
case 0x1a: // MODE_SENSE_6
|
|
if (obj.debug) console.log("SCSI: MODE_SENSE_6", dev);
|
|
if ((cdb[2] == 0x3f) && (cdb[3] == 0x00)) {
|
|
var a = 0, b = 0;
|
|
switch (dev) {
|
|
case 0xA0: // DEV_FLOPPY
|
|
if (obj.floppy == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
a = 0x00;
|
|
b = 0x80; // Read only = 0x80, Read write = 0x00
|
|
break;
|
|
case 0xB0: // DEV_CDDVD
|
|
if (obj.cdrom == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
a = 0x05;
|
|
b = 0x80;
|
|
break;
|
|
default:
|
|
if (obj.debug) console.log("SCSI Internal error 6", dev);
|
|
return -1;
|
|
}
|
|
obj.SendDataToHost(dev, true, new Buffer([0, a, b, 0]), featureRegister & 1);
|
|
return;
|
|
}
|
|
obj.SendCommandEndResponse(1, 0x05, dev, 0x24, 0x00);
|
|
break;
|
|
case 0x1b: // START_STOP (Called when you eject the CDROM)
|
|
//var immediate = cdb[1] & 0x01;
|
|
//var loej = cdb[4] & 0x02;
|
|
//var start = cdb[4] & 0x01;
|
|
obj.SendCommandEndResponse(1, 0, dev);
|
|
break;
|
|
case 0x1e: // LOCK_UNLOCK - ALLOW_MEDIUM_REMOVAL
|
|
if (obj.debug) console.log("SCSI: ALLOW_MEDIUM_REMOVAL", dev);
|
|
if ((dev == 0xA0) && (obj.floppy == null)) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
if ((dev == 0xB0) && (obj.cdrom == null)) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
obj.SendCommandEndResponse(1, 0x00, dev, 0x00, 0x00);
|
|
break;
|
|
case 0x23: // READ_FORMAT_CAPACITIES (Floppy only)
|
|
if (obj.debug) console.log("SCSI: READ_FORMAT_CAPACITIES", dev);
|
|
var buflen = ReadShort(cdb, 7);
|
|
var mediaStatus = 0, sectors;
|
|
var mcSize = buflen / 8; // Capacity descriptor size is 8
|
|
|
|
switch (dev) {
|
|
case 0xA0: // DEV_FLOPPY
|
|
if ((obj.floppy == null) || (obj.floppy.size == 0)) { obj.SendCommandEndResponse(0, 0x05, dev, 0x24, 0x00); return -1; }
|
|
sectors = (obj.floppy.size >> 9) - 1;
|
|
break;
|
|
case 0xB0: // DEV_CDDVD
|
|
if ((obj.cdrom == null) || (obj.cdrom.size == 0)) { obj.SendCommandEndResponse(0, 0x05, dev, 0x24, 0x00); return -1; }
|
|
sectors = (obj.cdrom.size >> 11) - 1; // Number 2048 byte blocks
|
|
break;
|
|
default:
|
|
if (obj.debug) console.log("SCSI Internal error 4", dev);
|
|
return -1;
|
|
}
|
|
|
|
obj.SendDataToHost(dev, true, Buffer.concat([IntToStr(8), new Buffer([0x00, 0x00, 0x0b, 0x40, 0x02, 0x00, 0x02, 0x00]) ]), featureRegister & 1);
|
|
break;
|
|
case 0x25: // READ_CAPACITY
|
|
if (obj.debug) console.log("SCSI: READ_CAPACITY", dev);
|
|
var len = 0;
|
|
switch(dev)
|
|
{
|
|
case 0xA0: // DEV_FLOPPY
|
|
if ((obj.floppy == null) || (obj.floppy.size == 0)) { obj.SendCommandEndResponse(0, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
if (obj.floppy != null) { len = (obj.floppy.size >> 9) - 1; }
|
|
if (obj.debug) console.log('DEV_FLOPPY', len); // Number 512 byte blocks
|
|
break;
|
|
case 0xB0: // DEV_CDDVD
|
|
if ((obj.cdrom == null) || (obj.cdrom.size == 0)) { obj.SendCommandEndResponse(0, 0x02, dev, 0x3a, 0x00); return -1; }
|
|
if (obj.cdrom != null) { len = (obj.cdrom.size >> 11) - 1; } // Number 2048 byte blocks
|
|
if (obj.debug) console.log('DEV_CDDVD', len);
|
|
break;
|
|
default:
|
|
if (obj.debug) console.log("SCSI Internal error 4", dev);
|
|
return -1;
|
|
}
|
|
//if (dev == 0xA0) { dev = 0x00; } else { dev = 0x10; } // Weird but seems to work.
|
|
if (obj.debug) console.log("SCSI: READ_CAPACITY2", dev, deviceFlags);
|
|
obj.SendDataToHost(deviceFlags, true, Buffer.concat([IntToStr(len), new Buffer([0, 0, ((dev == 0xB0) ? 0x08 : 0x02), 0])]), featureRegister & 1);
|
|
break;
|
|
case 0x28: // READ_10
|
|
lba = ReadInt(cdb, 2);
|
|
len = ReadShort(cdb, 7);
|
|
if (obj.debug) console.log("SCSI: READ_10", dev, lba, len);
|
|
sendDiskData(dev, lba, len, featureRegister);
|
|
break;
|
|
case 0x2a: // WRITE_10 (Floppy only)
|
|
case 0x2e: // WRITE_AND_VERIFY (Floppy only)
|
|
lba = ReadInt(cdb, 2);
|
|
len = ReadShort(cdb, 7);
|
|
if (obj.debug) console.log("SCSI: WRITE_10", dev, lba, len);
|
|
obj.SendGetDataFromHost(dev, 512 * len); // Floppy writes only, accept sectors of 512 bytes
|
|
break;
|
|
case 0x43: // READ_TOC (CD Audio only)
|
|
var buflen = ReadShort(cdb, 7);
|
|
var msf = cdb[1] & 0x02;
|
|
var format = cdb[2] & 0x07;
|
|
if (format == 0) { format = cdb[9] >> 6; }
|
|
if (obj.debug) console.log("SCSI: READ_TOC, dev=" + dev + ", buflen=" + buflen + ", msf=" + msf + ", format=" + format);
|
|
|
|
switch (dev) {
|
|
case 0xA0: // DEV_FLOPPY
|
|
obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00); // Not implemented
|
|
return -1;
|
|
case 0xB0: // DEV_CDDVD
|
|
// NOP
|
|
break;
|
|
default:
|
|
if (obj.debug) console.log("SCSI Internal error 9", dev);
|
|
return -1;
|
|
}
|
|
|
|
if (format == 1) { obj.SendDataToHost(dev, true, new Buffer([0x00, 0x0a, 0x01, 0x01, 0x00, 0x14, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00]), featureRegister & 1); }
|
|
else if (format == 0) {
|
|
if (msf) {
|
|
obj.SendDataToHost(dev, true, new Buffer([0x00, 0x12, 0x01, 0x01, 0x00, 0x14, 0x01, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x14, 0xaa, 0x00, 0x00, 0x00, 0x34, 0x13]), featureRegister & 1);
|
|
} else {
|
|
obj.SendDataToHost(dev, true, new Buffer([0x00, 0x12, 0x01, 0x01, 0x00, 0x14, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x14, 0xaa, 0x00, 0x00, 0x00, 0x00, 0x00]), featureRegister & 1);
|
|
}
|
|
}
|
|
break;
|
|
case 0x46: // GET_CONFIGURATION
|
|
var sendall = (cdb[1] != 2);
|
|
var firstcode = ReadShort(cdb, 2);
|
|
var buflen = ReadShort(cdb, 7);
|
|
|
|
if (obj.debug) console.log("SCSI: GET_CONFIGURATION", dev, sendall, firstcode, buflen);
|
|
if (buflen == 0) { obj.SendDataToHost(dev, true, Buffer.concat([IntToStr(0x003c), IntToStr(0x0008)]), featureRegister & 1); return -1; } // TODO: Fixed this return, it's not correct.
|
|
|
|
// Set the header
|
|
var r = null;
|
|
|
|
// Add the data
|
|
if (firstcode == 0) { r = IDE_CD_ConfigArrayProfileList; }
|
|
if ((firstcode == 0x1) || (sendall && (firstcode < 0x1))) { r = IDE_CD_ConfigArrayCore; }
|
|
if ((firstcode == 0x2) || (sendall && (firstcode < 0x2))) { r = IDE_CD_Morphing; }
|
|
if ((firstcode == 0x3) || (sendall && (firstcode < 0x3))) { r = IDE_CD_ConfigArrayRemovable; }
|
|
if ((firstcode == 0x10) || (sendall && (firstcode < 0x10))) { r = IDE_CD_ConfigArrayRandom; }
|
|
if ((firstcode == 0x1E) || (sendall && (firstcode < 0x1E))) { r = IDE_CD_Read; }
|
|
if ((firstcode == 0x100) || (sendall && (firstcode < 0x100))) { r = IDE_CD_PowerManagement; }
|
|
if ((firstcode == 0x105) || (sendall && (firstcode < 0x105))) { r = IDE_CD_Timeout; }
|
|
|
|
if (r == null) {
|
|
//console.log('NOT RIGHT', sendall, firstcode, cdb[2], cdb[3]);
|
|
//process.exit(0);
|
|
r = Buffer.concat([IntToStr(0x0008), IntToStr(4)]);
|
|
} else {
|
|
r = Buffer.concat([IntToStr(0x0008), IntToStr(r.length + 4), r]);
|
|
}
|
|
|
|
// Cut the length to buflen if needed
|
|
if (r.length > buflen) { r = r.slice(0, buflen); }
|
|
|
|
obj.SendDataToHost(dev, true, r, featureRegister & 1);
|
|
return -1;
|
|
case 0x4a: // GET_EV_STATUS - GET_EVENT_STATUS_NOTIFICATION
|
|
//var buflen = (cdb[7] << 8) + cdb[8];
|
|
//if (buflen == 0) { obj.SendDataToHost(dev, true, Buffer.concat([IntToStr(0x003c), IntToStr(0x0008)]), featureRegister & 1); return -1; } // TODO: Fixed this return, it's not correct.
|
|
if (obj.debug) console.log("SCSI: GET_EVENT_STATUS_NOTIFICATION", dev, cdb[1], cdb[4], cdb[9]);
|
|
if ((cdb[1] != 0x01) && (cdb[4] != 0x10)) {
|
|
if (obj.debug) console.log('SCSI ERROR');
|
|
obj.SendCommandEndResponse(1, 0x05, dev, 0x26, 0x01);
|
|
break;
|
|
}
|
|
var present = 0x00;
|
|
if ((dev == 0xA0) && (obj.floppy != null)) { present = 0x02; }
|
|
else if ((dev == 0xB0) && (obj.cdrom != null)) { present = 0x02; }
|
|
obj.SendDataToHost(dev, true, new Buffer([0x00, present, 0x80, 0x00]), featureRegister & 1); // This is the original version, 4 bytes long
|
|
break;
|
|
case 0x4c:
|
|
obj.SendCommand(0x51, Buffer.concat([IntToStrX(0), IntToStrX(0), IntToStrX(0), new Buffer([0x87, 0x50, 0x03, 0x00, 0x00, 0x00, 0xb0, 0x51, 0x05, 0x20, 0x00]) ]), true);
|
|
break;
|
|
case 0x51: // READ_DISC_INFO
|
|
if (obj.debug) console.log("SCSI READ_DISC_INFO", dev);
|
|
obj.SendCommandEndResponse(0, 0x05, dev, 0x20, 0x00); // Correct
|
|
return -1;
|
|
case 0x55: // MODE_SELECT_10:
|
|
if (obj.debug) console.log("SCSI ERROR: MODE_SELECT_10", dev);
|
|
obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00);
|
|
return -1;
|
|
case 0x5a: // MODE_SENSE_10
|
|
if (obj.debug) console.log("SCSI: MODE_SENSE_10", dev, cdb[2] & 0x3f);
|
|
var buflen = ReadShort(cdb, 7);
|
|
//var pc = cdb[2] & 0xc0;
|
|
var r = null;
|
|
|
|
if (buflen == 0) { obj.SendDataToHost(dev, true, Buffer.concat([IntToStr(0x003c), IntToStr(0x0008)]), featureRegister & 1); return -1; } // TODO: Fixed this return, it's not correct.
|
|
|
|
// 1.44 mb floppy or LS120 (sectorCount == 0x3c300)
|
|
var sectorCount = 0;
|
|
if (dev == 0xA0) {
|
|
if (obj.floppy != null) { sectorCount = (obj.floppy.size >> 9); }
|
|
} else {
|
|
if (obj.cdrom != null) { sectorCount = (obj.cdrom.size >> 11); }
|
|
}
|
|
|
|
switch (cdb[2] & 0x3f) {
|
|
case 0x01: if (dev == 0xA0) { r = (sectorCount <= 0xb40)?IDE_ModeSence_FloppyError_Recovery_Array:IDE_ModeSence_Ls120Error_Recovery_Array; } else { r = IDE_ModeSence_CDError_Recovery_Array; } break;
|
|
case 0x05: if (dev == 0xA0) { r = (sectorCount <= 0xb40)?IDE_ModeSence_FloppyDisk_Page_Array:IDE_ModeSence_LS120Disk_Page_Array; } break;
|
|
case 0x3f: if (dev == 0xA0) { r = (sectorCount <= 0xb40)?IDE_ModeSence_3F_Floppy_Array:IDE_ModeSence_3F_LS120_Array; } else { r = IDE_ModeSence_3F_CD_Array; } break;
|
|
case 0x1A: if (dev == 0xB0) { r = IDE_ModeSence_CD_1A_Array; } break;
|
|
case 0x1D: if (dev == 0xB0) { r = IDE_ModeSence_CD_1D_Array; } break;
|
|
case 0x2A: if (dev == 0xB0) { r = IDE_ModeSence_CD_2A_Array; } break;
|
|
}
|
|
|
|
if (r == null) {
|
|
obj.SendCommandEndResponse(0, 0x05, dev, 0x20, 0x00); // TODO: Send proper error!!!
|
|
} else {
|
|
// Set disk to read only (we don't support write).
|
|
//ms_data[3] = ms_data[3] | 0x80;
|
|
obj.SendDataToHost(dev, true, r, featureRegister & 1);
|
|
}
|
|
break;
|
|
default: // UNKNOWN COMMAND
|
|
if (obj.debug) console.log("IDER: Unknown SCSI command", cdb[0]);
|
|
obj.SendCommandEndResponse(0, 0x05, dev, 0x20, 0x00);
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
function sendDiskData(dev, lba, len, featureRegister) {
|
|
var media = null;
|
|
var mediaBlocks = 0;
|
|
if (dev == 0xA0) { media = obj.floppy; if (obj.floppy != null) { mediaBlocks = (obj.floppy.size >> 9); } }
|
|
if (dev == 0xB0) { media = obj.cdrom; if (obj.cdrom != null) { mediaBlocks = (obj.cdrom.size >> 11); } }
|
|
if ((len < 0) || (lba + len > mediaBlocks)) { obj.SendCommandEndResponse(1, 0x05, dev, 0x21, 0x00); return 0; }
|
|
if (len == 0) { obj.SendCommandEndResponse(1, 0x00, dev, 0x00, 0x00); return 0; }
|
|
if (media != null) {
|
|
// Send sector stats
|
|
if (obj.sectorStats) { obj.sectorStats(1, (dev == 0xA0) ? 0 : 1, mediaBlocks, lba, len); }
|
|
if (dev == 0xA0) { lba <<= 9; len <<= 9; } else { lba <<= 11; len <<= 11; }
|
|
if (g_media !== null) {
|
|
// Queue read operation
|
|
g_readQueue.push({ media: media, dev: dev, lba: lba, len: len, fr: featureRegister });
|
|
} else {
|
|
// obj.iderinfo.readbfr // TODO: MaxRead
|
|
g_media = media;
|
|
g_dev = dev;
|
|
g_lba = lba;
|
|
g_len = len;
|
|
sendDiskDataEx(featureRegister);
|
|
}
|
|
}
|
|
}
|
|
|
|
var g_readQueue = [];
|
|
var g_reset = false;
|
|
var g_media = null;
|
|
var g_dev;
|
|
var g_lba;
|
|
var g_len;
|
|
function sendDiskDataEx(featureRegister) {
|
|
var len = g_len, lba = g_lba;
|
|
if (g_len > obj.iderinfo.readbfr) { len = obj.iderinfo.readbfr; }
|
|
g_len -= len;
|
|
g_lba += len;
|
|
|
|
//console.log('Read from ' + lba + ' to ' + (lba + len) + ', total of ' + len);
|
|
|
|
var result = Buffer.alloc(len);
|
|
fs.readSync(g_media.file, result, 0, len, lba);
|
|
obj.SendDataToHost(g_dev, (g_len == 0), result, featureRegister & 1);
|
|
if ((g_len > 0) && (g_reset == false)) {
|
|
sendDiskDataEx(featureRegister);
|
|
} else {
|
|
g_media = null;
|
|
if (g_reset) { obj.SendCommand(0x47); g_readQueue = []; g_reset = false; } // Send ResetOccuredResponse
|
|
else if (g_readQueue.length > 0) { var op = g_readQueue.shift(); g_media = op.media; g_dev = op.dev; g_lba = op.lba; g_len = op.len; sendDiskDataEx(op.fr); } // Un-queue read operation
|
|
}
|
|
}
|
|
|
|
return obj;
|
|
}
|
|
|
|
function ShortToStr(v) { return new Buffer([(v >> 8) & 0xFF, v & 0xFF]); }
|
|
function ShortToStrX(v) { return new Buffer([v & 0xFF, (v >> 8) & 0xFF]); }
|
|
function IntToStr(v) { return new Buffer([(v >> 24) & 0xFF, (v >> 16) & 0xFF, (v >> 8) & 0xFF, v & 0xFF]); }
|
|
function IntToStrX(v) { return new Buffer([v & 0xFF, (v >> 8) & 0xFF, (v >> 16) & 0xFF, (v >> 24) & 0xFF]); }
|
|
function ReadShort(v, p) { return (v[p] << 8) + v[p + 1]; }
|
|
function ReadShortX(v, p) { return (v[p + 1] << 8) + v[p]; }
|
|
function ReadInt(v, p) { return (v[p] * 0x1000000) + (v[p + 1] << 16) + (v[p + 2] << 8) + v[p + 3]; } // We use "*0x1000000" instead of "<<24" because the shift converts the number to signed int32.
|
|
function ReadSInt(v, p) { return (v[p] << 24) + (v[p + 1] << 16) + (v[p + 2] << 8) + v[p + 3]; }
|
|
function ReadIntX(v, p) { return (v[p + 3] * 0x1000000) + (v[p + 2] << 16) + (v[p + 1] << 8) + v[p]; } |