mirror of
https://github.com/TomHarte/CLK.git
synced 2024-12-28 07:29:45 +00:00
129 lines
3.8 KiB
C++
129 lines
3.8 KiB
C++
//
|
|
// CSW.cpp
|
|
// Clock Signal
|
|
//
|
|
// Created by Thomas Harte on 10/07/2017.
|
|
// Copyright © 2017 Thomas Harte. All rights reserved.
|
|
//
|
|
|
|
#include "CSW.hpp"
|
|
|
|
#include <cassert>
|
|
|
|
using namespace Storage::Tape;
|
|
|
|
CSW::CSW(const std::string &file_name) :
|
|
source_data_pointer_(0) {
|
|
Storage::FileHolder file(file_name);
|
|
if(file.stats().st_size < 0x20) throw ErrorNotCSW;
|
|
|
|
// Check signature.
|
|
if(!file.check_signature("Compressed Square Wave")) {
|
|
throw ErrorNotCSW;
|
|
}
|
|
|
|
// Check terminating byte.
|
|
if(file.get8() != 0x1a) throw ErrorNotCSW;
|
|
|
|
// Get version file number.
|
|
uint8_t major_version = file.get8();
|
|
uint8_t minor_version = file.get8();
|
|
|
|
// Reject if this is an unknown version.
|
|
if(major_version > 2 || !major_version || minor_version > 1) throw ErrorNotCSW;
|
|
|
|
// The header now diverges based on version.
|
|
uint32_t number_of_waves = 0;
|
|
if(major_version == 1) {
|
|
pulse_.length.clock_rate = file.get16le();
|
|
|
|
if(file.get8() != 1) throw ErrorNotCSW;
|
|
compression_type_ = CompressionType::RLE;
|
|
|
|
pulse_.type = (file.get8() & 1) ? Pulse::High : Pulse::Low;
|
|
|
|
file.seek(0x20, SEEK_SET);
|
|
} else {
|
|
pulse_.length.clock_rate = file.get32le();
|
|
number_of_waves = file.get32le();
|
|
switch(file.get8()) {
|
|
case 1: compression_type_ = CompressionType::RLE; break;
|
|
case 2: compression_type_ = CompressionType::ZRLE; break;
|
|
default: throw ErrorNotCSW;
|
|
}
|
|
|
|
pulse_.type = (file.get8() & 1) ? Pulse::High : Pulse::Low;
|
|
uint8_t extension_length = file.get8();
|
|
|
|
if(file.stats().st_size < 0x34 + extension_length) throw ErrorNotCSW;
|
|
file.seek(0x34 + extension_length, SEEK_SET);
|
|
}
|
|
|
|
// Grab all data remaining in the file.
|
|
std::vector<uint8_t> file_data;
|
|
std::size_t remaining_data = static_cast<std::size_t>(file.stats().st_size) - static_cast<std::size_t>(file.tell());
|
|
file_data.resize(remaining_data);
|
|
file.read(file_data.data(), remaining_data);
|
|
|
|
if(compression_type_ == CompressionType::ZRLE) {
|
|
// The only clue given by CSW as to the output size in bytes is that there will be
|
|
// number_of_waves waves. Waves are usually one byte, but may be five. So this code
|
|
// is pessimistic.
|
|
source_data_.resize(static_cast<std::size_t>(number_of_waves) * 5);
|
|
|
|
// uncompress will tell how many compressed bytes there actually were, so use its
|
|
// modification of output_length to throw away all the memory that isn't actually
|
|
// needed.
|
|
uLongf output_length = static_cast<uLongf>(number_of_waves * 5);
|
|
uncompress(source_data_.data(), &output_length, file_data.data(), file_data.size());
|
|
source_data_.resize(static_cast<std::size_t>(output_length));
|
|
} else {
|
|
source_data_ = std::move(file_data);
|
|
}
|
|
|
|
invert_pulse();
|
|
}
|
|
|
|
CSW::CSW(const std::vector<uint8_t> &&data, CompressionType compression_type, bool initial_level, uint32_t sampling_rate) {
|
|
pulse_.length.clock_rate = sampling_rate;
|
|
pulse_.type = initial_level ? Pulse::High : Pulse::Low;
|
|
source_data_ = std::move(data);
|
|
}
|
|
|
|
uint8_t CSW::get_next_byte() {
|
|
if(source_data_pointer_ == source_data_.size()) return 0xff;
|
|
uint8_t result = source_data_[source_data_pointer_];
|
|
source_data_pointer_++;
|
|
return result;
|
|
}
|
|
|
|
uint32_t CSW::get_next_int32le() {
|
|
if(source_data_pointer_ > source_data_.size() - 4) return 0xffff;
|
|
uint32_t result = (uint32_t)(
|
|
(source_data_[source_data_pointer_ + 0] << 0) |
|
|
(source_data_[source_data_pointer_ + 1] << 8) |
|
|
(source_data_[source_data_pointer_ + 2] << 16) |
|
|
(source_data_[source_data_pointer_ + 3] << 24));
|
|
source_data_pointer_ += 4;
|
|
return result;
|
|
}
|
|
|
|
void CSW::invert_pulse() {
|
|
pulse_.type = (pulse_.type == Pulse::High) ? Pulse::Low : Pulse::High;
|
|
}
|
|
|
|
bool CSW::is_at_end() {
|
|
return source_data_pointer_ == source_data_.size();
|
|
}
|
|
|
|
void CSW::virtual_reset() {
|
|
source_data_pointer_ = 0;
|
|
}
|
|
|
|
Tape::Pulse CSW::virtual_get_next_pulse() {
|
|
invert_pulse();
|
|
pulse_.length.length = get_next_byte();
|
|
if(!pulse_.length.length) pulse_.length.length = get_next_int32le();
|
|
return pulse_;
|
|
}
|