#include <sys/modctl.h>
#include <sys/systm.h>
#include <sys/cpuvar.h>
#include <sys/promif.h>
#include <sys/sgsbbc_iosram.h>
#include <sys/todsg.h>
#include <sys/cmn_err.h>
#include <sys/time.h>
#include <sys/sysmacros.h>
#include <sys/clock.h>
#if defined(DEBUG) || defined(lint)
static int todsg_debug = 0;
#define DCMNERR if (todsg_debug) cmn_err
#else
#define DCMNERR
#endif
#define OFFSET(base, field) ((char *)&base.field - (char *)&base)
#define SC_DOWN_COUNT_THRESHOLD 2
#define SC_TOD_MIN_REV 2
static timestruc_t todsg_get(void);
static void todsg_set(timestruc_t);
static uint32_t todsg_set_watchdog_timer(uint_t);
static uint32_t todsg_clear_watchdog_timer(void);
static void todsg_set_power_alarm(timestruc_t);
static void todsg_clear_power_alarm(void);
static uint64_t todsg_get_cpufrequency(void);
static int update_heartbeat(void);
static int verify_sc_tod_version(void);
static int update_tod_skew(time_t skew);
static uint32_t i_am_alive = 0;
static uint32_t sc_tod_version = 0;
static time_t skew_adjust = 0;
static int is_sc_down = 0;
static int adjust_sc_down = 0;
static struct modlmisc modlmisc = {
&mod_miscops, "Serengeti tod module"
};
static struct modlinkage modlinkage = {
MODREV_1, (void *)&modlmisc, NULL
};
int
_init(void)
{
DCMNERR(CE_NOTE, "todsg:_init(): begins");
if (strcmp(tod_module_name, "todsg") == 0) {
time_t ssc_time = (time_t)0;
char obp_string[80];
(void) sprintf(obp_string,
"h# %p \" unix-get-tod\" $find if execute else 3drop then",
(void *)&ssc_time);
prom_interpret(obp_string, 0, 0, 0, 0, 0);
if (ssc_time == (time_t)0) {
cmn_err(CE_WARN, "Initial date is invalid. "
"This can be caused by older firmware.");
cmn_err(CE_CONT, "Please flashupdate the System "
"Controller firmware to the latest version.\n");
cmn_err(CE_CONT, "Attempting to set the date and time "
"based on the last shutdown.\n");
cmn_err(CE_CONT, "Please inspect the date and time and "
"correct if necessary.\n");
}
hrestime.tv_sec = ssc_time;
DCMNERR(CE_NOTE, "todsg: _init(): time from OBP 0x%lX",
ssc_time);
if (TIMESPEC_OVERFLOW(&hrestime)) {
cmn_err(CE_WARN, "Date overflow detected.");
cmn_err(CE_CONT, "Attempting to set the date and time "
"based on the last shutdown.\n");
cmn_err(CE_CONT, "Please inspect the date and time and "
"correct if necessary.\n");
hrestime.tv_sec = (time_t)0;
skew_adjust = -ssc_time;
}
DCMNERR(CE_NOTE, "todsg:_init(): set tod_ops");
tod_ops.tod_get = todsg_get;
tod_ops.tod_set = todsg_set;
tod_ops.tod_set_watchdog_timer = todsg_set_watchdog_timer;
tod_ops.tod_clear_watchdog_timer = todsg_clear_watchdog_timer;
tod_ops.tod_set_power_alarm = todsg_set_power_alarm;
tod_ops.tod_clear_power_alarm = todsg_clear_power_alarm;
tod_ops.tod_get_cpufrequency = todsg_get_cpufrequency;
}
return (mod_install(&modlinkage));
}
int
_fini(void)
{
if (strcmp(tod_module_name, "todsg") == 0)
return (EBUSY);
else
return (mod_remove(&modlinkage));
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
static int
update_heartbeat(void)
{
tod_iosram_t tod_buf;
int complained = 0;
if (i_am_alive == UINT32_MAX)
i_am_alive = 0;
else
i_am_alive++;
if (iosram_write(SBBC_TOD_KEY, OFFSET(tod_buf, tod_i_am_alive),
(char *)&i_am_alive, sizeof (uint32_t))) {
complained++;
cmn_err(CE_WARN, "update_heartbeat(): write heartbeat failed");
}
return (complained);
}
static int
verify_sc_tod_version(void)
{
uint32_t magic;
tod_iosram_t tod_buf;
if (!todsg_use_sc)
return (FALSE);
if (!sc_tod_version || is_sc_down >= SC_DOWN_COUNT_THRESHOLD) {
if (iosram_read(SBBC_TOD_KEY, OFFSET(tod_buf, tod_magic),
(char *)&magic, sizeof (uint32_t)) ||
magic != TODSG_MAGIC) {
cmn_err(CE_WARN, "get_sc_tod_version(): "
"TOD SRAM magic error");
return (FALSE);
}
if (iosram_read(SBBC_TOD_KEY, OFFSET(tod_buf, tod_version),
(char *)&sc_tod_version, sizeof (uint32_t))) {
cmn_err(CE_WARN, "get_sc_tod_version(): "
"read tod version failed");
sc_tod_version = 0;
return (FALSE);
}
}
if (sc_tod_version >= SC_TOD_MIN_REV) {
return (TRUE);
} else {
todsg_use_sc = 0;
cmn_err(CE_WARN, "todsg_get(): incorrect firmware version, "
"(%d): expected version >= %d.", sc_tod_version,
SC_TOD_MIN_REV);
}
return (FALSE);
}
static int
update_tod_skew(time_t skew)
{
time_t domain_skew;
tod_iosram_t tod_buf;
int complained = 0;
DCMNERR(CE_NOTE, "update_tod_skew(): skew 0x%lX", skew);
if (iosram_read(SBBC_TOD_KEY, OFFSET(tod_buf, tod_domain_skew),
(char *)&domain_skew, sizeof (time_t))) {
complained++;
cmn_err(CE_WARN,
"update_tod_skew(): read tod domain skew failed");
}
domain_skew += skew;
domain_skew += skew_adjust;
if (!complained && iosram_write(SBBC_TOD_KEY,
OFFSET(tod_buf, tod_domain_skew), (char *)&domain_skew,
sizeof (time_t))) {
complained++;
cmn_err(CE_WARN,
"update_tod_skew(): write domain skew failed");
}
if (!complained)
skew_adjust = 0;
return (complained);
}
static timestruc_t
todsg_get(void)
{
tod_iosram_t tod_buf;
time_t seconds;
time_t domain_skew;
int complained = 0;
static time_t pre_seconds = (time_t)0;
ASSERT(MUTEX_HELD(&tod_lock));
if (!verify_sc_tod_version()) {
goto return_hrestime;
}
if (watchdog_activated != 0 || watchdog_enable != 0)
complained = update_heartbeat();
if (!complained && (iosram_read(SBBC_TOD_KEY,
OFFSET(tod_buf, tod_get_value), (char *)&seconds,
sizeof (time_t)))) {
complained++;
cmn_err(CE_WARN, "todsg_get(): read 64-bit tod value failed");
}
if (!complained && skew_adjust) {
complained = update_tod_skew(0);
}
if (!complained && iosram_read(SBBC_TOD_KEY,
OFFSET(tod_buf, tod_domain_skew), (char *)&domain_skew,
sizeof (time_t))) {
complained++;
cmn_err(CE_WARN, "todsg_get(): read tod domain skew failed");
}
if (complained) {
cmn_err(CE_WARN, "todsg_get(): turned off using tod");
todsg_use_sc = 0;
goto return_hrestime;
}
if (seconds != pre_seconds) {
pre_seconds = seconds;
if (is_sc_down >= SC_DOWN_COUNT_THRESHOLD && adjust_sc_down) {
skew_adjust = hrestime.tv_sec - (seconds + domain_skew);
complained = update_tod_skew(0);
if (!complained && (iosram_read(SBBC_TOD_KEY,
OFFSET(tod_buf, tod_domain_skew),
(char *)&domain_skew, sizeof (time_t)))) {
complained++;
cmn_err(CE_WARN, "todsg_get(): "
"read tod domain skew failed");
}
}
is_sc_down = 0;
adjust_sc_down = 0;
if (!complained) {
tod_status_clear(TOD_GET_FAILED);
timestruc_t ts = {0, 0};
ts.tv_sec = seconds + domain_skew;
return (ts);
} else {
goto return_hrestime;
}
}
is_sc_down++;
if (timedelta != 0) {
adjust_sc_down = 1;
}
return_hrestime:
tod_status_set(TOD_GET_FAILED);
return (hrestime);
}
static void
todsg_set(timestruc_t ts)
{
int complained = 0;
tod_iosram_t tod_buf;
time_t domain_skew;
time_t seconds;
time_t hwtod;
ASSERT(MUTEX_HELD(&tod_lock));
if (!verify_sc_tod_version()) {
return;
}
if (is_sc_down) {
adjust_sc_down = 1;
return;
}
if (watchdog_activated != 0 || watchdog_enable != 0)
complained = update_heartbeat();
if (!complained && (iosram_read(SBBC_TOD_KEY,
OFFSET(tod_buf, tod_get_value), (char *)&seconds,
sizeof (time_t)))) {
complained++;
cmn_err(CE_WARN, "todsg_set(): read 64-bit tod value failed");
}
if (!complained && iosram_read(SBBC_TOD_KEY,
OFFSET(tod_buf, tod_domain_skew), (char *)&domain_skew,
sizeof (time_t))) {
complained++;
cmn_err(CE_WARN, "todsg_set(): read tod domain skew failed");
}
if (!complained && (ts.tv_sec != (seconds + domain_skew))) {
hwtod = seconds + domain_skew;
complained = update_tod_skew(ts.tv_sec - hwtod);
DCMNERR(CE_NOTE, "todsg_set(): set time %lX (%lX)%s",
ts.tv_sec, hwtod, complained ? " failed" : "");
}
if (complained) {
cmn_err(CE_WARN, "todsg_set(): turned off using tod");
todsg_use_sc = 0;
}
}
static uint32_t
todsg_set_watchdog_timer(uint32_t timeoutval)
{
tod_iosram_t tod_buf;
ASSERT(MUTEX_HELD(&tod_lock));
if (!verify_sc_tod_version()) {
DCMNERR(CE_NOTE, "todsg_set_watchdog_timer(): "
"verify_sc_tod_version failed");
return (0);
}
DCMNERR(CE_NOTE, "todsg_set_watchdog_timer(): "
"set watchdog timer value = %d", timeoutval);
if (iosram_write(SBBC_TOD_KEY, OFFSET(tod_buf, tod_timeout_period),
(char *)&timeoutval, sizeof (uint32_t))) {
DCMNERR(CE_NOTE, "todsg_set_watchdog_timer(): "
"write new timeout value failed");
return (0);
}
watchdog_activated = 1;
return (timeoutval);
}
static uint32_t
todsg_clear_watchdog_timer(void)
{
tod_iosram_t tod_buf;
uint32_t r_timeout_period;
uint32_t w_timeout_period;
ASSERT(MUTEX_HELD(&tod_lock));
if ((watchdog_activated == 0) || !verify_sc_tod_version()) {
DCMNERR(CE_NOTE, "todsg_set_watchdog_timer(): "
"either watchdog not activated or "
"verify_sc_tod_version failed");
return (0);
}
if (iosram_read(SBBC_TOD_KEY, OFFSET(tod_buf, tod_timeout_period),
(char *)&r_timeout_period, sizeof (uint32_t))) {
DCMNERR(CE_NOTE, "todsg_clear_watchdog_timer(): "
"read timeout value failed");
return (0);
}
DCMNERR(CE_NOTE, "todsg_clear_watchdog_timer(): "
"clear watchdog timer (old value=%d)", r_timeout_period);
w_timeout_period = 0;
if (iosram_write(SBBC_TOD_KEY, OFFSET(tod_buf, tod_timeout_period),
(char *)&w_timeout_period, sizeof (uint32_t))) {
DCMNERR(CE_NOTE, "todsg_clear_watchdog_timer(): "
"write zero timeout value failed");
return (0);
}
watchdog_activated = 0;
return (r_timeout_period);
}
static void
todsg_set_power_alarm(timestruc_t ts)
{
ASSERT(MUTEX_HELD(&tod_lock));
}
static void
todsg_clear_power_alarm()
{
ASSERT(MUTEX_HELD(&tod_lock));
}
uint64_t
todsg_get_cpufrequency(void)
{
DCMNERR(CE_NOTE, "todsg_get_cpufrequency(): frequency=%ldMHz",
cpunodes[CPU->cpu_id].clock_freq/1000000);
return (cpunodes[CPU->cpu_id].clock_freq);
}