Previous 15994 Revisions Next

r7327 Thursday 11th February, 2010 at 17:37:38 UTC by Curt Coder
[C1541] Added ATN IN reads.
[src/mess/machine]c1541.c

src/mess/machine/c1541.c
r7326r7327
284284}
285285
286286/*-------------------------------------------------
287    read_current_track - read track from disk
288-------------------------------------------------*/
289
290static 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
308static 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
329static 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/*-------------------------------------------------
287357    c1541_iec_atn_w - serial bus attention
288358-------------------------------------------------*/
289359
r7326r7327
486556   c1541->atna = atna;
487557}
488558
559static 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
489566static const via6522_interface c1541_via0_intf =
490567{
491568   DEVCB_HANDLER(via0_pa_r),
492569   DEVCB_HANDLER(via0_pb_r),
570   DEVCB_LINE(atn_in_r),
493571   DEVCB_NULL,
494572   DEVCB_NULL,
495573   DEVCB_NULL,
496   DEVCB_NULL,
497574
498575   DEVCB_NULL,
499576   DEVCB_HANDLER(via0_pb_w),
500   DEVCB_NULL, /* ATN IN */
501577   DEVCB_NULL,
502578   DEVCB_NULL,
503579   DEVCB_NULL,
580   DEVCB_NULL,
504581
505582   DEVCB_LINE(via0_irq_w)
506583};
r7326r7327
535612{
536613   DEVCB_HANDLER(c1541c_via0_pa_r),
537614   DEVCB_HANDLER(via0_pb_r),
615   DEVCB_LINE(atn_in_r),
538616   DEVCB_NULL,
539617   DEVCB_NULL,
540618   DEVCB_NULL,
541   DEVCB_NULL,
542619
543620   DEVCB_NULL,
544621   DEVCB_HANDLER(via0_pb_w),
545   DEVCB_NULL, /* ATN IN */
546622   DEVCB_NULL,
547623   DEVCB_NULL,
548624   DEVCB_NULL,
625   DEVCB_NULL,
549626
550627   DEVCB_LINE(via0_irq_w)
551628};
r7326r7327
731808    via6522_interface c1541_via1_intf
732809-------------------------------------------------*/
733810
734static 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
748static 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
765static 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
792811static WRITE_LINE_DEVICE_HANDLER( via1_irq_w )
793812{
794813   c1541_t *c1541 = get_safe_token(device->owner);

Previous 15994 Revisions Next


© 1998-2018 The MESS Team