| 1 |
/* |
| 2 |
* IEC.cpp - IEC bus routines, 1541 emulation (DOS level) |
| 3 |
* |
| 4 |
* Frodo (C) 1994-1997,2002-2003 Christian Bauer |
| 5 |
* |
| 6 |
* This program is free software; you can redistribute it and/or modify |
| 7 |
* it under the terms of the GNU General Public License as published by |
| 8 |
* the Free Software Foundation; either version 2 of the License, or |
| 9 |
* (at your option) any later version. |
| 10 |
* |
| 11 |
* This program is distributed in the hope that it will be useful, |
| 12 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 14 |
* GNU General Public License for more details. |
| 15 |
* |
| 16 |
* You should have received a copy of the GNU General Public License |
| 17 |
* along with this program; if not, write to the Free Software |
| 18 |
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| 19 |
*/ |
| 20 |
|
| 21 |
/* |
| 22 |
* Notes: |
| 23 |
* ------ |
| 24 |
* |
| 25 |
* - There are three kinds of devices on the IEC bus: controllers, |
| 26 |
* listeners and talkers. We are always the controller and we |
| 27 |
* can additionally be either listener or talker. There can be |
| 28 |
* only one listener and one talker active at the same time (the |
| 29 |
* real IEC bus allows multiple listeners, but we don't). |
| 30 |
* - There is one Drive object for every emulated drive (8..11). |
| 31 |
* A pointer to one of them is stored in "listener"/"talker" |
| 32 |
* when talk()/listen() is called and is used by the functions |
| 33 |
* called afterwards. |
| 34 |
* - The Drive objects have four virtual functions so that the |
| 35 |
* interface to them is independent of their implementation: |
| 36 |
* Open() opens a channel |
| 37 |
* Close() closes a channel |
| 38 |
* Read() reads from a channel |
| 39 |
* Write() writes to a channel |
| 40 |
* - The EOI/EOF signal is special on the IEC bus in that it is |
| 41 |
* Sent before the last byte, not after it. |
| 42 |
*/ |
| 43 |
|
| 44 |
#include "sysdeps.h" |
| 45 |
|
| 46 |
#include "IEC.h" |
| 47 |
#include "1541fs.h" |
| 48 |
#include "1541d64.h" |
| 49 |
#include "1541t64.h" |
| 50 |
#include "Prefs.h" |
| 51 |
#include "Display.h" |
| 52 |
|
| 53 |
|
| 54 |
/* |
| 55 |
* Constructor: Initialize variables |
| 56 |
*/ |
| 57 |
|
| 58 |
IEC::IEC(C64Display *display) : the_display(display) |
| 59 |
{ |
| 60 |
int i; |
| 61 |
|
| 62 |
// Create drives 8..11 |
| 63 |
for (i=0; i<4; i++) |
| 64 |
drive[i] = NULL; // Important because UpdateLEDs is called from the drive constructors (via set_error) |
| 65 |
|
| 66 |
if (!ThePrefs.Emul1541Proc) |
| 67 |
for (i=0; i<4; i++) { |
| 68 |
if (ThePrefs.DriveType[i] == DRVTYPE_DIR) |
| 69 |
drive[i] = new FSDrive(this, ThePrefs.DrivePath[i]); |
| 70 |
else if (ThePrefs.DriveType[i] == DRVTYPE_D64) |
| 71 |
drive[i] = new D64Drive(this, ThePrefs.DrivePath[i]); |
| 72 |
else |
| 73 |
drive[i] = new T64Drive(this, ThePrefs.DrivePath[i]); |
| 74 |
} |
| 75 |
|
| 76 |
listener_active = talker_active = false; |
| 77 |
listening = false; |
| 78 |
} |
| 79 |
|
| 80 |
|
| 81 |
/* |
| 82 |
* Destructor: Delete drives |
| 83 |
*/ |
| 84 |
|
| 85 |
IEC::~IEC() |
| 86 |
{ |
| 87 |
for (int i=0; i<4; i++) |
| 88 |
delete drive[i]; |
| 89 |
} |
| 90 |
|
| 91 |
|
| 92 |
/* |
| 93 |
* Reset all drives |
| 94 |
*/ |
| 95 |
|
| 96 |
void IEC::Reset(void) |
| 97 |
{ |
| 98 |
for (int i=0; i<4; i++) |
| 99 |
if (drive[i] != NULL && drive[i]->Ready) |
| 100 |
drive[i]->Reset(); |
| 101 |
|
| 102 |
UpdateLEDs(); |
| 103 |
} |
| 104 |
|
| 105 |
|
| 106 |
/* |
| 107 |
* Preferences have changed, prefs points to new preferences, |
| 108 |
* ThePrefs still holds the previous ones. Check if drive settings |
| 109 |
* have changed. |
| 110 |
*/ |
| 111 |
|
| 112 |
void IEC::NewPrefs(Prefs *prefs) |
| 113 |
{ |
| 114 |
// Delete and recreate all changed drives |
| 115 |
for (int i=0; i<4; i++) |
| 116 |
if ((ThePrefs.DriveType[i] != prefs->DriveType[i]) || strcmp(ThePrefs.DrivePath[i], prefs->DrivePath[i]) || ThePrefs.Emul1541Proc != prefs->Emul1541Proc) { |
| 117 |
delete drive[i]; |
| 118 |
drive[i] = NULL; // Important because UpdateLEDs is called from drive constructors (via set_error()) |
| 119 |
if (!prefs->Emul1541Proc) { |
| 120 |
if (prefs->DriveType[i] == DRVTYPE_DIR) |
| 121 |
drive[i] = new FSDrive(this, prefs->DrivePath[i]); |
| 122 |
else if (prefs->DriveType[i] == DRVTYPE_D64) |
| 123 |
drive[i] = new D64Drive(this, prefs->DrivePath[i]); |
| 124 |
else |
| 125 |
drive[i] = new T64Drive(this, prefs->DrivePath[i]); |
| 126 |
} |
| 127 |
} |
| 128 |
|
| 129 |
UpdateLEDs(); |
| 130 |
} |
| 131 |
|
| 132 |
|
| 133 |
/* |
| 134 |
* Update drive LED display |
| 135 |
*/ |
| 136 |
|
| 137 |
void IEC::UpdateLEDs(void) |
| 138 |
{ |
| 139 |
if (drive[0] != NULL && drive[1] != NULL && drive[2] != NULL && drive[3] != NULL) |
| 140 |
the_display->UpdateLEDs(drive[0]->LED, drive[1]->LED, drive[2]->LED, drive[3]->LED); |
| 141 |
} |
| 142 |
|
| 143 |
|
| 144 |
/* |
| 145 |
* Output one byte |
| 146 |
*/ |
| 147 |
|
| 148 |
uint8 IEC::Out(uint8 byte, bool eoi) |
| 149 |
{ |
| 150 |
if (listener_active) { |
| 151 |
if (received_cmd == CMD_OPEN) |
| 152 |
return open_out(byte, eoi); |
| 153 |
if (received_cmd == CMD_DATA) |
| 154 |
return data_out(byte, eoi); |
| 155 |
return ST_TIMEOUT; |
| 156 |
} else |
| 157 |
return ST_TIMEOUT; |
| 158 |
} |
| 159 |
|
| 160 |
|
| 161 |
/* |
| 162 |
* Output one byte with ATN (Talk/Listen/Untalk/Unlisten) |
| 163 |
*/ |
| 164 |
|
| 165 |
uint8 IEC::OutATN(uint8 byte) |
| 166 |
{ |
| 167 |
received_cmd = sec_addr = 0; // Command is sent with secondary address |
| 168 |
switch (byte & 0xf0) { |
| 169 |
case ATN_LISTEN: |
| 170 |
listening = true; |
| 171 |
return listen(byte & 0x0f); |
| 172 |
case ATN_UNLISTEN: |
| 173 |
listening = false; |
| 174 |
return unlisten(); |
| 175 |
case ATN_TALK: |
| 176 |
listening = false; |
| 177 |
return talk(byte & 0x0f); |
| 178 |
case ATN_UNTALK: |
| 179 |
listening = false; |
| 180 |
return untalk(); |
| 181 |
} |
| 182 |
return ST_TIMEOUT; |
| 183 |
} |
| 184 |
|
| 185 |
|
| 186 |
/* |
| 187 |
* Output secondary address |
| 188 |
*/ |
| 189 |
|
| 190 |
uint8 IEC::OutSec(uint8 byte) |
| 191 |
{ |
| 192 |
if (listening) { |
| 193 |
if (listener_active) { |
| 194 |
sec_addr = byte & 0x0f; |
| 195 |
received_cmd = byte & 0xf0; |
| 196 |
return sec_listen(); |
| 197 |
} |
| 198 |
} else { |
| 199 |
if (talker_active) { |
| 200 |
sec_addr = byte & 0x0f; |
| 201 |
received_cmd = byte & 0xf0; |
| 202 |
return sec_talk(); |
| 203 |
} |
| 204 |
} |
| 205 |
return ST_TIMEOUT; |
| 206 |
} |
| 207 |
|
| 208 |
|
| 209 |
/* |
| 210 |
* Read one byte |
| 211 |
*/ |
| 212 |
|
| 213 |
uint8 IEC::In(uint8 *byte) |
| 214 |
{ |
| 215 |
if (talker_active && (received_cmd == CMD_DATA)) |
| 216 |
return data_in(byte); |
| 217 |
|
| 218 |
*byte = 0; |
| 219 |
return ST_TIMEOUT; |
| 220 |
} |
| 221 |
|
| 222 |
|
| 223 |
/* |
| 224 |
* Assert ATN (for Untalk) |
| 225 |
*/ |
| 226 |
|
| 227 |
void IEC::SetATN(void) |
| 228 |
{ |
| 229 |
// Only needed for real IEC |
| 230 |
} |
| 231 |
|
| 232 |
|
| 233 |
/* |
| 234 |
* Release ATN |
| 235 |
*/ |
| 236 |
|
| 237 |
void IEC::RelATN(void) |
| 238 |
{ |
| 239 |
// Only needed for real IEC |
| 240 |
} |
| 241 |
|
| 242 |
|
| 243 |
/* |
| 244 |
* Talk-attention turn-around |
| 245 |
*/ |
| 246 |
|
| 247 |
void IEC::Turnaround(void) |
| 248 |
{ |
| 249 |
// Only needed for real IEC |
| 250 |
} |
| 251 |
|
| 252 |
|
| 253 |
/* |
| 254 |
* System line release |
| 255 |
*/ |
| 256 |
|
| 257 |
void IEC::Release(void) |
| 258 |
{ |
| 259 |
// Only needed for real IEC |
| 260 |
} |
| 261 |
|
| 262 |
|
| 263 |
/* |
| 264 |
* Listen |
| 265 |
*/ |
| 266 |
|
| 267 |
uint8 IEC::listen(int device) |
| 268 |
{ |
| 269 |
if ((device >= 8) && (device <= 11)) { |
| 270 |
if ((listener = drive[device-8]) != NULL && listener->Ready) { |
| 271 |
listener_active = true; |
| 272 |
return ST_OK; |
| 273 |
} |
| 274 |
} |
| 275 |
|
| 276 |
listener_active = false; |
| 277 |
return ST_NOTPRESENT; |
| 278 |
} |
| 279 |
|
| 280 |
|
| 281 |
/* |
| 282 |
* Talk |
| 283 |
*/ |
| 284 |
|
| 285 |
uint8 IEC::talk(int device) |
| 286 |
{ |
| 287 |
if ((device >= 8) && (device <= 11)) { |
| 288 |
if ((talker = drive[device-8]) != NULL && talker->Ready) { |
| 289 |
talker_active = true; |
| 290 |
return ST_OK; |
| 291 |
} |
| 292 |
} |
| 293 |
|
| 294 |
talker_active = false; |
| 295 |
return ST_NOTPRESENT; |
| 296 |
} |
| 297 |
|
| 298 |
|
| 299 |
/* |
| 300 |
* Unlisten |
| 301 |
*/ |
| 302 |
|
| 303 |
uint8 IEC::unlisten(void) |
| 304 |
{ |
| 305 |
listener_active = false; |
| 306 |
return ST_OK; |
| 307 |
} |
| 308 |
|
| 309 |
|
| 310 |
/* |
| 311 |
* Untalk |
| 312 |
*/ |
| 313 |
|
| 314 |
uint8 IEC::untalk(void) |
| 315 |
{ |
| 316 |
talker_active = false; |
| 317 |
return ST_OK; |
| 318 |
} |
| 319 |
|
| 320 |
|
| 321 |
/* |
| 322 |
* Secondary address after Listen |
| 323 |
*/ |
| 324 |
|
| 325 |
uint8 IEC::sec_listen(void) |
| 326 |
{ |
| 327 |
switch (received_cmd) { |
| 328 |
|
| 329 |
case CMD_OPEN: // Prepare for receiving the file name |
| 330 |
name_ptr = name_buf; |
| 331 |
name_len = 0; |
| 332 |
return ST_OK; |
| 333 |
|
| 334 |
case CMD_CLOSE: // Close channel |
| 335 |
if (listener->LED != DRVLED_ERROR) { |
| 336 |
listener->LED = DRVLED_OFF; // Turn off drive LED |
| 337 |
UpdateLEDs(); |
| 338 |
} |
| 339 |
return listener->Close(sec_addr); |
| 340 |
} |
| 341 |
return ST_OK; |
| 342 |
} |
| 343 |
|
| 344 |
|
| 345 |
/* |
| 346 |
* Secondary address after Talk |
| 347 |
*/ |
| 348 |
|
| 349 |
uint8 IEC::sec_talk(void) |
| 350 |
{ |
| 351 |
return ST_OK; |
| 352 |
} |
| 353 |
|
| 354 |
|
| 355 |
/* |
| 356 |
* Byte after Open command: Store character in file name, open file on EOI |
| 357 |
*/ |
| 358 |
|
| 359 |
uint8 IEC::open_out(uint8 byte, bool eoi) |
| 360 |
{ |
| 361 |
if (name_len < NAMEBUF_LENGTH) { |
| 362 |
*name_ptr++ = byte; |
| 363 |
name_len++; |
| 364 |
} |
| 365 |
|
| 366 |
if (eoi) { |
| 367 |
*name_ptr = 0; // End string |
| 368 |
listener->LED = DRVLED_ON; // Turn on drive LED |
| 369 |
UpdateLEDs(); |
| 370 |
return listener->Open(sec_addr, name_buf, name_len); |
| 371 |
} |
| 372 |
|
| 373 |
return ST_OK; |
| 374 |
} |
| 375 |
|
| 376 |
|
| 377 |
/* |
| 378 |
* Write byte to channel |
| 379 |
*/ |
| 380 |
|
| 381 |
uint8 IEC::data_out(uint8 byte, bool eoi) |
| 382 |
{ |
| 383 |
return listener->Write(sec_addr, byte, eoi); |
| 384 |
} |
| 385 |
|
| 386 |
|
| 387 |
/* |
| 388 |
* Read byte from channel |
| 389 |
*/ |
| 390 |
|
| 391 |
uint8 IEC::data_in(uint8 *byte) |
| 392 |
{ |
| 393 |
return talker->Read(sec_addr, byte); |
| 394 |
} |
| 395 |
|
| 396 |
|
| 397 |
/* |
| 398 |
* Drive constructor |
| 399 |
*/ |
| 400 |
|
| 401 |
Drive::Drive(IEC *iec) |
| 402 |
{ |
| 403 |
the_iec = iec; |
| 404 |
LED = DRVLED_OFF; |
| 405 |
Ready = false; |
| 406 |
set_error(ERR_STARTUP); |
| 407 |
} |
| 408 |
|
| 409 |
|
| 410 |
/* |
| 411 |
* Set error message on drive |
| 412 |
*/ |
| 413 |
|
| 414 |
// 1541 error messages |
| 415 |
static const char *Errors_1541[] = { |
| 416 |
"00, OK,%02d,%02d\x0d", |
| 417 |
"01, FILES SCRATCHED,%02d,%02d\x0d", |
| 418 |
"03, UNIMPLEMENTED,%02d,%02d\x0d", |
| 419 |
"20, READ ERROR,%02d,%02d\x0d", |
| 420 |
"21, READ ERROR,%02d,%02d\x0d", |
| 421 |
"22, READ ERROR,%02d,%02d\x0d", |
| 422 |
"23, READ ERROR,%02d,%02d\x0d", |
| 423 |
"24, READ ERROR,%02d,%02d\x0d", |
| 424 |
"25, WRITE ERROR,%02d,%02d\x0d", |
| 425 |
"26, WRITE PROTECT ON,%02d,%02d\x0d", |
| 426 |
"27, READ ERROR,%02d,%02d\x0d", |
| 427 |
"28, WRITE ERROR,%02d,%02d\x0d", |
| 428 |
"29, DISK ID MISMATCH,%02d,%02d\x0d", |
| 429 |
"30, SYNTAX ERROR,%02d,%02d\x0d", |
| 430 |
"31, SYNTAX ERROR,%02d,%02d\x0d", |
| 431 |
"32, SYNTAX ERROR,%02d,%02d\x0d", |
| 432 |
"33, SYNTAX ERROR,%02d,%02d\x0d", |
| 433 |
"34, SYNTAX ERROR,%02d,%02d\x0d", |
| 434 |
"60, WRITE FILE OPEN,%02d,%02d\x0d", |
| 435 |
"61, FILE NOT OPEN,%02d,%02d\x0d", |
| 436 |
"62, FILE NOT FOUND,%02d,%02d\x0d", |
| 437 |
"63, FILE EXISTS,%02d,%02d\x0d", |
| 438 |
"64, FILE TYPE MISMATCH,%02d,%02d\x0d", |
| 439 |
"65, NO BLOCK,%02d,%02d\x0d", |
| 440 |
"66, ILLEGAL TRACK OR SECTOR,%02d,%02d\x0d", |
| 441 |
"70, NO CHANNEL,%02d,%02d\x0d", |
| 442 |
"71, DIR ERROR,%02d,%02d\x0d", |
| 443 |
"72, DISK FULL,%02d,%02d\x0d", |
| 444 |
"73, CBM DOS V2.6 1541,%02d,%02d\x0d", |
| 445 |
"74, DRIVE NOT READY,%02d,%02d\x0d" |
| 446 |
}; |
| 447 |
|
| 448 |
void Drive::set_error(int error, int track, int sector) |
| 449 |
{ |
| 450 |
// Write error message to buffer |
| 451 |
sprintf(error_buf, Errors_1541[error], track, sector); |
| 452 |
error_ptr = error_buf; |
| 453 |
error_len = strlen(error_buf); |
| 454 |
|
| 455 |
// Set drive condition |
| 456 |
if (error != ERR_OK && error != ERR_SCRATCHED) |
| 457 |
if (error == ERR_STARTUP) |
| 458 |
LED = DRVLED_OFF; |
| 459 |
else |
| 460 |
LED = DRVLED_ERROR; |
| 461 |
else if (LED == DRVLED_ERROR) |
| 462 |
LED = DRVLED_OFF; |
| 463 |
the_iec->UpdateLEDs(); |
| 464 |
} |
| 465 |
|
| 466 |
|
| 467 |
/* |
| 468 |
* Parse file name, determine access mode and file type |
| 469 |
*/ |
| 470 |
|
| 471 |
void Drive::parse_file_name(const uint8 *src, int src_len, uint8 *dest, int &dest_len, int &mode, int &type, int &rec_len, bool convert_charset) |
| 472 |
{ |
| 473 |
// If the string contains a ':', the file name starts after that |
| 474 |
const uint8 *p = (const uint8 *)memchr(src, ':', src_len); |
| 475 |
if (p) { |
| 476 |
p++; |
| 477 |
src_len -= p - src; |
| 478 |
} else |
| 479 |
p = src; |
| 480 |
|
| 481 |
// Transfer file name upto ',' |
| 482 |
dest_len = 0; |
| 483 |
uint8 *q = dest; |
| 484 |
while (*p != ',' && src_len-- > 0) { |
| 485 |
if (convert_charset) |
| 486 |
*q++ = petscii2ascii(*p++); |
| 487 |
else |
| 488 |
*q++ = *p++; |
| 489 |
dest_len++; |
| 490 |
} |
| 491 |
*q++ = 0; |
| 492 |
|
| 493 |
// Strip trailing CRs |
| 494 |
while (dest_len > 0 && dest[dest_len - 1] == 0x0d) |
| 495 |
dest[--dest_len] = 0; |
| 496 |
|
| 497 |
// Look for mode and type parameters separated by ',' |
| 498 |
p++; src_len--; |
| 499 |
while (src_len > 0) { |
| 500 |
switch (*p) { |
| 501 |
case 'D': |
| 502 |
type = FTYPE_DEL; |
| 503 |
break; |
| 504 |
case 'S': |
| 505 |
type = FTYPE_SEQ; |
| 506 |
break; |
| 507 |
case 'P': |
| 508 |
type = FTYPE_PRG; |
| 509 |
break; |
| 510 |
case 'U': |
| 511 |
type = FTYPE_USR; |
| 512 |
break; |
| 513 |
case 'L': |
| 514 |
type = FTYPE_REL; |
| 515 |
while (*p != ',' && src_len-- > 0) p++; |
| 516 |
p++; src_len--; |
| 517 |
rec_len = *p++; src_len--; |
| 518 |
if (src_len < 0) |
| 519 |
rec_len = 0; |
| 520 |
break; |
| 521 |
case 'R': |
| 522 |
mode = FMODE_READ; |
| 523 |
break; |
| 524 |
case 'W': |
| 525 |
mode = FMODE_WRITE; |
| 526 |
break; |
| 527 |
case 'A': |
| 528 |
mode = FMODE_APPEND; |
| 529 |
break; |
| 530 |
case 'M': |
| 531 |
mode = FMODE_M; |
| 532 |
break; |
| 533 |
} |
| 534 |
|
| 535 |
// Skip to ',' |
| 536 |
while (*p != ',' && src_len-- > 0) p++; |
| 537 |
p++; src_len--; |
| 538 |
} |
| 539 |
} |
| 540 |
|
| 541 |
|
| 542 |
/* |
| 543 |
* Execute DOS command (parse command and call appropriate routine) |
| 544 |
*/ |
| 545 |
|
| 546 |
static void parse_block_cmd_args(const uint8 *p, int &arg1, int &arg2, int &arg3, int &arg4) |
| 547 |
{ |
| 548 |
arg1 = arg2 = arg3 = arg4 = 0; |
| 549 |
|
| 550 |
while (*p == ' ' || *p == 0x1d || *p == ',') p++; |
| 551 |
while (*p >= '0' && *p < '@') |
| 552 |
arg1 = arg1 * 10 + (*p++ & 0x0f); |
| 553 |
|
| 554 |
while (*p == ' ' || *p == 0x1d || *p == ',') p++; |
| 555 |
while (*p >= '0' && *p < '@') |
| 556 |
arg2 = arg2 * 10 + (*p++ & 0x0f); |
| 557 |
|
| 558 |
while (*p == ' ' || *p == 0x1d || *p == ',') p++; |
| 559 |
while (*p >= '0' && *p < '@') |
| 560 |
arg3 = arg3 * 10 + (*p++ & 0x0f); |
| 561 |
|
| 562 |
while (*p == ' ' || *p == 0x1d || *p == ',') p++; |
| 563 |
while (*p >= '0' && *p < '@') |
| 564 |
arg4 = arg4 * 10 + (*p++ & 0x0f); |
| 565 |
} |
| 566 |
|
| 567 |
void Drive::execute_cmd(const uint8 *cmd, int cmd_len) |
| 568 |
{ |
| 569 |
// Strip trailing CRs |
| 570 |
while (cmd_len > 0 && cmd[cmd_len - 1] == 0x0d) |
| 571 |
cmd_len--; |
| 572 |
|
| 573 |
// Find token delimiters |
| 574 |
const uint8 *colon = (const uint8 *)memchr(cmd, ':', cmd_len); |
| 575 |
const uint8 *equal = colon ? (const uint8 *)memchr(colon, '=', cmd_len - (colon - cmd)) : NULL; |
| 576 |
const uint8 *comma = (const uint8 *)memchr(cmd, ',', cmd_len); |
| 577 |
const uint8 *minus = (const uint8 *)memchr(cmd, '-', cmd_len); |
| 578 |
|
| 579 |
// Parse command name |
| 580 |
set_error(ERR_OK); |
| 581 |
switch (cmd[0]) { |
| 582 |
case 'B': // Block/buffer |
| 583 |
if (!minus) |
| 584 |
set_error(ERR_SYNTAX31); |
| 585 |
else { |
| 586 |
// Parse arguments (up to 4 decimal numbers separated by |
| 587 |
// space, cursor right or comma) |
| 588 |
const uint8 *p = colon ? colon + 1 : cmd + 3; |
| 589 |
int arg1, arg2, arg3, arg4; |
| 590 |
parse_block_cmd_args(p, arg1, arg2, arg3, arg4); |
| 591 |
|
| 592 |
// Switch on command |
| 593 |
switch (minus[1]) { |
| 594 |
case 'R': |
| 595 |
block_read_cmd(arg1, arg3, arg4); |
| 596 |
break; |
| 597 |
case 'W': |
| 598 |
block_write_cmd(arg1, arg3, arg4); |
| 599 |
break; |
| 600 |
case 'E': |
| 601 |
block_execute_cmd(arg1, arg3, arg4); |
| 602 |
break; |
| 603 |
case 'A': |
| 604 |
block_allocate_cmd(arg2, arg3); |
| 605 |
break; |
| 606 |
case 'F': |
| 607 |
block_free_cmd(arg2, arg3); |
| 608 |
break; |
| 609 |
case 'P': |
| 610 |
buffer_pointer_cmd(arg1, arg2); |
| 611 |
break; |
| 612 |
default: |
| 613 |
set_error(ERR_SYNTAX31); |
| 614 |
break; |
| 615 |
} |
| 616 |
} |
| 617 |
break; |
| 618 |
|
| 619 |
case 'M': // Memory |
| 620 |
if (cmd[1] != '-') |
| 621 |
set_error(ERR_SYNTAX31); |
| 622 |
else { |
| 623 |
// Read parameters |
| 624 |
uint16 adr = uint8(cmd[3]) | (uint8(cmd[4]) << 8); |
| 625 |
uint8 len = uint8(cmd[5]); |
| 626 |
|
| 627 |
// Switch on command |
| 628 |
switch (cmd[2]) { |
| 629 |
case 'R': |
| 630 |
mem_read_cmd(adr, (cmd_len < 6) ? 1 : len); |
| 631 |
break; |
| 632 |
case 'W': |
| 633 |
mem_write_cmd(adr, len, (uint8 *)cmd + 6); |
| 634 |
break; |
| 635 |
case 'E': |
| 636 |
mem_execute_cmd(adr); |
| 637 |
break; |
| 638 |
default: |
| 639 |
set_error(ERR_SYNTAX31); |
| 640 |
break; |
| 641 |
} |
| 642 |
} |
| 643 |
break; |
| 644 |
|
| 645 |
case 'C': // Copy |
| 646 |
if (!colon) |
| 647 |
set_error(ERR_SYNTAX31); |
| 648 |
else if (!equal || memchr(cmd, '*', cmd_len) || memchr(cmd, '?', cmd_len) || (comma && comma < equal)) |
| 649 |
set_error(ERR_SYNTAX30); |
| 650 |
else |
| 651 |
copy_cmd(colon + 1, equal - colon - 1, equal + 1, cmd_len - (equal + 1 - cmd)); |
| 652 |
break; |
| 653 |
|
| 654 |
case 'R': // Rename |
| 655 |
if (!colon) |
| 656 |
set_error(ERR_SYNTAX34); |
| 657 |
else if (!equal || comma || memchr(cmd, '*', cmd_len) || memchr(cmd, '?', cmd_len)) |
| 658 |
set_error(ERR_SYNTAX30); |
| 659 |
else |
| 660 |
rename_cmd(colon + 1, equal - colon - 1, equal + 1, cmd_len - (equal + 1 - cmd)); |
| 661 |
break; |
| 662 |
|
| 663 |
case 'S': // Scratch |
| 664 |
if (!colon) |
| 665 |
set_error(ERR_SYNTAX34); |
| 666 |
else |
| 667 |
scratch_cmd(colon + 1, cmd_len - (colon + 1 - cmd)); |
| 668 |
break; |
| 669 |
|
| 670 |
case 'P': // Position |
| 671 |
position_cmd(cmd + 1, cmd_len - 1); |
| 672 |
break; |
| 673 |
|
| 674 |
case 'I': // Initialize |
| 675 |
initialize_cmd(); |
| 676 |
break; |
| 677 |
|
| 678 |
case 'N': // New (format) |
| 679 |
if (!colon) |
| 680 |
set_error(ERR_SYNTAX34); |
| 681 |
else |
| 682 |
new_cmd(colon + 1, comma ? (comma - colon - 1) : cmd_len - (colon + 1 - cmd), comma); |
| 683 |
break; |
| 684 |
|
| 685 |
case 'V': // Validate |
| 686 |
validate_cmd(); |
| 687 |
break; |
| 688 |
|
| 689 |
case 'U': // User |
| 690 |
if (cmd[1] == '0') |
| 691 |
break; |
| 692 |
switch (cmd[1] & 0x0f) { |
| 693 |
case 1: { // U1/UA: Read block |
| 694 |
const uint8 *p = colon ? colon + 1 : cmd + 2; |
| 695 |
int arg1, arg2, arg3, arg4; |
| 696 |
parse_block_cmd_args(p, arg1, arg2, arg3, arg4); |
| 697 |
block_read_cmd(arg1, arg3, arg4, true); |
| 698 |
break; |
| 699 |
} |
| 700 |
case 2: { // U2/UB: Write block |
| 701 |
const uint8 *p = colon ? colon + 1 : cmd + 2; |
| 702 |
int arg1, arg2, arg3, arg4; |
| 703 |
parse_block_cmd_args(p, arg1, arg2, arg3, arg4); |
| 704 |
block_write_cmd(arg1, arg3, arg4, true); |
| 705 |
break; |
| 706 |
} |
| 707 |
case 9: // U9/UI: C64/VC20 mode switch |
| 708 |
if (cmd[2] != '+' && cmd[2] != '-') |
| 709 |
Reset(); |
| 710 |
break; |
| 711 |
case 10: // U:/UJ: Reset |
| 712 |
Reset(); |
| 713 |
break; |
| 714 |
default: |
| 715 |
set_error(ERR_UNIMPLEMENTED); |
| 716 |
break; |
| 717 |
} |
| 718 |
break; |
| 719 |
|
| 720 |
default: |
| 721 |
set_error(ERR_SYNTAX31); |
| 722 |
break; |
| 723 |
} |
| 724 |
} |
| 725 |
|
| 726 |
// BLOCK-READ:channel,0,track,sector |
| 727 |
void Drive::block_read_cmd(int channel, int track, int sector, bool user_cmd) |
| 728 |
{ |
| 729 |
set_error(ERR_UNIMPLEMENTED); |
| 730 |
} |
| 731 |
|
| 732 |
// BLOCK-WRITE:channel,0,track,sector |
| 733 |
void Drive::block_write_cmd(int channel, int track, int sector, bool user_cmd) |
| 734 |
{ |
| 735 |
set_error(ERR_UNIMPLEMENTED); |
| 736 |
} |
| 737 |
|
| 738 |
// BLOCK-EXECUTE:channel,0,track,sector |
| 739 |
void Drive::block_execute_cmd(int channel, int track, int sector) |
| 740 |
{ |
| 741 |
set_error(ERR_UNIMPLEMENTED); |
| 742 |
} |
| 743 |
|
| 744 |
// BLOCK-ALLOCATE:0,track,sector |
| 745 |
void Drive::block_allocate_cmd(int track, int sector) |
| 746 |
{ |
| 747 |
set_error(ERR_UNIMPLEMENTED); |
| 748 |
} |
| 749 |
|
| 750 |
// BLOCK-FREE:0,track,sector |
| 751 |
void Drive::block_free_cmd(int track, int sector) |
| 752 |
{ |
| 753 |
set_error(ERR_UNIMPLEMENTED); |
| 754 |
} |
| 755 |
|
| 756 |
// BUFFER-POINTER:channel,pos |
| 757 |
void Drive::buffer_pointer_cmd(int channel, int pos) |
| 758 |
{ |
| 759 |
set_error(ERR_UNIMPLEMENTED); |
| 760 |
} |
| 761 |
|
| 762 |
// M-R<adr low><adr high>[<number>] |
| 763 |
void Drive::mem_read_cmd(uint16 adr, uint8 len) |
| 764 |
{ |
| 765 |
unsupp_cmd(); |
| 766 |
error_ptr = error_buf; |
| 767 |
error_buf[0] = 0; |
| 768 |
error_len = 0; |
| 769 |
set_error(ERR_OK); |
| 770 |
} |
| 771 |
|
| 772 |
// M-W<adr low><adr high><number><data...> |
| 773 |
void Drive::mem_write_cmd(uint16 adr, uint8 len, uint8 *p) |
| 774 |
{ |
| 775 |
set_error(ERR_UNIMPLEMENTED); |
| 776 |
} |
| 777 |
|
| 778 |
// M-E<adr low><adr high> |
| 779 |
void Drive::mem_execute_cmd(uint16 adr) |
| 780 |
{ |
| 781 |
set_error(ERR_UNIMPLEMENTED); |
| 782 |
} |
| 783 |
|
| 784 |
// COPY:new=file1,file2,... |
| 785 |
// ^ ^ |
| 786 |
// new_file old_files |
| 787 |
void Drive::copy_cmd(const uint8 *new_file, int new_file_len, const uint8 *old_files, int old_files_len) |
| 788 |
{ |
| 789 |
set_error(ERR_UNIMPLEMENTED); |
| 790 |
} |
| 791 |
|
| 792 |
// RENAME:new=old |
| 793 |
// ^ ^ |
| 794 |
// new_file old_file |
| 795 |
void Drive::rename_cmd(const uint8 *new_file, int new_file_len, const uint8 *old_file, int old_file_len) |
| 796 |
{ |
| 797 |
set_error(ERR_UNIMPLEMENTED); |
| 798 |
} |
| 799 |
|
| 800 |
// SCRATCH:file1,file2,... |
| 801 |
// ^ |
| 802 |
// files |
| 803 |
void Drive::scratch_cmd(const uint8 *files, int files_len) |
| 804 |
{ |
| 805 |
set_error(ERR_UNIMPLEMENTED); |
| 806 |
} |
| 807 |
|
| 808 |
// P<channel><record low><record high><byte> |
| 809 |
// ^ |
| 810 |
// cmd |
| 811 |
void Drive::position_cmd(const uint8 *cmd, int cmd_len) |
| 812 |
{ |
| 813 |
set_error(ERR_UNIMPLEMENTED); |
| 814 |
} |
| 815 |
|
| 816 |
// INITIALIZE |
| 817 |
void Drive::initialize_cmd(void) |
| 818 |
{ |
| 819 |
set_error(ERR_UNIMPLEMENTED); |
| 820 |
} |
| 821 |
|
| 822 |
// NEW:name,id |
| 823 |
// ^ ^ |
| 824 |
// name comma (or NULL) |
| 825 |
void Drive::new_cmd(const uint8 *name, int name_len, const uint8 *comma) |
| 826 |
{ |
| 827 |
set_error(ERR_UNIMPLEMENTED); |
| 828 |
} |
| 829 |
|
| 830 |
// VALIDATE |
| 831 |
void Drive::validate_cmd(void) |
| 832 |
{ |
| 833 |
set_error(ERR_UNIMPLEMENTED); |
| 834 |
} |
| 835 |
|
| 836 |
|
| 837 |
/* |
| 838 |
* Notice user of unsupported drive command |
| 839 |
*/ |
| 840 |
|
| 841 |
void Drive::unsupp_cmd(void) |
| 842 |
{ |
| 843 |
} |
| 844 |
|
| 845 |
|
| 846 |
/* |
| 847 |
* Convert PETSCII<->ASCII |
| 848 |
*/ |
| 849 |
|
| 850 |
char ascii2petscii(char c) |
| 851 |
{ |
| 852 |
if ((c >= 'A') && (c <= 'Z') || (c >= 'a') && (c <= 'z')) |
| 853 |
return c ^ 0x20; |
| 854 |
return c; |
| 855 |
} |
| 856 |
|
| 857 |
void ascii2petscii(char *dest, const char *src, int n) |
| 858 |
{ |
| 859 |
while (n-- && (*dest++ = ascii2petscii(*src++))) ; |
| 860 |
} |
| 861 |
|
| 862 |
char petscii2ascii(uint8 c) |
| 863 |
{ |
| 864 |
if ((c >= 'A') && (c <= 'Z') || (c >= 'a') && (c <= 'z')) |
| 865 |
return c ^ 0x20; |
| 866 |
if ((c >= 0xc1) && (c <= 0xda)) |
| 867 |
return c ^ 0x80; |
| 868 |
return c; |
| 869 |
} |
| 870 |
|
| 871 |
void petscii2ascii(char *dest, const char *src, int n) |
| 872 |
{ |
| 873 |
while (n-- && (*dest++ = petscii2ascii(*src++))) ; |
| 874 |
} |
