68 lines
2.7 KiB
C
68 lines
2.7 KiB
C
|
//----------------------------------------------------------------------------//
|
||
|
|
// GNU GPL OS/K //
|
||
|
|
// //
|
||
|
|
// Desc: RTC Time related functions //
|
||
|
|
// //
|
||
|
|
// //
|
||
|
|
// Copyright © 2018-2019 The OS/K Team //
|
||
|
|
// //
|
||
|
|
// This file is part of OS/K. //
|
||
|
|
// //
|
||
|
|
// OS/K is free software: you can redistribute it and/or modify //
|
||
|
|
// it under the terms of the GNU General Public License as published by //
|
||
|
|
// the Free Software Foundation, either version 3 of the License, or //
|
||
|
|
// any later version. //
|
||
|
|
// //
|
||
|
|
// OS/K 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 General Public License for more details. //
|
||
|
|
// //
|
||
|
|
// You should have received a copy of the GNU General Public License //
|
||
|
|
// along with OS/K. If not, see <https://www.gnu.org/licenses/>. //
|
||
|
|
//----------------------------------------------------------------------------//
|
||
|
|
|
||
|
|
#include <lib/buf.h>
|
||
|
|
#include <ke/time.h>
|
||
|
|
#include <ke/idt.h>
|
||
|
|
|
||
|
|
#define COUNTDONE 1
|
||
|
|
|
||
|
|
static TimerFilo_t timerFilo[20]; //20 concurrent sleep max
|
||
|
|
|
||
|
|
//
|
||
|
|
// ISR handler for the Programmable Interval Timer
|
||
|
|
//
|
||
|
|
static void HandleTimer(ISRFrame_t *regs)
|
||
|
|
{
|
||
|
|
for (uchar i = 0; i < 20; i++) {
|
||
|
|
if (timerFilo[i].countDown > 0) {
|
||
|
|
timerFilo[i].countDown--;
|
||
|
|
|
||
|
|
if (timerFilo[i].countDown == 0)
|
||
|
|
i; //XXX SendMessage a message to timerFifo[i].sema that COUNTDONE;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
static TimerFilo_t* KeFindTimerBlock(void)
|
||
|
|
{
|
||
|
|
for(uchar i = 0; i < 20; i++) {
|
||
|
|
if (timerFilo[i].countDown == 0)
|
||
|
|
return &timerFilo[i];
|
||
|
|
}
|
||
|
|
|
||
|
|
return NULL;
|
||
|
|
}
|
||
|
|
|
||
|
|
void KeSleep(uint delay)
|
||
|
|
{
|
||
|
|
struct TimerFilo_t *timerBlock;
|
||
|
|
|
||
|
|
if ((timerBlock = (TimerFilo_t*)KeFindTimerBlock()) == NULL)
|
||
|
|
return;
|
||
|
|
|
||
|
|
timerBlock->countDown = delay;
|
||
|
|
// wait for a message on timerFifo[i].sema
|
||
|
|
}
|