clang-format in src/floppy/
This commit is contained in:
@@ -36,73 +36,67 @@
|
||||
#include <86box/fdc.h>
|
||||
#include <fdi2raw.h>
|
||||
|
||||
|
||||
typedef struct {
|
||||
FILE *f;
|
||||
FDI *h;
|
||||
FILE *f;
|
||||
FDI *h;
|
||||
|
||||
int lasttrack;
|
||||
int sides;
|
||||
int track;
|
||||
int tracklen[2][4];
|
||||
int trackindex[2][4];
|
||||
int lasttrack;
|
||||
int sides;
|
||||
int track;
|
||||
int tracklen[2][4];
|
||||
int trackindex[2][4];
|
||||
|
||||
uint8_t track_data[2][4][256*1024];
|
||||
uint8_t track_timing[2][4][256*1024];
|
||||
uint8_t track_data[2][4][256 * 1024];
|
||||
uint8_t track_timing[2][4][256 * 1024];
|
||||
} fdi_t;
|
||||
|
||||
|
||||
static fdi_t *fdi[FDD_NUM];
|
||||
static fdc_t *fdi_fdc;
|
||||
|
||||
static fdi_t *fdi[FDD_NUM];
|
||||
static fdc_t *fdi_fdc;
|
||||
|
||||
#ifdef ENABLE_FDI_LOG
|
||||
int fdi_do_log = ENABLE_FDI_LOG;
|
||||
|
||||
|
||||
static void
|
||||
fdi_log(const char *fmt, ...)
|
||||
{
|
||||
va_list ap;
|
||||
va_list ap;
|
||||
|
||||
if (fdi_do_log)
|
||||
{
|
||||
va_start(ap, fmt);
|
||||
pclog_ex(fmt, ap);
|
||||
va_end(ap);
|
||||
}
|
||||
if (fdi_do_log) {
|
||||
va_start(ap, fmt);
|
||||
pclog_ex(fmt, ap);
|
||||
va_end(ap);
|
||||
}
|
||||
}
|
||||
#else
|
||||
#define fdi_log(fmt, ...)
|
||||
# define fdi_log(fmt, ...)
|
||||
#endif
|
||||
|
||||
|
||||
static uint16_t
|
||||
disk_flags(int drive)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
uint16_t temp_disk_flags = 0x80; /* We ALWAYS claim to have extra bit cells, even if the actual amount is 0. */
|
||||
fdi_t *dev = fdi[drive];
|
||||
uint16_t temp_disk_flags = 0x80; /* We ALWAYS claim to have extra bit cells, even if the actual amount is 0. */
|
||||
|
||||
switch (fdi2raw_get_bit_rate(dev->h)) {
|
||||
case 500:
|
||||
temp_disk_flags |= 2;
|
||||
break;
|
||||
case 500:
|
||||
temp_disk_flags |= 2;
|
||||
break;
|
||||
|
||||
case 300:
|
||||
case 250:
|
||||
temp_disk_flags |= 0;
|
||||
break;
|
||||
case 300:
|
||||
case 250:
|
||||
temp_disk_flags |= 0;
|
||||
break;
|
||||
|
||||
case 1000:
|
||||
temp_disk_flags |= 4;
|
||||
break;
|
||||
case 1000:
|
||||
temp_disk_flags |= 4;
|
||||
break;
|
||||
|
||||
default:
|
||||
temp_disk_flags |= 0;
|
||||
default:
|
||||
temp_disk_flags |= 0;
|
||||
}
|
||||
|
||||
if (dev->sides == 2)
|
||||
temp_disk_flags |= 8;
|
||||
temp_disk_flags |= 8;
|
||||
|
||||
/*
|
||||
* Tell the 86F handler that we will handle our
|
||||
@@ -110,39 +104,38 @@ disk_flags(int drive)
|
||||
*/
|
||||
temp_disk_flags |= 0x800;
|
||||
|
||||
return(temp_disk_flags);
|
||||
return (temp_disk_flags);
|
||||
}
|
||||
|
||||
|
||||
static uint16_t
|
||||
side_flags(int drive)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
fdi_t *dev = fdi[drive];
|
||||
uint16_t temp_side_flags = 0;
|
||||
|
||||
switch (fdi2raw_get_bit_rate(dev->h)) {
|
||||
case 500:
|
||||
temp_side_flags = 0;
|
||||
break;
|
||||
case 500:
|
||||
temp_side_flags = 0;
|
||||
break;
|
||||
|
||||
case 300:
|
||||
temp_side_flags = 1;
|
||||
break;
|
||||
case 300:
|
||||
temp_side_flags = 1;
|
||||
break;
|
||||
|
||||
case 250:
|
||||
temp_side_flags = 2;
|
||||
break;
|
||||
case 250:
|
||||
temp_side_flags = 2;
|
||||
break;
|
||||
|
||||
case 1000:
|
||||
temp_side_flags = 3;
|
||||
break;
|
||||
case 1000:
|
||||
temp_side_flags = 3;
|
||||
break;
|
||||
|
||||
default:
|
||||
temp_side_flags = 2;
|
||||
default:
|
||||
temp_side_flags = 2;
|
||||
}
|
||||
|
||||
if (fdi2raw_get_rotation(dev->h) == 360)
|
||||
temp_side_flags |= 0x20;
|
||||
temp_side_flags |= 0x20;
|
||||
|
||||
/*
|
||||
* Set the encoding value to match that provided by the FDC.
|
||||
@@ -150,163 +143,158 @@ side_flags(int drive)
|
||||
*/
|
||||
temp_side_flags |= 0x08;
|
||||
|
||||
return(temp_side_flags);
|
||||
return (temp_side_flags);
|
||||
}
|
||||
|
||||
|
||||
static int
|
||||
fdi_density(void)
|
||||
{
|
||||
if (! fdc_is_mfm(fdi_fdc)) return(0);
|
||||
if (!fdc_is_mfm(fdi_fdc))
|
||||
return (0);
|
||||
|
||||
switch (fdc_get_bit_rate(fdi_fdc)) {
|
||||
case 0:
|
||||
return(2);
|
||||
case 0:
|
||||
return (2);
|
||||
|
||||
case 1:
|
||||
return(1);
|
||||
case 1:
|
||||
return (1);
|
||||
|
||||
case 2:
|
||||
return(1);
|
||||
case 2:
|
||||
return (1);
|
||||
|
||||
case 3:
|
||||
case 5:
|
||||
return(3);
|
||||
case 3:
|
||||
case 5:
|
||||
return (3);
|
||||
|
||||
default:
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return(1);
|
||||
return (1);
|
||||
}
|
||||
|
||||
|
||||
static int32_t
|
||||
extra_bit_cells(int drive, int side)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
int density = 0;
|
||||
int raw_size = 0;
|
||||
int is_300_rpm = 0;
|
||||
fdi_t *dev = fdi[drive];
|
||||
int density = 0;
|
||||
int raw_size = 0;
|
||||
int is_300_rpm = 0;
|
||||
|
||||
density = fdi_density();
|
||||
|
||||
is_300_rpm = (fdd_getrpm(drive) == 300);
|
||||
|
||||
switch (fdc_get_bit_rate(fdi_fdc)) {
|
||||
case 0:
|
||||
raw_size = is_300_rpm ? 200000 : 166666;
|
||||
break;
|
||||
case 0:
|
||||
raw_size = is_300_rpm ? 200000 : 166666;
|
||||
break;
|
||||
|
||||
case 1:
|
||||
raw_size = is_300_rpm ? 120000 : 100000;
|
||||
break;
|
||||
case 1:
|
||||
raw_size = is_300_rpm ? 120000 : 100000;
|
||||
break;
|
||||
|
||||
case 2:
|
||||
raw_size = is_300_rpm ? 100000 : 83333;
|
||||
break;
|
||||
case 2:
|
||||
raw_size = is_300_rpm ? 100000 : 83333;
|
||||
break;
|
||||
|
||||
case 3:
|
||||
case 5:
|
||||
raw_size = is_300_rpm ? 400000 : 333333;
|
||||
break;
|
||||
case 3:
|
||||
case 5:
|
||||
raw_size = is_300_rpm ? 400000 : 333333;
|
||||
break;
|
||||
|
||||
default:
|
||||
raw_size = is_300_rpm ? 100000 : 83333;
|
||||
default:
|
||||
raw_size = is_300_rpm ? 100000 : 83333;
|
||||
}
|
||||
|
||||
return((dev->tracklen[side][density] - raw_size));
|
||||
return ((dev->tracklen[side][density] - raw_size));
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
read_revolution(int drive)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
int c, den, side;
|
||||
int track = dev->track;
|
||||
int c, den, side;
|
||||
int track = dev->track;
|
||||
|
||||
if (track > dev->lasttrack) {
|
||||
for (den = 0; den < 4; den++) {
|
||||
memset(dev->track_data[0][den], 0, 106096);
|
||||
memset(dev->track_data[1][den], 0, 106096);
|
||||
dev->tracklen[0][den] = dev->tracklen[1][den] = 100000;
|
||||
}
|
||||
return;
|
||||
for (den = 0; den < 4; den++) {
|
||||
memset(dev->track_data[0][den], 0, 106096);
|
||||
memset(dev->track_data[1][den], 0, 106096);
|
||||
dev->tracklen[0][den] = dev->tracklen[1][den] = 100000;
|
||||
}
|
||||
return;
|
||||
}
|
||||
|
||||
for (den = 0; den < 4; den++) {
|
||||
for (side = 0; side < dev->sides; side++) {
|
||||
c = fdi2raw_loadtrack(dev->h,
|
||||
(uint16_t *)dev->track_data[side][den],
|
||||
(uint16_t *)dev->track_timing[side][den],
|
||||
(track * dev->sides) + side,
|
||||
&dev->tracklen[side][den],
|
||||
&dev->trackindex[side][den], NULL, den);
|
||||
if (! c)
|
||||
memset(dev->track_data[side][den], 0, dev->tracklen[side][den]);
|
||||
}
|
||||
for (side = 0; side < dev->sides; side++) {
|
||||
c = fdi2raw_loadtrack(dev->h,
|
||||
(uint16_t *) dev->track_data[side][den],
|
||||
(uint16_t *) dev->track_timing[side][den],
|
||||
(track * dev->sides) + side,
|
||||
&dev->tracklen[side][den],
|
||||
&dev->trackindex[side][den], NULL, den);
|
||||
if (!c)
|
||||
memset(dev->track_data[side][den], 0, dev->tracklen[side][den]);
|
||||
}
|
||||
|
||||
if (dev->sides == 1) {
|
||||
memset(dev->track_data[1][den], 0, 106096);
|
||||
dev->tracklen[1][den] = 100000;
|
||||
}
|
||||
if (dev->sides == 1) {
|
||||
memset(dev->track_data[1][den], 0, 106096);
|
||||
dev->tracklen[1][den] = 100000;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static uint32_t
|
||||
index_hole_pos(int drive, int side)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
int density;
|
||||
int density;
|
||||
|
||||
density = fdi_density();
|
||||
|
||||
return(dev->trackindex[side][density]);
|
||||
return (dev->trackindex[side][density]);
|
||||
}
|
||||
|
||||
|
||||
static uint32_t
|
||||
get_raw_size(int drive, int side)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
int density;
|
||||
int density;
|
||||
|
||||
density = fdi_density();
|
||||
|
||||
return(dev->tracklen[side][density]);
|
||||
return (dev->tracklen[side][density]);
|
||||
}
|
||||
|
||||
|
||||
static uint16_t *
|
||||
encoded_data(int drive, int side)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
int density = 0;
|
||||
fdi_t *dev = fdi[drive];
|
||||
int density = 0;
|
||||
|
||||
density = fdi_density();
|
||||
|
||||
return((uint16_t *)dev->track_data[side][density]);
|
||||
return ((uint16_t *) dev->track_data[side][density]);
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
fdi_seek(int drive, int track)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
|
||||
if (fdd_doublestep_40(drive)) {
|
||||
if (fdi2raw_get_tpi(dev->h) < 2)
|
||||
track /= 2;
|
||||
if (fdi2raw_get_tpi(dev->h) < 2)
|
||||
track /= 2;
|
||||
}
|
||||
|
||||
d86f_set_cur_track(drive, track);
|
||||
|
||||
if (dev->f == NULL) return;
|
||||
if (dev->f == NULL)
|
||||
return;
|
||||
|
||||
if (track < 0)
|
||||
track = 0;
|
||||
track = 0;
|
||||
|
||||
#if 0
|
||||
if (track > dev->lasttrack)
|
||||
@@ -318,21 +306,20 @@ fdi_seek(int drive, int track)
|
||||
read_revolution(drive);
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
fdi_load(int drive, char *fn)
|
||||
{
|
||||
char header[26];
|
||||
char header[26];
|
||||
fdi_t *dev;
|
||||
|
||||
writeprot[drive] = fwriteprot[drive] = 1;
|
||||
|
||||
/* Allocate a drive block. */
|
||||
dev = (fdi_t *)malloc(sizeof(fdi_t));
|
||||
dev = (fdi_t *) malloc(sizeof(fdi_t));
|
||||
|
||||
if (dev == NULL) {
|
||||
memset(floppyfns[drive], 0, sizeof(floppyfns[drive]));
|
||||
return;
|
||||
memset(floppyfns[drive], 0, sizeof(floppyfns[drive]));
|
||||
return;
|
||||
}
|
||||
|
||||
memset(dev, 0x00, sizeof(fdi_t));
|
||||
@@ -341,39 +328,39 @@ fdi_load(int drive, char *fn)
|
||||
|
||||
dev->f = plat_fopen(fn, "rb");
|
||||
if (fread(header, 1, 25, dev->f) != 25)
|
||||
fatal("fdi_load(): Error reading header\n");
|
||||
fatal("fdi_load(): Error reading header\n");
|
||||
if (fseek(dev->f, 0, SEEK_SET) == -1)
|
||||
fatal("fdi_load(): Error seeking to the beginning of the file\n");
|
||||
fatal("fdi_load(): Error seeking to the beginning of the file\n");
|
||||
header[25] = 0;
|
||||
if (strcmp(header, "Formatted Disk Image file") != 0) {
|
||||
/* This is a Japanese FDI file. */
|
||||
fdi_log("fdi_load(): Japanese FDI file detected, redirecting to IMG loader\n");
|
||||
fclose(dev->f);
|
||||
free(dev);
|
||||
img_load(drive, fn);
|
||||
return;
|
||||
/* This is a Japanese FDI file. */
|
||||
fdi_log("fdi_load(): Japanese FDI file detected, redirecting to IMG loader\n");
|
||||
fclose(dev->f);
|
||||
free(dev);
|
||||
img_load(drive, fn);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Set up the drive unit. */
|
||||
fdi[drive] = dev;
|
||||
|
||||
dev->h = fdi2raw_header(dev->f);
|
||||
dev->h = fdi2raw_header(dev->f);
|
||||
dev->lasttrack = fdi2raw_get_last_track(dev->h);
|
||||
dev->sides = fdi2raw_get_last_head(dev->h) + 1;
|
||||
dev->sides = fdi2raw_get_last_head(dev->h) + 1;
|
||||
|
||||
/* Attach this format to the D86F engine. */
|
||||
d86f_handler[drive].disk_flags = disk_flags;
|
||||
d86f_handler[drive].side_flags = side_flags;
|
||||
d86f_handler[drive].writeback = null_writeback;
|
||||
d86f_handler[drive].set_sector = null_set_sector;
|
||||
d86f_handler[drive].write_data = null_write_data;
|
||||
d86f_handler[drive].disk_flags = disk_flags;
|
||||
d86f_handler[drive].side_flags = side_flags;
|
||||
d86f_handler[drive].writeback = null_writeback;
|
||||
d86f_handler[drive].set_sector = null_set_sector;
|
||||
d86f_handler[drive].write_data = null_write_data;
|
||||
d86f_handler[drive].format_conditions = null_format_conditions;
|
||||
d86f_handler[drive].extra_bit_cells = extra_bit_cells;
|
||||
d86f_handler[drive].encoded_data = encoded_data;
|
||||
d86f_handler[drive].read_revolution = read_revolution;
|
||||
d86f_handler[drive].index_hole_pos = index_hole_pos;
|
||||
d86f_handler[drive].get_raw_size = get_raw_size;
|
||||
d86f_handler[drive].check_crc = 1;
|
||||
d86f_handler[drive].extra_bit_cells = extra_bit_cells;
|
||||
d86f_handler[drive].encoded_data = encoded_data;
|
||||
d86f_handler[drive].read_revolution = read_revolution;
|
||||
d86f_handler[drive].index_hole_pos = index_hole_pos;
|
||||
d86f_handler[drive].get_raw_size = get_raw_size;
|
||||
d86f_handler[drive].check_crc = 1;
|
||||
d86f_set_version(drive, D86FVER);
|
||||
|
||||
d86f_common_handlers(drive);
|
||||
@@ -383,32 +370,31 @@ fdi_load(int drive, char *fn)
|
||||
fdi_log("Loaded as FDI\n");
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
fdi_close(int drive)
|
||||
{
|
||||
fdi_t *dev = fdi[drive];
|
||||
|
||||
if (dev == NULL) return;
|
||||
if (dev == NULL)
|
||||
return;
|
||||
|
||||
d86f_unregister(drive);
|
||||
|
||||
drives[drive].seek = NULL;
|
||||
|
||||
if (dev->h)
|
||||
fdi2raw_header_free(dev->h);
|
||||
fdi2raw_header_free(dev->h);
|
||||
|
||||
if (dev->f)
|
||||
fclose(dev->f);
|
||||
fclose(dev->f);
|
||||
|
||||
/* Release the memory. */
|
||||
free(dev);
|
||||
fdi[drive] = NULL;
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
fdi_set_fdc(void *fdc)
|
||||
{
|
||||
fdi_fdc = (fdc_t *)fdc;
|
||||
fdi_fdc = (fdc_t *) fdc;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user