ciderpress/diskimg/FDI.cpp
Andy McFadden 8e910b23ca gcc/linux updates
Many updates to format strings, largely as a result of changing
various "long" variables to uint32_t.

Fixed the diskimg debug macros for gcc, which requires an extra
"##" to remove the "," when there are no arguments.  (Apparently
Visual Studio just strips this away for you.)

Stripped out a couple of dead variables spotted by gcc.  Return
the actual error in a couple of HFS file functions.
2014-12-11 16:36:40 -08:00

1523 lines
48 KiB
C++

/*
* CiderPress
* Copyright (C) 2007 by faddenSoft, LLC. All Rights Reserved.
* See the file LICENSE for distribution terms.
*/
/*
* Support for Formatted Disk Image (FDI) format.
*
* Based on the v2.0 spec and "fdi2raw.c". The latter was released under
* version 2 of the GPL, so this code may be subject to it.
*
* (Note: I tend to abuse the term "nibble" here. Instead of 4 bits, I
* use it to refer to 8 bits of "nibblized" data. Sorry.)
*
* THOUGHT: we have access to the self-sync byte data. We could use this
* to pretty easily convert a track to 6656-byte format, which would allow
* conversion to .NIB instead of .APP. This would probably need to be
* specified as a global preference (how to open .FDI), though we could
* just drag the self-sync flags around in a parallel data structure and
* invent a format-conversion API. The former seems easier, and should
* be easy to explain in the UI.
*/
#include "StdAfx.h"
#include "DiskImgPriv.h"
/*
* ===========================================================================
* FDI compression functions
* ===========================================================================
*/
/*
* Pack a disk image with FDI.
*/
DIError WrapperFDI::PackDisk(GenericFD* pSrcGFD, GenericFD* pWrapperGFD)
{
DIError dierr = kDIErrGeneric; // not yet
return dierr;
}
/*
* ===========================================================================
* FDI expansion functions
* ===========================================================================
*/
/*
* Unpack an FDI-encoded disk image from "pGFD" to a new memory buffer
* created in "*ppNewGFD". The output is a collection of variable-length
* nibble tracks.
*
* "pNewGFD" will need to hold (kTrackAllocSize * numCyls * numHeads)
* bytes of data.
*
* Fills in "fNibbleTrackInfo".
*/
DIError WrapperFDI::UnpackDisk525(GenericFD* pGFD, GenericFD* pNewGFD,
int numCyls, int numHeads)
{
DIError dierr = kDIErrNone;
uint8_t nibbleBuf[kNibbleBufLen];
uint8_t* inputBuf = NULL;
bool goodTracks[kMaxNibbleTracks525];
int inputBufLen = -1;
int badTracks = 0;
int trk, type, length256;
long nibbleLen;
bool result;
assert(numHeads == 1);
memset(goodTracks, false, sizeof(goodTracks));
dierr = pGFD->Seek(kMinHeaderLen, kSeekSet);
if (dierr != kDIErrNone) {
LOGI("FDI: track seek failed (offset=%d)", kMinHeaderLen);
goto bail;
}
for (trk = 0; trk < numCyls * numHeads; trk++) {
GetTrackInfo(trk, &type, &length256);
LOGI("%2d.%d: t=0x%02x l=%d (%d)", trk / numHeads, trk % numHeads,
type, length256, length256 * 256);
/* if we have data to read, read it */
if (length256 > 0) {
if (length256 * 256 > inputBufLen) {
/* allocate or increase the size of the input buffer */
delete[] inputBuf;
inputBufLen = length256 * 256;
inputBuf = new uint8_t[inputBufLen];
if (inputBuf == NULL) {
dierr = kDIErrMalloc;
goto bail;
}
}
dierr = pGFD->Read(inputBuf, length256 * 256);
if (dierr != kDIErrNone)
goto bail;
} else {
assert(type == 0x00);
}
/* figure out what we want to do with this track */
switch (type) {
case 0x00:
/* blank track */
badTracks++;
memset(nibbleBuf, 0xff, sizeof(nibbleBuf));
nibbleLen = kTrackLenNb2525;
break;
case 0x80:
case 0x90:
case 0xa0:
case 0xb0:
/* low-level pulse-index */
nibbleLen = kNibbleBufLen;
result = DecodePulseTrack(inputBuf, length256*256, kBitRate525,
nibbleBuf, &nibbleLen);
if (!result) {
/* something failed in the decoder; fake it */
badTracks++;
memset(nibbleBuf, 0xff, sizeof(nibbleBuf));
nibbleLen = kTrackLenNb2525;
} else {
goodTracks[trk] = true;
}
if (nibbleLen > kTrackAllocSize) {
LOGI(" FDI: decoded %ld nibbles, buffer is only %d",
nibbleLen, kTrackAllocSize);
dierr = kDIErrBadRawData;
goto bail;
}
break;
default:
LOGI("FDI: unexpected track type 0x%04x", type);
dierr = kDIErrUnsupportedImageFeature;
goto bail;
}
fNibbleTrackInfo.offset[trk] = trk * kTrackAllocSize;
fNibbleTrackInfo.length[trk] = nibbleLen;
FixBadNibbles(nibbleBuf, nibbleLen);
dierr = pNewGFD->Seek(fNibbleTrackInfo.offset[trk], kSeekSet);
if (dierr != kDIErrNone)
goto bail;
dierr = pNewGFD->Write(nibbleBuf, nibbleLen);
if (dierr != kDIErrNone)
goto bail;
LOGI(" FDI: track %d: wrote %ld nibbles", trk, nibbleLen);
//offset += 256 * length256;
//break; // DEBUG DEBUG
}
LOGI(" FDI: %d of %d tracks bad or blank",
badTracks, numCyls * numHeads);
if (badTracks > (numCyls * numHeads) / 2) {
LOGI("FDI: too many bad tracks");
dierr = kDIErrBadRawData;
goto bail;
}
/*
* For convenience we want this to be 35 or 40 tracks. Start by
* reducing trk to 35 if there are no good tracks at 35+.
*/
bool want40;
int i;
want40 = false;
for (i = kTrackCount525; i < kMaxNibbleTracks525; i++) {
if (goodTracks[i]) {
want40 = true;
break;
}
}
if (!want40 && trk > kTrackCount525) {
LOGI(" FDI: no good tracks past %d, reducing from %d",
kTrackCount525, trk);
trk = kTrackCount525; // nothing good out there, roll back
}
/*
* Now pad us *up* to 35 if we have fewer than that.
*/
memset(nibbleBuf, 0xff, sizeof(nibbleBuf));
for ( ; trk < kMaxNibbleTracks525; trk++) {
if (trk == kTrackCount525)
break;
fNibbleTrackInfo.offset[trk] = trk * kTrackAllocSize;
fNibbleTrackInfo.length[trk] = kTrackLenNb2525;
fNibbleTrackInfo.numTracks++;
dierr = pNewGFD->Seek(fNibbleTrackInfo.offset[trk], kSeekSet);
if (dierr != kDIErrNone)
goto bail;
dierr = pNewGFD->Write(nibbleBuf, nibbleLen);
if (dierr != kDIErrNone)
goto bail;
}
assert(trk == kTrackCount525 || trk == kMaxNibbleTracks525);
fNibbleTrackInfo.numTracks = trk;
bail:
delete[] inputBuf;
return dierr;
}
/*
* Unpack an FDI-encoded disk image from "pGFD" to 800K of ProDOS-ordered
* 512-byte blocks in "pNewGFD".
*
* We could keep the 12-byte "tags" on each block, but they were never
* really used in the Apple II world.
*
* We also need to set up a "bad block" map to identify parts that we had
* trouble unpacking.
*/
DIError WrapperFDI::UnpackDisk35(GenericFD* pGFD, GenericFD* pNewGFD, int numCyls,
int numHeads, LinearBitmap* pBadBlockMap)
{
DIError dierr = kDIErrNone;
uint8_t nibbleBuf[kNibbleBufLen];
uint8_t* inputBuf = NULL;
uint8_t outputBuf[kMaxSectors35 * kBlockSize]; // 6KB
int inputBufLen = -1;
int badTracks = 0;
int trk, type, length256;
long nibbleLen;
bool result;
assert(numHeads == 2);
dierr = pGFD->Seek(kMinHeaderLen, kSeekSet);
if (dierr != kDIErrNone) {
LOGI("FDI: track seek failed (offset=%d)", kMinHeaderLen);
goto bail;
}
pNewGFD->Rewind();
for (trk = 0; trk < numCyls * numHeads; trk++) {
GetTrackInfo(trk, &type, &length256);
LOGI("%2d.%d: t=0x%02x l=%d (%d)", trk / numHeads, trk % numHeads,
type, length256, length256 * 256);
/* if we have data to read, read it */
if (length256 > 0) {
if (length256 * 256 > inputBufLen) {
/* allocate or increase the size of the input buffer */
delete[] inputBuf;
inputBufLen = length256 * 256;
inputBuf = new uint8_t[inputBufLen];
if (inputBuf == NULL) {
dierr = kDIErrMalloc;
goto bail;
}
}
dierr = pGFD->Read(inputBuf, length256 * 256);
if (dierr != kDIErrNone)
goto bail;
} else {
assert(type == 0x00);
}
/* figure out what we want to do with this track */
switch (type) {
case 0x00:
/* blank track */
badTracks++;
memset(nibbleBuf, 0xff, sizeof(nibbleBuf));
nibbleLen = kTrackLenNb2525;
break;
case 0x80:
case 0x90:
case 0xa0:
case 0xb0:
/* low-level pulse-index */
nibbleLen = kNibbleBufLen;
result = DecodePulseTrack(inputBuf, length256*256,
BitRate35(trk/numHeads), nibbleBuf, &nibbleLen);
if (!result) {
/* something failed in the decoder; fake it */
badTracks++;
memset(nibbleBuf, 0xff, sizeof(nibbleBuf));
nibbleLen = kTrackLenNb2525;
}
if (nibbleLen > kNibbleBufLen) {
LOGI(" FDI: decoded %ld nibbles, buffer is only %d",
nibbleLen, kTrackAllocSize);
dierr = kDIErrBadRawData;
goto bail;
}
break;
default:
LOGI("FDI: unexpected track type 0x%04x", type);
dierr = kDIErrUnsupportedImageFeature;
goto bail;
}
LOGI(" FDI: track %d got %ld nibbles", trk, nibbleLen);
/*
fNibbleTrackInfo.offset[trk] = trk * kTrackAllocSize;
fNibbleTrackInfo.length[trk] = nibbleLen;
dierr = pNewGFD->Seek(fNibbleTrackInfo.offset[trk], kSeekSet);
if (dierr != kDIErrNone)
goto bail;
dierr = pNewGFD->Write(nibbleBuf, nibbleLen);
if (dierr != kDIErrNone)
goto bail;
*/
dierr = DiskImg::UnpackNibbleTrack35(nibbleBuf, nibbleLen, outputBuf,
trk / numHeads, trk % numHeads, pBadBlockMap);
if (dierr != kDIErrNone)
goto bail;
dierr = pNewGFD->Write(outputBuf,
kBlockSize * DiskImg::SectorsPerTrack35(trk / numHeads));
if (dierr != kDIErrNone) {
LOGI("FDI: failed writing disk blocks (%d * %d)",
kBlockSize, DiskImg::SectorsPerTrack35(trk / numHeads));
goto bail;
}
}
//fNibbleTrackInfo.numTracks = numCyls * numHeads;
bail:
delete[] inputBuf;
return dierr;
}
/*
* Return the approximate bit rate for the specified cylinder, in bits/sec.
*/
int WrapperFDI::BitRate35(int cyl)
{
if (cyl >= 0 && cyl <= 15)
return 375000; // 394rpm
else if (cyl <= 31)
return 343750; // 429rpm
else if (cyl <= 47)
return 312500; // 472rpm
else if (cyl <= 63)
return 281250; // 525rpm
else if (cyl <= 79)
return 250000; // 590rpm
else {
LOGI(" FDI: invalid 3.5 cylinder %d", cyl);
return 250000;
}
}
/*
* Fix any obviously-bad nibble values.
*
* This should be unlikely, but if we find several zeroes in a row due to
* garbled data from the drive, it can happen. We clean it up here so that,
* when we convert to another format (e.g. TrackStar), we don't flunk a
* simple high-bit screening test.
*
* (We could be more rigorous and test against valid disk bytes, but that's
* probably excessive.)
*/
void WrapperFDI::FixBadNibbles(uint8_t* nibbleBuf, long nibbleLen)
{
int badCount = 0;
while (nibbleLen--) {
if ((*nibbleBuf & 0x80) == 0) {
badCount++;
*nibbleBuf = 0xff;
}
nibbleBuf++;
}
if (badCount != 0) {
LOGI(" FDI: fixed %d bad nibbles", badCount);
}
}
/*
* Get the info for the Nth track. The track number is used as an index
* into the track descriptor table.
*
* Returns the track type and amount of data (/256).
*/
void WrapperFDI::GetTrackInfo(int trk, int* pType, int* pLength256)
{
uint16_t trackDescr;
trackDescr = fHeaderBuf[kTrackDescrOffset + trk * 2] << 8 |
fHeaderBuf[kTrackDescrOffset + trk * 2 +1];
*pType = (trackDescr & 0xff00) >> 8;
*pLength256 = trackDescr & 0x00ff;
switch (trackDescr & 0xf000) {
case 0x0000:
/* high-level type */
switch (trackDescr & 0xff00) {
case 0x0000:
/* blank track */
break;
default:
/* miscellaneous high-level type */
break;
}
break;
case 0x8000:
case 0x9000:
case 0xa000:
case 0xb000:
/* low-level type, length is 14 bits */
*pType = (trackDescr & 0xc000) >> 8;
*pLength256 = trackDescr & 0x3fff;
break;
case 0xc000:
case 0xd000:
/* mid-level format, value in 0n00 holds a bit rate index */
break;
case 0xe000:
case 0xf000:
/* raw MFM; for 0xf000, the value in 0n00 holds a bit rate index */
break;
default:
LOGI("Unexpected trackDescr 0x%04x", trackDescr);
*pType = 0x7e; // return an invalid value
*pLength256 = 0;
break;
}
}
/*
* Convert a track encoded as one or more pulse streams to nibbles.
*
* This decompresses the pulse streams in "inputBuf", then converts them
* to nibble form in "nibbleBuf".
*
* "*pNibbleLen" should hold the maximum size of the buffer. On success,
* it will hold the actual number of bytes used.
*
* Returns "true" on success, "false" on failure.
*/
bool WrapperFDI::DecodePulseTrack(const uint8_t* inputBuf, long inputLen,
int bitRate, uint8_t* nibbleBuf, long* pNibbleLen)
{
const int kSizeValueMask = 0x003fffff;
const int kSizeCompressMask = 0x00c00000;
const int kSizeCompressShift = 22;
PulseIndexHeader hdr;
uint32_t val;
bool result = false;
memset(&hdr, 0, sizeof(hdr));
hdr.numPulses = GetLongBE(&inputBuf[0x00]);
val = Get24BE(&inputBuf[0x04]);
hdr.avgStreamLen = val & kSizeValueMask;
hdr.avgStreamCompression = (val & kSizeCompressMask) >> kSizeCompressShift;
val = Get24BE(&inputBuf[0x07]);
hdr.minStreamLen = val & kSizeValueMask;
hdr.minStreamCompression = (val & kSizeCompressMask) >> kSizeCompressShift;
val = Get24BE(&inputBuf[0x0a]);
hdr.maxStreamLen = val & kSizeValueMask;
hdr.maxStreamCompression = (val & kSizeCompressMask) >> kSizeCompressShift;
val = Get24BE(&inputBuf[0x0d]);
hdr.idxStreamLen = val & kSizeValueMask;
hdr.idxStreamCompression = (val & kSizeCompressMask) >> kSizeCompressShift;
if (hdr.numPulses < 64 || hdr.numPulses > 131072) {
/* should be about 40,000 */
LOGI(" FDI: bad pulse count %ld in track", hdr.numPulses);
return false;
}
/* advance past the 16 hdr bytes; now pointing at "average" stream */
inputBuf += kPulseStreamDataOffset;
LOGI(" pulses: %ld", hdr.numPulses);
//LOGI(" avg: len=%d comp=%d", hdr.avgStreamLen, hdr.avgStreamCompression);
//LOGI(" min: len=%d comp=%d", hdr.minStreamLen, hdr.minStreamCompression);
//LOGI(" max: len=%d comp=%d", hdr.maxStreamLen, hdr.maxStreamCompression);
//LOGI(" idx: len=%d comp=%d", hdr.idxStreamLen, hdr.idxStreamCompression);
/*
* Uncompress or endian-swap the pulse streams.
*/
hdr.avgStream = new uint32_t[hdr.numPulses];
if (hdr.avgStream == NULL)
goto bail;
if (!UncompressPulseStream(inputBuf, hdr.avgStreamLen, hdr.avgStream,
hdr.numPulses, hdr.avgStreamCompression, 4))
{
goto bail;
}
inputBuf += hdr.avgStreamLen;
if (hdr.minStreamLen > 0) {
hdr.minStream = new uint32_t[hdr.numPulses];
if (hdr.minStream == NULL)
goto bail;
if (!UncompressPulseStream(inputBuf, hdr.minStreamLen, hdr.minStream,
hdr.numPulses, hdr.minStreamCompression, 4))
{
goto bail;
}
inputBuf += hdr.minStreamLen;
}
if (hdr.maxStreamLen > 0) {
hdr.maxStream = new uint32_t[hdr.numPulses];
if (!UncompressPulseStream(inputBuf, hdr.maxStreamLen, hdr.maxStream,
hdr.numPulses, hdr.maxStreamCompression, 4))
{
goto bail;
}
inputBuf += hdr.maxStreamLen;
}
if (hdr.idxStreamLen > 0) {
hdr.idxStream = new uint32_t[hdr.numPulses];
if (!UncompressPulseStream(inputBuf, hdr.idxStreamLen, hdr.idxStream,
hdr.numPulses, hdr.idxStreamCompression, 2))
{
goto bail;
}
inputBuf += hdr.idxStreamLen;
}
/*
* Convert the pulse streams to a nibble stream.
*/
result = ConvertPulseStreamsToNibbles(&hdr, bitRate, nibbleBuf, pNibbleLen);
// fall through with result
bail:
/* clean up */
if (hdr.avgStream != NULL)
delete[] hdr.avgStream;
if (hdr.minStream != NULL)
delete[] hdr.minStream;
if (hdr.maxStream != NULL)
delete[] hdr.maxStream;
if (hdr.idxStream != NULL)
delete[] hdr.idxStream;
return result;
}
/*
* Uncompress, or at least endian-swap, the input data.
*
* "inputLen" is the length in bytes of the input stream. For an uncompressed
* stream this should be equal to numPulses*bytesPerPulse, for a compressed
* stream it's the length of the compressed data.
*
* "bytesPerPulse" indicates the width of the input data. This will usually
* be 4, but is 2 for the index stream. The output is always 4 bytes/pulse.
* For Huffman-compressed data, it appears that the input is always 4 bytes.
*
* Returns "true" if all went well, "false" if we hit something that we
* couldn't handle.
*/
bool WrapperFDI::UncompressPulseStream(const uint8_t* inputBuf, long inputLen,
uint32_t* outputBuf, long numPulses, int format, int bytesPerPulse)
{
assert(bytesPerPulse == 2 || bytesPerPulse == 4);
/*
* Sample code has a snippet that says: if the format is "uncompressed"
* but inputLen < (numPulses*2), treat it as compressed. This may be
* for handling some badly-formed images. Not currently doing it here.
*/
if (format == kCompUncompressed) {
int i;
LOGE("NOT TESTED"); // remove this when we've tested it
if (inputLen != numPulses * bytesPerPulse) {
LOGI(" FDI: got unc inputLen=%ld, outputLen=%ld",
inputLen, numPulses * bytesPerPulse);
return false;
}
if (bytesPerPulse == 2) {
for (i = 0; i < numPulses; i++) {
*outputBuf++ = GetShortBE(inputBuf);
inputBuf += 2;
}
} else {
for (i = 0; i < numPulses; i++) {
*outputBuf++ = GetLongBE(inputBuf);
inputBuf += 4;
}
}
} else if (format == kCompHuffman) {
if (!ExpandHuffman(inputBuf, inputLen, outputBuf, numPulses))
return false;
//LOGI(" FDI: Huffman expansion succeeded");
} else {
LOGI(" FDI: got weird compression format %d", format);
return false;
}
return true;
}
/*
* Expand a Huffman-compressed stream.
*
* The code takes bit-slices across the entire input and compresses them
* separately with a static Huffman variant.
*
* "outputBuf" is expected to hold "numPulses" entries.
*
* This implementation is based on the fdi2raw code.
*/
bool WrapperFDI::ExpandHuffman(const uint8_t* inputBuf, long inputLen,
uint32_t* outputBuf, long numPulses)
{
HuffNode root;
const uint8_t* origInputBuf = inputBuf;
bool signExtend, sixteenBits;
int i, subStreamShift;
uint8_t bits;
uint8_t bitMask;
memset(outputBuf, 0, numPulses * sizeof(uint32_t));
subStreamShift = 1;
while (subStreamShift != 0) {
if (inputBuf - origInputBuf >= inputLen) {
LOGI(" FDI: overran input(1)");
return false;
}
/* decode the sub-stream header */
bits = *inputBuf++;
subStreamShift = bits & 0x7f; // low-order bit number
signExtend = (bits & 0x80) != 0;
bits = *inputBuf++;
sixteenBits = (bits & 0x80) != 0; // ignore redundant high-order
//LOGI(" FDI: shift=%d ext=%d sixt=%d",
// subStreamShift, signExtend, sixteenBits);
/* decode the Huffman tree structure */
root.left = NULL;
root.right = NULL;
bitMask = 0;
inputBuf = HuffExtractTree(inputBuf, &root, &bits, &bitMask);
//LOGI(" after tree: off=%d", inputBuf - origInputBuf);
/* extract the Huffman node values */
if (sixteenBits)
inputBuf = HuffExtractValues16(inputBuf, &root);
else
inputBuf = HuffExtractValues8(inputBuf, &root);
if (inputBuf - origInputBuf >= inputLen) {
LOGI(" FDI: overran input(2)");
return false;
}
//LOGI(" after values: off=%d", inputBuf - origInputBuf);
/* decode the data over all pulses */
bitMask = 0;
for (i = 0; i < numPulses; i++) {
uint32_t outVal;
const HuffNode* pCurrent = &root;
/* chase down the tree until we hit a leaf */
/* (note: nodes have two kids or none) */
while (true) {
if (pCurrent->left == NULL) {
break;
} else {
bitMask >>= 1;
if (bitMask == 0) {
bitMask = 0x80;
bits = *inputBuf++;
}
if (bits & bitMask)
pCurrent = pCurrent->right;
else
pCurrent = pCurrent->left;
}
}
outVal = outputBuf[i];
if (signExtend) {
if (sixteenBits)
outVal |= HuffSignExtend16(pCurrent->val) << subStreamShift;
else
outVal |= HuffSignExtend8(pCurrent->val) << subStreamShift;
} else {
outVal |= pCurrent->val << subStreamShift;
}
outputBuf[i] = outVal;
}
HuffFreeNodes(root.left);
HuffFreeNodes(root.right);
}
if (inputBuf - origInputBuf != inputLen) {
LOGI(" FDI: warning: Huffman input %ld vs. %ld",
inputBuf - origInputBuf, inputLen);
return false;
}
return true;
}
/*
* Recursively extract the Huffman tree structure for this sub-stream.
*/
const uint8_t* WrapperFDI::HuffExtractTree(const uint8_t* inputBuf,
HuffNode* pNode, uint8_t* pBits, uint8_t* pBitMask)
{
uint8_t val;
if (*pBitMask == 0) {
*pBits = *inputBuf++;
*pBitMask = 0x80;
}
val = *pBits & *pBitMask;
(*pBitMask) >>= 1;
//LOGI(" val=%d", val);
if (val != 0) {
assert(pNode->left == NULL);
assert(pNode->right == NULL);
return inputBuf;
} else {
pNode->left = new HuffNode;
memset(pNode->left, 0, sizeof(HuffNode));
inputBuf = HuffExtractTree(inputBuf, pNode->left, pBits, pBitMask);
pNode->right = new HuffNode;
memset(pNode->right, 0, sizeof(HuffNode));
return HuffExtractTree(inputBuf, pNode->right, pBits, pBitMask);
}
}
/*
* Recursively get the 16-bit values for our Huffman tree from the stream.
*/
const uint8_t* WrapperFDI::HuffExtractValues16(const uint8_t* inputBuf,
HuffNode* pNode)
{
if (pNode->left == NULL) {
pNode->val = (*inputBuf++) << 8;
pNode->val |= *inputBuf++;
return inputBuf;
} else {
inputBuf = HuffExtractValues16(inputBuf, pNode->left);
return HuffExtractValues16(inputBuf, pNode->right);
}
}
/*
* Recursively get the 8-bit values for our Huffman tree from the stream.
*/
const uint8_t* WrapperFDI::HuffExtractValues8(const uint8_t* inputBuf,
HuffNode* pNode)
{
if (pNode->left == NULL) {
pNode->val = *inputBuf++;
return inputBuf;
} else {
inputBuf = HuffExtractValues8(inputBuf, pNode->left);
return HuffExtractValues8(inputBuf, pNode->right);
}
}
/*
* Recursively free up the current node and all nodes beneath it.
*/
void WrapperFDI::HuffFreeNodes(HuffNode* pNode)
{
if (pNode != NULL) {
HuffFreeNodes(pNode->left);
HuffFreeNodes(pNode->right);
delete pNode;
}
}
/*
* Sign-extend a 16-bit value to 32 bits.
*/
uint32_t WrapperFDI::HuffSignExtend16(uint32_t val)
{
if (val & 0x8000)
val |= 0xffff0000;
return val;
}
/*
* Sign-extend an 8-bit value to 32 bits.
*/
uint32_t WrapperFDI::HuffSignExtend8(uint32_t val)
{
if (val & 0x80)
val |= 0xffffff00;
return val;
}
/* use these to extract values from the index stream */
#define ZeroStateCount(_val) (((_val) >> 8) & 0xff)
#define OneStateCount(_val) ((_val) & 0xff)
/*
* Convert our collection of pulse streams into (what we hope will be)
* Apple II nibble form.
*
* This modifies the contents of the minStream, maxStream, and idxStream
* arrays.
*
* "*pNibbleLen" should hold the maximum size of the buffer. On success,
* it will hold the actual number of bytes used.
*/
bool WrapperFDI::ConvertPulseStreamsToNibbles(PulseIndexHeader* pHdr, int bitRate,
uint8_t* nibbleBuf, long* pNibbleLen)
{
uint32_t* fakeIdxStream = NULL;
bool result = false;
int i;
/*
* Stream pointers. If we don't have a stream, fake it.
*/
uint32_t* avgStream;
uint32_t* minStream;
uint32_t* maxStream;
uint32_t* idxStream;
avgStream = pHdr->avgStream;
if (pHdr->minStream != NULL && pHdr->maxStream != NULL) {
minStream = pHdr->minStream;
maxStream = pHdr->maxStream;
/* adjust the values in the min/max streams */
for (i = 0; i < pHdr->numPulses; i++) {
maxStream[i] = avgStream[i] + minStream[i] - maxStream[i];
minStream[i] = avgStream[i] - minStream[i];
}
} else {
minStream = pHdr->avgStream;
maxStream = pHdr->avgStream;
}
if (pHdr->idxStream != NULL)
idxStream = pHdr->idxStream;
else {
/*
* The UAE sample code has some stuff to fake it. The code there
* is broken, so I'm guessing it has never been used, but I'm going
* to replicate it here (and probably never test it either). This
* assumes that the original was written for a big-endian machine.
*/
LOGI(" FDI: HEY: using fake index stream");
DebugBreak();
fakeIdxStream = new uint32_t[pHdr->numPulses];
if (fakeIdxStream == NULL) {
LOGI(" FDI: unable to alloc fake idx stream");
goto bail;
}
for (i = 1; i < pHdr->numPulses; i++)
fakeIdxStream[i] = 0x0200; // '1' for two, '0' for zero
fakeIdxStream[0] = 0x0101; // '1' for one, '0' for one
idxStream = fakeIdxStream;
}
/*
* Compute a value for maxIndex.
*/
uint32_t maxIndex;
maxIndex = 0;
for (i = 0; i < pHdr->numPulses; i++) {
uint32_t sum;
/* add up the two single-byte values in the index stream */
sum = ZeroStateCount(idxStream[i]) + OneStateCount(idxStream[i]);
if (sum > maxIndex)
maxIndex = sum;
}
/*
* Compute a value for indexOffset.
*/
int indexOffset;
indexOffset = 0;
for (i = 0; i < pHdr->numPulses && OneStateCount(idxStream[i]) != 0; i++) {
/* "falling edge, replace with ZeroStateCount for rising edge" */
}
if (i < pHdr->numPulses) {
int start = i;
do {
i++;
if (i >= pHdr->numPulses)
i = 0; // wrapped around
} while (i != start && ZeroStateCount(idxStream[i]) == 0);
if (i != start) {
/* index pulse detected */
while (i != start &&
ZeroStateCount(idxStream[i]) > OneStateCount(idxStream[i]))
{
i++;
if (i >= pHdr->numPulses)
i = 0;
}
if (i != start)
indexOffset = i; /* index position detected */
}
}
/*
* Compute totalAvg and weakBits, and rewrite idxStream.
* (We don't actually use weakBits.)
*/
uint32_t totalAvg;
int weakBits;
totalAvg = weakBits = 0;
for (i = 0; i < pHdr->numPulses; i++) {
unsigned int sum;
sum = ZeroStateCount(idxStream[i]) + OneStateCount(idxStream[i]);
if (sum >= maxIndex)
totalAvg += avgStream[i]; // could this overflow...?
else
weakBits++;
idxStream[i] = sum;
}
LOGI(" FDI: maxIndex=%u indexOffset=%d totalAvg=%d weakBits=%d",
maxIndex, indexOffset, totalAvg, weakBits);
/*
* Take our altered stream values and the stuff we've calculated,
* and convert the pulse values into bits.
*/
uint8_t bitBuffer[kBitBufferSize];
int bitCount;
bitCount = kBitBufferSize;
if (!ConvertPulsesToBits(avgStream, minStream, maxStream, idxStream,
pHdr->numPulses, maxIndex, indexOffset, totalAvg, bitRate,
bitBuffer, &bitCount))
{
LOGI(" FDI: ConvertPulsesToBits() failed");
goto bail;
}
//LOGI(" Got %d bits", bitCount);
if (bitCount < 0) {
LOGI(" FDI: overran output bit buffer");
goto bail;
}
/*
* We have a bit stream with the GCR bits as they appear coming out of
* the IWM. Convert it to 8-bit nibble form.
*
* We currently discard self-sync byte information.
*/
if (!ConvertBitsToNibbles(bitBuffer, bitCount, nibbleBuf, pNibbleLen))
{
LOGI(" FDI: ConvertBitsToNibbles() failed");
goto bail;
}
result = true;
bail:
delete[] fakeIdxStream;
return result;
}
/*
* Local data structures. Not worth putting in the header file.
*/
const int kPulseLimitVal = 15; /* "tolerance of 15%" */
typedef struct PulseSamples {
uint32_t size;
int numBits;
} PulseSamples;
class PulseSampleCollection {
public:
PulseSampleCollection(void) {
fArrayIndex = fTotalDiv = -1;
fTotal = 0;
}
~PulseSampleCollection(void) {}
void Create(int stdMFM2BitCellSize, int numBits) {
int i;
fArrayIndex = 0;
fTotal = 0;
fTotalDiv = 0;
for (i = 0; i < kSampleArrayMax; i++) {
// "That is (total track length / 50000) for Amiga double density"
fArray[i].size = stdMFM2BitCellSize;
fTotal += fArray[i].size;
fArray[i].numBits = numBits;
fTotalDiv += fArray[i].numBits;
}
assert(fTotalDiv != 0);
}
uint32_t GetTotal(void) const { return fTotal; }
int GetTotalDiv(void) const { return fTotalDiv; }
void AdjustTotal(long val) { fTotal += val; }
void AdjustTotalDiv(int val) { fTotalDiv += val; }
void IncrIndex(void) {
fArrayIndex++;
if (fArrayIndex >= kSampleArrayMax)
fArrayIndex = 0;
}
PulseSamples* GetCurrentArrayEntry(void) {
return &fArray[fArrayIndex];
}
enum {
kSampleArrayMax = 10,
};
private:
PulseSamples fArray[kSampleArrayMax];
int fArrayIndex;
uint32_t fTotal;
int fTotalDiv;
};
#define MY_RANDOM
#ifdef MY_RANDOM
/* replace rand() with my function */
#define rand() MyRand()
/*
* My psuedo-random number generator, which is even less random than
* rand(). It is, however, consistent across all platforms, and the
* value for RAND_MAX is small enough to avoid some integer overflow
* problems that the code has with (2^31-1) implementations.
*/
#undef RAND_MAX
#define RAND_MAX 32767
int WrapperFDI::MyRand(void)
{
const int kNumStates = 31;
const int kQuantum = RAND_MAX / (kNumStates+1);
static int state = 0;
int retVal;
state++;
if (state == kNumStates)
state = 0;
retVal = (kQuantum * state) + (kQuantum / 2);
assert(retVal >= 0 && retVal <= RAND_MAX);
return retVal;
}
#endif
/*
* Convert the pulses we've read to a bit stream. This is a tad complex
* because the FDI scanner was reading a GCR disk with an MFM drive.
*
* Pass the output buffer size in bytes in "*pOutputLen". The actual number
* of *bits* output is returned in it.
*
* This is a fairly direct conversion from the sample code. There's a lot
* here that I haven't taken the time to figure out.
*/
bool WrapperFDI::ConvertPulsesToBits(const uint32_t* avgStream,
const uint32_t* minStream, const uint32_t* maxStream,
const uint32_t* idxStream, int numPulses, int maxIndex,
int indexOffset, uint32_t totalAvg, int bitRate,
uint8_t* outputBuf, int* pOutputLen)
{
PulseSampleCollection samples;
BitOutputBuffer bitOutput(outputBuf, *pOutputLen);
/* magic numbers, from somewhere */
const uint32_t kStdMFM2BitCellSize = (totalAvg * 5) / bitRate;
const uint32_t kStdMFM8BitCellSize = (totalAvg * 20) / bitRate;
int mfmMagic = 0; // if set to 1, decode as MFM rather than GCR
bool result = false;
int i;
//int debugCounter = 0;
/* sample code doesn't do this, but I want consistent results */
srand(0);
/*
* "detects a long-enough stable pulse coming just after another
* stable pulse"
*/
i = 1;
while (i < numPulses &&
(idxStream[i] < (uint32_t) maxIndex ||
idxStream[i-1] < (uint32_t) maxIndex ||
minStream[i] < (kStdMFM2BitCellSize - (kStdMFM2BitCellSize / 4))
))
{
i++;
}
if (i == numPulses) {
LOGW(" FDI: no stable and long-enough pulse in track");
goto bail;
}
/*
* Set up some variables.
*/
int nextI, endOfData, adjust, /*bitOffset,*/ step;
uint32_t refPulse;
long jitter;
samples.Create(kStdMFM2BitCellSize, 1 + mfmMagic);
nextI = i;
endOfData = i;
i--;
adjust = 0;
//bitOffset = 0;
refPulse = 0;
jitter = 0;
step = -1;
/*
* Run through the data three times:
* (-1) do stuff
* (0) do more stuff
* (1) output bits
*/
while (step < 2) {
/*
* Calculates the current average bit rate from previously
* decoded data.
*/
uint32_t avgSize;
int kCell8Limit = (kPulseLimitVal * kStdMFM8BitCellSize) / 100;
/* this is the new average size for one MFM bit */
avgSize = (samples.GetTotal() << (2 + mfmMagic)) / samples.GetTotalDiv();
/*
* Prevent avgSize from getting too far out of whack.
*
* "you can try tighter ranges than 25%, or wider ranges. I would
* probably go for tighter..."
*/
if ((avgSize < kStdMFM8BitCellSize - kCell8Limit) ||
(avgSize > kStdMFM8BitCellSize + kCell8Limit))
{
avgSize = kStdMFM8BitCellSize;
}
/*
* Get the next long-enough pulse (may require more than one pulse).
*/
uint32_t pulse;
pulse = 0;
while (pulse < ((avgSize / 4) - (avgSize / 16))) {
uint32_t avgPulse, minPulse, maxPulse;
/* advance i */
i++;
if (i >= numPulses)
i = 0; // wrapped around
/* advance nextI */
if (i == nextI) {
do {
nextI++;
if (nextI >= numPulses)
nextI = 0;
} while (idxStream[nextI] < (uint32_t) maxIndex);
}
if (idxStream[i] >= (uint32_t) maxIndex) {
/* stable pulse */
avgPulse = avgStream[i] - jitter;
minPulse = minStream[i];
maxPulse = maxStream[i];
if (jitter >= 0)
maxPulse -= jitter;
else
minPulse -= jitter;
if (maxStream[nextI] - avgStream[nextI] < avgPulse - minPulse)
minPulse = avgPulse - (maxStream[nextI] - avgStream[nextI]);
if (avgStream[nextI] - minStream[nextI] < maxPulse - avgPulse)
maxPulse = avgPulse + (avgStream[nextI] - minStream[nextI]);
if (minPulse < refPulse)
minPulse = refPulse;
/*
* This appears to use a pseudo-random number generator
* to dither the signal. This strikes me as highly
* questionable, but I'm trying to recreate what the sample
* code does, and I don't fully understand this stuff.
*/
int randVal;
randVal = rand();
if (randVal < (RAND_MAX / 2)) {
if (randVal > (RAND_MAX / 4)) {
if (randVal <= (3 * (RAND_MAX / 8)))
randVal = (2 * randVal) - (RAND_MAX / 4);
else
randVal = (4 * randVal) - RAND_MAX;
}
jitter = 0 - (randVal * (avgPulse - minPulse)) / RAND_MAX;
} else {
randVal -= RAND_MAX / 2;
if (randVal > (RAND_MAX / 4)) {
if (randVal <= (3 * (RAND_MAX / 8)))
randVal = (2 * randVal) - (RAND_MAX / 4);
else
randVal = (4 * randVal) - RAND_MAX;
}
jitter = (randVal * (maxPulse - avgPulse)) / RAND_MAX;
}
avgPulse += jitter;
if (avgPulse < minPulse || avgPulse > maxPulse) {
/* this is bad -- we're out of bounds */
LOGI(" FDI: avgPulse out of bounds: avg=%u min=%u max=%u",
avgPulse, minPulse, maxPulse);
}
if (avgPulse < refPulse) {
/* I guess this is also bad */
LOGI(" FDI: avgPulse < refPulse (%u %u)",
avgPulse, refPulse);
}
pulse += avgPulse - refPulse;
refPulse = 0;
/*
* If we've reached the end, advance to the next step.
*/
if (i == endOfData)
step++;
} else if ((uint32_t) rand() <= (idxStream[i] * RAND_MAX) / maxIndex) {
/* futz with it */
int randVal;
avgPulse = avgStream[i];
minPulse = minStream[i];
maxPulse = maxStream[i];
randVal = rand();
if (randVal < (RAND_MAX / 2)) {
if (randVal > (RAND_MAX / 4)) {
if (randVal <= (3 * (RAND_MAX / 8)))
randVal = (2 * randVal) - (RAND_MAX / 4);
else
randVal = (4 * randVal) - RAND_MAX;
}
avgPulse -= (randVal * (avgPulse - minPulse)) / RAND_MAX;
} else {
randVal -= RAND_MAX / 2;
if (randVal > (RAND_MAX / 4)) {
if (randVal <= (3 * (RAND_MAX / 8)))
randVal = (2 * randVal) - (RAND_MAX / 4);
else
randVal = (4 * randVal) - RAND_MAX;
}
avgPulse += (randVal * (maxPulse - avgPulse)) / RAND_MAX;
}
if (avgPulse > refPulse &&
avgPulse < (avgStream[nextI] - jitter))
{
pulse += avgPulse - refPulse;
refPulse = avgPulse;
}
} else {
// do nothing
}
}
/*
* "gets the size in bits from the pulse width, considering the current
* average bitrate"
*
* "realSize" will end up holding the number of bits we're going
* to output for this pulse.
*/
uint32_t adjustedPulse;
int realSize;
adjustedPulse = pulse;
realSize = 0;
if (mfmMagic != 0) {
while (adjustedPulse >= avgSize) {
realSize += 4;
adjustedPulse -= avgSize / 2;
}
adjustedPulse <<= 3;
while (adjustedPulse >= ((avgSize * 4) + (avgSize / 4))) {
realSize += 2;
adjustedPulse -= avgSize * 2;
}
if (adjustedPulse >= ((avgSize * 3) + (avgSize / 4))) {
if (adjustedPulse <= ((avgSize * 4) - (avgSize / 4))) {
if ((2* ((adjustedPulse >> 2) - adjust)) <=
((2 * avgSize) - (avgSize / 4)))
{
realSize += 3;
} else {
realSize += 4;
}
} else {
realSize += 4;
}
} else {
if (adjustedPulse > ((avgSize * 3) - (avgSize / 4))) {
realSize += 3;
} else {
if (adjustedPulse >= ((avgSize * 2) + (avgSize / 4))) {
if ((2 * ((adjustedPulse >> 2) - adjust)) <
(avgSize + (avgSize / 4)))
{
realSize += 2;
} else {
realSize += 3;
}
} else {
realSize += 2;
}
}
}
} else {
/* mfmMagic == 0, whatever that means */
while (adjustedPulse >= (2 * avgSize)) {
realSize += 4;
adjustedPulse -= avgSize;
}
adjustedPulse <<= 2;
while (adjustedPulse >= ((avgSize * 3) + (avgSize / 4))) {
realSize += 2;
adjustedPulse -= avgSize * 2;
}
if (adjustedPulse >= ((avgSize * 2) + (avgSize / 4))) {
if (adjustedPulse <= ((avgSize * 3) - (avgSize / 4))) {
if (((adjustedPulse >> 1) - adjust) <
(avgSize + (avgSize / 4)))
{
realSize += 2;
} else {
realSize += 3;
}
} else {
realSize += 3;
}
} else {
if (adjustedPulse > ((avgSize * 2) - (avgSize / 4)))
realSize += 2;
else {
if (adjustedPulse >= (avgSize + (avgSize / 4))) {
if (((adjustedPulse >> 1) - adjust) <=
(avgSize - (avgSize / 4)))
{
realSize++;
} else {
realSize += 2;
}
} else {
realSize++;
}
}
}
}
/*
* "after one pass to correctly initialize the average bitrate,
* outputs the bits"
*/
if (step == 1) {
int j;
for (j = realSize; j > 1; j--)
bitOutput.WriteBit(0);
bitOutput.WriteBit(1);
}
/*
* Prepare for next pulse.
*/
adjust = ((realSize * avgSize) / (4 << mfmMagic)) - pulse;
PulseSamples* pSamples;
pSamples = samples.GetCurrentArrayEntry();
samples.AdjustTotal(-(long)pSamples->size);
samples.AdjustTotalDiv(-pSamples->numBits);
pSamples->size = pulse;
pSamples->numBits = realSize;
samples.AdjustTotal(pulse);
samples.AdjustTotalDiv(realSize);
samples.IncrIndex();
}
*pOutputLen = bitOutput.Finish();
LOGI(" FDI: converted pulses to %d bits", *pOutputLen);
result = true;
bail:
return result;
}
/*
* Convert a stream of GCR bits into nibbles.
*
* The stream includes 9-bit and 10-bit self-sync bytes. We need to process
* the bits as if we were an Apple II, shifting bits into a register until
* we get a 1 in the msb.
*
* There is a (roughly) 7 in 8 chance that we will not start out reading
* the stream on a byte boundary. We have to read for a bit to let the
* self-sync bytes do their job.
*
* "*pNibbleLen" should hold the maximum size of the buffer. On success,
* it will hold the actual number of bytes used.
*/
bool WrapperFDI::ConvertBitsToNibbles(const uint8_t* bitBuffer, int bitCount,
uint8_t* nibbleBuf, long* pNibbleLen)
{
BitInputBuffer inputBuffer(bitBuffer, bitCount);
const uint8_t* nibbleBufStart = nibbleBuf;
long outputBufSize = *pNibbleLen;
bool result = false;
uint8_t val;
bool wrap;
/*
* Start 3/4 of the way through the buffer. That should give us a
* couple of self-sync zones before we hit the end of the buffer.
*/
inputBuffer.SetStartPosition(3 * (bitCount / 4));
/*
* Run until we wrap. We should be in sync by that point.
*/
wrap = false;
while (!wrap) {
val = inputBuffer.GetByte(&wrap);
if ((val & 0x80) == 0)
val = (val << 1) | inputBuffer.GetBit(&wrap);
if ((val & 0x80) == 0)
val = (val << 1) | inputBuffer.GetBit(&wrap);
if ((val & 0x80) == 0) {
// not allowed by GCR encoding, probably garbage between sectors
LOGI(" FDI: WARNING: more than 2 consecutive zeroes (sync)");
}
}
/*
* Extract the nibbles.
*/
inputBuffer.ResetBitsConsumed();
wrap = false;
while (true) {
val = inputBuffer.GetByte(&wrap);
if ((val & 0x80) == 0)
val = (val << 1) | inputBuffer.GetBit(&wrap);
if ((val & 0x80) == 0)
val = (val << 1) | inputBuffer.GetBit(&wrap);
if ((val & 0x80) == 0) {
LOGW(" FDI: WARNING: more than 2 consecutive zeroes (read)");
}
if (nibbleBuf - nibbleBufStart >= outputBufSize) {
LOGW(" FDI: bits overflowed nibble buffer");
goto bail;
}
*nibbleBuf++ = val;
/* if we wrapped around on this one, we've reached the start point */
if (wrap)
break;
}
if (inputBuffer.GetBitsConsumed() != bitCount) {
/* we dropped some or double-counted some */
LOGW(" FDI: WARNING: consumed %d of %d bits",
inputBuffer.GetBitsConsumed(), bitCount);
}
LOGI(" FDI: consumed %d of %d (first=0x%02x last=0x%02x)",
inputBuffer.GetBitsConsumed(), bitCount,
*nibbleBufStart, *(nibbleBuf-1));
*pNibbleLen = nibbleBuf - nibbleBufStart;
result = true;
bail:
return result;
}