mirror of
https://github.com/TomHarte/CLK.git
synced 2024-08-16 16:28:59 +00:00
198 lines
5.2 KiB
C++
198 lines
5.2 KiB
C++
//
|
|
// MFM.cpp
|
|
// Clock Signal
|
|
//
|
|
// Created by Thomas Harte on 18/09/2016.
|
|
// Copyright © 2016 Thomas Harte. All rights reserved.
|
|
//
|
|
|
|
#include "MFM.hpp"
|
|
|
|
#import "../PCMTrack.hpp"
|
|
|
|
using namespace Storage::Encodings::MFM;
|
|
|
|
template <class T> class Shifter {
|
|
public:
|
|
virtual void add_byte(uint8_t input) = 0;
|
|
virtual void add_index_address_mark() = 0;
|
|
virtual void add_ID_address_mark() = 0;
|
|
virtual void add_data_address_mark() = 0;
|
|
virtual void add_deleted_data_address_mark() = 0;
|
|
|
|
protected:
|
|
// override me!
|
|
void output_short(uint16_t value);
|
|
};
|
|
|
|
template <class T> class MFMShifter: public Shifter<T> {
|
|
public:
|
|
void add_byte(uint8_t input) {
|
|
uint16_t spread_value =
|
|
(uint16_t)(
|
|
((input & 0x01) << 0) |
|
|
((input & 0x02) << 1) |
|
|
((input & 0x04) << 2) |
|
|
((input & 0x08) << 3) |
|
|
((input & 0x10) << 4) |
|
|
((input & 0x20) << 5) |
|
|
((input & 0x40) << 6) |
|
|
((input & 0x80) << 7)
|
|
);
|
|
uint16_t or_bits = (uint16_t)((spread_value << 1) | (spread_value >> 1) | (output_ << 15));
|
|
output_ = spread_value | ((~or_bits) & 0xaaaa);
|
|
static_cast<T *>(this)->output_short(output_);
|
|
}
|
|
|
|
void add_index_address_mark() {
|
|
static_cast<T *>(this)->output_short(output_ = 0x5224);
|
|
add_byte(0xfc);
|
|
}
|
|
|
|
void add_ID_address_mark() {
|
|
static_cast<T *>(this)->output_short(output_ = 0x4489);
|
|
add_byte(0xfe);
|
|
}
|
|
|
|
void add_data_address_mark() {
|
|
static_cast<T *>(this)->output_short(output_ = 0x4489);
|
|
add_byte(0xfb);
|
|
}
|
|
|
|
void add_deleted_data_address_mark() {
|
|
static_cast<T *>(this)->output_short(output_ = 0x4489);
|
|
add_byte(0xf8);
|
|
}
|
|
|
|
private:
|
|
uint16_t output_;
|
|
};
|
|
|
|
template <class T> class FMShifter: public Shifter<T> {
|
|
public:
|
|
void add_byte(uint8_t input) {
|
|
static_cast<T *>(this)->output_short(
|
|
(uint16_t)(
|
|
((input & 0x01) << 1) |
|
|
((input & 0x02) << 2) |
|
|
((input & 0x04) << 3) |
|
|
((input & 0x08) << 4) |
|
|
((input & 0x10) << 5) |
|
|
((input & 0x20) << 6) |
|
|
((input & 0x40) << 7) |
|
|
((input & 0x80) << 8) |
|
|
0x5555
|
|
));
|
|
}
|
|
|
|
void add_index_address_mark() {
|
|
// data 0xfc, with clock 0xd7 => 1111 1100 with clock 1101 0111 => 1111 1011 1011 0101
|
|
static_cast<T *>(this)->output_short(0xfbb5);
|
|
}
|
|
|
|
void add_ID_address_mark() {
|
|
// data 0xfe, with clock 0xc7 => 1111 1110 with clock 1100 0111 => 1111 1010 1011 1101
|
|
static_cast<T *>(this)->output_short(0xfabd);
|
|
}
|
|
|
|
void add_data_address_mark() {
|
|
// data 0xfb, with clock 0xc7 => 1111 1011 with clock 1100 0111 => 1111 1010 1001 1111
|
|
static_cast<T *>(this)->output_short(0xfa9f);
|
|
}
|
|
|
|
void add_deleted_data_address_mark() {
|
|
// data 0xf8, with clock 0xc7 => 1111 1000 with clock 1100 0111 => 1111 1010 1001 0101
|
|
static_cast<T *>(this)->output_short(0xfa95);
|
|
}
|
|
};
|
|
|
|
template<class T> std::shared_ptr<Storage::Disk::Track>
|
|
GetTrackWithSectors(
|
|
const std::vector<Sector> §ors,
|
|
size_t post_index_address_mark_bytes, uint8_t post_index_address_mark_value,
|
|
size_t pre_address_mark_bytes, size_t post_address_mark_bytes,
|
|
size_t pre_data_mark_bytes, size_t post_data_bytes,
|
|
size_t inter_sector_gap)
|
|
{
|
|
T shifter;
|
|
|
|
// output the index mark
|
|
shifter.add_index_address_mark();
|
|
|
|
// add the post-index mark
|
|
for(int c = 0; c < post_index_address_mark_bytes; c++) shifter.add_byte(post_index_address_mark_value);
|
|
|
|
// add sectors
|
|
for(const Sector §or : sectors)
|
|
{
|
|
for(int c = 0; c < pre_address_mark_bytes; c++) shifter.add_byte(0x00);
|
|
|
|
shifter.add_ID_address_mark();
|
|
shifter.add_byte(sector.track);
|
|
shifter.add_byte(sector.side);
|
|
shifter.add_byte(sector.sector);
|
|
switch(sector.data.size())
|
|
{
|
|
default: shifter.add_byte(0); break;
|
|
case 256: shifter.add_byte(1); break;
|
|
case 512: shifter.add_byte(2); break;
|
|
case 1024: shifter.add_byte(3); break;
|
|
case 2048: shifter.add_byte(4); break;
|
|
case 4196: shifter.add_byte(5); break;
|
|
}
|
|
// TODO: CRC of bytes since the track number
|
|
|
|
for(int c = 0; c < post_address_mark_bytes; c++) shifter.add_byte(0x4e);
|
|
for(int c = 0; c < pre_data_mark_bytes; c++) shifter.add_byte(0x00);
|
|
|
|
shifter.add_data_address_mark();
|
|
for(size_t c = 0; c < sector.data.size(); c++) shifter.add_byte(sector.data[c]);
|
|
// TODO: CRC of data
|
|
|
|
for(int c = 0; c < post_data_bytes; c++) shifter.add_byte(0x00);
|
|
for(int c = 0; c < inter_sector_gap; c++) shifter.add_byte(0x4e);
|
|
}
|
|
|
|
// TODO: total size check
|
|
|
|
Storage::Disk::PCMSegment segment;
|
|
return std::shared_ptr<Storage::Disk::Track>(new Storage::Disk::PCMTrack(std::move(segment)));
|
|
}
|
|
|
|
|
|
std::shared_ptr<Storage::Disk::Track> Storage::Encodings::MFM::GetFMTrackWithSectors(const std::vector<Sector> §ors)
|
|
{
|
|
struct VectorShifter: public FMShifter<VectorShifter> {
|
|
void output_short(uint16_t value) {
|
|
data.push_back(value & 0xff);
|
|
data.push_back(value >> 8);
|
|
}
|
|
std::vector<uint8_t> data;
|
|
};
|
|
|
|
return GetTrackWithSectors<VectorShifter>(
|
|
sectors,
|
|
16, 0x00,
|
|
6, 0,
|
|
17, 14,
|
|
0);
|
|
}
|
|
|
|
std::shared_ptr<Storage::Disk::Track> Storage::Encodings::MFM::GetMFMTrackWithSectors(const std::vector<Sector> §ors)
|
|
{
|
|
struct VectorShifter: public MFMShifter<VectorShifter> {
|
|
void output_short(uint16_t value) {
|
|
data.push_back(value & 0xff);
|
|
data.push_back(value >> 8);
|
|
}
|
|
std::vector<uint8_t> data;
|
|
};
|
|
|
|
return GetTrackWithSectors<VectorShifter>(
|
|
sectors,
|
|
50, 0x4e,
|
|
12, 22,
|
|
12, 18,
|
|
32);
|
|
}
|