arch/ppc-chrp/efika/timer/ticks.c

   1 #include <aros/debug.h>
   2 #include <asm/mpc5200b.h>
   3 #include <asm/io.h>
   4 #include <aros/asmcall.h>
   5 #include <exec/execbase.h>
   6
   7 #include <inttypes.h>
   8 #include <proto/exec.h>
   9 #include <proto/timer.h>
  10
  11 #include "lowlevel.h"
  12
  13 // tick2usec -  64424510 for 66.666666MHz
  14 // tick2usec - 130150524 for 33.000000MHz
  15
  16 inline uint32_t __attribute__((const)) tick2usec(uint32_t tick)
  17 {
  18     uint32_t retval;
  19     uint64_t tmp = ((uint64_t)tick) * 130150524;
  20
  21     retval = (tmp + 0x7fffffff) >> 32;
  22
  23     return retval;
  24 }
  25
  26 inline uint32_t __attribute__((const)) usec2tick(uint32_t usec)
  27 {
  28     uint32_t retval;
  29 //    uint64_t tmp = ((uint64_t)usec) * 286331150203ULL;
  30 //
  31 //    retval = (tmp + 0x7fffffff) >> 32;
  32
  33     retval = usec * 33;
  34
  35     return retval;
  36 }
  37
  38 void EClockUpdate(struct TimerBase *TimerBase)
  39 {
  40     uint32_t time;
  41     uint32_t diff;
  42     int show = 0;
  43
  44     time = mftbl();
  45     diff = (time - TimerBase->tb_prev_tick);
  46     TimerBase->tb_prev_tick = time;
  47
  48     TimerBase->tb_ticks_total += diff;
  49
  50     TimerBase->tb_ticks_sec += diff;
  51     TimerBase->tb_ticks_elapsed += diff;
  52
  53     if (TimerBase->tb_ticks_sec >= 33000000)
  54     {
  55         TimerBase->tb_ticks_sec -= 33000000;
  56         TimerBase->tb_CurrentTime.tv_secs++;
  57
  58         show = 1;
  59     }
  60
  61     if (TimerBase->tb_ticks_elapsed >= 33000000)
  62     {
  63         TimerBase->tb_ticks_elapsed -= 33000000;
  64         TimerBase->tb_Elapsed.tv_secs++;
  65     }
  66
  67     TimerBase->tb_Elapsed.tv_micro = tick2usec(TimerBase->tb_ticks_elapsed);
  68     TimerBase->tb_CurrentTime.tv_micro = tick2usec(TimerBase->tb_ticks_sec);
  69
  70 //    if (show)
  71 //    {
  72 //        bug("[timer] CurrentTime: %d:%06d\n", TimerBase->tb_CurrentTime.tv_secs, TimerBase->tb_CurrentTime.tv_micro);
  73 //        bug("[timer] %08x %08x %d %d \n", tbc_expected, tbc_achieved, tbc_achieved-tbc_expected, corr);
  74 //    }
  75 }
  76
  77 void EClockSet(struct TimerBase *TimerBase)
  78 {
  79     TimerBase->tb_ticks_sec = usec2tick(TimerBase->tb_CurrentTime.tv_micro);
  80 }
  81
  82 extern volatile slt_t *slice_timer;
  83
  84 void TimerSetup(struct TimerBase *TimerBase, uint32_t waste)
  85 {
  86     int32_t delay = 660000;  /* 50Hz in worst case */
  87     struct timeval time;
  88     struct timerequest *tr;
  89     uint32_t current_time;
  90
  91     tr = (struct timerequest *)GetHead(&TimerBase->tb_Lists[TL_WAITVBL]);
  92
  93     if (tr)
  94     {
  95         time.tv_micro = tr->tr_time.tv_micro;
  96         time.tv_secs  = tr->tr_time.tv_secs;
  97
  98         SubTime(&time, &TimerBase->tb_CurrentTime);
  99
 100         if ((LONG)time.tv_secs < 0)
 101         {
 102             delay = 0;
 103         }
 104         else if (time.tv_secs == 0)
 105         {
 106 //            if (time.tv_micro < 20000)
 107 //            {
 108                 if (delay > usec2tick(time.tv_micro))
 109                     delay = usec2tick(time.tv_micro);
 110 //            }
 111         }
 112     }
 113
 114     tr = (struct timerequest *)GetHead(&TimerBase->tb_Lists[TL_VBLANK]);
 115
 116     if (tr)
 117     {
 118         time.tv_micro = tr->tr_time.tv_micro;
 119         time.tv_secs  = tr->tr_time.tv_secs;
 120
 121         SubTime(&time, &TimerBase->tb_Elapsed);
 122
 123         if ((LONG)time.tv_secs < 0)
 124         {
 125             delay = 0;
 126         }
 127         else if (time.tv_secs == 0)
 128         {
 129 //            if (time.tv_micro < 20000)
 130 //            {
 131                 if (delay > usec2tick(time.tv_micro))
 132                     delay = usec2tick(time.tv_micro);
 133 //            }
 134         }
 135     }
 136
 137     current_time = mftbl();
 138     delay -= ((int32_t)(current_time - waste)) + corr;
 139
 140     if (delay < 256) delay = 256;
 141
 142     tbc_expected = current_time + delay;
 143
 144     /* Stop the timer */
 145     outl(SLT_CF_INTRENA, &slice_timer->slt_cf);
 146     /* Set the delay */
 147     outl(delay, &slice_timer->slt_tc);
 148     /* Let timer go */
 149     outl(SLT_CF_INTRENA | SLT_CF_ENABLE, &slice_timer->slt_cf);
 150     /* Clear interrupt request. */
 151     outl(SLT_TS_ST, &slice_timer->slt_ts);
 152 }