src/mess/machine/c1541.c
| r7326 | r7327 | |
| 284 | 284 | } |
| 285 | 285 | |
| 286 | 286 | /*------------------------------------------------- |
| 287 | read_current_track - read track from disk |
| 288 | -------------------------------------------------*/ |
| 289 | |
| 290 | static void read_current_track(c1541_t *c1541) |
| 291 | { |
| 292 | c1541->track_len = G64_BUFFER_SIZE; |
| 293 | c1541->buffer_pos = G64_DATA_START; |
| 294 | c1541->bit_pos = 7; |
| 295 | c1541->bit_count = 0; |
| 296 | |
| 297 | /* read track data */ |
| 298 | floppy_drive_read_track_data_info_buffer(c1541->image, 0, c1541->track_buffer, &c1541->track_len); |
| 299 | |
| 300 | /* extract track length */ |
| 301 | c1541->track_len = G64_DATA_START + ((c1541->track_buffer[1] << 8) | c1541->track_buffer[0]); |
| 302 | } |
| 303 | |
| 304 | /*------------------------------------------------- |
| 305 | spindle_motor - spindle motor control |
| 306 | -------------------------------------------------*/ |
| 307 | |
| 308 | static void spindle_motor(c1541_t *c1541, int mtr) |
| 309 | { |
| 310 | if (c1541->mtr != mtr) |
| 311 | { |
| 312 | if (mtr) |
| 313 | { |
| 314 | /* read track data */ |
| 315 | read_current_track(c1541); |
| 316 | } |
| 317 | |
| 318 | floppy_mon_w(c1541->image, !mtr); |
| 319 | timer_enable(c1541->bit_timer, mtr); |
| 320 | |
| 321 | c1541->mtr = mtr; |
| 322 | } |
| 323 | } |
| 324 | |
| 325 | /*------------------------------------------------- |
| 326 | step_motor - stepper motor control |
| 327 | -------------------------------------------------*/ |
| 328 | |
| 329 | static void step_motor(c1541_t *c1541, int mtr, int stp) |
| 330 | { |
| 331 | if (mtr & (c1541->stp != stp)) |
| 332 | { |
| 333 | int tracks = 0; |
| 334 | |
| 335 | switch (c1541->stp) |
| 336 | { |
| 337 | case 0: if (stp == 1) tracks++; else if (stp == 3) tracks--; break; |
| 338 | case 1: if (stp == 2) tracks++; else if (stp == 0) tracks--; break; |
| 339 | case 2: if (stp == 3) tracks++; else if (stp == 1) tracks--; break; |
| 340 | case 3: if (stp == 0) tracks++; else if (stp == 2) tracks--; break; |
| 341 | } |
| 342 | |
| 343 | if (tracks != 0) |
| 344 | { |
| 345 | /* step read/write head */ |
| 346 | floppy_drive_seek(c1541->image, tracks); |
| 347 | |
| 348 | /* read new track data */ |
| 349 | read_current_track(c1541); |
| 350 | } |
| 351 | |
| 352 | c1541->stp = stp; |
| 353 | } |
| 354 | } |
| 355 | |
| 356 | /*------------------------------------------------- |
| 287 | 357 | c1541_iec_atn_w - serial bus attention |
| 288 | 358 | -------------------------------------------------*/ |
| 289 | 359 | |
| r7326 | r7327 | |
| 486 | 556 | c1541->atna = atna; |
| 487 | 557 | } |
| 488 | 558 | |
| 559 | static READ_LINE_DEVICE_HANDLER( atn_in_r ) |
| 560 | { |
| 561 | c1541_t *c1541 = get_safe_token(device->owner); |
| 562 | |
| 563 | return !cbm_iec_atn_r(c1541->bus); |
| 564 | } |
| 565 | |
| 489 | 566 | static const via6522_interface c1541_via0_intf = |
| 490 | 567 | { |
| 491 | 568 | DEVCB_HANDLER(via0_pa_r), |
| 492 | 569 | DEVCB_HANDLER(via0_pb_r), |
| 570 | DEVCB_LINE(atn_in_r), |
| 493 | 571 | DEVCB_NULL, |
| 494 | 572 | DEVCB_NULL, |
| 495 | 573 | DEVCB_NULL, |
| 496 | | DEVCB_NULL, |
| 497 | 574 | |
| 498 | 575 | DEVCB_NULL, |
| 499 | 576 | DEVCB_HANDLER(via0_pb_w), |
| 500 | | DEVCB_NULL, /* ATN IN */ |
| 501 | 577 | DEVCB_NULL, |
| 502 | 578 | DEVCB_NULL, |
| 503 | 579 | DEVCB_NULL, |
| 580 | DEVCB_NULL, |
| 504 | 581 | |
| 505 | 582 | DEVCB_LINE(via0_irq_w) |
| 506 | 583 | }; |
| r7326 | r7327 | |
| 535 | 612 | { |
| 536 | 613 | DEVCB_HANDLER(c1541c_via0_pa_r), |
| 537 | 614 | DEVCB_HANDLER(via0_pb_r), |
| 615 | DEVCB_LINE(atn_in_r), |
| 538 | 616 | DEVCB_NULL, |
| 539 | 617 | DEVCB_NULL, |
| 540 | 618 | DEVCB_NULL, |
| 541 | | DEVCB_NULL, |
| 542 | 619 | |
| 543 | 620 | DEVCB_NULL, |
| 544 | 621 | DEVCB_HANDLER(via0_pb_w), |
| 545 | | DEVCB_NULL, /* ATN IN */ |
| 546 | 622 | DEVCB_NULL, |
| 547 | 623 | DEVCB_NULL, |
| 548 | 624 | DEVCB_NULL, |
| 625 | DEVCB_NULL, |
| 549 | 626 | |
| 550 | 627 | DEVCB_LINE(via0_irq_w) |
| 551 | 628 | }; |
| r7326 | r7327 | |
| 731 | 808 | via6522_interface c1541_via1_intf |
| 732 | 809 | -------------------------------------------------*/ |
| 733 | 810 | |
| 734 | | static void read_current_track(c1541_t *c1541) |
| 735 | | { |
| 736 | | c1541->track_len = G64_BUFFER_SIZE; |
| 737 | | c1541->buffer_pos = G64_DATA_START; |
| 738 | | c1541->bit_pos = 7; |
| 739 | | c1541->bit_count = 0; |
| 740 | | |
| 741 | | /* read track data */ |
| 742 | | floppy_drive_read_track_data_info_buffer(c1541->image, 0, c1541->track_buffer, &c1541->track_len); |
| 743 | | |
| 744 | | /* extract track length */ |
| 745 | | c1541->track_len = G64_DATA_START + ((c1541->track_buffer[1] << 8) | c1541->track_buffer[0]); |
| 746 | | } |
| 747 | | |
| 748 | | static void spindle_motor(c1541_t *c1541, int mtr) |
| 749 | | { |
| 750 | | if (c1541->mtr != mtr) |
| 751 | | { |
| 752 | | if (mtr) |
| 753 | | { |
| 754 | | /* read track data */ |
| 755 | | read_current_track(c1541); |
| 756 | | } |
| 757 | | |
| 758 | | floppy_mon_w(c1541->image, !mtr); |
| 759 | | timer_enable(c1541->bit_timer, mtr); |
| 760 | | |
| 761 | | c1541->mtr = mtr; |
| 762 | | } |
| 763 | | } |
| 764 | | |
| 765 | | static void step_motor(c1541_t *c1541, int mtr, int stp) |
| 766 | | { |
| 767 | | if (mtr & (c1541->stp != stp)) |
| 768 | | { |
| 769 | | int tracks = 0; |
| 770 | | |
| 771 | | switch (c1541->stp) |
| 772 | | { |
| 773 | | case 0: if (stp == 1) tracks++; else if (stp == 3) tracks--; break; |
| 774 | | case 1: if (stp == 2) tracks++; else if (stp == 0) tracks--; break; |
| 775 | | case 2: if (stp == 3) tracks++; else if (stp == 1) tracks--; break; |
| 776 | | case 3: if (stp == 0) tracks++; else if (stp == 2) tracks--; break; |
| 777 | | } |
| 778 | | |
| 779 | | if (tracks != 0) |
| 780 | | { |
| 781 | | /* step read/write head */ |
| 782 | | floppy_drive_seek(c1541->image, tracks); |
| 783 | | |
| 784 | | /* read new track data */ |
| 785 | | read_current_track(c1541); |
| 786 | | } |
| 787 | | |
| 788 | | c1541->stp = stp; |
| 789 | | } |
| 790 | | } |
| 791 | | |
| 792 | 811 | static WRITE_LINE_DEVICE_HANDLER( via1_irq_w ) |
| 793 | 812 | { |
| 794 | 813 | c1541_t *c1541 = get_safe_token(device->owner); |