mirror of
https://github.com/davidgiven/fluxengine.git
synced 2025-10-24 11:11:02 -07:00
58 lines
1.3 KiB
C++
58 lines
1.3 KiB
C++
#include "globals.h"
|
|
#include "fluxmap.h"
|
|
#include "decoders/fluxmapreader.h"
|
|
#include "protocol.h"
|
|
#include "decoders/decoders.h"
|
|
#include "sector.h"
|
|
#include "zilogmcz.h"
|
|
#include "bytes.h"
|
|
#include "crc.h"
|
|
#include "fmt/format.h"
|
|
#include <string.h>
|
|
#include <algorithm>
|
|
|
|
static const FluxPattern SECTOR_START_PATTERN(16, 0xaaab);
|
|
|
|
class ZilogMczDecoder : public Decoder
|
|
{
|
|
public:
|
|
ZilogMczDecoder(const DecoderProto& config):
|
|
Decoder(config)
|
|
{}
|
|
|
|
nanoseconds_t advanceToNextRecord() override
|
|
{
|
|
seekToIndexMark();
|
|
return seekToPattern(SECTOR_START_PATTERN);
|
|
}
|
|
|
|
void decodeSectorRecord() override
|
|
{
|
|
readRawBits(14);
|
|
|
|
auto rawbits = readRawBits(140*16);
|
|
auto bytes = decodeFmMfm(rawbits).slice(0, 140);
|
|
ByteReader br(bytes);
|
|
|
|
_sector->logicalSector = br.read_8() & 0x1f;
|
|
_sector->logicalSide = 0;
|
|
_sector->logicalTrack = br.read_8() & 0x7f;
|
|
if (_sector->logicalSector > 31)
|
|
return;
|
|
if (_sector->logicalTrack > 80)
|
|
return;
|
|
|
|
_sector->data = br.read(132);
|
|
uint16_t wantChecksum = br.read_be16();
|
|
uint16_t gotChecksum = crc16(MODBUS_POLY, 0x0000, bytes.slice(0, 134));
|
|
|
|
_sector->status = (wantChecksum == gotChecksum) ? Sector::OK : Sector::BAD_CHECKSUM;
|
|
}
|
|
};
|
|
|
|
std::unique_ptr<Decoder> createZilogMczDecoder(const DecoderProto& config)
|
|
{
|
|
return std::unique_ptr<Decoder>(new ZilogMczDecoder(config));
|
|
}
|
|
|