2019-11-11 23:57:31 +01:00
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
|
// 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
|
2019-11-14 00:54:34 +01:00
|
|
|
#define PIT_FREQUENCY 100 // Hz = 10ms
|
2019-11-11 23:57:31 +01:00
|
|
|
|
|
|
|
|
static TimerFilo_t timerFilo[20]; //20 concurrent sleep max
|
2019-11-14 00:54:34 +01:00
|
|
|
static ulong Ticks = 0;
|
2019-11-11 23:57:31 +01:00
|
|
|
|
|
|
|
|
//
|
|
|
|
|
// ISR handler for the Programmable Interval Timer
|
|
|
|
|
//
|
2019-11-14 00:54:34 +01:00
|
|
|
static void HandlePIT(ISRFrame_t *regs)
|
2019-11-11 23:57:31 +01:00
|
|
|
{
|
|
|
|
|
for (uchar i = 0; i < 20; i++) {
|
2019-11-14 00:54:34 +01:00
|
|
|
|
|
|
|
|
// debug
|
|
|
|
|
//DebugLog("Hello world of PIT ticks !\n");
|
|
|
|
|
//
|
|
|
|
|
|
2019-11-11 23:57:31 +01:00
|
|
|
if (timerFilo[i].countDown > 0) {
|
|
|
|
|
timerFilo[i].countDown--;
|
|
|
|
|
|
|
|
|
|
if (timerFilo[i].countDown == 0)
|
|
|
|
|
i; //XXX SendMessage a message to timerFifo[i].sema that COUNTDONE;
|
|
|
|
|
}
|
2019-11-14 00:54:34 +01:00
|
|
|
|
|
|
|
|
KeSendEOItoPIC(0x28);
|
2019-11-11 23:57:31 +01:00
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
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
|
|
|
|
|
}
|
2019-11-14 00:54:34 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
void KeEnablePIT(void)
|
|
|
|
|
{
|
|
|
|
|
ulong flags = KePauseIRQs();
|
|
|
|
|
char readIrqs;
|
|
|
|
|
uint divisor = 1193180 / PIT_FREQUENCY;
|
|
|
|
|
|
|
|
|
|
KeRegisterISR(HandlePIT, 0x20);
|
|
|
|
|
|
|
|
|
|
IoWriteByteOnPort(0x43, 0x36); // 0x34 = 00110100 for rate gen
|
|
|
|
|
|
|
|
|
|
IoWriteByteOnPort(0x40, (char)(divisor & 0xFF )); // low byte of freq
|
|
|
|
|
IoWriteByteOnPort(0x40, (char)((divisor >> 8)& 0xFF)); // high byte of freq
|
|
|
|
|
|
|
|
|
|
// Setting up the IRQs
|
|
|
|
|
KeUnmaskIRQ(0);
|
|
|
|
|
|
|
|
|
|
DebugLog("\tPIT activated with rate generator mode 10ms\n");
|
|
|
|
|
|
|
|
|
|
KeRestoreIRQs(flags);
|
|
|
|
|
KeEnableNMI();
|
|
|
|
|
}
|
