@cryptotaxi247 / MeshCentral
Code Commits Issues Pulls Sessions CI/CD
master
master
js 610 lines 34.2 KB
Raw
1 /**
2 * @description IDER Handling Module
3 * @author Ylian Saint-Hilaire
4 */
5
6 // meshservice meshcmd.js amtider --host 192.168.2.186 --pass P@ssw0rd --floppy msdos.img
7
8 // Construct a Intel AMT IDER object
9 module.exports = function CreateAmtRemoteIder() {
10 var obj = {};
11 obj.protocol = 3; // IDER
12 obj.bytesToAmt = 0;
13 obj.bytesFromAmt = 0;
14 obj.rx_timeout = 30000; // Default 30000
15 obj.tx_timeout = 0; // Default 0
16 obj.heartbeat = 20000; // Default 20000
17 obj.version = 1;
18 obj.acc = null;
19 obj.inSequence = 0;
20 obj.outSequence = 0;
21 obj.iderinfo = null;
22 obj.enabled = false;
23 obj.iderStart = 0; // OnReboot = 0, Graceful = 1, Now = 2
24 obj.floppy = null;
25 obj.cdrom = null;
26 obj.floppyReady = false;
27 obj.cdromReady = false;
28 //obj.pingTimer = null;
29 obj.sectorStats = null;
30 obj.debug = false;
31
32 // Mode Sense
33 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]);
34 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]);
35 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]);
36 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]);
37 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]);
38 //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]);
39 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]);
40 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]);
41 //var IDE_ModeSence_CD_01_Array = new Buffer([0x00, 0x0E, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x06, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00]);
42 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]);
43
44 // 0x46 constant data
45 var IDE_CD_ConfigArrayHeader = new Buffer([0x00, 0x00,0x00, 0x28, 0x00, 0x00, 0x00, 0x08]);
46 var IDE_CD_ConfigArrayProfileList = new Buffer([0x00, 0x00, 0x03, 0x04, 0x00, 0x08, 0x01, 0x00]);
47 var IDE_CD_ConfigArrayCore = new Buffer([0x00, 0x01, 0x03, 0x04, 0x00, 0x00, 0x00, 0x02]);
48 var IDE_CD_Morphing = new Buffer([0x00, 0x02, 0x03, 0x04, 0x00, 0x00, 0x00, 0x00]);
49 var IDE_CD_ConfigArrayRemovable = new Buffer([0x00, 0x03, 0x03, 0x04, 0x29, 0x00, 0x00, 0x02]);
50 var IDE_CD_ConfigArrayRandom = new Buffer([0x00, 0x10, 0x01, 0x08, 0x00, 0x00, 0x08, 0x00, 0x00, 0x01, 0x00, 0x00]);
51 var IDE_CD_Read = new Buffer([0x00, 0x1E, 0x03, 0x00]);
52 var IDE_CD_PowerManagement = new Buffer([0x01, 0x00, 0x03, 0x00]);
53 var IDE_CD_Timeout = new Buffer([0x01, 0x05, 0x03, 0x00]);
54
55 // 0x01 constant data
56 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]);
57 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]);
58 var IDE_ModeSence_CDError_Recovery_Array = new Buffer([0x00, 0x0E, 0x01, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x06, 0x00, 0xFF, 0x00, 0x00, 0x00, 0x00]);
59
60 // CD info and performance
61 var RD_CD_DiskInfo = new Buffer([0x00, 0x20, 0x0e, 0x01, 0x01, 0x01, 0x01, 0x20, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
62 var RD_CD_Performance = new Buffer([0x00, 0x00, 0x00, 0x04, 0x02, 0x00, 0x00, 0x00]);
63
64 // Private method, called by parent when it change state
65 obj.xxStateChange = function (newstate) {
66 if (obj.debug) console.log("IDER-StateChange", newstate);
67 if (newstate == 0) { obj.Stop(); }
68 if (newstate == 3) { obj.Start(); }
69 }
70
71 obj.Start = function () {
72 if (obj.debug) { console.log("IDER-Start"); console.log(obj.floppy, obj.cdrom); }
73 obj.bytesToAmt = 0;
74 obj.bytesFromAmt = 0;
75 obj.inSequence = 0;
76 obj.outSequence = 0;
77 g_readQueue = [];
78
79 // Send first command, OPEN_SESSION
80 obj.SendCommand(0x40, Buffer.concat([ ShortToStrX(obj.rx_timeout), ShortToStrX(obj.tx_timeout), ShortToStrX(obj.heartbeat), IntToStrX(obj.version) ]));
81
82 // Send sector stats
83 if (obj.sectorStats) {
84 obj.sectorStats(0, 0, obj.floppy ? (obj.floppy.size >> 9) : 0);
85 obj.sectorStats(0, 1, obj.cdrom ? (obj.cdrom.size >> 11) : 0);
86 }
87
88 // Setup the ping timer
89 //obj.pingTimer = setInterval(function () { obj.SendCommand(0x44); }, 5000);
90 }
91
92 obj.Stop = function () {
93 if (obj.debug) console.log("IDER-Stop");
94 //if (obj.pingTimer) { clearInterval(obj.pingTimer); obj.pingTimer = null; }
95 obj.parent.Stop();
96 }
97
98 // Private method
99 obj.ProcessData = function (data) {
100 obj.bytesFromAmt += data.length;
101 if (obj.acc == null) { obj.acc = data; } else { obj.acc = Buffer.concat([obj.acc, data]); }
102 if (obj.debug) console.log('IDER-ProcessData', obj.acc.length, obj.acc.toString('hex'));
103
104 // Process as many commands as possible
105 while (obj.acc != null) {
106 var len = obj.ProcessDataEx();
107 if (len == 0) return;
108 if (obj.inSequence != ReadIntX(obj.acc, 4)) {
109 if (obj.debug) console.log('ERROR: Out of sequence', obj.inSequence, ReadIntX(obj.acc, 4));
110 obj.Stop();
111 return;
112 }
113 obj.inSequence++;
114 if (len == obj.acc.length) { obj.acc = null; } else { obj.acc = obj.acc.slice(len); }
115 }
116 }
117
118 // Private method
119 obj.SendCommand = function (cmdid, data, completed, dma) {
120 if (data == null) { data = Buffer.alloc(0); }
121 var attributes = ((cmdid > 50) && (completed == true)) ? 2 : 0;
122 if (dma) { attributes += 1; }
123 var x = Buffer.concat([Buffer([cmdid, 0, 0, attributes]), IntToStrX(obj.outSequence++), data]);
124 obj.parent.xxSend(x);
125 obj.bytesToAmt += x.length;
126 //if (cmdid != 0x4B) { console.log('IDER-SendData', x.length, x.toString('hex')); }
127 }
128
129 // CommandEndResponse (SCSI_SENSE)
130 obj.SendCommandEndResponse = function (error, sense, device, asc, asq) {
131 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); }
132 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); }
133 }
134
135 // DataToHost (SCSI_READ)
136 obj.SendDataToHost = function (device, completed, data, dma) {
137 var dmalen = (dma) ? 0 : data.length;
138 if (completed == true) {
139 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);
140 } else {
141 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);
142 }
143 }
144
145 // GetDataFromHost (SCSI_CHUNK)
146 obj.SendGetDataFromHost = function (device, chunksize) {
147 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);
148 }
149
150 // DisableEnableFeatures (STATUS_DATA)
151 // If type is REGS_TOGGLE (3), 4 bytes of data must be provided.
152 obj.SendDisableEnableFeatures = function (type, data) { if (data == null) { data = ''; } obj.SendCommand(0x48, Buffer.concat([new Buffer([type]), data])); }
153
154 // Private method
155 obj.ProcessDataEx = function () {
156 if (obj.acc.length < 8) return 0;
157
158 // First 8 bytes are the header
159 // CommandID + 0x000000 + Sequence Number
160 //console.log('ProcessDataEx', obj.acc[0]);
161
162 switch(obj.acc[0]) {
163 case 0x41: // OPEN_SESSION
164 if (obj.acc.length < 30) return 0;
165 var len = obj.acc[29];
166 if (obj.acc.length < (30 + len)) return 0;
167 obj.iderinfo = {};
168 obj.iderinfo.major = obj.acc[8];
169 obj.iderinfo.minor = obj.acc[9];
170 obj.iderinfo.fwmajor = obj.acc[10];
171 obj.iderinfo.fwminor = obj.acc[11];
172 obj.iderinfo.readbfr = ReadShortX(obj.acc, 16);
173 obj.iderinfo.writebfr = ReadShortX(obj.acc, 18);
174 obj.iderinfo.proto = obj.acc[21];
175 obj.iderinfo.iana = ReadIntX(obj.acc, 25);
176 if (obj.debug) console.log(obj.iderinfo);
177
178 if (obj.iderinfo.proto != 0) {
179 if (obj.debug) console.log("Unknown proto", obj.iderinfo.proto);
180 obj.Stop();
181 }
182 if (obj.iderinfo.readbfr > 8192) {
183 if (obj.debug) console.log("Illegal read buffer size", obj.iderinfo.readbfr);
184 obj.Stop();
185 }
186 if (obj.iderinfo.writebfr > 8192) {
187 if (obj.debug) console.log("Illegal write buffer size", obj.iderinfo.writebfr);
188 obj.Stop();
189 }
190
191 if (obj.iderStart == 0) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x08)); } // OnReboot
192 else if (obj.iderStart == 1) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x10)); } // Graceful
193 else if (obj.iderStart == 2) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x18)); } // Now
194 //obj.SendDisableEnableFeatures(1); // GetSupportedFeatures
195 return 30 + len;
196 case 0x43: // CLOSE
197 if (obj.debug) console.log('CLOSE');
198 obj.Stop();
199 return 8;
200 case 0x44: // KEEPALIVEPING
201 obj.SendCommand(0x45); // Send PONG back
202 return 8;
203 case 0x45: // KEEPALIVEPONG
204 if (obj.debug) console.log('PONG');
205 return 8;
206 case 0x46: // RESETOCCURED
207 if (obj.acc.length < 9) return 0;
208 var resetMask = obj.acc[8];
209 if (g_media === null) {
210 // No operations are pending
211 obj.SendCommand(0x47); // Send ResetOccuredResponse
212 if (obj.debug) console.log('RESETOCCURED1', resetMask);
213 } else {
214 // Operations are being done, sent the reset once completed.
215 g_reset = true;
216 if (obj.debug) console.log('RESETOCCURED2', resetMask);
217 }
218 return 9;
219 case 0x49: // STATUS_DATA - DisableEnableFeaturesReply
220 if (obj.acc.length < 13) return 0;
221 var type = obj.acc[8];
222 var value = ReadIntX(obj.acc, 9);
223 if (obj.debug) console.log('STATUS_DATA', type, value);
224 switch (type)
225 {
226 case 1: // REGS_AVAIL
227 if (value & 1) {
228 if (obj.iderStart == 0) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x08)); } // OnReboot
229 else if (obj.iderStart == 1) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x10)); } // Graceful
230 else if (obj.iderStart == 2) { obj.SendDisableEnableFeatures(3, IntToStrX(0x01 + 0x18)); } // Now
231 }
232 break;
233 case 2: // REGS_STATUS
234 obj.enabled = (value & 2) ? true : false;
235 if (obj.debug) console.log("IDER Status: " + obj.enabled);
236 break;
237 case 3: // REGS_TOGGLE
238 if (value != 1) {
239 if (obj.debug) console.log("Register toggle failure");
240 } //else { obj.SendDisableEnableFeatures(2); }
241 break;
242 }
243 return 13;
244 case 0x4A: // ERROR OCCURED
245 if (obj.acc.length < 11) return 0;
246 if (obj.debug) console.log('IDER: ABORT', obj.acc[8]);
247 //obj.Stop();
248 return 11;
249 case 0x4B: // HEARTBEAT
250 //console.log('HEARTBEAT');
251 return 8;
252 case 0x50: // COMMAND WRITTEN
253 if (obj.acc.length < 28) return 0;
254 var device = (obj.acc[14] & 0x10) ? 0xB0 : 0xA0;
255 var deviceFlags = obj.acc[14];
256 var cdb = obj.acc.slice(16, 28);
257 var featureRegister = obj.acc[9];
258 if (obj.debug) console.log('SCSI_CMD', device, cdb.toString('hex'), featureRegister, deviceFlags);
259 handleSCSI(device, cdb, featureRegister, deviceFlags);
260 return 28;
261 case 0x53: // DATA FROM HOST
262 if (obj.acc.length < 14) return 0;
263 var len = ReadShortX(obj.acc, 9);
264 if (obj.acc.length < (14 + len)) return 0;
265 if (obj.debug) console.log('SCSI_WRITE, len = ' + (14 + len));
266 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);
267 return 14 + len;
268 default:
269 if (obj.debug) console.log('Unknown IDER command', obj.acc[0]);
270 obj.Stop();
271 break;
272 }
273 return 0;
274 }
275
276 function handleSCSI(dev, cdb, featureRegister, deviceFlags)
277 {
278 var lba;
279 var len;
280
281 switch(cdb[0])
282 {
283 case 0x00: // TEST_UNIT_READY:
284 if (obj.debug) console.log("SCSI: TEST_UNIT_READY", dev);
285 switch (dev) {
286 case 0xA0: // DEV_FLOPPY
287 if (obj.floppy == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
288 if (obj.floppyReady == false) { obj.floppyReady = true; obj.SendCommandEndResponse(1, 0x06, dev, 0x28, 0x00); return -1; } // Switch to ready
289 break;
290 case 0xB0: // DEV_CDDVD
291 if (obj.cdrom == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
292 if (obj.cdromReady == false) { obj.cdromReady = true; obj.SendCommandEndResponse(1, 0x06, dev, 0x28, 0x00); return -1; } // Switch to ready
293 break;
294 default:
295 if (obj.debug) console.log("SCSI Internal error 3", dev);
296 return -1;
297 }
298 obj.SendCommandEndResponse(1, 0x00, dev, 0x00, 0x00); // Indicate ready
299 break;
300 case 0x08: // READ_6
301 lba = ((cdb[1] & 0x1f) << 16) + (cdb[2] << 8) + cdb[3];
302 len = cdb[4];
303 if (len == 0) { len = 256; }
304 if (obj.debug) console.log("SCSI: READ_6", dev, lba, len);
305 sendDiskData(dev, lba, len, featureRegister);
306 break;
307 case 0x0a: // WRITE_6
308 lba = ((cdb[1] & 0x1f) << 16) + (cdb[2] << 8) + cdb[3];
309 len = cdb[4];
310 if (len == 0) { len = 256; }
311 if (obj.debug) console.log("SCSI: WRITE_6", dev, lba, len);
312 obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); // Write is not supported, remote no medium.
313 return -1;
314 /*
315 case 0x15: // MODE_SELECT_6:
316 console.log("SCSI ERROR: MODE_SELECT_6", dev);
317 obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00);
318 return -1;
319 */
320 case 0x1a: // MODE_SENSE_6
321 if (obj.debug) console.log("SCSI: MODE_SENSE_6", dev);
322 if ((cdb[2] == 0x3f) && (cdb[3] == 0x00)) {
323 var a = 0, b = 0;
324 switch (dev) {
325 case 0xA0: // DEV_FLOPPY
326 if (obj.floppy == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
327 a = 0x00;
328 b = 0x80; // Read only = 0x80, Read write = 0x00
329 break;
330 case 0xB0: // DEV_CDDVD
331 if (obj.cdrom == null) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
332 a = 0x05;
333 b = 0x80;
334 break;
335 default:
336 if (obj.debug) console.log("SCSI Internal error 6", dev);
337 return -1;
338 }
339 obj.SendDataToHost(dev, true, new Buffer([0, a, b, 0]), featureRegister & 1);
340 return;
341 }
342 obj.SendCommandEndResponse(1, 0x05, dev, 0x24, 0x00);
343 break;
344 case 0x1b: // START_STOP (Called when you eject the CDROM)
345 //var immediate = cdb[1] & 0x01;
346 //var loej = cdb[4] & 0x02;
347 //var start = cdb[4] & 0x01;
348 obj.SendCommandEndResponse(1, 0, dev);
349 break;
350 case 0x1e: // LOCK_UNLOCK - ALLOW_MEDIUM_REMOVAL
351 if (obj.debug) console.log("SCSI: ALLOW_MEDIUM_REMOVAL", dev);
352 if ((dev == 0xA0) && (obj.floppy == null)) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
353 if ((dev == 0xB0) && (obj.cdrom == null)) { obj.SendCommandEndResponse(1, 0x02, dev, 0x3a, 0x00); return -1; }
354 obj.SendCommandEndResponse(1, 0x00, dev, 0x00, 0x00);
355 break;
356 case 0x23: // READ_FORMAT_CAPACITIES (Floppy only)
357 if (obj.debug) console.log("SCSI: READ_FORMAT_CAPACITIES", dev);
358 var buflen = ReadShort(cdb, 7);
359 var mediaStatus = 0, sectors;
360 var mcSize = buflen / 8; // Capacity descriptor size is 8
361
362 switch (dev) {
363 case 0xA0: // DEV_FLOPPY
364 if ((obj.floppy == null) || (obj.floppy.size == 0)) { obj.SendCommandEndResponse(0, 0x05, dev, 0x24, 0x00); return -1; }
365 sectors = (obj.floppy.size >> 9) - 1;
366 break;
367 case 0xB0: // DEV_CDDVD
368 if ((obj.cdrom == null) || (obj.cdrom.size == 0)) { obj.SendCommandEndResponse(0, 0x05, dev, 0x24, 0x00); return -1; }
369 sectors = (obj.cdrom.size >> 11) - 1; // Number 2048 byte blocks
370 break;
371 default:
372 if (obj.debug) console.log("SCSI Internal error 4", dev);
373 return -1;
374 }
375
376 obj.SendDataToHost(dev, true, Buffer.concat([IntToStr(8), new Buffer([0x00, 0x00, 0x0b, 0x40, 0x02, 0x00, 0x02, 0x00]) ]), featureRegister & 1);
377 break;
378 case 0x25: // READ_CAPACITY
379 if (obj.debug) console.log("SCSI: READ_CAPACITY", dev);
380 var len = 0;
381 switch(dev)
382 {
383 case 0xA0: // DEV_FLOPPY
384 if ((obj.floppy == null) || (obj.floppy.size == 0)) { obj.SendCommandEndResponse(0, 0x02, dev, 0x3a, 0x00); return -1; }
385 if (obj.floppy != null) { len = (obj.floppy.size >> 9) - 1; }
386 if (obj.debug) console.log('DEV_FLOPPY', len); // Number 512 byte blocks
387 break;
388 case 0xB0: // DEV_CDDVD
389 if ((obj.cdrom == null) || (obj.cdrom.size == 0)) { obj.SendCommandEndResponse(0, 0x02, dev, 0x3a, 0x00); return -1; }
390 if (obj.cdrom != null) { len = (obj.cdrom.size >> 11) - 1; } // Number 2048 byte blocks
391 if (obj.debug) console.log('DEV_CDDVD', len);
392 break;
393 default:
394 if (obj.debug) console.log("SCSI Internal error 4", dev);
395 return -1;
396 }
397 //if (dev == 0xA0) { dev = 0x00; } else { dev = 0x10; } // Weird but seems to work.
398 if (obj.debug) console.log("SCSI: READ_CAPACITY2", dev, deviceFlags);
399 obj.SendDataToHost(deviceFlags, true, Buffer.concat([IntToStr(len), new Buffer([0, 0, ((dev == 0xB0) ? 0x08 : 0x02), 0])]), featureRegister & 1);
400 break;
401 case 0x28: // READ_10
402 lba = ReadInt(cdb, 2);
403 len = ReadShort(cdb, 7);
404 if (obj.debug) console.log("SCSI: READ_10", dev, lba, len);
405 sendDiskData(dev, lba, len, featureRegister);
406 break;
407 case 0x2a: // WRITE_10 (Floppy only)
408 case 0x2e: // WRITE_AND_VERIFY (Floppy only)
409 lba = ReadInt(cdb, 2);
410 len = ReadShort(cdb, 7);
411 if (obj.debug) console.log("SCSI: WRITE_10", dev, lba, len);
412 obj.SendGetDataFromHost(dev, 512 * len); // Floppy writes only, accept sectors of 512 bytes
413 break;
414 case 0x43: // READ_TOC (CD Audio only)
415 var buflen = ReadShort(cdb, 7);
416 var msf = cdb[1] & 0x02;
417 var format = cdb[2] & 0x07;
418 if (format == 0) { format = cdb[9] >> 6; }
419 if (obj.debug) console.log("SCSI: READ_TOC, dev=" + dev + ", buflen=" + buflen + ", msf=" + msf + ", format=" + format);
420
421 switch (dev) {
422 case 0xA0: // DEV_FLOPPY
423 obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00); // Not implemented
424 return -1;
425 case 0xB0: // DEV_CDDVD
426 // NOP
427 break;
428 default:
429 if (obj.debug) console.log("SCSI Internal error 9", dev);
430 return -1;
431 }
432
433 if (format == 1) { obj.SendDataToHost(dev, true, new Buffer([0x00, 0x0a, 0x01, 0x01, 0x00, 0x14, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00]), featureRegister & 1); }
434 else if (format == 0) {
435 if (msf) {
436 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);
437 } else {
438 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);
439 }
440 }
441 break;
442 case 0x46: // GET_CONFIGURATION
443 var sendall = (cdb[1] != 2);
444 var firstcode = ReadShort(cdb, 2);
445 var buflen = ReadShort(cdb, 7);
446
447 if (obj.debug) console.log("SCSI: GET_CONFIGURATION", dev, sendall, firstcode, buflen);
448 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.
449
450 // Set the header
451 var r = null;
452
453 // Add the data
454 if (firstcode == 0) { r = IDE_CD_ConfigArrayProfileList; }
455 if ((firstcode == 0x1) || (sendall && (firstcode < 0x1))) { r = IDE_CD_ConfigArrayCore; }
456 if ((firstcode == 0x2) || (sendall && (firstcode < 0x2))) { r = IDE_CD_Morphing; }
457 if ((firstcode == 0x3) || (sendall && (firstcode < 0x3))) { r = IDE_CD_ConfigArrayRemovable; }
458 if ((firstcode == 0x10) || (sendall && (firstcode < 0x10))) { r = IDE_CD_ConfigArrayRandom; }
459 if ((firstcode == 0x1E) || (sendall && (firstcode < 0x1E))) { r = IDE_CD_Read; }
460 if ((firstcode == 0x100) || (sendall && (firstcode < 0x100))) { r = IDE_CD_PowerManagement; }
461 if ((firstcode == 0x105) || (sendall && (firstcode < 0x105))) { r = IDE_CD_Timeout; }
462
463 if (r == null) {
464 //console.log('NOT RIGHT', sendall, firstcode, cdb[2], cdb[3]);
465 //process.exit(0);
466 r = Buffer.concat([IntToStr(0x0008), IntToStr(4)]);
467 } else {
468 r = Buffer.concat([IntToStr(0x0008), IntToStr(r.length + 4), r]);
469 }
470
471 // Cut the length to buflen if needed
472 if (r.length > buflen) { r = r.slice(0, buflen); }
473
474 obj.SendDataToHost(dev, true, r, featureRegister & 1);
475 return -1;
476 case 0x4a: // GET_EV_STATUS - GET_EVENT_STATUS_NOTIFICATION
477 //var buflen = (cdb[7] << 8) + cdb[8];
478 //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.
479 if (obj.debug) console.log("SCSI: GET_EVENT_STATUS_NOTIFICATION", dev, cdb[1], cdb[4], cdb[9]);
480 if ((cdb[1] != 0x01) && (cdb[4] != 0x10)) {
481 if (obj.debug) console.log('SCSI ERROR');
482 obj.SendCommandEndResponse(1, 0x05, dev, 0x26, 0x01);
483 break;
484 }
485 var present = 0x00;
486 if ((dev == 0xA0) && (obj.floppy != null)) { present = 0x02; }
487 else if ((dev == 0xB0) && (obj.cdrom != null)) { present = 0x02; }
488 obj.SendDataToHost(dev, true, new Buffer([0x00, present, 0x80, 0x00]), featureRegister & 1); // This is the original version, 4 bytes long
489 break;
490 case 0x4c:
491 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);
492 break;
493 case 0x51: // READ_DISC_INFO
494 if (obj.debug) console.log("SCSI READ_DISC_INFO", dev);
495 obj.SendCommandEndResponse(0, 0x05, dev, 0x20, 0x00); // Correct
496 return -1;
497 case 0x55: // MODE_SELECT_10:
498 if (obj.debug) console.log("SCSI ERROR: MODE_SELECT_10", dev);
499 obj.SendCommandEndResponse(1, 0x05, dev, 0x20, 0x00);
500 return -1;
501 case 0x5a: // MODE_SENSE_10
502 if (obj.debug) console.log("SCSI: MODE_SENSE_10", dev, cdb[2] & 0x3f);
503 var buflen = ReadShort(cdb, 7);
504 //var pc = cdb[2] & 0xc0;
505 var r = null;
506
507 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.
508
509 // 1.44 mb floppy or LS120 (sectorCount == 0x3c300)
510 var sectorCount = 0;
511 if (dev == 0xA0) {
512 if (obj.floppy != null) { sectorCount = (obj.floppy.size >> 9); }
513 } else {
514 if (obj.cdrom != null) { sectorCount = (obj.cdrom.size >> 11); }
515 }
516
517 switch (cdb[2] & 0x3f) {
518 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;
519 case 0x05: if (dev == 0xA0) { r = (sectorCount <= 0xb40)?IDE_ModeSence_FloppyDisk_Page_Array:IDE_ModeSence_LS120Disk_Page_Array; } break;
520 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;
521 case 0x1A: if (dev == 0xB0) { r = IDE_ModeSence_CD_1A_Array; } break;
522 case 0x1D: if (dev == 0xB0) { r = IDE_ModeSence_CD_1D_Array; } break;
523 case 0x2A: if (dev == 0xB0) { r = IDE_ModeSence_CD_2A_Array; } break;
524 }
525
526 if (r == null) {
527 obj.SendCommandEndResponse(0, 0x05, dev, 0x20, 0x00); // TODO: Send proper error!!!
528 } else {
529 // Set disk to read only (we don't support write).
530 //ms_data[3] = ms_data[3] | 0x80;
531 obj.SendDataToHost(dev, true, r, featureRegister & 1);
532 }
533 break;
534 case 0x51: // READ_DISK_INFORMATION
535 obj.SendDataToHost(dev, true, RD_CD_DiskInfo, featureRegister & 1);
536 break;
537 case 0xAC: // GET_PERFORMANCE
538 obj.SendDataToHost(dev, true, RD_CD_Performance, featureRegister & 1);
539 break;
540 default: // UNKNOWN COMMAND
541 if (obj.debug) console.log("IDER: Unknown SCSI command", cdb[0]);
542 obj.SendCommandEndResponse(0, 0x05, dev, 0x20, 0x00);
543 return -1;
544 }
545 return 0;
546 }
547
548 function sendDiskData(dev, lba, len, featureRegister) {
549 var media = null;
550 var mediaBlocks = 0;
551 if (dev == 0xA0) { media = obj.floppy; if (obj.floppy != null) { mediaBlocks = (obj.floppy.size >> 9); } }
552 if (dev == 0xB0) { media = obj.cdrom; if (obj.cdrom != null) { mediaBlocks = (obj.cdrom.size >> 11); } }
553 if ((len < 0) || (lba + len > mediaBlocks)) { obj.SendCommandEndResponse(1, 0x05, dev, 0x21, 0x00); return 0; }
554 if (len == 0) { obj.SendCommandEndResponse(1, 0x00, dev, 0x00, 0x00); return 0; }
555 if (media != null) {
556 // Send sector stats
557 if (obj.sectorStats) { obj.sectorStats(1, (dev == 0xA0) ? 0 : 1, mediaBlocks, lba, len); }
558 if (dev == 0xA0) { lba <<= 9; len <<= 9; } else { lba <<= 11; len <<= 11; }
559 if (g_media !== null) {
560 // Queue read operation
561 g_readQueue.push({ media: media, dev: dev, lba: lba, len: len, fr: featureRegister });
562 } else {
563 // obj.iderinfo.readbfr // TODO: MaxRead
564 g_media = media;
565 g_dev = dev;
566 g_lba = lba;
567 g_len = len;
568 sendDiskDataEx(featureRegister);
569 }
570 }
571 }
572
573 var g_readQueue = [];
574 var g_reset = false;
575 var g_media = null;
576 var g_dev;
577 var g_lba;
578 var g_len;
579 function sendDiskDataEx(featureRegister) {
580 var len = g_len, lba = g_lba;
581 if (g_len > obj.iderinfo.readbfr) { len = obj.iderinfo.readbfr; }
582 g_len -= len;
583 g_lba += len;
584
585 //console.log('Read from ' + lba + ' to ' + (lba + len) + ', total of ' + len);
586
587 var result = Buffer.alloc(len);
588 fs.readSync(g_media.file, result, 0, len, lba);
589 obj.SendDataToHost(g_dev, (g_len == 0), result, featureRegister & 1);
590 if ((g_len > 0) && (g_reset == false)) {
591 sendDiskDataEx(featureRegister);
592 } else {
593 g_media = null;
594 if (g_reset) { obj.SendCommand(0x47); g_readQueue = []; g_reset = false; } // Send ResetOccuredResponse
595 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
596 }
597 }
598
599 return obj;
600 }
601
602 function ShortToStr(v) { return new Buffer([(v >> 8) & 0xFF, v & 0xFF]); }
603 function ShortToStrX(v) { return new Buffer([v & 0xFF, (v >> 8) & 0xFF]); }
604 function IntToStr(v) { return new Buffer([(v >> 24) & 0xFF, (v >> 16) & 0xFF, (v >> 8) & 0xFF, v & 0xFF]); }
605 function IntToStrX(v) { return new Buffer([v & 0xFF, (v >> 8) & 0xFF, (v >> 16) & 0xFF, (v >> 24) & 0xFF]); }
606 function ReadShort(v, p) { return (v[p] << 8) + v[p + 1]; }
607 function ReadShortX(v, p) { return (v[p + 1] << 8) + v[p]; }
608 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.
609 function ReadSInt(v, p) { return (v[p] << 24) + (v[p + 1] << 16) + (v[p + 2] << 8) + v[p + 3]; }
610 function ReadIntX(v, p) { return (v[p + 3] * 0x1000000) + (v[p + 2] << 16) + (v[p + 1] << 8) + v[p]; }