---

/projects/cubeos/src_current/kernel/ptimer.c

Go to the documentation of this file.

/*  src/kernel/ptimer.c
   CubeOS Version 0.4.90
   Copyright (C) 1999,2000 Holger Kenn

   CubeOS is free software; you can redistribute it and/or
   modify it under the terms of the GNU Library General Public
   License as published by the Free Software Foundation; either
   version 2 of the License, or any later version.

   CubeOS is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
   Library General Public License for more details.

 */
#include <ptimer.h>
#include <cubeos.h>
#include <sys_var.h>
#include <io_duart.h>
#include <schedule.h>
#include <sys/time.h>


void (*_KERN_call_dispatcher) ();

int KERN_installdispatcher(void (*dispatcher) ())
{
if (_KERN_call_dispatcher)
        return (-1);
disable();
_KERN_call_dispatcher = dispatcher;
enable();
return(0);
}

int KERN_removedispatcher()
{
if (!_KERN_call_dispatcher)
        return(-1);
disable();
_KERN_call_dispatcher = NULL;
enable();
return (0);
}


/*
 * The periodic timer is a internal device of the 68332
 */

int KERN_ptint (void)
{


        /* Advance the system clock */
        if ((++_time_ticks) == TICKS_PER_SECOND) {
                _time_seconds++;
                _time_ticks = 0;
        }
#ifdef DUART_BASE
        if ((DUART_BASE) != 0)
                _DUART_duart_bugfix ();
#endif
        if (_KERN_call_dispatcher)
                _KERN_call_dispatcher ();

        if (KERN_delta_handler ()) {
                /* time has run out for at least one thread, 
                   delta_handler has woken up the threads, we need to call the
                   scheduler immediately */
                _KERN_quantum_count = 0;        /* abort the current quantum! */
                return (1);
        }
        if (++_KERN_quantum_count == QUANTUM) {
                _KERN_quantum_count = 0;
                return (1);     /* and call scheduler */
        }
        return (0);             /* don't call scheduler */
}

void KERN_init_ptimer (void)
{
        _time_seconds = 0;
        _time_ticks = 0;
        writeshort (SIM_PITR, PTIMER_PITR_VAL);

        writeshortpos (SIM_PICR, PTIMER_VECTOR, 0xff, 0x0);
        writeshortpos (SIM_PICR, PTIMER_IRQ_LEVEL, 0x7, 0x8);

//      ptimer_clears_wdt = 1; /* clear WDT on timer int */


// the software watchdog timeout period is determined by 
        //      XTAL_FREQ: The clock frequency of the VCO/external clock source
        //      SIM_SYPCR.SWP: Clock Prescaler, 1: div 512 2: no prescaler
        //      SIM_SYPCR.SWT0/1





}

unsigned long _getseconds ()
{
        return _time_seconds;
}


int _gettimeofday (struct timeval *tp, struct timezone *ignore)
{

        tp->tv_sec = _time_seconds;

        tp->tv_usec = (_time_ticks * 1000 / TICKS_PER_SECOND);
        return 0;
}

int gettimeofday (struct timeval *tp, struct timezone *ignore)
{

        tp->tv_sec = _time_seconds;

        tp->tv_usec = (_time_ticks * 1000 / TICKS_PER_SECOND);
        return 0;
}

unsigned long _settimeofday (unsigned long val)
{
        writeshort (SIM_PITR, 0);       /* Disable timer interrupt */
        _time_ticks = 0;
        _time_seconds = val;    /* set clock */
        writeshort (SIM_PITR, PTIMER_PITR_VAL);         /* and return it */
        return _time_seconds;
}


int settimeofday(const struct timeval* tp,const struct timezone* ignore)
{
 writeshort (SIM_PITR, 0);
 _time_ticks = 0;
 _time_seconds = tp->tv_sec;
 writeshort (SIM_PITR, PTIMER_PITR_VAL);
 return 0;
}

---