Changeset 2f2a597 in rtems for c/src/lib/libbsp/i386/go32/timer/timer.c

Timestamp:

07/24/95 14:00:27 (28 years ago)

Author:

Joel Sherrill <joel.sherrill@…>

Branches:

4.10, 4.11, 4.8, 4.9, 5, master

Children:

c35e9622

Parents:

1690c6b

Message:

hopefully works with regular timer and tm27

File:

• c/src/lib/libbsp/i386/go32/timer/timer.c (modified) (2 diffs)

c/src/lib/libbsp/i386/go32/timer/timer.c

@@ -35 +35 @@
     return result;
 }
-static void restore_timer( void )
+#else
+extern rtems_isr timerisr();
+static rtems_isr_entry Old_Ticker;
+#endif
+
+static void Timer_exit( void )
 {
+#if defined(pentium)
     CLOCK_ENABLE();
+#else /* pentium */
+    extern void rtc_set_dos_date( void );
+
+    /* reset to DOS value: */
+    outport_byte( TIMER_MODE, TIMER_SEL0|TIMER_16BIT|TIMER_RATEGEN );
+    outport_byte( TIMER_CNTR0, 0 );
+    outport_byte( TIMER_CNTR0, 0 );
+
+    /* reset time-of-day */
+    rtc_set_dos_date();
+        
+    /* re-enable old handler: assume it was one of ours */
+    set_vector( (rtems_isr_entry)Old_Ticker, 0x8, 0 );
+#endif /* pentium */
 }
-#else /* pentium */
-rtems_isr timerisr();
-
-#define TIMER_ISR_US  10000
-
-#endif /* pentium */
 
 void Timer_initialize()
 {
+    extern int atexit( void (*)(void) );
+
     static int First = 1;
-#if defined(pentium)
-    if ( First )  {
-        extern int atexit( void (*)(void) );
-        First = 0;
-        /* Disable the programmable timer. */
-        CLOCK_DISABLE();
-        /* Try not to hose the system on return to DOS. */
-        atexit( restore_timer );
-    }
-    Ttimer_val = rdtsc();
-#else /* pentium */
-
-#define WAIT() \
-  { \
-    Ttimer_val = 0; \
-    while ( Ttimer_val == 0 ) \
-      continue; \
-    Ttimer_val = 0; \
-  }
 
     if ( First )  {
         First = 0;
 
-        /* install ISR */
-        set_vector( timerisr, 0x8, 0 );
+        /* Try not to hose the system on return to DOS. */
+        atexit( Timer_exit );
 
-       /* Wait for ISR to be called at least once */
-       WAIT();
+#if defined(pentium)
+        /* Disable the programmable timer so ticks don't interfere. */
+        CLOCK_DISABLE();
+#else /* pentium */
+        /* install a timer ISR */
+        Old_Ticker = (rtems_isr_entry) set_vector( timerisr, 0x8, 0 );
 
-       /* load timer for TIMER_ISR_US microsecond period */
-       outport_byte( TIMER_MODE, TIMER_SEL0|TIMER_16BIT|TIMER_RATEGEN );
-       outport_byte( TIMER_CNTR0, US_TO_TICK(TIMER_ISR_US) >> 0 & 0xff);
-       outport_byte( TIMER_CNTR0, US_TO_TICK(TIMER_ISR_US) >> 8 & 0xff);
+        /* Wait for ISR to be called at least once */
+        Ttimer_val = 0;
+        while ( Ttimer_val == 0 )
+            continue;
+
+        /* load timer for 250 microsecond period */
+        outport_byte( TIMER_MODE, TIMER_SEL0|TIMER_16BIT|TIMER_RATEGEN );
+        outport_byte( TIMER_CNTR0, US_TO_TICK(250) >> 0 & 0xff );
+        outport_byte( TIMER_CNTR0, US_TO_TICK(250) >> 8 & 0xff );
+#endif /* PENTIUM */
     }
-
+#if defined(pentium)
+    Ttimer_val = rdtsc();       /* read starting time */
+#else
     /* Wait for ISR to be called at least once */
-    WAIT();
-#endif /* PENTIUM */
+    asm( "sti" );
+    Ttimer_val = 0;
+    while ( Ttimer_val == 0 )
+        continue;
+    Ttimer_val = 0;
+#endif
 }
 
@@ -105 +118 @@
     inport_byte( TIMER_CNTR0, msb );
     clicks = msb << 8 | lsb;
-    total = (Ttimer_val * TIMER_ISR_US) + (TIMER_ISR_US - TICK_TO_US( clicks ));
+    total = Ttimer_val + 250 - TICK_TO_US( clicks );
 #endif /* pentium */