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

   1 /*
   2     Copyright © 1995-2010, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: Timer startup and device commands
   6 */
   7
   8 /****************************************************************************************/
   9
  10 #define DEBUG 0
  11
  12 #include <exec/types.h>
  13 #include <exec/io.h>
  14 #include <exec/errors.h>
  15 #include <exec/devices.h>
  16 #include <exec/alerts.h>
  17 #include <exec/initializers.h>
  18 #include <devices/timer.h>
  19 #include <hardware/intbits.h>
  20
  21 #include <proto/exec.h>
  22 #include <proto/timer.h>
  23 #include <proto/kernel.h>
  24 #include <proto/utility.h>
  25 #include <proto/openfirmware.h>
  26
  27 #include <utility/tagitem.h>
  28
  29 #include <aros/symbolsets.h>
  30
  31 #include <asm/io.h>
  32 #include <asm/mpc5200b.h>
  33
  34 #include <aros/debug.h>
  35 #include <proto/arossupport.h>
  36
  37 //#include "timer_intern.h"
  38 #include LC_LIBDEFS_FILE
  39
  40 #include "lowlevel.h"
  41
  42 void SliceHandler(struct TimerBase *TimerBase, struct ExecBase *SysBase);
  43 extern volatile slt_t *slice_timer;
  44
  45 /****************************************************************************************/
  46
  47 static int GM_UNIQUENAME(Init)(LIBBASETYPEPTR LIBBASE)
  48 {
  49     struct ExecBase *SysBase = getSysBase();
  50     void *KernelBase = getKernelBase();
  51
  52     TimerBase->tb_prev_tick = mftbl();
  53
  54     /* Setup the timer.device data */
  55     LIBBASE->tb_CurrentTime.tv_secs = 0;
  56     LIBBASE->tb_CurrentTime.tv_micro = 0;
  57     LIBBASE->tb_VBlankTime.tv_secs = 0;
  58     LIBBASE->tb_VBlankTime.tv_micro = 1000000 / SysBase->VBlankFrequency;
  59     LIBBASE->tb_Elapsed.tv_secs = 0;
  60     LIBBASE->tb_Elapsed.tv_micro = 0;
  61
  62     D(bug("Timer period: %ld secs, %ld micros\n",
  63         LIBBASE->tb_VBlankTime.tv_secs, LIBBASE->tb_VBlankTime.tv_micro));
  64
  65     /* Initialise the lists */
  66     NEWLIST( &LIBBASE->tb_Lists[0] );
  67     NEWLIST( &LIBBASE->tb_Lists[1] );
  68     NEWLIST( &LIBBASE->tb_Lists[2] );
  69     NEWLIST( &LIBBASE->tb_Lists[3] );
  70     NEWLIST( &LIBBASE->tb_Lists[4] );
  71
  72     void *OpenFirmwareBase = OpenResource("openfirmware.resource");
  73     void *key = OF_OpenKey("/builtin");
  74     if (key)
  75     {
  76         void *prop = OF_FindProperty(key, "reg");
  77         if (prop)
  78         {
  79                 intptr_t *mbar = OF_GetPropValue(prop);
  80                 slice_timer = (slt_t *)(*mbar + 0x710);
  81
  82                 D(bug("MBAR located at %08x\n", *mbar));
  83                 D(bug("slice timer at %08x\n", slice_timer));
  84         }
  85     }
  86
  87     /* Start up the interrupt server */
  88
  89     LIBBASE->tb_TimerIRQHandle = KrnAddIRQHandler(MPC5200B_ST1, SliceHandler, LIBBASE, SysBase); //KrnAddExceptionHandler(10, DecrementerHandler, LIBBASE, SysBase);
  90
  91     /* Start the slice timer 1 */
  92 //    outl(SLT_CF_RUNWAIT | SLT_CF_INTRENA | SLT_CF_ENABLE, &slice_timer->slt_cf);
  93
  94     outl(SLT_TS_ST, &slice_timer->slt_ts);
  95 //    TimerSetup(TimerBase, mftbl());
  96
  97 //    outl(SLT_TS_ST, &slice_timer->slt_ts);
  98     TimerSetup(TimerBase, 0);
  99
 100     /* VBlank EMU */
 101
 102     LIBBASE->tb_vblank_timerequest.tr_node.io_Command = TR_ADDREQUEST;
 103     LIBBASE->tb_vblank_timerequest.tr_node.io_Device = (struct Device *)TimerBase;
 104     LIBBASE->tb_vblank_timerequest.tr_node.io_Unit = (struct Unit *)UNIT_MICROHZ;
 105     LIBBASE->tb_vblank_timerequest.tr_time.tv_secs = 0;
 106     LIBBASE->tb_vblank_timerequest.tr_time.tv_micro = 1000000 / SysBase->VBlankFrequency;
 107
 108     SendIO(&LIBBASE->tb_vblank_timerequest.tr_node);
 109
 110     return TRUE;
 111 }
 112
 113 /****************************************************************************************/
 114
 115 static int GM_UNIQUENAME(Open)
 116 (
 117     LIBBASETYPEPTR LIBBASE,
 118     struct timerequest *tr,
 119     ULONG unitNum,
 120     ULONG flags
 121 )
 122 {
 123     /*
 124         Normally, we should check the length of the message and other
 125         such things, however the RKM documents an example where the
 126         length of the timerrequest isn't set, so we must not check
 127         this.
 128
 129         This fixes bug SF# 741580
 130     */
 131
 132     D(bug("[timer] OpenDevice(%d)\n", unitNum));
 133     switch(unitNum)
 134     {
 135         case UNIT_VBLANK:
 136         case UNIT_WAITUNTIL:
 137     case UNIT_MICROHZ:
 138     case UNIT_ECLOCK:
 139     case UNIT_WAITECLOCK:
 140             tr->tr_node.io_Error = 0;
 141             tr->tr_node.io_Unit = (struct Unit *)unitNum;
 142             tr->tr_node.io_Device = (struct Device *)LIBBASE;
 143             break;
 144
 145         default:
 146             tr->tr_node.io_Error = IOERR_OPENFAIL;
 147     }
 148
 149     return TRUE;
 150 }
 151
 152 /****************************************************************************************/
 153
 154 static int GM_UNIQUENAME(Expunge)(LIBBASETYPEPTR LIBBASE)
 155 {
 156     void *KernelBase = getKernelBase();
 157
 158     KrnRemIRQHandler(LIBBASE->tb_TimerIRQHandle);
 159
 160     return TRUE;
 161 }
 162
 163 /****************************************************************************************/
 164
 165 ADD2INITLIB(GM_UNIQUENAME(Init), 0)
 166 ADD2OPENDEV(GM_UNIQUENAME(Open), 0)
 167 ADD2EXPUNGELIB(GM_UNIQUENAME(Expunge), 0)