MeshCentral/amt/amt-ider-module.js

/** 
* @description IDER Handling Module
* @author Ylian Saint-Hilaire
* @version v0.0.2
*/

// Construct a Intel AMT IDER object
module.exports.CreateAmtRemoteIder = function (webserver, meshcentral) {
    const fs = require('fs');

    var obj = {};
    obj.debug = false;
    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 = "";
    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.floppySize = null;
    obj.cdromSize = null;
    obj.floppyReady = false;
    obj.cdromReady = false;
    obj.sectorStats = null;

    // Private method
    function debug() { if (obj.debug) { console.log(...arguments); } }

    // Mode Sense
    var IDE_ModeSence_LS120Disk_Page_Array = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(0x00, 0x0E, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x06, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00);
    var IDE_ModeSence_3F_CD_Array = String.fromCharCode(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 = String.fromCharCode(0x00, 0x00,0x00, 0x28, 0x00, 0x00, 0x00, 0x08);
    var IDE_CD_ConfigArrayProfileList = String.fromCharCode(0x00, 0x00, 0x03, 0x04, 0x00, 0x08, 0x01, 0x00);
    var IDE_CD_ConfigArrayCore = String.fromCharCode(0x00, 0x01, 0x03, 0x04, 0x00, 0x00, 0x00, 0x02);
    var IDE_CD_Morphing = String.fromCharCode(0x00, 0x02, 0x03, 0x04, 0x00, 0x00, 0x00, 0x00);
    var IDE_CD_ConfigArrayRemovable = String.fromCharCode(0x00, 0x03, 0x03, 0x04, 0x29, 0x00, 0x00, 0x02);
    var IDE_CD_ConfigArrayRandom = String.fromCharCode(0x00, 0x10, 0x01, 0x08, 0x00, 0x00, 0x08, 0x00, 0x00, 0x01, 0x00, 0x00);
    var IDE_CD_Read = String.fromCharCode(0x00, 0x1E, 0x03, 0x00);
    var IDE_CD_PowerManagement = String.fromCharCode(0x01, 0x00, 0x03, 0x00);
    var IDE_CD_Timeout = String.fromCharCode(0x01, 0x05, 0x03, 0x00);

    // 0x01 constant data
    var IDE_ModeSence_FloppyError_Recovery_Array = String.fromCharCode(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 = String.fromCharCode(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 = String.fromCharCode(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) {
        debug("IDER-StateChange", newstate);
        if (newstate == 0) { obj.Stop(); }
        if (newstate == 3) { obj.Start(); }
    }

    obj.diskSetup = function (floppyPath, cdromPath) {
        debug(floppyPath, cdromPath);

        // Setup floppy
        if (floppyPath != null) {
            try {
                if (fs.existsSync(floppyPath) == false) { return 1; } // Floppy disk image does not exist
                var stats = fs.statSync(floppyPath);
                if ((stats.size % 512) != 0) { return 2; } // Invalid floppy disk image
                obj.floppySize = stats.size;
                obj.floppy = fs.openSync(floppyPath, 'r');
            } catch (ex) { return 3; } // Unable to open floppy disk image
        }

        // Setup CDROM
        if (cdromPath != null) {
            try {
                if (fs.existsSync(cdromPath) == false) { return 4; } // CDROM disk image does not exist
                var stats = fs.statSync(cdromPath);
                if ((stats.size % 512) != 0) { return 5; } // Invalid CDROM disk image
                obj.cdromSize = stats.size;
                obj.cdrom = fs.openSync(cdromPath, 'r');
            } catch (ex) { return 6; } // Unable to open CDROM disk image
        }

        if ((obj.cdrom == null) && (obj.floppy == null)) { return 7; } // Can't do IDER with no disk images

        return 0;
    }

    obj.Start = function () {
        debug("IDER-Start");

        // Get ready
        obj.bytesToAmt = 0;
        obj.bytesFromAmt = 0;
        obj.inSequence = 0;
        obj.outSequence = 0;
        g_readQueue = [];

        // Send first command, OPEN_SESSION
        obj.SendCommand(0x40, webserver.common.ShortToStrX(obj.rx_timeout) + webserver.common.ShortToStrX(obj.tx_timeout) + webserver.common.ShortToStrX(obj.heartbeat) + webserver.common.IntToStrX(obj.version));

        // Send sector stats
        if (obj.sectorStats) {
            obj.sectorStats(0, 0, obj.floppy ? (obj.floppySize >> 9) : 0);
            obj.sectorStats(0, 1, obj.cdrom ? (obj.cdromSize >> 11) : 0);
        }
    }

    obj.Stop = function () {
        debug("IDER-Stop");

        // Close the files
        if (obj.floppy) { fs.close(obj.floppy); delete obj.floppy; }
        if (obj.cdrom) { fs.close(obj.cdrom); delete obj.cdrom; }

        // Clean up
        obj.floppySize = 0;
        obj.cdromSize = 0;
        obj.floppyReady = false;
        obj.cdromReady = false;

        // Stop the redirection connection
        obj.parent.Stop();
    }

    // Private method
    obj.ProcessData = function (data) {
        obj.bytesFromAmt += data.length;
        obj.acc += data;
        debug('IDER-ProcessData', obj.acc.length, webserver.common.rstr2hex(obj.acc));

        // Process as many commands as possible
        while (true) {
            var len = obj.ProcessDataEx();
            if (len == 0) return;
            if (obj.inSequence != webserver.common.ReadIntX(obj.acc, 4)) {
                debug('ERROR: Out of sequence', obj.inSequence, webserver.common.ReadIntX(obj.acc, 4));
                obj.Stop();
                return;
            }
            obj.inSequence++;
            obj.acc = obj.acc.substring(len);
        }
    }

    // Private method
    obj.SendCommand = function (cmdid, data, completed, dma) {
        if (data == null) { data = ''; }
        var attributes = ((cmdid > 50) && (completed == true)) ? 2 : 0;
        if (dma) { attributes += 1; }
        var x = String.fromCharCode(cmdid, 0, 0, attributes) + webserver.common.IntToStrX(obj.outSequence++) + data;
        obj.parent.xxSend(x);
        obj.bytesToAmt += x.length;
        if (cmdid != 0x4B) { debug('IDER-SendData', x.length, webserver.common.rstr2hex(x)); }
    }

    // CommandEndResponse (SCSI_SENSE)
    obj.SendCommandEndResponse = function (error, sense, device, asc, asq) {
        if (error) { obj.SendCommand(0x51, String.fromCharCode(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, String.fromCharCode(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, String.fromCharCode(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, String.fromCharCode(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, String.fromCharCode(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, String.fromCharCode(type) + data); }

    // Private method
    obj.ProcessDataEx = function () {
        if (obj.acc.length < 8) return 0;

        // First 8 bytes are the header
        // CommandID + 0x000000 + Sequence Number

        switch(obj.acc.charCodeAt(0)) {
            case 0x41: // OPEN_SESSION
                if (obj.acc.length < 30) return 0;
                var len = obj.acc.charCodeAt(29);
                if (obj.acc.length < (30 + len)) return 0;
                obj.iderinfo = {};
                obj.iderinfo.major = obj.acc.charCodeAt(8);
                obj.iderinfo.minor = obj.acc.charCodeAt(9);
                obj.iderinfo.fwmajor = obj.acc.charCodeAt(10);
                obj.iderinfo.fwminor = obj.acc.charCodeAt(11);
                obj.iderinfo.readbfr = webserver.common.ReadShortX(obj.acc, 16);
                obj.iderinfo.writebfr = webserver.common.ReadShortX(obj.acc, 18);
                obj.iderinfo.proto = obj.acc.charCodeAt(21);
                obj.iderinfo.iana = webserver.common.ReadIntX(obj.acc, 25);
                debug(obj.iderinfo);

                if (obj.iderinfo.proto != 0) {
                    debug("Unknown proto", obj.iderinfo.proto);
                    obj.Stop();
                }
                if (obj.iderinfo.readbfr > 8192) {
                    debug("Illegal read buffer size", obj.iderinfo.readbfr);
                    obj.Stop();
                }
                if (obj.iderinfo.writebfr > 8192) {
                    debug("Illegal write buffer size", obj.iderinfo.writebfr);
                    obj.Stop();
                }

                if (obj.iderStart == 0) { obj.SendDisableEnableFeatures(3, webserver.common.IntToStrX(0x01 + 0x08)); } // OnReboot
                else if (obj.iderStart == 1) { obj.SendDisableEnableFeatures(3, webserver.common.IntToStrX(0x01 + 0x10)); } // Graceful
                else if (obj.iderStart == 2) { obj.SendDisableEnableFeatures(3, webserver.common.IntToStrX(0x01 + 0x18)); } // Now
                //obj.SendDisableEnableFeatures(1); // GetSupportedFeatures
                return 30 + len;
            case 0x43: // CLOSE
                debug('CLOSE');
                obj.Stop();
                return 8;
            case 0x44: // KEEPALIVEPING
                obj.SendCommand(0x45); // Send PONG back
                return 8;
            case 0x45: // KEEPALIVEPONG
                debug('PONG');
                return 8;
            case 0x46: // RESETOCCURED
                if (obj.acc.length < 9) return 0;
                var resetMask = obj.acc.charCodeAt(8);
                if (g_media === null) {
                    // No operations are pending
                    obj.SendCommand(0x47); // Send ResetOccuredResponse
                    debug('RESETOCCURED1', resetMask);
                } else {
                    // Operations are being done, sent the reset once completed.
                    g_reset = true;
                    debug('RESETOCCURED2', resetMask);
                }
                return 9;
            case 0x49: // STATUS_DATA - DisableEnableFeaturesReply
                if (obj.acc.length < 13) return 0;
                var type = obj.acc.charCodeAt(8);
                var value = webserver.common.ReadIntX(obj.acc, 9);
                debug('STATUS_DATA', type, value);
                switch (type)
                {
                    case 1: // REGS_AVAIL
                        if (value & 1) {
                            if (obj.iderStart == 0) { obj.SendDisableEnableFeatures(3, webserver.common.IntToStrX(0x01 + 0x08)); } // OnReboot
                            else if (obj.iderStart == 1) { obj.SendDisableEnableFeatures(3, webserver.common.IntToStrX(0x01 + 0x10)); } // Graceful
                            else if (obj.iderStart == 2) { obj.SendDisableEnableFeatures(3, webserver.common.IntToStrX(0x01 + 0x18)); } // Now
                        }
                        break;
                    case 2: // REGS_STATUS
                        obj.enabled = (value & 2) ? true : false;
                        debug("IDER Status: " + obj.enabled);
                        break;
                    case 3: // REGS_TOGGLE
                        if (value != 1) {
                            debug("Register toggle failure");
                        } //else { obj.SendDisableEnableFeatures(2); }
                        break;
                }
                return 13;
            case 0x4A: // ERROR OCCURED
                if (obj.acc.length < 11) return 0;
                debug('IDER: ABORT', obj.acc.charCodeAt(8));
                //obj.Stop();
                return 11;
            case 0x4B: // HEARTBEAT
                //debug('HEARTBEAT');
                return 8;
            case 0x50: // COMMAND WRITTEN
                if (obj.acc.length < 28) return 0;
                var device = (obj.acc.charCodeAt(14) & 0x10) ? 0xB0 : 0xA0;
                var deviceFlags = obj.acc.charCodeAt(14);
                var cdb = obj.acc.substring(16, 28);
                var featureRegister = obj.acc.charCodeAt(9);
                debug('SCSI_CMD', device, webserver.common.rstr2hex(cdb), featureRegister, deviceFlags);
                handleSCSI(device, cdb, featureRegister, deviceFlags);
                return 28;
            case 0x53: // DATA FROM HOST
                if (obj.acc.length < 14) return 0;
                var len = webserver.common.ReadShortX(obj.acc, 9);
                if (obj.acc.length < (14 + len)) return 0;
                debug('SCSI_WRITE, len = ' + (14 + len));
                obj.SendCommand(0x51, String.fromCharCode(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:
                debug('Unknown IDER command', obj.acc[0]);
                obj.Stop();
                break;
        }
        return 0;
    }

    function handleSCSI(dev, cdb, featureRegister, deviceFlags)
    {
        var lba;
        var len;

        switch(cdb.charCodeAt(0))
        {
            case 0x00: // TEST_UNIT_READY:
                debug("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:
                        debug("SCSI Internal error 3", dev);
                        return -1;
                }
                obj.SendCommandEndResponse(1, 0x00, dev, 0x00, 0x00); // Indicate ready
                break;
            case 0x08: // READ_6
                lba = ((cdb.charCodeAt(1) & 0x1f) << 16) + (cdb.charCodeAt(2) << 8) + cdb.charCodeAt(3);
                len = cdb.charCodeAt(4);
                if (len == 0) { len = 256; }
                debug("SCSI: READ_6", dev, lba, len);
                sendDiskData(dev, lba, len, featureRegister);
                break;
            case 0x0a: // WRITE_6
                lba = ((cdb.charCodeAt(1) & 0x1f) << 16) + (cdb.charCodeAt(2) << 8) + cdb.charCodeAt(3);
                len = cdb.charCodeAt(4);
                if (len == 0) { len = 256; }
                debug("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:
                debug("SCSI ERROR: MODE_SELECT_6", dev);
                obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00);
                return -1;
                */
            case 0x1a: // MODE_SENSE_6
                debug("SCSI: MODE_SENSE_6", dev);
                if ((cdb.charCodeAt(2) == 0x3f) && (cdb.charCodeAt(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:
                            debug("SCSI Internal error 6", dev);
                            return -1;
                    }
                    obj.SendDataToHost(dev, true, String.fromCharCode(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.charCodeAt(1) & 0x01;
                //var loej = cdb.charCodeAt(4) & 0x02;
                //var start = cdb.charCodeAt(4) & 0x01;
                obj.SendCommandEndResponse(1, 0, dev);
                break;
            case 0x1e: // LOCK_UNLOCK - ALLOW_MEDIUM_REMOVAL
                debug("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)
                debug("SCSI: READ_FORMAT_CAPACITIES", dev);
                var buflen = webserver.common.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.floppySize == 0)) { obj.SendCommandEndResponse(0, 0x05, dev, 0x24, 0x00); return -1; }
                        sectors = (obj.floppySize >> 9) - 1;
                        break;
                    case 0xB0: // DEV_CDDVD
                        if ((obj.cdrom == null) || (obj.cdromSize == 0)) { obj.SendCommandEndResponse(0, 0x05, dev, 0x24, 0x00); return -1; }
                        sectors = (obj.cdromSize >> 11) - 1; // Number 2048 byte blocks
                        break;
                    default:
                        debug("SCSI Internal error 4", dev);
                        return -1;
                }

                obj.SendDataToHost(dev, true, webserver.common.IntToStr(8) + String.fromCharCode(0x00, 0x00, 0x0b, 0x40, 0x02, 0x00, 0x02, 0x00), featureRegister & 1);
                break;
            case 0x25: // READ_CAPACITY
                debug("SCSI: READ_CAPACITY", dev);
                var len = 0;
                switch(dev)
                {
                    case 0xA0: // DEV_FLOPPY
                        if ((obj.floppy == null) || (obj.floppySize == 0)) { obj.SendCommandEndResponse(0, 0x02, dev, 0x3a, 0x00); return -1; }
                        if (obj.floppy != null) { len = (obj.floppySize >> 9) - 1; }
                        debug('DEV_FLOPPY', len); // Number 512 byte blocks
                        break;
                    case 0xB0: // DEV_CDDVD
                        if ((obj.floppy == null) || (obj.floppySize == 0)) { obj.SendCommandEndResponse(0, 0x02, dev, 0x3a, 0x00); return -1; }
                        if (obj.cdrom != null) { len = (obj.cdromSize >> 11) - 1; } // Number 2048 byte blocks
                        debug('DEV_CDDVD', len);
                        break;
                    default:
                        debug("SCSI Internal error 4", dev);
                        return -1;
                }
                //if (dev == 0xA0) { dev = 0x00; } else { dev = 0x10; } // Weird but seems to work.
                debug("SCSI: READ_CAPACITY2", dev, deviceFlags);
                obj.SendDataToHost(deviceFlags, true, webserver.common.IntToStr(len) + String.fromCharCode(0, 0, ((dev == 0xB0) ? 0x08 : 0x02), 0), featureRegister & 1);
                break;
            case 0x28: // READ_10
                lba = webserver.common.ReadInt(cdb, 2);
                len = webserver.common.ReadShort(cdb, 7);
                debug("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 = webserver.common.ReadInt(cdb, 2);
                len = webserver.common.ReadShort(cdb, 7);
                debug("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 = webserver.common.ReadShort(cdb, 7);
                var msf = cdb.charCodeAt(1) & 0x02; 
                var format = cdb.charCodeAt(2) & 0x07;
                if (format == 0) { format = cdb.charCodeAt(9) >> 6; }
                debug("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:
                        debug("SCSI Internal error 9", dev);
                        return -1;
                }

                if (format == 1) { obj.SendDataToHost(dev, true, String.fromCharCode(0x00, 0x0a, 0x01, 0x01, 0x00, 0x14, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00), featureRegister & 1); }
                else if (format == 0) {
                    if (msf) {
                        obj.SendDataToHost(dev, true, String.fromCharCode(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, String.fromCharCode(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.charCodeAt(1) != 2);
                var firstcode = webserver.common.ReadShort(cdb, 2);
                var buflen = webserver.common.ReadShort(cdb, 7);

                debug("SCSI: GET_CONFIGURATION", dev, sendall, firstcode, buflen);

                if (buflen == 0) { obj.SendDataToHost(dev, true, webserver.common.IntToStr(0x003c) + webserver.common.IntToStr(0x0008), featureRegister & 1); return -1; } // TODO: Fixed this return, it's not correct.

                // Set the header
                var r = webserver.common.IntToStr(0x0008);

                // 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; }

                // Set the length
                r = webserver.common.IntToStr(r.length) + r;

                // Cut the length to buflen if needed
                if (r.length > buflen) { r = r.substring(0, buflen); }

                obj.SendDataToHost(dev, true, r, featureRegister & 1);
                return -1;
            case 0x4a: // GET_EV_STATUS - GET_EVENT_STATUS_NOTIFICATION
                //var buflen = (cdb.charCodeAt(7) << 8) + cdb.charCodeAt(8);
                //if (buflen == 0) { obj.SendDataToHost(dev, true, webserver.common.IntToStr(0x003c) + webserver.common.IntToStr(0x0008), featureRegister & 1); return -1; } // TODO: Fixed this return, it's not correct.
                debug("SCSI: GET_EVENT_STATUS_NOTIFICATION", dev, cdb.charCodeAt(1), cdb.charCodeAt(4), cdb.charCodeAt(9));
                if ((cdb.charCodeAt(1) != 0x01) && (cdb.charCodeAt(4) != 0x10)) {
                    debug('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, String.fromCharCode(0x00, present, 0x80, 0x00), featureRegister & 1); // This is the original version, 4 bytes long
                break;
            case 0x4c:
                obj.SendCommand(0x51, webserver.common.IntToStrX(0) + webserver.common.IntToStrX(0) + webserver.common.IntToStrX(0) + String.fromCharCode(0x87, 0x50, 0x03, 0x00, 0x00, 0x00, 0xb0, 0x51, 0x05, 0x20, 0x00), true);
                break;
            case 0x51: // READ_DISC_INFO
                debug("SCSI READ_DISC_INFO", dev);
                obj.SendCommandEndResponse(0, 0x05, dev, 0x20, 0x00); // Correct
                return -1;
            case 0x55: // MODE_SELECT_10:
                debug("SCSI ERROR: MODE_SELECT_10", dev);
                obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00);
                return -1;
            case 0x5a: // MODE_SENSE_10
                debug("SCSI: MODE_SENSE_10", dev, cdb.charCodeAt(2) & 0x3f);
                var buflen = webserver.common.ReadShort(cdb, 7);
                //var pc = cdb.charCodeAt(2) & 0xc0;
                var r = null;
                
                if (buflen == 0) { obj.SendDataToHost(dev, true, webserver.common.IntToStr(0x003c) + webserver.common.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.floppySize >> 9); }
                } else {
                    if (obj.cdrom != null) { sectorCount = (obj.cdromSize >> 11); }
                }

                switch (cdb.charCodeAt(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
                debug("IDER: Unknown SCSI command", cdb.charCodeAt(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.floppySize >> 9); } }
        if (dev == 0xB0) { media = obj.cdrom; if (obj.cdrom != null) { mediaBlocks = (obj.cdromSize >> 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 = [], g_dev, g_lba, g_len, g_media = null, g_reset = false;
    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;
        var buffer = new Buffer(len);
        fs.read(g_media, buffer, 0, len, lba, function (error, bytesRead, buffer) {
            obj.SendDataToHost(g_dev, (g_len == 0), buffer.toString('binary'), 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;
}