2021-07-16 22:11:07 +00:00
|
|
|
//
|
|
|
|
// AmigaADF.cpp
|
|
|
|
// Clock Signal
|
|
|
|
//
|
|
|
|
// Created by Thomas Harte on 16/07/2021.
|
|
|
|
// Copyright © 2021 Thomas Harte. All rights reserved.
|
|
|
|
//
|
|
|
|
|
|
|
|
#include "AmigaADF.hpp"
|
|
|
|
|
2021-07-17 00:07:17 +00:00
|
|
|
#include "../../Encodings/MFM/Constants.hpp"
|
|
|
|
#include "../../Encodings/MFM/Encoder.hpp"
|
|
|
|
#include "../../Track/PCMTrack.hpp"
|
2021-07-16 22:11:07 +00:00
|
|
|
|
|
|
|
using namespace Storage::Disk;
|
|
|
|
|
2021-07-17 00:07:17 +00:00
|
|
|
namespace {
|
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
template <typename IteratorT, class OutputIt> void encode_block(IteratorT begin, IteratorT end, OutputIt first) {
|
|
|
|
// Parse 1: combine odd bits.
|
2021-07-17 00:07:17 +00:00
|
|
|
auto cursor = begin;
|
|
|
|
while(cursor != end) {
|
2021-10-09 20:45:19 +00:00
|
|
|
auto source = uint8_t(
|
|
|
|
((*cursor & 0x02) << 3) |
|
|
|
|
((*cursor & 0x08) << 2) |
|
|
|
|
((*cursor & 0x20) << 1) |
|
|
|
|
((*cursor & 0x80) << 0)
|
|
|
|
);
|
2021-07-17 00:07:17 +00:00
|
|
|
++cursor;
|
|
|
|
source |=
|
2021-10-09 20:45:19 +00:00
|
|
|
((*cursor & 0x02) >> 1) |
|
|
|
|
((*cursor & 0x08) >> 2) |
|
|
|
|
((*cursor & 0x20) >> 3) |
|
|
|
|
((*cursor & 0x80) >> 4);
|
2021-07-17 00:07:17 +00:00
|
|
|
++cursor;
|
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
*first = source;
|
|
|
|
++first;
|
2021-07-17 00:07:17 +00:00
|
|
|
}
|
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
// Parse 2: combine even bits.
|
2021-07-17 00:07:17 +00:00
|
|
|
cursor = begin;
|
|
|
|
while(cursor != end) {
|
2021-10-09 20:45:19 +00:00
|
|
|
auto source = uint8_t(
|
|
|
|
((*cursor & 0x01) << 4) |
|
|
|
|
((*cursor & 0x04) << 3) |
|
|
|
|
((*cursor & 0x10) << 2) |
|
|
|
|
((*cursor & 0x40) << 1)
|
|
|
|
);
|
2021-07-17 00:07:17 +00:00
|
|
|
++cursor;
|
|
|
|
source |=
|
2021-10-09 20:45:19 +00:00
|
|
|
((*cursor & 0x01) >> 0) |
|
|
|
|
((*cursor & 0x04) >> 1) |
|
|
|
|
((*cursor & 0x10) >> 2) |
|
|
|
|
((*cursor & 0x40) >> 3);
|
2021-07-17 00:07:17 +00:00
|
|
|
++cursor;
|
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
*first = source;
|
|
|
|
++first;
|
2021-07-17 00:07:17 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
template <typename IteratorT> void write(IteratorT begin, IteratorT end, std::unique_ptr<Storage::Encodings::MFM::Encoder> &encoder) {
|
2021-07-17 00:07:17 +00:00
|
|
|
while(begin != end) {
|
2021-10-10 18:47:48 +00:00
|
|
|
encoder->add_byte(*begin);
|
|
|
|
++begin;
|
2021-07-17 00:07:17 +00:00
|
|
|
}
|
2021-10-10 18:47:48 +00:00
|
|
|
}
|
2021-07-17 00:07:17 +00:00
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
template <typename IteratorT> std::array<uint8_t, 2> checksum(IteratorT begin, IteratorT end) {
|
|
|
|
uint16_t checksum = 0;
|
|
|
|
while(begin != end) {
|
|
|
|
const uint8_t value = *begin;
|
|
|
|
++begin;
|
|
|
|
|
|
|
|
// Do a clockless MFM encode.
|
|
|
|
const auto spread = uint16_t(
|
|
|
|
((value&0x80) << 7) |
|
|
|
|
((value&0x40) << 6) |
|
|
|
|
((value&0x20) << 5) |
|
|
|
|
((value&0x10) << 4) |
|
|
|
|
((value&0x08) << 3) |
|
|
|
|
((value&0x04) << 2) |
|
|
|
|
((value&0x02) << 1) |
|
|
|
|
((value&0x01) << 0)
|
|
|
|
);
|
|
|
|
checksum ^= spread;
|
|
|
|
}
|
2021-07-17 00:07:17 +00:00
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
return std::array<uint8_t, 2>{
|
|
|
|
uint8_t(checksum >> 8),
|
|
|
|
uint8_t(checksum)
|
2021-07-17 00:07:17 +00:00
|
|
|
};
|
|
|
|
}
|
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
template <typename IteratorT> void write_checksum(IteratorT begin, IteratorT end, std::unique_ptr<Storage::Encodings::MFM::Encoder> &encoder) {
|
|
|
|
const auto raw_checksum = checksum(begin, end);
|
|
|
|
|
|
|
|
std::array<uint8_t, 2> encoded_checksum;
|
|
|
|
encode_block(raw_checksum.begin(), raw_checksum.end(), encoded_checksum.begin());
|
|
|
|
|
|
|
|
write(encoded_checksum.begin(), encoded_checksum.end(), encoder);
|
|
|
|
}
|
|
|
|
|
2021-07-17 00:07:17 +00:00
|
|
|
}
|
|
|
|
|
2021-07-16 22:11:07 +00:00
|
|
|
AmigaADF::AmigaADF(const std::string &file_name) :
|
|
|
|
file_(file_name) {
|
|
|
|
// Dumb validation only for now: a size check.
|
|
|
|
if(file_.stats().st_size != 901120) throw Error::InvalidFormat;
|
|
|
|
}
|
|
|
|
|
|
|
|
HeadPosition AmigaADF::get_maximum_head_position() {
|
|
|
|
return HeadPosition(80);
|
|
|
|
}
|
|
|
|
|
|
|
|
int AmigaADF::get_head_count() {
|
|
|
|
return 2;
|
|
|
|
}
|
|
|
|
|
|
|
|
std::shared_ptr<Track> AmigaADF::get_track_at_position(Track::Address address) {
|
2021-07-17 00:07:17 +00:00
|
|
|
using namespace Storage::Encodings;
|
|
|
|
|
|
|
|
// Create an MFM encoder.
|
|
|
|
Storage::Disk::PCMSegment encoded_segment;
|
|
|
|
encoded_segment.data.reserve(102'400); // i.e. 0x1900 bytes.
|
|
|
|
auto encoder = MFM::GetMFMEncoder(encoded_segment.data);
|
|
|
|
|
|
|
|
// Each track begins with two sync words.
|
|
|
|
encoder->output_short(MFM::MFMSync);
|
|
|
|
encoder->output_short(MFM::MFMSync);
|
|
|
|
|
|
|
|
// Grab the unencoded track.
|
2021-07-16 22:11:07 +00:00
|
|
|
file_.seek(get_file_offset_for_position(address), SEEK_SET);
|
2021-07-17 00:07:17 +00:00
|
|
|
const std::vector<uint8_t> track_data = file_.read(512 * 11);
|
|
|
|
|
|
|
|
// Eleven sectors are then encoded.
|
|
|
|
for(size_t s = 0; s < 11; s++) {
|
|
|
|
// Two bytes of 0x00 act as an inter-sector gap.
|
|
|
|
encoder->add_byte(0);
|
|
|
|
encoder->add_byte(0);
|
|
|
|
|
|
|
|
// Add additional sync.
|
|
|
|
encoder->output_short(MFM::MFMSync);
|
|
|
|
encoder->output_short(MFM::MFMSync);
|
|
|
|
|
2021-10-10 18:47:48 +00:00
|
|
|
// Encode and write the header.
|
2021-07-17 00:07:17 +00:00
|
|
|
const uint8_t header[4] = {
|
|
|
|
0xff, // Amiga v1.0 format.
|
|
|
|
uint8_t(address.position.as_int()), // Track.
|
|
|
|
uint8_t(s), // Sector.
|
|
|
|
uint8_t(11 - s), // Sectors remaining.
|
|
|
|
};
|
2021-10-10 18:47:48 +00:00
|
|
|
std::array<uint8_t, 4> encoded_header;
|
|
|
|
encode_block(std::begin(header), std::end(header), std::begin(encoded_header));
|
|
|
|
write(std::begin(encoded_header), std::end(encoded_header), encoder);
|
|
|
|
|
|
|
|
// Encode the data.
|
|
|
|
std::array<uint8_t, 512> encoded_data;
|
|
|
|
encode_block(&track_data[s * 512], &track_data[(s + 1) * 512], std::begin(encoded_data));
|
2021-07-17 00:07:17 +00:00
|
|
|
|
|
|
|
// Write the sector label.
|
|
|
|
const std::array<uint8_t, 16> os_recovery{};
|
2021-10-10 18:47:48 +00:00
|
|
|
write(os_recovery.begin(), os_recovery.end(), encoder);
|
2021-07-17 00:07:17 +00:00
|
|
|
|
|
|
|
// Write checksums.
|
2021-10-10 18:47:48 +00:00
|
|
|
write_checksum(std::begin(encoded_header), std::end(encoded_header), encoder);
|
|
|
|
write_checksum(std::begin(encoded_data), std::end(encoded_data), encoder);
|
2021-07-16 22:11:07 +00:00
|
|
|
|
2021-07-17 00:07:17 +00:00
|
|
|
// Write data.
|
2021-10-10 18:47:48 +00:00
|
|
|
write(std::begin(encoded_data), std::end(encoded_data), encoder);
|
2021-07-17 00:07:17 +00:00
|
|
|
}
|
2021-07-16 22:11:07 +00:00
|
|
|
|
2021-07-17 00:07:17 +00:00
|
|
|
return std::make_shared<Storage::Disk::PCMTrack>(std::move(encoded_segment));
|
2021-07-16 22:11:07 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
long AmigaADF::get_file_offset_for_position(Track::Address address) {
|
|
|
|
return (address.position.as_int() * 2 + address.head) * 512 * 11;
|
|
|
|
}
|