summaryrefslogtreecommitdiffstatshomepage
path: root/src/lib/formats/apd_dsk.cpp
blob: cd5de8ad2068bb8a859ac8e00068ab39f68b398d (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
// license:BSD-3-Clause
// copyright-holders:Nigel Barnes
/*********************************************************************

    formats/apd_dsk.c

    Archimedes Protected Disk Image format

*********************************************************************/

#include <zlib.h>
#include "formats/apd_dsk.h"

static const uint8_t APD_HEADER[8] = { 0x41, 0x50, 0x44, 0x58, 0x30, 0x30, 0x30, 0x31 };
static const uint8_t GZ_HEADER[2] = { 0x1f, 0x8b };

apd_format::apd_format()
{
}

const char *apd_format::name() const
{
	return "apd";
}

const char *apd_format::description() const
{
	return "Archimedes Protected Disk Image";
}

const char *apd_format::extensions() const
{
	return "apd";
}

int apd_format::identify(io_generic *io, uint32_t form_factor)
{
	char h[8];

	io_generic_read(io, h, 0, 8);
	if (!memcmp(h, GZ_HEADER, sizeof(GZ_HEADER)) || !memcmp(h, APD_HEADER, sizeof(APD_HEADER))) {
		return 100;
	}

	return 0;
}

bool apd_format::load(io_generic *io, uint32_t form_factor, floppy_image *image)
{
	uint64_t size = io_generic_size(io);
	std::vector<uint8_t> img(size);
	io_generic_read(io, &img[0], 0, size);

	int err;
	std::vector<uint8_t> gz_ptr;
	z_stream d_stream;
	int inflate_size = (img[size - 1] << 24) | (img[size - 2] << 16) | (img[size - 3] << 8) | img[size - 4];
	uint8_t *in_ptr = &img[0];

	gz_ptr.resize(inflate_size);

	d_stream.zalloc = nullptr;
	d_stream.zfree = nullptr;
	d_stream.opaque = nullptr;
	d_stream.next_in = in_ptr;
	d_stream.avail_in = size;
	d_stream.next_out = &gz_ptr[0];
	d_stream.avail_out = inflate_size;

	err = inflateInit2(&d_stream, MAX_WBITS | 16);
	if (err != Z_OK) {
		LOG_FORMATS("inflateInit2 error: %d\n", err);
		return false;
	}
	err = inflate(&d_stream, Z_FINISH);
	if (err != Z_STREAM_END && err != Z_OK) {
		LOG_FORMATS("inflate error: %d\n", err);
		return false;
	}
	err = inflateEnd(&d_stream);
	if (err != Z_OK) {
		LOG_FORMATS("inflateEnd error: %d\n", err);
		return false;
	}
	size = inflate_size;
	img = gz_ptr;

	if (memcmp(&img[0], APD_HEADER, sizeof(APD_HEADER))) {
		LOG_FORMATS("apd_dsk: floppy image has incorrect header\n");
		return false;
	}

	int data = 0x7d0;
	for (int track = 0; track < 83; track++) {
		for (int side = 0; side < 2; side++) {
			uint32_t sdlen = little_endianize_int32(*(uint32_t *)(&img[(track * 2 + side) * 12 + 8 + 0x0]));
			uint32_t ddlen = little_endianize_int32(*(uint32_t *)(&img[(track * 2 + side) * 12 + 8 + 0x4]));
			uint32_t qdlen = little_endianize_int32(*(uint32_t *)(&img[(track * 2 + side) * 12 + 8 + 0x8]));

			if (sdlen > 0) {
				generate_track_from_bitstream(track, side, &img[data], sdlen, image);
				data += (sdlen + 7) >> 3;
			}
			if (ddlen > 0) {
				generate_track_from_bitstream(track, side, &img[data], ddlen, image);
				data += (ddlen + 7) >> 3;
			}
			if (qdlen > 0) {
				generate_track_from_bitstream(track, side, &img[data], qdlen, image);
				data += (qdlen + 7) >> 3;
			}
		}
	}
	image->set_variant(floppy_image::DSDD);

	return true;
}

bool apd_format::supports_save() const
{
	return false;
}

const floppy_format_type FLOPPY_APD_FORMAT = &floppy_image_format_creator<apd_format>;