CLK/Storage/Disk/DiskImage/Formats/SSD.cpp

//
//  SSD.cpp
//  Clock Signal
//
//  Created by Thomas Harte on 18/09/2016.
//  Copyright © 2016 Thomas Harte. All rights reserved.
//

#include "SSD.hpp"

#include "../../Encodings/MFM/MFM.hpp"
#include "../../Encodings/MFM/Parser.hpp"

using namespace Storage::Disk;

SSD::SSD(const char *file_name) :
		Storage::FileHolder(file_name) {
	// very loose validation: the file needs to be a multiple of 256 bytes
	// and not ungainly large

	if(file_stats_.st_size & 255) throw ErrorNotSSD;
	if(file_stats_.st_size < 512) throw ErrorNotSSD;
	if(file_stats_.st_size > 800*256) throw ErrorNotSSD;

	// this has two heads if the suffix is .dsd, one if it's .ssd
	head_count_ = (tolower(file_name[strlen(file_name) - 3]) == 'd') ? 2 : 1;
	track_count_ = (unsigned int)(file_stats_.st_size / (256 * 10));
	if(track_count_ < 40) track_count_ = 40;
	else if(track_count_ < 80) track_count_ = 80;
}

unsigned int SSD::get_head_position_count() {
	return track_count_;
}

unsigned int SSD::get_head_count() {
	return head_count_;
}

bool SSD::get_is_read_only() {
	return is_read_only_;
}

long SSD::get_file_offset_for_position(unsigned int head, unsigned int position) {
	return (position * head_count_ + head) * 256 * 10;
}

std::shared_ptr<Track> SSD::get_track_at_position(unsigned int head, unsigned int position) {
	std::shared_ptr<Track> track;

	if(head >= head_count_) return track;

	std::vector<Storage::Encodings::MFM::Sector> sectors;
	{
		std::lock_guard<std::mutex> lock_guard(file_access_mutex_);
		fseek(file_, get_file_offset_for_position(head, position), SEEK_SET);

		for(int sector = 0; sector < 10; sector++) {
			Storage::Encodings::MFM::Sector new_sector;
			new_sector.track = (uint8_t)position;
			new_sector.side = 0;
			new_sector.sector = (uint8_t)sector;
			new_sector.size = 1;

			new_sector.data.resize(256);
			fread(new_sector.data.data(), 1, 256, file_);

			// zero out if this wasn't present in the disk image; it's still appropriate to put a sector
			// on disk because one will have been placed during formatting, but there's no reason to leak
			// information from outside the emulated machine's world
			if(feof(file_)) memset(new_sector.data.data(), 0, 256);

			sectors.push_back(std::move(new_sector));
		}
	}

	if(sectors.size()) return Storage::Encodings::MFM::GetFMTrackWithSectors(sectors);

	return track;
}

void SSD::set_track_at_position(unsigned int head, unsigned int position, const std::shared_ptr<Track> &track) {
	std::vector<uint8_t> data;
	Storage::Encodings::MFM::Parser parser(false, track);
	for(unsigned int c = 0; c < 10; c++) {
		std::shared_ptr<Storage::Encodings::MFM::Sector> sector = parser.get_sector(0, (uint8_t)position, (uint8_t)c);
		if(sector) {
			data.insert(data.end(), sector->data.begin(), sector->data.end());
		} else {
			// TODO: what's correct here? Warn the user that whatever has been written to the disk,
			// it can no longer be stored as an SSD? If so, warn them by what route?
			data.resize(data.size() + 256);
		}
	}

	long file_offset = get_file_offset_for_position(head, position);

	std::lock_guard<std::mutex> lock_guard(file_access_mutex_);
	ensure_file_is_at_least_length(file_offset);
	fseek(file_, file_offset, SEEK_SET);
	fwrite(data.data(), 1, data.size(), file_);
}