mirror of https://github.com/JorjBauer/aiie.git
63 lines
1.5 KiB
C++
63 lines
1.5 KiB
C++
#include <string.h> // memset
|
|
#include <TimeLib.h>
|
|
|
|
#include "noslotclock.h"
|
|
|
|
#include "teensy-clock.h"
|
|
|
|
TeensyClock::TeensyClock(AppleMMU *mmu) : NoSlotClock(mmu)
|
|
{
|
|
}
|
|
|
|
TeensyClock::~TeensyClock()
|
|
{
|
|
}
|
|
|
|
void TeensyClock::populateClockRegister()
|
|
{
|
|
tmElements_t tm;
|
|
breakTime(now(), tm);
|
|
|
|
tm.Year %= 100; // 00-99
|
|
tm.Month++; // 1-12
|
|
tm.Wday++; // 1-7, where 1 = Sunday
|
|
|
|
writeNibble(tm.Year / 10); // 00-99
|
|
writeNibble(tm.Year % 10);
|
|
writeNibble(tm.Month / 10); // 1-12
|
|
writeNibble(tm.Month % 10);
|
|
writeNibble(tm.Day / 10); // 1-31
|
|
writeNibble(tm.Day % 10);
|
|
writeNibble(0);
|
|
writeNibble(tm.Wday); // 1-7, where 1 = Sunday
|
|
writeNibble(tm.Hour / 10);
|
|
writeNibble(tm.Hour % 10);
|
|
writeNibble(tm.Minute / 10);
|
|
writeNibble(tm.Minute % 10);
|
|
writeNibble(tm.Second / 10);
|
|
writeNibble(tm.Second % 10);
|
|
writeNibble(0); // 00-99 milliseconds
|
|
writeNibble(0);
|
|
}
|
|
|
|
static uint8_t bcdToDecimal(uint8_t v)
|
|
{
|
|
return ((v & 0x0F) + (((v & 0xF0) >> 4) * 10));
|
|
}
|
|
|
|
|
|
void TeensyClock::updateClockFromRegister()
|
|
{
|
|
uint8_t hours, minutes, seconds, days, months;
|
|
uint16_t years;
|
|
|
|
years = bcdToDecimal(clockReg & 0xFF00000000000000LL >> 56) + 2000;
|
|
months = bcdToDecimal(clockReg & 0x00FF000000000000LL >> 48) - 1;
|
|
days = bcdToDecimal(clockReg & 0x0000FF0000000000LL >> 40);
|
|
hours = bcdToDecimal(clockReg & 0x00000000FF000000LL >> 24);
|
|
minutes = bcdToDecimal(clockReg & 0x0000000000FF0000LL >> 16);
|
|
seconds = bcdToDecimal(clockReg & 0x000000000000FF00LL >> 8);
|
|
|
|
setTime(hours, minutes, seconds, days, months, years);
|
|
}
|