static int
readblock(CBM_FILE fd, unsigned char *p, unsigned int length)
{
unsigned char c1;
unsigned char c2;
SETSTATEDEBUG(DebugByteCount = 0);
for (; length < 0x100; length++)
{
SETSTATEDEBUG(DebugByteCount += 2);
if (pp_read(fd, &c1, &c2))
{
SETSTATEDEBUG(DebugByteCount = -1);
return 1;
}
*p++ = c1; length++;
if (length < 0x100)
*p++ = c2;
}
SETSTATEDEBUG(DebugByteCount = -1);
// perform end-handshake
pp_read(fd, &c1, &c2);
SETSTATEDEBUG((void)0);
return 0;
}
static int
write2byte(CBM_FILE fd, unsigned char c1, unsigned char c2)
{
int ret;
SETSTATEDEBUG(DebugByteCount = -12801);
ret = pp_write(fd, c1, c2);
SETSTATEDEBUG(DebugByteCount = -1);
return ret;
}
static int
write1byte(CBM_FILE fd, unsigned char c1)
{
int ret;
SETSTATEDEBUG(DebugByteCount = -6401);
ret = pp_write(fd, c1, 0);
SETSTATEDEBUG(DebugByteCount = -1);
return ret;
}
static int
read1byte(CBM_FILE fd, unsigned char *c1)
{
unsigned char dummy;
int ret;
SETSTATEDEBUG(DebugByteCount = -6401);
ret = pp_read(fd, c1, &dummy);
SETSTATEDEBUG(DebugByteCount = -1);
return ret;
}
static int
init(CBM_FILE fd, unsigned char drive)
{
SETSTATEDEBUG((void)0);
cbm_iec_set(fd, IEC_CLOCK);
SETSTATEDEBUG((void)0);
cbm_iec_wait(fd, IEC_DATA, 1);
SETSTATEDEBUG((void)0);
return 0;
}
static int pp_write(CBM_FILE fd, unsigned char c1, unsigned char c2)
{
SETSTATEDEBUG((void)0);
#ifndef USE_CBM_IEC_WAIT
while(!cbm_iec_get(fd, IEC_DATA));
#else
cbm_iec_wait(fd, IEC_DATA, 1);
#endif
SETSTATEDEBUG((void)0);
cbm_pp_write(fd, c1);
SETSTATEDEBUG((void)0);
cbm_iec_release(fd, IEC_CLOCK);
SETSTATEDEBUG((void)0);
#ifndef USE_CBM_IEC_WAIT
while(cbm_iec_get(fd, IEC_DATA));
#else
cbm_iec_wait(fd, IEC_DATA, 0);
#endif
SETSTATEDEBUG((void)0);
cbm_pp_write(fd, c2);
SETSTATEDEBUG((void)0);
cbm_iec_set(fd, IEC_CLOCK);
SETSTATEDEBUG((void)0);
#ifndef USE_CBM_IEC_WAIT
while(!cbm_iec_get(fd, IEC_DATA));
#else
cbm_iec_wait(fd, IEC_DATA, 1);
#endif
SETSTATEDEBUG((void)0);
return 0;
}
static int pp_read(CBM_FILE fd, unsigned char *c1, unsigned char *c2)
{
SETSTATEDEBUG((void)0);
pp_check_direction(PP_READ);
SETSTATEDEBUG((void)0);
#ifndef USE_CBM_IEC_WAIT
while(!cbm_iec_get(fd, IEC_DATA));
#else
cbm_iec_wait(fd, IEC_DATA, 1);
#endif
SETSTATEDEBUG((void)0);
*c1 = cbm_pp_read(fd);
SETSTATEDEBUG((void)0);
cbm_iec_release(fd, IEC_CLOCK);
SETSTATEDEBUG((void)0);
#ifndef USE_CBM_IEC_WAIT
while(cbm_iec_get(fd, IEC_DATA));
#else
cbm_iec_wait(fd, IEC_DATA, 0);
#endif
SETSTATEDEBUG((void)0);
*c2 = cbm_pp_read(fd);
SETSTATEDEBUG((void)0);
cbm_iec_set(fd, IEC_CLOCK);
SETSTATEDEBUG((void)0);
return 0;
}
//
// entry point :: read image file
//
int imgcopy_read_image(CBM_FILE cbm_fd,
imgcopy_settings *settings,
int src_drive,
const char *dst_image,
imgcopy_message_cb msg_cb,
imgcopy_status_cb stat_cb)
{
const transfer_funcs *src;
const transfer_funcs *dst;
int ret;
message_cb = msg_cb;
status_cb = stat_cb;
src = transfers[settings->transfer_mode].trf;
dst = &imgcopy_fs_transfer;
atom_dst = dst;
atom_mustcleanup = 1;
imgcopy_set_image_type(settings, dst_image);
SETSTATEDEBUG((void)0);
ret = copy_disk(cbm_fd, settings,
src, (void*)(ULONG_PTR)src_drive, dst, (void*)dst_image, (unsigned char) src_drive);
atom_mustcleanup = 0;
return ret;
}
static int
writeblock(CBM_FILE fd, unsigned char *p, unsigned int length)
{
SETSTATEDEBUG(DebugByteCount = 0);
for (; length < 0x100; length += 2, p += 2)
{
SETSTATEDEBUG(DebugByteCount += 2);
if (pp_write(fd, p[0], p[1]))
{
SETSTATEDEBUG(DebugByteCount = -1);
return 1;
}
}
SETSTATEDEBUG(DebugByteCount = -1);
return 0;
}
//
// check auto transfer mode and replace default
//
int imgcopy_check_auto_transfer_mode(CBM_FILE cbm_fd, int auto_transfermode, int drive)
{
int transfermode = auto_transfermode;
assert(strcmp(transfers[0].name, "auto") == 0);
if (auto_transfermode == 0)
{
SETSTATEDEBUG((void)0);
if (transfermode == 0)
transfermode = imgcopy_get_transfer_mode_index("original");
SETSTATEDEBUG((void)0);
}
return transfermode;
}
static void close_disk(void)
{
SETSTATEDEBUG((void)0);
pp_write(fd_cbm, 0, 0);
arch_usleep(100);
SETSTATEDEBUG((void)0);
cbm_iec_wait(fd_cbm, IEC_DATA, 0);
/* make sure the XP1541 portion of the cable is in input mode */
SETSTATEDEBUG((void)0);
cbm_pp_read(fd_cbm);
SETSTATEDEBUG((void)0);
opencbm_plugin_pp_dc_read_n = NULL;
opencbm_plugin_pp_dc_write_n = NULL;
}
static int read_gcr_block(unsigned char *se, unsigned char *gcrbuf)
{
unsigned char s[2];
SETSTATEDEBUG((void)0);
read_n(s, 2);
*se = s[1];
SETSTATEDEBUG((void)0);
read_n(s, 2);
if(s[1]) {
return s[1];
}
SETSTATEDEBUG(debugLibImgByteCount=0);
read_n(gcrbuf, GCRBUFSIZE);
SETSTATEDEBUG(debugLibImgByteCount=-1);
SETSTATEDEBUG((void)0);
return 0;
}
static int read_block(unsigned char tr, unsigned char se, unsigned char *block)
{
unsigned char status[2];
SETSTATEDEBUG((void)0);
status[0] = tr; status[1] = se;
write_n(status, 2);
#ifndef USE_CBM_IEC_WAIT
arch_usleep(20000);
#endif
SETSTATEDEBUG((void)0);
read_n(status, 2);
SETSTATEDEBUG(debugLibImgByteCount=0);
read_n(block, BLOCKSIZE);
SETSTATEDEBUG(debugLibImgByteCount=-1);
SETSTATEDEBUG((void)0);
return status[1];
}
static int read_block(unsigned char tr, unsigned char se, unsigned char *block)
{
char cmd[48];
int rv = 1;
sprintf(cmd, "U1:2 0 %d %d", tr, se);
if(cbm_exec_command(fd_cbm, drive, cmd, 0) == 0) {
rv = cbm_device_status(fd_cbm, drive, cmd, sizeof(cmd));
if(rv == 0) {
if(cbm_exec_command(fd_cbm, drive, "B-P2 0", 0) == 0) {
if(cbm_talk(fd_cbm, drive, 2) == 0) {
SETSTATEDEBUG(debugLibImgByteCount=0);
rv = cbm_raw_read(fd_cbm, block, BLOCKSIZE) != BLOCKSIZE;
SETSTATEDEBUG(debugLibImgByteCount=-1);
cbm_untalk(fd_cbm);
}
}
}
}
return rv;
}
static int write_block(unsigned char tr, unsigned char se, const unsigned char *blk, int size, int read_status)
{
int i = 0;
unsigned char status[2];
SETSTATEDEBUG((void)0);
status[0] = tr; status[1] = se;
write_n(status, 2);
SETSTATEDEBUG((void)0);
/* send first byte twice if length is odd */
if(size % 2) {
write_n(blk, 2);
i = 1;
}
SETSTATEDEBUG(debugLibImgByteCount=0);
write_n(blk+i, size-i);
SETSTATEDEBUG(debugLibImgByteCount=-1);
#ifndef USE_CBM_IEC_WAIT
if(size == BLOCKSIZE) {
arch_usleep(20000);
}
#endif
SETSTATEDEBUG((void)0);
read_n(status, 2);
SETSTATEDEBUG((void)0);
return status[1];
}
static int write_block(unsigned char tr, unsigned char se, const unsigned char *blk, int size, int read_status)
{
char cmd[48];
int rv = 1;
if(cbm_exec_command(fd_cbm, drive, "B-P2 0", 0) == 0)
{
if(cbm_listen(fd_cbm, drive, 2) == 0)
{
SETSTATEDEBUG(debugLibImgByteCount=0);
rv = cbm_raw_write(fd_cbm, blk, size) != size;
SETSTATEDEBUG(debugLibImgByteCount=-1);
cbm_unlisten(fd_cbm);
if(rv == 0)
{
sprintf(cmd ,"U2:2 0 %d %d", tr, se);
cbm_exec_command(fd_cbm, drive, cmd, 0);
rv = cbm_device_status(fd_cbm, drive, cmd, sizeof(cmd));
}
}
}
return rv;
}
static int send_track_map(imgcopy_settings *settings, unsigned char tr, const char *trackmap, unsigned char count)
{
int i, size;
unsigned char *data;
size = imgcopy_sector_count(settings, tr);
data = malloc(2+2*size);
data[0] = tr;
data[1] = count;
/* build track map */
for(i = 0; i < size; i++)
data[2+2*i] = data[2+2*i+1] = !NEED_SECTOR(trackmap[i]);
write_n(data, 2*size+2);
free(data);
SETSTATEDEBUG((void)0);
return 0;
}
static int open_disk(CBM_FILE fd, imgcopy_settings *settings,
const void *arg, int for_writing,
turbo_start start, imgcopy_message_cb message_cb)
{
unsigned char d = (unsigned char)(ULONG_PTR)arg;
const unsigned char *drive_prog;
int prog_size;
fd_cbm = fd;
two_sided = settings->two_sided;
opencbm_plugin_pp_dc_read_n = cbm_get_plugin_function_address("opencbm_plugin_pp_dc_read_n");
opencbm_plugin_pp_dc_write_n = cbm_get_plugin_function_address("opencbm_plugin_pp_dc_write_n");
if(settings->drive_type != cbm_dt_cbm1541)
{
drive_prog = pp1571_drive_prog;
prog_size = sizeof(pp1571_drive_prog);
}
else
{
drive_prog = pp1541_drive_prog;
prog_size = sizeof(pp1541_drive_prog);
}
SETSTATEDEBUG((void)0);
/* make sure the XP1541 portion of the cable is in input mode */
cbm_pp_read(fd_cbm);
SETSTATEDEBUG((void)0);
cbm_upload(fd_cbm, d, 0x700, drive_prog, prog_size);
SETSTATEDEBUG((void)0);
start(fd, d);
SETSTATEDEBUG((void)0);
pp_check_direction(PP_READ);
SETSTATEDEBUG((void)0);
cbm_iec_set(fd_cbm, IEC_CLOCK);
SETSTATEDEBUG((void)0);
cbm_iec_wait(fd_cbm, IEC_DATA, 1);
SETSTATEDEBUG((void)0);
return 0;
}
//
// entry point :: write image file
//
int imgcopy_write_image(CBM_FILE cbm_fd,
imgcopy_settings *settings,
const char *src_image,
int dst_drive,
imgcopy_message_cb msg_cb,
imgcopy_status_cb stat_cb)
{
const transfer_funcs *src;
const transfer_funcs *dst;
message_cb = msg_cb;
status_cb = stat_cb;
src = &imgcopy_fs_transfer;
dst = transfers[settings->transfer_mode].trf;
imgcopy_set_image_type(settings, src_image);
SETSTATEDEBUG((void)0);
return copy_disk(cbm_fd, settings,
src, (void*)src_image, dst, (void*)(ULONG_PTR)dst_drive, (unsigned char) dst_drive);
}
static int copy_disk(CBM_FILE fd_cbm, imgcopy_settings *settings,
const transfer_funcs *src, const void *src_arg,
const transfer_funcs *dst, const void *dst_arg, unsigned char cbm_drive)
{
unsigned char tr = 0;
unsigned char se = 0;
int st;
int cnt = 0;
unsigned char scnt = 0;
unsigned char errors;
int retry_count;
int resend_trackmap;
char trackmap[MAX_SECTORS+1];
char buf[40];
//unsigned const char *bam_ptr;
unsigned char bam[BLOCKSIZE *5];
int bam_count;
unsigned char block[BLOCKSIZE];
//unsigned char gcr[GCRBUFSIZE];
const transfer_funcs *cbm_transf = NULL;
imgcopy_status status;
const char *type_str = "*unknown*";
if(settings->drive_type == cbm_dt_unknown )
{
message_cb( 2, "Trying to identify drive type" );
if( cbm_identify( fd_cbm, cbm_drive, &settings->drive_type, NULL ) )
{
message_cb( 0, "could not identify device" );
}
switch( settings->drive_type )
{
case cbm_dt_cbm1541:
case cbm_dt_cbm1570:
case cbm_dt_cbm1571:
case cbm_dt_cbm4040:
message_cb( 0, "drive is not supported" );
return -1;
case cbm_dt_cbm1581:
case cbm_dt_cbm8050:
case cbm_dt_cbm8250:
case cbm_dt_sfd1001:
/* fine */
break;
default:
message_cb( 1, "Unknown drive, assuming 8250" );
settings->drive_type = cbm_dt_cbm8250;
break;
}
}
if(settings->two_sided == -1)
{
// set default
switch( settings->drive_type )
{
case cbm_dt_cbm8250:
case cbm_dt_sfd1001:
settings->two_sided = 1;
break;
case cbm_dt_cbm8050:
case cbm_dt_cbm1581:
default:
settings->two_sided = 0;
break;
}
}
if(imgcopy_set_image_type(settings, NULL))
{
message_cb(0, "invalid imagetype for this drive type");
return -1;
}
if(imgcopy_sector_count(settings, 1) < 0)
{
message_cb(0, "invalid drive or image type");
return -1;
}
if(settings->interleave != -1 &&
(settings->interleave < 1 || settings->interleave > 24))
{
message_cb(0,
"invalid value (%d) for interleave", settings->interleave);
return -1;
}
if(settings->start_track < 1 || settings->start_track > settings->max_tracks)
{
message_cb(0,
"invalid value (%d) for start track. (MAXTRACKS=%d)", settings->start_track, settings->max_tracks);
return -1;
}
if(settings->end_track != -1 &&
(settings->end_track < settings->start_track ||
settings->end_track > settings->max_tracks))
{
message_cb(0,
"invalid value (%d) for end track. (MAXTRACKS=%d)", settings->end_track, settings->max_tracks);
return -1;
}
if(settings->interleave == -1)
{
switch( settings->drive_type )
{
case cbm_dt_cbm1581:
settings->interleave = 1; // always 1 cause track buffering
break;
case cbm_dt_cbm8050:
case cbm_dt_cbm8250:
case cbm_dt_sfd1001:
default:
settings->interleave = (dst->is_cbm_drive && settings->warp) ?
warp_write_interleave[settings->transfer_mode] :
default_interleave[settings->transfer_mode];
break;
}
assert(settings->interleave >= 0);
}
SETSTATEDEBUG((void)0);
cbm_exec_command(fd_cbm, cbm_drive, "I0:", 0);
SETSTATEDEBUG((void)0);
cnt = cbm_device_status(fd_cbm, cbm_drive, buf, sizeof(buf));
SETSTATEDEBUG((void)0);
switch( settings->drive_type )
{
case cbm_dt_cbm8050: type_str = "CBM-8050"; break;
case cbm_dt_cbm8250: type_str = "CBM-8250"; break;
case cbm_dt_sfd1001: type_str = "SFD-1001"; break;
case cbm_dt_cbm1581: type_str = "CBM-1581"; break;
default: type_str = "unknown"; break;
}
if(cnt == 66)
{
// illegal track or sector :: DOS error
if(settings->image_type == D80)
cnt = 0;
else
{
if(settings->image_type == D82)
{
//settings->image_type = D80;
//imgcopy_set_image_type(settings, NULL);
message_cb(1, "maybe a 8050 disk in a 8250 drive");
cnt = 0;
}
}
}
if(cnt)
{
// DOS error
message_cb(0, "drive %02d (%s): %s", cbm_drive, type_str, buf );
return -1;
}
message_cb(2, "drive %02d (%s)", cbm_drive, type_str);
if(settings->two_sided)
{
switch( settings->drive_type )
{
case cbm_dt_cbm8250:
case cbm_dt_sfd1001:
// ok
break;
default:
message_cb(0, "requires a two side drive");
return -1;
}
SETSTATEDEBUG((void)0);
}
switch( settings->drive_type )
{
case cbm_dt_cbm1541:
case cbm_dt_cbm1571:
if(settings->warp && (cbm_transf->read_gcr_block == NULL))
{
if(settings->warp>0)
message_cb(1, "`-w' for this transfer mode ignored");
settings->warp = 0;
}
break;
case cbm_dt_cbm1581:
case cbm_dt_cbm8050:
case cbm_dt_cbm8250:
case cbm_dt_sfd1001:
default:
if(settings->warp)
{
if(settings->warp>0)
message_cb(1, "drive type doesn't support warp mode");
settings->warp = 0;
}
break;
}
//
// Check if transfer mode is allowed
//
if(imgcopy_check_transfer_mode(settings))
{
message_cb(0, "transfer mode not allowed for this drive type");
return -1;
}
message_cb(2, "set transfer struc.");
SETSTATEDEBUG((void)0);
cbm_transf = src->is_cbm_drive ? src : dst;
settings->warp = settings->warp ? 1 : 0;
if(cbm_transf->needs_turbo)
{
int rc;
message_cb(2, "sending turbo drive code ...");
SETSTATEDEBUG((void)0);
// send_turbo(fd_cbm, cbm_drive, dst->is_cbm_drive, settings->warp, settings->drive_type == cbm_dt_cbm1541 ? 0 : 1);
if((rc=send_turbo(settings, fd_cbm, cbm_drive, dst->is_cbm_drive)) != 0)
{
message_cb(0, "error while upload of drive code (rc=%d)", rc);
return -1;
}
}
SETSTATEDEBUG((void)0);
message_cb(2, "open source disk.");
if(src->open_disk(fd_cbm, settings, src_arg, 0,
start_turbo, message_cb) == 0)
{
if(settings->end_track == -1)
{
settings->end_track = settings->max_tracks;
}
SETSTATEDEBUG((void)0);
message_cb(2, "open destination.");
if(dst->open_disk(fd_cbm, settings, dst_arg, 1,
start_turbo, message_cb) != 0)
{
message_cb(0, "can't open destination");
return -1;
}
}
else
{
message_cb(0, "can't open source");
return -1;
}
//message_cb(2, "set BAM buffer (%dx%d)", MAX_TRACKS, MAX_SECTORS);
memset(status.bam, bs_invalid, MAX_TRACKS * MAX_SECTORS);
if(settings->bam_mode != bm_ignore)
{
//message_cb(2, "reading BAM ...");
st = ReadBAM(settings, src, bam, &bam_count);
if(st)
{
message_cb(1, "failed to read BAM (%d), reading whole disk", st);
settings->bam_mode = bm_ignore;
}
}
SETSTATEDEBUG((void)0);
memset(&status, 0, sizeof(status));
/* setup BAM */
//message_cb(3, "setup BAM (%d tracks)", settings->max_tracks);
for(tr = 1; tr <= settings->max_tracks; tr++)
{
int sectorCount = imgcopy_sector_count(settings, tr);
//message_cb(2, "track %d, sector %d", tr, sectorCount);
if(tr < settings->start_track || tr > settings->end_track)
{
memset(status.bam[tr-1], bs_dont_copy, sectorCount);
}
else if(settings->bam_mode == bm_allocated ||
(settings->bam_mode == bm_save && (tr != settings->cat_track && tr != settings->bam_track )))
{
//message_cb(2, "offsets into BAM for track: tr=%d, se=%d", tr);
/*char lbuf[100];
gets(lbuf);*/
for(se = 0; se < sectorCount; se++)
{
if(ChkBAM(settings, bam, tr, se))
{
//printf("copy track: %d, sector: %d\n", tr, se);
status.bam[tr-1][se] = bs_must_copy;
status.total_sectors++;
}
else
{
//printf("don't copy track: %d, sector: %d\n", tr, se);
status.bam[tr-1][se] = bs_dont_copy;
}
}
}
else
{
status.total_sectors += sectorCount;
memset(status.bam[tr-1], bs_must_copy, sectorCount);
}
}
status.settings = settings;
status_cb(status);
message_cb(2, "copying tracks %d-%d (%d sectors)",
settings->start_track, settings->end_track, status.total_sectors);
//
// copy disk
//
SETSTATEDEBUG(debugLibImgBlockCount=0);
for(tr = 1; tr <= settings->max_tracks; tr++)
{
unsigned char sectorCount = (unsigned char) imgcopy_sector_count(settings, tr);
if(tr >= settings->start_track && tr <= settings->end_track)
{
memcpy(trackmap, status.bam[tr-1], sectorCount);
retry_count = settings->retries;
do
{
errors = resend_trackmap = 0;
// calc count of blocks to copy
scnt = sectorCount;
if(settings->bam_mode != bm_ignore)
{
for(se = 0; se < sectorCount; se++)
{
if(trackmap[se] != bs_must_copy)
{
scnt--;
}
}
}
//if(tr == 77) printf("scnt=%d\n", scnt);
if(scnt > 0 && settings->warp && src->is_cbm_drive)
{
SETSTATEDEBUG((void)0);
src->send_track_map(settings, tr, trackmap, scnt);
}
else
{
se = 0;
}
while(scnt > 0 && !resend_trackmap)
{
/* if(settings->warp && src->is_cbm_drive)
{
SETSTATEDEBUG((void)0);
status.read_result = src->read_gcr_block(&se, gcr);
if(status.read_result == 0)
{
SETSTATEDEBUG((void)0);
status.read_result = gcr_decode(gcr, block);
}
else
{
// mark all sectors not received so far
// ugly
errors = 0;
for(scnt = 0; scnt < sector_map[tr]; scnt++)
{
if(NEED_SECTOR(trackmap[scnt]) && scnt != se)
{
trackmap[scnt] = bs_error;
errors++;
}
}
resend_trackmap = 1;
}
}
else */
{
int se_max = sectorCount;
while(!NEED_SECTOR(trackmap[se]))
{
if(++se >= sectorCount) se = 0;
if(se_max-- <= 0) break;
}
if(se_max-- <= 0) break;
SETSTATEDEBUG(debugLibImgBlockCount++);
status.read_result = src->read_block(tr, se, block);
}
/*if(settings->warp && dst->is_cbm_drive)
{
SETSTATEDEBUG((void)0);
gcr_encode(block, gcr);
SETSTATEDEBUG(debugLibImgBlockCount++);
status.write_result =
dst->write_block(tr, se, gcr, GCRBUFSIZE-1,
status.read_result);
}
else */
{
SETSTATEDEBUG(debugLibImgBlockCount++);
status.write_result =
dst->write_block(tr, se, block, BLOCKSIZE,
status.read_result);
}
SETSTATEDEBUG((void)0);
if(status.read_result)
{
/* read error */
trackmap[se] = bs_error;
errors++;
if(retry_count == 0)
{
status.sectors_processed++;
/* FIXME: shall we get rid of this? */
message_cb( 1, "read error: %02x/%02x: %d",
tr, se, status.read_result );
}
}
else
{
/* successfull read */
if(status.write_result)
{
/* write error */
trackmap[se] = bs_error;
errors++;
if(retry_count == 0)
{
status.sectors_processed++;
/* FIXME: shall we get rid of this? */
message_cb(1, "write error: %02x/%02x: %d",
tr, se, status.write_result);
}
}
else
{
/* successfull read and write, mark sector */
trackmap[se] = bs_copied;
cnt++;
status.sectors_processed++;
}
}
/* remaining sectors on this track */
if(!resend_trackmap)
{
scnt--;
}
status.track = tr;
status.sector= se;
status_cb(status);
if(dst->is_cbm_drive || !settings->warp)
{
se += (unsigned char) settings->interleave;
if(se >= sectorCount) se -= sectorCount;
}
}
//if(tr == 77) printf("after while\n");
if(errors > 0)
{
retry_count--;
scnt = errors;
}
} while(retry_count >= 0 && errors > 0);
//if(tr == 77) printf("after do\n");
if(errors)
{
message_cb(1, "giving up...");
}
}
if(settings->two_sided)
{
if(tr <= D80_TRACKS)
{
if(tr + D80_TRACKS <= D82_TRACKS)
{
tr += (D80_TRACKS -1);
}
}
else if(tr != D82_TRACKS)
{
tr -= D80_TRACKS;
}
}
//message_cb(2, "track: %d, maxtrack=%d", tr, settings->max_tracks);
}
message_cb(2, "finished imagecopy.");
SETSTATEDEBUG(debugLibImgBlockCount=-1);
dst->close_disk();
SETSTATEDEBUG((void)0);
src->close_disk();
SETSTATEDEBUG((void)0);
return cnt;
}
//
// stgart drive code at $0503
//
static int start_turbo(CBM_FILE fd, unsigned char drive)
{
SETSTATEDEBUG((void)0);
return cbm_exec_command(fd, drive, "U4:", 3);
}
static int
measure_2cyleJitter(CBM_FILE HandleDevice, unsigned char DeviceAddress,
unsigned char diskTrack, unsigned char sector, unsigned char count,
GroupOfMeasurements *pDeltaGroup,
int printDeltas)
{
char cmd[10];
unsigned char insts[40];
unsigned int mNo, timerValue, lastTvalue;
#if _MINMAX_VALUES_PRINTOUT
unsigned int dMin=~0, dMax=0;
#endif
struct Timer24bitValues T24Sample;
SETSTATEDEBUG((void)0);
#if _ASCII_PARAMETER_PASSING
// must be: "Ux <track> <sector>"
// sprintf(cmd, "U%c %d %d", ExecuteJobInBuffer, i, i & 0x0f);
sprintf(cmd, "U%c %d %d", ExecuteJobInBuffer, diskTrack, sector);
#else
// must be: "Ux<track><sector>" with directly encoded bytes
sprintf(cmd, "U%c%c%c", ExecuteJobInBuffer, diskTrack, sector);
#endif
pDeltaGroup->trueNumberOfIntervals = 0;
// for each track do 1 initialisation and then
// several measurements
timerValue = 0;
for(mNo = 0; mNo <= count; mNo++)
{
lastTvalue = timerValue;
#if _ASCII_PARAMETER_PASSING
if( cbm_exec_command(HandleDevice, DeviceAddress, cmd, strlen(cmd))
!= 0) return 1;
#else
if( cbm_exec_command(HandleDevice, DeviceAddress, cmd, 4)
!= 0) return 1;
#endif
SETSTATEDEBUG((void)0);
// wait for job to finish
if( cbm_device_status(HandleDevice, DeviceAddress, insts, sizeof(insts)) )
{
printf("%s\n", insts);
}
if( cbm_download(HandleDevice, DeviceAddress,
timerShotMain, (unsigned char *) & T24Sample,
sizeof(T24Sample))
!= sizeof(T24Sample)) return 1;
// read out sample that was shot by the jobcode
timerValue = reconstruct_v32bitInc(T24Sample);
if(mNo > 0){
lastTvalue = timerValue - lastTvalue;
// increase by the number of overflows
pDeltaGroup->trueNumberOfIntervals +=
(lastTvalue + 100000) / 200000;
if( printDeltas ) printf("%6u ", lastTvalue);
#if _MINMAX_VALUES_PRINTOUT
if(lastTvalue > dMax) dMax = lastTvalue;
if(lastTvalue < dMin) dMin = lastTvalue;
#endif
}
else
{
pDeltaGroup->startValue = timerValue;
if( printDeltas ) printf(" %10u ||", timerValue);
}
}
#if _MINMAX_VALUES_PRINTOUT
if( printDeltas ) printf(" %6u..%6u=%2u", dMin, dMax, dMax - dMin);
#endif
pDeltaGroup->endValue = timerValue;
return 0;
}
int ARCH_MAINDECL
main(int argc, char *argv[])
{
int status = 0;
char cmd[40];
unsigned char job = 1, begintrack = 1, endtrack = 35, retries = 5;
char c, *arg;
char *adapter = NULL;
int sector = 0, berror = 0;
struct option longopts[] =
{
{ "help" , no_argument , NULL, 'h' },
{ "version" , no_argument , NULL, 'V' },
{ "adapter" , required_argument, NULL, '@' },
{ "job" , no_argument , NULL, 'j' },
{ "retries" , required_argument, NULL, 'r' },
{ "extended" , no_argument , NULL, 'x' },
{ "retries" , required_argument, NULL, 'r' },
{ "begin-track", required_argument, NULL, 'b' },
{ "end-track" , required_argument, NULL, 'e' },
{ "sector" , required_argument, NULL, 'c' },
/*
{ "quiet" , no_argument , NULL, 'q' },
{ "verbose" , no_argument , NULL, 'v' },
{ "no-progress", no_argument , NULL, 'n' },
*/
{ NULL , 0 , NULL, 0 }
};
// const char shortopts[] ="hVj:sr:xb:e:c:qvn";
const char shortopts[] ="hVj:sxr:b:e:c:@:";
while((c=(unsigned char)getopt_long(argc, argv, shortopts, longopts, NULL)) != -1)
{
switch(c)
{
case 'h': help();
return 0;
case 'V': printf("cbmrpm41 Version %s\n", OPENCBM_VERSION ", built on " __DATE__ " at " __TIME__ "\n");
return 0;
case 'j': job = arch_atoc(optarg);
break;
case 's': status = 1;
break;
case 'x': begintrack = 1;
endtrack = 40;
break;
case 'r': retries = arch_atoc(optarg);
if(retries<1) retries = 1;
else if(retries>63) retries = 63;
break;
case 'b': begintrack = arch_atoc(optarg);
break;
case 'e': endtrack = arch_atoc(optarg);
break;
case 'c': sector = atoi(optarg);
break;
case '@': if (adapter == NULL)
adapter = cbmlibmisc_strdup(optarg);
else
{
fprintf(stderr, "--adapter/-@ given more than once.");
help();
return 0;
}
break;
default : hint(argv[0]);
return 1;
}
}
if(optind + 1 != argc)
{
fprintf(stderr, "Usage: %s [OPTION]... DRIVE\n", argv[0]);
hint(argv[0]);
return 1;
}
arg = argv[optind++];
drive = arch_atoc(arg);
if(drive < 8 || drive > 11)
{
fprintf(stderr, "Invalid drive number (%s)\n", arg);
return 1;
}
if(begintrack < 1)
{
fprintf(stderr, "Beginning track is less than 1, it should be 1 or greater.\n");
return 1;
}
if(endtrack > 42)
{
fprintf(stderr, "Ending track is greater than 42, it should be 42 or less.\n");
return 1;
}
if(begintrack > endtrack)
{
fprintf(stderr, "Beginning track is greater than ending track, it should be less or equal.");
return 1;
}
if(sector < 0)
{
fprintf(stderr, "Sector numbers less than zero are not allowed.");
return 1;
}
SETSTATEDEBUG((void)0);
printf("Please remove any diskettes used with production data on it. Insert a freshly\n"
"formatted disk into drive %d; you can format a disk with e.g. the command:\n\n"
" cbmforng -o -v %d freshdisk,fd\n\n"
"If you desperately need to examine a production disk or even an original\n"
"diskette, then please protect the disk with a write protect adhesive label.\n\n"
"Press <Enter>, when ready or press <CTRL>-C to abort.\r", drive, drive);
getchar();
if(cbm_driver_open_ex(&fd, adapter) == 0) do
{
arch_set_ctrlbreak_handler(handle_CTRL_C);
SETSTATEDEBUG((void)0);
if( cbm_upload(fd, drive, sizeof(cbmDev_StartAddress), cbmrpm41, sizeof(cbmrpm41))
!= sizeof(cbmrpm41)) break;
// location of the new U vector user commands table
sprintf(cmd, "%c%c", UcmdTblAddr & 0xFF, UcmdTblAddr >> 8);
// install the new U vector table
SETSTATEDEBUG((void)0);
if( cbm_upload(fd, drive, sizeof(cbmDev_UxCMDtVector), cmd, 2)
!= 2) break;
// execute Ux command behind the symbolic name Init23_BitTimersStd
SETSTATEDEBUG((void)0);
if( cbm_sendUxCommand(fd, drive, Init23_BitTimersStd)
!= 0) break;
// read disk ID and initialise other parameters
// from the currently inserted disk into the
// drive's RAM locations
SETSTATEDEBUG((void)0);
if( cbm_exec_command(fd, drive, "I0", 2)
!= 0) break;
SETSTATEDEBUG((void)0);
berror = cbm_device_status(fd, drive, cmd, sizeof(cmd));
if(berror && status)
{
printf("%s\n", cmd);
}
switch(job)
{
case 4:
if( do_RPMadjustment (begintrack, endtrack, sector, retries)
!= 0 ) continue; // jump to begin of do{}while(0);
break;
case 3:
if( do_RPMregression (begintrack, endtrack, sector, retries)
!= 0 ) continue; // jump to begin of do{}while(0);
break;
case 2:
if( do_SKEWmeasurment(begintrack, endtrack, sector, retries)
!= 0 ) continue; // jump to begin of do{}while(0);
break;
default:
if( do_RPMmeasurment (begintrack, endtrack, sector, retries)
!= 0 ) continue; // jump to begin of do{}while(0);
}
if( cbm_sendUxCommand(fd, drive, ResetVIA2ShiftRegConfig)
!= 0 ) break;
if( cbm_sendUxCommand(fd, drive, ResetUxVectorTable)
!= 0 ) break;
if( cbm_exec_command(fd, drive, "I", 2)
!= 0 ) break;
if(!berror && status)
{
cbm_device_status(fd, drive, cmd, sizeof(cmd));
printf("%s\n", cmd);
}
cbm_driver_close(fd);
cbmlibmisc_strfree(adapter);
return 0;
} while(0);
else
{
