public unsafe void ReadTrack(int track, DiskReaderParams2 pars, ScanMode scanMode) { // Массив sectors: // D0 - Признак обработанного сектора при чтении трека в одной попытке. Обнуляется перед каждой попыткой чтения трека. // D1 - Используется в блоке чтения заголовков. Отмечаются сектора заголовки которых были найдены. Вне этого блока не используется. // D2 - Запрет чтения сектора из-за того что его заголовок был прочитан SectorReadAttempts раз и не был найден. Параметр сохраняется между попытками чтения трека. TrackFormat trackF = pars.Image.Tracks[track]; const int sectorArrayLen = 50; int * sectors = stackalloc int[sectorArrayLen]; for (int i = 0; i < sectorArrayLen; i++) { sectors[i] = 0; } bool trackScanned = false; for (int attempt = 0; attempt < pars.SectorReadAttempts; attempt++) { if (Aborted) { return; } // Сканирование трека. if ( ((scanMode == ScanMode.Once && !trackScanned) || (scanMode == ScanMode.UnscannedOnly && trackF.FormatName == TrackFormatName.Unscanned) || scanMode == ScanMode.EachTrackRead) && (trackF.MaxGap() > 128 + TrackFormat.MinSectorHeaderSize || trackF.ContainsCalculatedTime()) ) { // workTrackFormat и longestTrackFormat используются чтобы не плодить объекты. // Объект scanFormatBuffer используется функциями ScanFormat и CombineFormats, поэтому его брать нельзя. trackF.Scanning = true; trackF.MapModified = true; if (ScanFormat(workTrackFormat, track, true)) { for (int i = 0; i < workTrackFormat.Layout.Cnt; i++) { workTrackFormat.Layout.Data[i].MapCellValue = MapCell.Unprocessed; } if (CombineFormats(track, trackF, workTrackFormat, longestTrackFormat)) { trackF.Assign(longestTrackFormat); trackF.MapModified = true; } } trackF.Scanning = false; trackF.MapModified = true; trackScanned = true; if (Aborted) { return; } } if (trackF.Layout.Cnt > sectorArrayLen) { Log.Error?.Out($"Число секторов превышает размер рабочего массива: {trackF.Layout.Cnt}"); throw new Exception(); } for (int i = 0; i < trackF.Layout.Cnt; i++) { sectors[i] &= ~1; } bool wasError = false; trackTimer.Restart(); int skip = 0; int processedSectors = 0; int sectorCounter = 0; SectorInfo diskSector; while (processedSectors < trackF.Layout.Cnt) { diskSector = trackF.Layout.Data[sectorCounter]; int sectorIndex = sectorCounter; sectorCounter++; skip++; if ((sectors[sectorIndex] & 1) != 0) { continue; } sectors[sectorIndex] |= 1; processedSectors++; if ((sectors[sectorIndex] & 4) != 0) { continue; } if (trackF.Layout.Data[sectorIndex].ProcessResult == SectorProcessResult.Good) { continue; } skip = 0; pars.Map.MarkSectorAsProcessing(track, sectorIndex); WinApi.RtlZeroMemory(memoryHandle, (UIntPtr)diskSector.SizeBytes); int error = Driver.ReadSectorF(DriverHandle, memoryHandle, diskSector.Cylinder, diskSector.SectorNumber, diskSector.SizeCode, track & 1, diskSector.Head, 0x0a, 0xff); double curTimeSinceSync = trackF.Timer.ElapsedMs; bool badWritten = diskSector.ProcessResult == SectorProcessResult.Bad; if (error == 0) { pars.Image.WriteGoodSector(memoryHandle, trackF, sectorIndex); } else { wasError = true; // Если надо проверить CRC-Error заголовка: (error == 27 && curTimeSinceSync > trackF.SpinTime) bool noHeader = error == 21 || error == 1112 || error == 27; if (noHeader) { if (!badWritten) { pars.Image.WriteNoHeader(memoryHandle, trackF, sectorIndex); } Make30HeadPositionings(error, track); } else if (error == 23) { pars.Image.WriteBadSector(memoryHandle, trackF, sectorIndex); badWritten = true; } else { Log.Info?.Out($"Необработанная ошибка при чтении сектора: {error}"); } } if (Aborted) { return; } } Log.Trace?.Out($"Время чтения трека: {GP.ToString(trackTimer.ElapsedMs, 2)}"); trackTimer.Restart(); if (!wasError) { break; } } }
/// <summary> /// Объединение форматов двух результатов сканирования одного трека. У треков main и add будут изменены тайминги при работе этой функции! /// </summary> /// <param name="track"></param> /// <param name="main">Основной трек.</param> /// <param name="add">Добавляемый трек.</param> /// <param name="result"></param> /// <returns>true - объединение успешно, false - объединение не удалось по какой-то причине (невозможность синхронизации, несовместимость треков).</returns> public bool CombineFormats(int track, TrackFormat main, TrackFormat add, TrackFormat result) { if (add.Layout.Cnt == 0) { result.Assign(main); if (result.FormatName == TrackFormatName.Unscanned) { result.FormatName = TrackFormatName.NoHeaders; } return(true); } if (main.Layout.Cnt == 0 && add.Layout.Cnt > 0) { result.AssignLayout(add, track); return(true); } int indexM = 0; int indexA = 0; for (int i = 0; i < main.Layout.Cnt; i++) { for (int j = 0; j < add.Layout.Cnt; j++) { if (main.Layout.Data[i].Parameters == add.Layout.Data[j].Parameters) { indexM = i; indexA = j; goto outside; } } } return(false); outside: int iM = indexM; int iA = indexA; int iR = 0; scanFormatBuffer.Layout.EnsureCapacity(main.Layout.Cnt + add.Layout.Cnt); scanFormatBuffer.Layout.Cnt = 0; int totalPassedInMain = 0; double timeM = main.Layout.Data[(iM + 1) % main.Layout.Cnt].TimeMs; double timeA = add.Layout.Data[(iA + 1) % add.Layout.Cnt].TimeMs; while (totalPassedInMain < main.Layout.Cnt) { int iM1 = (iM + 1) % main.Layout.Cnt; int iA1 = (iA + 1) % add.Layout.Cnt; if (main.Layout.Data[iM1].TimeCalculated) { if (main.Layout.Data[iM1].Parameters == add.Layout.Data[iA1].Parameters) { iM = iM1; totalPassedInMain++; iA = iA1; scanFormatBuffer.Layout.Data[iR] = main.Layout.Data[iM]; scanFormatBuffer.Layout.Data[iR].TimeMs = add.Layout.Data[iA].TimeMs; scanFormatBuffer.Layout.Data[iR].TimeCalculated = false; iR++; } else { return(false); //totalPassedInMain++; //for (int t = 0, r = iM1, tlast = main.Layout.Cnt - totalPassedInMain; t < tlast; t++, totalPassedInMain++, r = r % main.Layout.Cnt) //{ // for (int y = 0; y < add.Layout.Cnt; y++) // { // if (main.Layout.Data[r].Parameters == add.Layout.Data[y].Parameters) // { // iM = r; // iA = y; // goto outOfLoop; // } // } //} //outOfLoop:; } } else if (Math.Abs(timeM - timeA) / timeM < 0.1) { iM = iM1; totalPassedInMain++; iA = iA1; if (main.Layout.Data[iM].Parameters != add.Layout.Data[iA].Parameters) { Log.Info?.Out($"Несовпадение параметров секторов при совмещении форматов. Основной сектор: {main[iM]} | Добавляемый сектор: {add[iA]}"); return(false); } scanFormatBuffer.Layout.Data[iR] = main.Layout.Data[iM]; iR++; timeM = main.Layout.Data[(iM + 1) % main.Layout.Cnt].TimeMs; timeA = add.Layout.Data[(iA + 1) % add.Layout.Cnt].TimeMs; } else if (timeA < timeM) { timeM -= timeA; main.Layout.Data[iM1].TimeMs -= timeA; iA = iA1; scanFormatBuffer.Layout.Data[iR] = add.Layout.Data[iA]; // Проверки ниже закомментированы, т.к. стало понятно что заголовки могут быть без данных и быть как следствие с более высокой плотностью. // Проверка выхода конца добавляемого сектора дальше начала следующего сектора в массиве main. if (timeM < (add.Layout.Data[iA].SizeBytes + TrackFormat.MinSectorHeaderSize) / add.BytesPerMs) { return(false); } // Проверка выхода начала добавляемого сектора влево от конца предыдущего сектора в массиве main. if (timeA < (main.Layout.Data[iM].SizeBytes + TrackFormat.MinSectorHeaderSize) / main.BytesPerMs) { return(false); } iR++; timeA = add.Layout.Data[(iA + 1) % add.Layout.Cnt].TimeMs; } else { timeA -= timeM; add.Layout.Data[iA1].TimeMs -= timeM; iM = iM1; totalPassedInMain++; scanFormatBuffer.Layout.Data[iR] = main.Layout.Data[iM]; iR++; timeM = main.Layout.Data[(iM + 1) % main.Layout.Cnt].TimeMs; } } scanFormatBuffer.Layout.Cnt = iR; result.AssignLayout(scanFormatBuffer, track); return(true); }
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; } } }