50 lines
1.2 KiB
C++
50 lines
1.2 KiB
C++
|
#include <cstdint>
|
||
|
|
#include <devices.hpp>
|
||
|
|
|
||
|
|
namespace Devices {
|
||
|
|
uint64_t RTC::get_time_internal() {
|
||
|
|
#if defined(CONFIG_TARGET_AM)
|
||
|
|
uint64_t us = io_read(AM_TIMER_UPTIME).us;
|
||
|
|
#elif defined(CONFIG_TIMER_GETTIMEOFDAY)
|
||
|
|
struct timeval now;
|
||
|
|
gettimeofday(&now, NULL);
|
||
|
|
uint64_t us = now.tv_sec * 1000000 + now.tv_usec;
|
||
|
|
#else
|
||
|
|
struct timespec now;
|
||
|
|
clock_gettime(CLOCK_MONOTONIC_COARSE, &now);
|
||
|
|
uint64_t us = now.tv_sec * 1000000 + now.tv_nsec / 1000;
|
||
|
|
#endif
|
||
|
|
return us;
|
||
|
|
}
|
||
|
|
|
||
|
|
uint64_t RTC::get_time() {
|
||
|
|
if (boot_time == 0)
|
||
|
|
boot_time = get_time_internal();
|
||
|
|
uint64_t now = get_time_internal();
|
||
|
|
return now - boot_time;
|
||
|
|
}
|
||
|
|
|
||
|
|
RTC::RTC(uint64_t addr, size_t len) : Device(addr, len, buf) {
|
||
|
|
*(uint64_t *)buf = 0;
|
||
|
|
};
|
||
|
|
|
||
|
|
void RTC::io_handler(uint32_t offset, size_t len, bool is_write) {
|
||
|
|
assert(offset == 0 || offset == 4);
|
||
|
|
if (!is_write && offset == 4) {
|
||
|
|
uint64_t us = get_time();
|
||
|
|
buf[0] = (uint32_t)us;
|
||
|
|
buf[1] = us >> 32;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// void RTC::transfer(uint8_t *src, size_t len, bool is_write) {
|
||
|
|
// if (is_write) {
|
||
|
|
// for (size_t i = 0; i < len; i++)
|
||
|
|
// buf[i] = src[i];
|
||
|
|
// } else {
|
||
|
|
// for (size_t i = 0; i < len; i++)
|
||
|
|
// src[i] = buf[i];
|
||
|
|
// }
|
||
|
|
// }
|
||
|
|
} // namespace Devices
|