/// <summary> /// 0 - Нет ошибок. /// 1 - Размер файла слишком мал. /// 5 - Размер файла слишком мал и содержит не все данные содержимого секторов. /// 6 - Нет сигнатуры FDI. /// </summary> /// <param name="fileName"></param> /// <param name="map"></param> /// <returns></returns> public unsafe int LoadFdi(string fileName, byte[] data, out string text) { Clear(); text = null; if (data.Length < 14) { return(1); } if (data[0] != 'F' || data[1] != 'D' || data[2] != 'I') { return(6); } int cylCount; int textOffset; int dataOffset; fixed(byte *d = &data[0]) { cylCount = *(ushort *)(d + 4); textOffset = *(ushort *)(d + 8); dataOffset = *(ushort *)(d + 10); } int minFileSize = 7 * cylCount * 2 + 14; if (data.Length < minFileSize || data.Length < textOffset + 1) { return(1); } int tt = textOffset; for (; tt < data.Length; tt++) { if (data[tt] == 0) { break; } } int textLen = tt - textOffset; text = textLen > 0 ? Encoding.ASCII.GetString(data, textOffset, tt - textOffset) : null; int index = 14; for (int track = 0; track < cylCount * 2; track++) { int trackOffset; fixed(byte *d = &data[index]) { trackOffset = *((int *)d); } int sectorsOnTrack = data[index + 6]; TrackFormat tf = Tracks.Data[track]; tf.Layout.EnsureCapacity(sectorsOnTrack); tf.Layout.Cnt = sectorsOnTrack; tf.SpinTime = TrackFormat.SpinTimeStandard; tf.MapModified = true; index += 7; double totalTimeMs = 0; for (int sector = 0; sector < sectorsOnTrack; sector++) { tf.Layout.Data[sector].Cylinder = data[index]; tf.Layout.Data[sector].Head = data[index + 1]; tf.Layout.Data[sector].SectorNumber = data[index + 2]; tf.Layout.Data[sector].SizeCode = data[index + 3]; int code = data[index + 4] & 63; tf.Layout.Data[sector].ProcessResult = code == 0 ? SectorProcessResult.Bad : SectorProcessResult.Good; int sectorOffset; fixed(byte *d = &data[index + 5]) { sectorOffset = *((ushort *)d); } int sizeBytes = tf.Layout.Data[sector].SizeBytes; if (data.Length < dataOffset + trackOffset + sectorOffset + sizeBytes) { return(5); } if (tf.Layout.Data[sector].Data == null || tf.Layout.Data[sector].Data.Length < tf.Layout.Data[sector].SizeBytes) { tf.Layout.Data[sector].Data = new byte[tf.Layout.Data[sector].SizeBytes]; } tf.Layout.Data[sector].MapCellValue = tf.Layout.Data[sector].ProcessResult == SectorProcessResult.Good ? MapCell.Good : MapCell.CrcError; Array.Copy(data, dataOffset + trackOffset + sectorOffset, tf.Layout.Data[sector].Data, 0, sizeBytes); if (tf.Layout.Data[sector].ProcessResult == SectorProcessResult.Good && DiskImage.AllBytes(tf.Layout.Data[sector].Data, 0, tf.Layout.Data[sector].SizeBytes, 0)) { tf.Layout.Data[sector].MapCellValue = MapCell.Zero; } index += 7; tf.Layout.Data[sector].TimeCalculated = true; if (sector != 0) { tf.Layout.Data[sector].TimeMs = (tf.Layout.Data[sector - 1].SizeBytes + TrackFormat.NormalSectorHeaderSize + 1) / TrackFormat.BytesPerMsStandard; totalTimeMs += tf.Layout.Data[sector].TimeMs; } } tf.FormatName = tf.GetFormatName(); if (sectorsOnTrack > 0) { tf.Layout.Data[0].TimeMs = Math.Max(0, TrackFormat.SpinTimeStandard - totalTimeMs); } } FileName = fileName; Name = Path.GetFileNameWithoutExtension(fileName); Modified = false; return(0); }
public void LoadFormatFromXml(string fileName) { int track = 0; MList <SectorInfo> layout = new MList <SectorInfo>(50); MList <SectorInfo> temp = new MList <SectorInfo>(50); using (XmlTextReader xml = new XmlTextReader(fileName)) { while (xml.Read()) { if (xml.NodeType == XmlNodeType.EndElement) { break; } if (xml.NodeType != XmlNodeType.Element) { continue; } if (xml.Name == "DiskFormat") { string name = xml.GetAttribute("Name"); if (string.IsNullOrEmpty(Name) && !string.IsNullOrEmpty(name)) { Name = name; } while (xml.Read()) { if (xml.NodeType == XmlNodeType.EndElement) { break; } if (xml.NodeType != XmlNodeType.Element) { continue; } switch (xml.Name) { case "Track": TrackFormat tf = Tracks[track]; tf.Layout.EnsureCapacity(Int32.Parse(xml.GetAttribute("SectorCount"))); layout.Cnt = 0; if (!xml.IsEmptyElement) { while (xml.Read()) { if (xml.NodeType == XmlNodeType.EndElement) { break; } if (xml.NodeType != XmlNodeType.Element) { continue; } switch (xml.Name) { case "Sector": SectorInfo s = new SectorInfo() { Cylinder = Int32.Parse(xml.GetAttribute("Cylinder")), Head = Int32.Parse(xml.GetAttribute("Head")), SectorNumber = Int32.Parse(xml.GetAttribute("Number")), SizeCode = Int32.Parse(xml.GetAttribute("Size")), TimeMs = Double.Parse(xml.GetAttribute("Time"), NumberStyles.Any, CultureInfo.InvariantCulture) }; layout.Add(s); break; } } } if (tf.Layout.Cnt > 0) { tf.Layout.CopyTo(temp); layout.CopyTo(tf.Layout); for (int i = 0; i < temp.Cnt; i++) { int index = tf.FindSectorIndex(temp[i].SectorNumber); if (index < 0) { Log.Info?.Out($"Сектор не найден. Трек: {track} | Сектор: {temp[i].SectorNumber}"); continue; } tf.Layout.Data[index].Data = temp[i].Data; tf.Layout.Data[index].ProcessResult = temp[i].ProcessResult; tf.Layout.Data[index].MapCellValue = temp[i].MapCellValue; tf.Layout.Data[index].TimeCalculated = false; } } else { layout.CopyTo(tf.Layout); for (int i = 0; i < layout.Cnt; i++) { tf.Layout.Data[i].MapCellValue = MapCell.Unprocessed; tf.Layout.Data[i].TimeCalculated = false; } } tf.FormatName = tf.GetFormatName(); tf.SpinTime = tf.GetSpinTime(); tf.MapModified = true; track++; break; } } } } } }
public unsafe void ReadTrack(int track, DiskReaderParams pars) { // Массив sectors: // D0 - Признак обработанного сектора при чтении трека в одной попытке. Обнуляется перед каждой попыткой чтения трека. // D1 - Используется в блоке чтения заголовков. Отмечаются сектора заголовки которых были найдены. Вне этого блока не используется. // D2 - Запрет чтения сектора из-за того что его заголовок был прочитан SectorReadAttempts раз и не был найден. Параметр сохраняется между попытками чтения трека. int *sectors = stackalloc int[pars.SectorsOnTrack]; for (int i = 0; i < pars.SectorsOnTrack; i++) { sectors[i] = 0; } bool formatScanned = false; bool headScanned = false; bool trackScanned = false; bool wasCorrectHead = false; bool missedHeaders = false; for (int attempt = 0; attempt < pars.SectorReadAttempts; attempt++) { if (Aborted) { return; } for (int i = 0; i < pars.SectorsOnTrack; i++) { sectors[i] &= ~1; } bool wasError = false; double timeAfterSync = 0; trackTimer.Restart(); int skip = 0; int processedSectors = 0; int sectorCounter = 0; SectorInfo diskSector; while (processedSectors < pars.SectorsOnTrack) { bool sync = false; if (pars.ReadMode == ReadMode.Fast && pars.CurrentTrackFormat.IsSync) { bool gcsError; diskSector = pars.CurrentTrackFormat.GetClosestSector(track, 0, skip, out timeAfterSync, out gcsError); sync = true; // Переключение в стандартный режим чтения в случае если функция GetClosestSector отработала с ошибкой. // Такое было у одного из пользователей и причина ошибки непонятна. if (gcsError) { pars.ReadMode = ReadMode.Standard; } } else { diskSector = pars.Image.StandardFormat.Layout.Data[sectorCounter]; sectorCounter++; } int sectorIndex = pars.Image.StandardFormat.FindSectorIndex(diskSector.SectorNumber); int diskSectorNum = track * Params.SectorsOnTrack + sectorIndex; skip++; if ((sectors[sectorIndex] & 1) != 0) { continue; } sectors[sectorIndex] |= 1; processedSectors++; if ((sectors[sectorIndex] & 4) != 0) { continue; } if (diskSectorNum < pars.FirstSectorNum || diskSectorNum >= pars.LastSectorNum) { continue; } if (pars.Image.Sectors[diskSectorNum] == SectorProcessResult.Good) { continue; } bool badWritten = pars.Image.Sectors[diskSectorNum] == SectorProcessResult.Bad; skip = 0; pars.Image.Map?.ClearHighlight(MapCell.Processing); pars.Image.Map?.MarkAsProcessing(diskSectorNum); WinApi.RtlZeroMemory(memoryHandle, (UIntPtr)diskSector.SizeBytes); int error = Driver.ReadSector(DriverHandle, memoryHandle, track, diskSector.SectorNumber, pars.UpperSideHead, diskSector.SizeCode); double curTimeSinceSync = pars.CurrentTrackFormat.Timer.ElapsedMs; if (error == 0) { pars.CurrentTrackFormat.Sync(track, diskSector.SectorNumber); pars.Image.WriteGoodSectors(diskSectorNum, memoryHandle, 1); wasCorrectHead = true; if (Aborted) { return; } // Проверка несовпадения расположения секторов с заданным. Работает только для TR-DOS. if (pars.ReadMode == ReadMode.Fast && pars.TrackLayoutAutodetect && sync && !formatScanned && !missedHeaders && curTimeSinceSync < 2 * pars.CurrentTrackFormat.SpinTime) { double remainderTime = curTimeSinceSync; for (int t = 0; remainderTime > 0 && t < 20; remainderTime -= pars.CurrentTrackFormat.SpinTime, t++) { // 6 - половина времени сектора TR-DOS (около 12 мс). if (Math.Abs(remainderTime - timeAfterSync) <= 6) { goto skip; } } Log.Trace?.Out($"Несовпадение расположения секторов. Calculated Time: {GP.ToString(timeAfterSync, 2)} | Real Time: {GP.ToString(curTimeSinceSync, 2)}"); formatScanned = true; bool scanResult = ScanFormat(workTrackFormat, track, true); if (Aborted) { return; } if (scanResult) { Log.Trace?.Out($"Формат трека {track}: {workTrackFormat.FormatName} | {workTrackFormat.Layout.Cnt} sectors | {workTrackFormat.ToStringAsSectorArray()}"); if (workTrackFormat.FormatName <= TrackFormatName.TrDosGeneric) { pars.CurrentTrackFormat.Assign(workTrackFormat); } } //pars.Image.Map?.ClearHighlight(MapCell.Scanning); //findex = pars.TrackFormat.GetNextSectorIndex(track); skip :; } } else { wasError = true; bool writeBad = true; bool noHeader = error == 21 || error == 1112 || error == 1122 || (error == 27 /* && curTimeSinceSync > pars.CurrentTrackFormat.SpinTime*/); if (noHeader) { Make30HeadPositionings(error, track); // Проверка параметра Head верхней стороны. bool scanWholeTrack = true; int scanHeadResult = 0; if (track % 2 == 1 && !headScanned && !wasCorrectHead && pars.UpperSideHeadAutodetect) { headScanned = true; UpperSideHead head = pars.UpperSideHead; scanHeadResult = ScanHeadParameter(ref head, track, pars.CurrentTrackFormat); if (scanHeadResult == 0) { if (head != pars.UpperSideHead) { Log.Trace?.Out($"Параметр Head верхней стороны для трека {track} определен: {(int)head}"); pars.UpperSideHead = head; writeBad = false; sectors[sectorIndex] = 0; processedSectors--; scanWholeTrack = false; } else { Log.Trace?.Out($"Параметр Head верхней стороны для трека {track} определен и совпадает с предыдущим: {(int)head}"); } } else { Log.Trace?.Out($"Параметр Head верхней стороны для трека {track} определить не удалось."); } } // Чтение неформатных областей. // Если встретился NoHeader, то предполагается что на этом треке может быть еще много случаев NoHeader, // поэтому они проверяются сканированием трека целиком. Это происходит быстрее, чем если пытаться читать их по-отдельности. if (scanWholeTrack && !trackScanned) { int sec0Num = Math.Max(track * pars.SectorsOnTrack, pars.FirstSectorNum); int sec0NtNum = Math.Min((track + 1) * pars.SectorsOnTrack, pars.LastSectorNum); // sectorsToCheck - число секторов которые надо проверить на предмет отсутствия заголовков. // Если подозреваемый сектор только один (т.е. только что прочитанный) и число попыток чтения 1, то sectorsToCheck после цикла будет нулём. bool ignoreCurSector = pars.SectorReadAttempts == 1; writeBad = ignoreCurSector; int sectorsToCheck = ignoreCurSector ? 0 : 1; // Учет только что обработанного сектора. // Далее к sectorsToCheck добавляются только необработанные сектора. for (int sn = sec0Num, si = sn - track * pars.SectorsOnTrack; sn < sec0NtNum; sn++, si++) { if (pars.Image.Sectors[sn] != SectorProcessResult.Good && (sectors[si] & 1) == 0) { sectorsToCheck++; } } if (sectorsToCheck > 0) { trackScanned = true; int foundHeaders = 0; bool scanResult = false; int maxExtraSectors = 0; if (!ignoreCurSector) { sectors[sectorIndex] &= ~1; } int attempts = !ignoreCurSector && sectorsToCheck == 1 ? pars.SectorReadAttempts - 1 : pars.SectorReadAttempts; for (int attemptnh = 0; attemptnh < attempts; attemptnh++) { scanResult = false; if (scanHeadResult == 1 && attemptnh == 0) { workTrackFormat.Layout.Cnt = 0; } else { scanResult = ScanFormat(workTrackFormat, track, true); } if (workTrackFormat.Layout.Cnt == 0) { Log.Info?.Out($"На треке {track} заголовки не найдены."); } else { Log.Trace?.Out($"Формат трека {track}: {workTrackFormat.FormatName} | {workTrackFormat.Layout.Cnt} sectors | {workTrackFormat.ToStringAsSectorArray()}"); } for (int sn = sec0Num, si = sn - track * pars.SectorsOnTrack; sn < sec0NtNum; sn++, si++) { if (pars.Image.Sectors[sn] == SectorProcessResult.Good || (sectors[si] & 1) == 1 || (sectors[si] & 2) != 0) { continue; } int dSector = pars.Image.StandardFormat.Layout.Data[si].SectorNumber; int sindex = workTrackFormat.FindSectorIndex(dSector); int head = pars.UpperSideHead == UpperSideHead.Head1 ? track & 1 : 0; int sizeCode = pars.CurrentTrackFormat.Layout.Data[pars.CurrentTrackFormat.FindSectorIndex(dSector)].SizeCode; if (sindex >= 0 && workTrackFormat.Layout.Data[sindex].SizeCode == sizeCode) { if (workTrackFormat.Layout.Data[sindex].Cylinder == track / 2 && workTrackFormat.Layout.Data[sindex].Head == head) { sectors[si] |= 2; foundHeaders++; } else { Log.Info?.Out($"Не совпадает Cylinder или Head в заголовке сектора {dSector} на треке {track} (цилиндр {track / 2} сторона {track % 2}): {workTrackFormat.Layout.Data[sindex]}"); } } } // Поиск экстра-секторов на треке. int extraSectors = 0; for (int ii = 0; ii < workTrackFormat.Layout.Cnt; ii++) { for (int jj = 0; jj < pars.CurrentTrackFormat.Layout.Cnt; jj++) { if (pars.CurrentTrackFormat.Layout.Data[jj].SectorNumber == workTrackFormat.Layout.Data[ii].SectorNumber && pars.CurrentTrackFormat.Layout.Data[jj].SizeCode == workTrackFormat.Layout.Data[ii].SizeCode) { goto found; } } extraSectors++; found :; } if (extraSectors > maxExtraSectors) { maxExtraSectors = extraSectors; longestTrackFormat.Assign(workTrackFormat); } if (foundHeaders == sectorsToCheck) { break; } } int noHeaderCnt = 0; for (int sn = sec0Num, si = sn - track * pars.SectorsOnTrack; sn < sec0NtNum; sn++, si++) { if (pars.Image.Sectors[sn] == SectorProcessResult.Good || (sectors[si] & 1) == 1) { continue; } if ((sectors[si] & 2) == 0) { // 4 (100b) означает что заголовок не найден за нужное число попыток // и больше читать этот сектор не надо, т.к. все попытки исчерпаны. sectors[si] |= 4; if (!badWritten) { pars.Image.WriteBadSectors(sn, 1, true); } noHeaderCnt++; } } if (scanResult) { pars.CurrentTrackFormat.Sync(workTrackFormat); } Log.Trace?.Out($"На треке {track} не найдены заголовки {noHeaderCnt} секторов."); if (noHeaderCnt > 0) { missedHeaders = true; } if (maxExtraSectors > 0) { Log.Info?.Out($"Трек {track} имеет несоответствующий формат: {longestTrackFormat.GetFormatName()} | {longestTrackFormat.Layout.Cnt} sectors | {longestTrackFormat.ToStringAsSectorArray()}"); } } } } else if (error == 23) { writeBad = false; pars.Image.WriteBadSectors(diskSectorNum, memoryHandle, 1, false); } if (writeBad && !badWritten) { pars.Image.WriteBadSectors(diskSectorNum, 1, noHeader); } } if (Aborted) { return; } } Log.Trace?.Out($"Время чтения трека: {GP.ToString(trackTimer.ElapsedMs, 2)}"); trackTimer.Restart(); if (!wasError) { break; } } }