* DiscImageChef.Decoders/Floppy/Apple2.cs:

Adds support for marshaling a whole disk, tracks and sectors
	  as well as decoding sectors in 5and3 and 6and2 GCRs.

	* DiscImageChef.Decoders/Floppy/AppleSony.cs:
	  Adds support for marshaling a whole disk, tracks and sectors
	  as well as decoding GCR sectors.

	* DiscImageChef.DiscImages/AppleNIB.cs:
	* DiscImageChef.DiscImages/DiscImageChef.DiscImages.csproj:
	  Adds support for Apple nibble disk images.
This commit is contained in:
2016-10-07 00:43:12 +01:00
parent 7483d004b7
commit b27c25d74e
6 changed files with 1445 additions and 19 deletions

View File

@@ -30,6 +30,9 @@
// Copyright © 2011-2016 Natalia Portillo
// ****************************************************************************/
using System;
using System.Collections.Generic;
using System.IO;
using System.Runtime.InteropServices;
namespace DiscImageChef.Decoders.Floppy
@@ -45,7 +48,7 @@ namespace DiscImageChef.Decoders.Floppy
/// <summary>
/// GCR-encoded Apple Sony GCR floppy track
/// </summary>
public struct RawTrack
public class RawTrack
{
/// <summary>
/// Track preamble, set to self-sync 0xFF, 36 bytes
@@ -57,7 +60,7 @@ namespace DiscImageChef.Decoders.Floppy
/// <summary>
/// GCR-encoded Apple Sony GCR floppy sector
/// </summary>
public struct RawSector
public class RawSector
{
/// <summary>
/// Address field
@@ -80,7 +83,7 @@ namespace DiscImageChef.Decoders.Floppy
/// <summary>
/// GCR-encoded Apple Sony GCR floppy sector address field
/// </summary>
public struct RawAddressField
public class RawAddressField
{
/// <summary>
/// Always 0xD5, 0xAA, 0x96
@@ -117,7 +120,7 @@ namespace DiscImageChef.Decoders.Floppy
/// <summary>
/// GCR-encoded Apple ][ GCR floppy sector data field
/// </summary>
public struct RawDataField
public class RawDataField
{
/// <summary>
/// Always 0xD5, 0xAA, 0xAD
@@ -144,6 +147,392 @@ namespace DiscImageChef.Decoders.Floppy
[MarshalAs(UnmanagedType.ByValArray, SizeConst = 2)]
public byte[] epilogue;
}
public static byte[] DecodeSector(RawSector sector)
{
if(sector.addressField.prologue[0] == 0xD5 &&
sector.addressField.prologue[1] == 0xAA &&
sector.addressField.prologue[2] == 0x96)
{
uint ck1, ck2, ck3;
byte carry;
byte w1, w2, w3, w4;
byte[] bf1 = new byte[175];
byte[] bf2 = new byte[175];
byte[] bf3 = new byte[175];
byte[] nib_data = sector.dataField.data;
MemoryStream ms = new MemoryStream();
int j = 0;
w3 = 0;
for(int i = 0; i <= 174; i++)
{
w4 = nib_data[j++];
w1 = nib_data[j++];
w2 = nib_data[j++];
if(i != 174) w3 = nib_data[j++];
bf1[i] = (byte)(((w1 & 0x3F) | ((w4 << 2) & 0xC0)) & 0x0F);
bf2[i] = (byte)(((w2 & 0x3F) | ((w4 << 4) & 0xC0)) & 0x0F);
bf3[i] = (byte)(((w3 & 0x3F) | ((w4 << 6) & 0xC0)) & 0x0F);
}
j = 0;
ck1 = 0;
ck2 = 0;
ck3 = 0;
while(true)
{
ck1 = (ck1 & 0xFF) << 1;
if((ck1 & 0x0100) > 0)
ck1++;
carry = (byte)((bf1[j] ^ ck1) & 0xFF);
ck3 += carry;
if((ck1 & 0x0100) > 0)
{
ck3++;
ck1 &= 0xFF;
}
ms.WriteByte(carry);
carry = (byte)((bf2[j] ^ ck3) & 0xFF);
ck2 += carry;
if (ck3 > 0xFF)
{
ck2++;
ck3 &= 0xFF;
}
ms.WriteByte(carry);
if (ms.Length == 524) break;
carry = (byte)((bf3[j] ^ ck2) & 0xFF);
ck1 += carry;
if (ck2 > 0xFF)
{
ck1++;
ck2 &= 0xFF;
}
ms.WriteByte(carry);
j++;
}
return ms.ToArray();
}
// Not Apple Sony GCR?
return null;
}
public static RawSector MarshalSector(byte[] data, int offset = 0)
{
int temp;
return MarshalSector(data, out temp, offset);
}
public static RawSector MarshalSector(byte[] data, out int endOffset, int offset = 0)
{
endOffset = offset;
// Not an Apple ][ GCR sector
if(data == null || data.Length < 363)
return null;
RawSector sector;
int position = offset;
MemoryStream gaps;
bool onSync;
int syncCount;
try
{
while(position < data.Length)
{
// Prologue found
if(data[position] == 0xD5 && data[position + 1] == 0xAA && data[position + 2] == 0x96)
{
// Epilogue not in correct position
if(data[position + 8] != 0xDE || data[position + 9] != 0xAA)
return null;
sector = new RawSector();
sector.addressField = new RawAddressField();
sector.addressField.prologue = new byte[3];
sector.addressField.prologue[0] = data[position];
sector.addressField.prologue[1] = data[position + 1];
sector.addressField.prologue[2] = data[position + 2];
sector.addressField.track = data[position + 3];
sector.addressField.sector = data[position + 4];
sector.addressField.side = data[position + 5];
sector.addressField.format = (AppleEncodedFormat)data[position + 6];
sector.addressField.checksum = data[position + 7];
sector.addressField.epilogue = new byte[2];
sector.addressField.epilogue[0] = data[position + 8];
sector.addressField.epilogue[1] = data[position + 9];
position += 10;
syncCount = 0;
onSync = false;
gaps = new MemoryStream();
while(data[position] == 0xFF)
{
gaps.WriteByte(data[position]);
syncCount++;
onSync = syncCount >= 5;
position++;
}
// Lost sync
if(!onSync)
return null;
// Prologue not found
if(data[position] != 0xDE || data[position + 1] != 0xAA || data[position + 2] != 0xAD)
return null;
sector.innerGap = gaps.ToArray();
sector.dataField = new RawDataField();
sector.dataField.prologue = new byte[3];
sector.dataField.prologue[0] = data[position];
sector.dataField.prologue[1] = data[position + 1];
sector.dataField.prologue[2] = data[position + 2];
sector.dataField.spare = data[position + 3];
position += 4;
gaps = new MemoryStream();
// Read data until epilogue is found
while(data[position + 4] != 0xD5 || data[position + 5] != 0xAA)
{
gaps.WriteByte(data[position]);
position++;
// No space left for epilogue
if(position + 7 > data.Length)
return null;
}
sector.dataField.data = gaps.ToArray();
sector.dataField.checksum = new byte[4];
sector.dataField.checksum[0] = data[position];
sector.dataField.checksum[1] = data[position + 2];
sector.dataField.checksum[2] = data[position + 3];
sector.dataField.checksum[3] = data[position + 4];
sector.dataField.epilogue = new byte[2];
sector.dataField.epilogue[0] = data[position + 5];
sector.dataField.epilogue[1] = data[position + 6];
position += 7;
gaps = new MemoryStream();
// Read gap, if any
while(position < data.Length && data[position] == 0xFF)
{
gaps.WriteByte(data[position]);
position++;
}
// Reduces last sector gap so doesn't eat next tracks's gap
if(gaps.Length > 5)
{
gaps.SetLength(gaps.Length / 2);
position -= (int)gaps.Length;
}
sector.gap = gaps.ToArray();
// Return current position to be able to read separate sectors
endOffset = position;
return sector;
}
if(data[position] == 0xFF)
position++;
// Found data that is not sync or a prologue
else
return null;
}
}
catch(IndexOutOfRangeException)
{
return null;
}
return null;
}
public static byte[] MarshalAddressField(RawAddressField addressField)
{
if(addressField == null)
return null;
MemoryStream raw = new MemoryStream();
raw.Write(addressField.prologue, 0, addressField.prologue.Length);
raw.WriteByte(addressField.track);
raw.WriteByte(addressField.sector);
raw.WriteByte(addressField.side);
raw.WriteByte((byte)addressField.format);
raw.WriteByte(addressField.checksum);
return raw.ToArray();
}
public static byte[] MarshalSector(RawSector sector)
{
if(sector == null)
return null;
MemoryStream raw = new MemoryStream();
raw.Write(sector.addressField.prologue, 0, sector.addressField.prologue.Length);
raw.WriteByte(sector.addressField.track);
raw.WriteByte(sector.addressField.sector);
raw.WriteByte(sector.addressField.side);
raw.WriteByte((byte)sector.addressField.format);
raw.WriteByte(sector.addressField.checksum);
raw.Write(sector.innerGap, 0, sector.innerGap.Length);
raw.Write(sector.dataField.prologue, 0, sector.dataField.prologue.Length);
raw.WriteByte(sector.dataField.spare);
raw.Write(sector.dataField.data, 0, sector.dataField.data.Length);
raw.Write(sector.dataField.checksum, 0, sector.dataField.checksum.Length);
raw.Write(sector.dataField.epilogue, 0, sector.dataField.epilogue.Length);
raw.Write(sector.gap, 0, sector.gap.Length);
return raw.ToArray();
}
public static RawTrack MarshalTrack(byte[] data, int offset = 0)
{
int temp;
return MarshalTrack(data, out temp, offset);
}
public static RawTrack MarshalTrack(byte[] data, out int endOffset, int offset = 0)
{
int position = offset;
bool firstSector = true;
bool onSync = false;
MemoryStream gaps = new MemoryStream();
int count = 0;
List<RawSector> sectors = new List<RawSector>();
byte trackNumber = 0;
byte sideNumber = 0;
endOffset = offset;
while(position < data.Length && data[position] == 0xFF)
{
gaps.WriteByte(data[position]);
count++;
position++;
onSync = count >= 5;
}
if(position >= data.Length)
return null;
if(!onSync)
return null;
while(position < data.Length)
{
int oldPosition = position;
RawSector sector = MarshalSector(data, out position, position);
if(sector == null)
break;
if(firstSector)
{
trackNumber = sector.addressField.track;
sideNumber = sector.addressField.side;
firstSector = false;
}
if(sector.addressField.track != trackNumber ||
sector.addressField.side != sideNumber)
{
position = oldPosition;
break;
}
sectors.Add(sector);
}
if(sectors.Count == 0)
return null;
RawTrack track = new RawTrack();
track.gap = gaps.ToArray();
track.sectors = sectors.ToArray();
endOffset = position;
return track;
}
public static byte[] MarshalTrack(RawTrack track)
{
if(track == null)
return null;
MemoryStream raw = new MemoryStream();
raw.Write(track.gap, 0, track.gap.Length);
foreach(RawSector sector in track.sectors)
{
byte[] rawSector = MarshalSector(sector);
raw.Write(rawSector, 0, rawSector.Length);
}
return raw.ToArray();
}
public static List<RawTrack> MarshalDisk(byte[] data, int offset = 0)
{
int temp;
return MarshalDisk(data, out temp, offset);
}
public static List<RawTrack> MarshalDisk(byte[] data, out int endOffset, int offset = 0)
{
endOffset = offset;
List<RawTrack> tracks = new List<RawTrack>();
int position = offset;
RawTrack track = MarshalTrack(data, out position, position);
while(track != null)
{
tracks.Add(track);
track = MarshalTrack(data, out position, position);
}
if(tracks.Count == 0)
return null;
endOffset = position;
return tracks;
}
public static byte[] MarshalDisk(List<RawTrack> disk)
{
return MarshalDisk(disk.ToArray());
}
public static byte[] MarshalDisk(RawTrack[] disk)
{
if(disk == null)
return null;
MemoryStream raw = new MemoryStream();
foreach(RawTrack track in disk)
{
byte[] rawTrack = MarshalTrack(track);
raw.Write(rawTrack, 0, rawTrack.Length);
}
return raw.ToArray();
}
public static bool IsAppleSonyGCR(byte[] data)
{
int position = 0;
RawSector sector = MarshalSector(data, out position, 0);
return sector != null && position != 0;
}
}
}