rtc: mc146818-lib: refactor mc146818_get_time
Refactor mc146818_get_time() so that it uses mc146818_avoid_UIP(). Signed-off-by: Mateusz Jończyk <mat.jonczyk@o2.pl> Cc: Alessandro Zummo <a.zummo@towertech.it> Cc: Alexandre Belloni <alexandre.belloni@bootlin.com> Signed-off-by: Alexandre Belloni <alexandre.belloni@bootlin.com> Link: https://lore.kernel.org/r/20211210200131.153887-7-mat.jonczyk@o2.pl
This commit is contained in:
parent
ec5895c0f2
commit
2a61b0ac54
|
@ -103,49 +103,20 @@ bool mc146818_does_rtc_work(void)
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(mc146818_does_rtc_work);
|
EXPORT_SYMBOL_GPL(mc146818_does_rtc_work);
|
||||||
|
|
||||||
unsigned int mc146818_get_time(struct rtc_time *time)
|
struct mc146818_get_time_callback_param {
|
||||||
{
|
struct rtc_time *time;
|
||||||
unsigned char ctrl;
|
unsigned char ctrl;
|
||||||
unsigned long flags;
|
#ifdef CONFIG_ACPI
|
||||||
unsigned int iter_count = 0;
|
unsigned char century;
|
||||||
unsigned char century = 0;
|
#endif
|
||||||
bool retry;
|
|
||||||
|
|
||||||
#ifdef CONFIG_MACH_DECSTATION
|
#ifdef CONFIG_MACH_DECSTATION
|
||||||
unsigned int real_year;
|
unsigned int real_year;
|
||||||
#endif
|
#endif
|
||||||
|
};
|
||||||
|
|
||||||
again:
|
static void mc146818_get_time_callback(unsigned char seconds, void *param_in)
|
||||||
if (iter_count > 10) {
|
{
|
||||||
memset(time, 0, sizeof(*time));
|
struct mc146818_get_time_callback_param *p = param_in;
|
||||||
return -EIO;
|
|
||||||
}
|
|
||||||
iter_count++;
|
|
||||||
|
|
||||||
spin_lock_irqsave(&rtc_lock, flags);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Check whether there is an update in progress during which the
|
|
||||||
* readout is unspecified. The maximum update time is ~2ms. Poll
|
|
||||||
* every msec for completion.
|
|
||||||
*
|
|
||||||
* Store the second value before checking UIP so a long lasting NMI
|
|
||||||
* which happens to hit after the UIP check cannot make an update
|
|
||||||
* cycle invisible.
|
|
||||||
*/
|
|
||||||
time->tm_sec = CMOS_READ(RTC_SECONDS);
|
|
||||||
|
|
||||||
if (CMOS_READ(RTC_FREQ_SELECT) & RTC_UIP) {
|
|
||||||
spin_unlock_irqrestore(&rtc_lock, flags);
|
|
||||||
mdelay(1);
|
|
||||||
goto again;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Revalidate the above readout */
|
|
||||||
if (time->tm_sec != CMOS_READ(RTC_SECONDS)) {
|
|
||||||
spin_unlock_irqrestore(&rtc_lock, flags);
|
|
||||||
goto again;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Only the values that we read from the RTC are set. We leave
|
* Only the values that we read from the RTC are set. We leave
|
||||||
|
@ -153,39 +124,39 @@ again:
|
||||||
* RTC has RTC_DAY_OF_WEEK, we ignore it, as it is only updated
|
* RTC has RTC_DAY_OF_WEEK, we ignore it, as it is only updated
|
||||||
* by the RTC when initially set to a non-zero value.
|
* by the RTC when initially set to a non-zero value.
|
||||||
*/
|
*/
|
||||||
time->tm_min = CMOS_READ(RTC_MINUTES);
|
p->time->tm_sec = seconds;
|
||||||
time->tm_hour = CMOS_READ(RTC_HOURS);
|
p->time->tm_min = CMOS_READ(RTC_MINUTES);
|
||||||
time->tm_mday = CMOS_READ(RTC_DAY_OF_MONTH);
|
p->time->tm_hour = CMOS_READ(RTC_HOURS);
|
||||||
time->tm_mon = CMOS_READ(RTC_MONTH);
|
p->time->tm_mday = CMOS_READ(RTC_DAY_OF_MONTH);
|
||||||
time->tm_year = CMOS_READ(RTC_YEAR);
|
p->time->tm_mon = CMOS_READ(RTC_MONTH);
|
||||||
|
p->time->tm_year = CMOS_READ(RTC_YEAR);
|
||||||
#ifdef CONFIG_MACH_DECSTATION
|
#ifdef CONFIG_MACH_DECSTATION
|
||||||
real_year = CMOS_READ(RTC_DEC_YEAR);
|
p->real_year = CMOS_READ(RTC_DEC_YEAR);
|
||||||
#endif
|
#endif
|
||||||
#ifdef CONFIG_ACPI
|
#ifdef CONFIG_ACPI
|
||||||
if (acpi_gbl_FADT.header.revision >= FADT2_REVISION_ID &&
|
if (acpi_gbl_FADT.header.revision >= FADT2_REVISION_ID &&
|
||||||
acpi_gbl_FADT.century)
|
acpi_gbl_FADT.century) {
|
||||||
century = CMOS_READ(acpi_gbl_FADT.century);
|
p->century = CMOS_READ(acpi_gbl_FADT.century);
|
||||||
|
} else {
|
||||||
|
p->century = 0;
|
||||||
|
}
|
||||||
#endif
|
#endif
|
||||||
ctrl = CMOS_READ(RTC_CONTROL);
|
|
||||||
/*
|
|
||||||
* Check for the UIP bit again. If it is set now then
|
|
||||||
* the above values may contain garbage.
|
|
||||||
*/
|
|
||||||
retry = CMOS_READ(RTC_FREQ_SELECT) & RTC_UIP;
|
|
||||||
/*
|
|
||||||
* A NMI might have interrupted the above sequence so check whether
|
|
||||||
* the seconds value has changed which indicates that the NMI took
|
|
||||||
* longer than the UIP bit was set. Unlikely, but possible and
|
|
||||||
* there is also virt...
|
|
||||||
*/
|
|
||||||
retry |= time->tm_sec != CMOS_READ(RTC_SECONDS);
|
|
||||||
|
|
||||||
spin_unlock_irqrestore(&rtc_lock, flags);
|
p->ctrl = CMOS_READ(RTC_CONTROL);
|
||||||
|
}
|
||||||
|
|
||||||
if (retry)
|
unsigned int mc146818_get_time(struct rtc_time *time)
|
||||||
goto again;
|
{
|
||||||
|
struct mc146818_get_time_callback_param p = {
|
||||||
|
.time = time
|
||||||
|
};
|
||||||
|
|
||||||
if (!(ctrl & RTC_DM_BINARY) || RTC_ALWAYS_BCD)
|
if (!mc146818_avoid_UIP(mc146818_get_time_callback, &p)) {
|
||||||
|
memset(time, 0, sizeof(*time));
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!(p.ctrl & RTC_DM_BINARY) || RTC_ALWAYS_BCD)
|
||||||
{
|
{
|
||||||
time->tm_sec = bcd2bin(time->tm_sec);
|
time->tm_sec = bcd2bin(time->tm_sec);
|
||||||
time->tm_min = bcd2bin(time->tm_min);
|
time->tm_min = bcd2bin(time->tm_min);
|
||||||
|
@ -193,15 +164,19 @@ again:
|
||||||
time->tm_mday = bcd2bin(time->tm_mday);
|
time->tm_mday = bcd2bin(time->tm_mday);
|
||||||
time->tm_mon = bcd2bin(time->tm_mon);
|
time->tm_mon = bcd2bin(time->tm_mon);
|
||||||
time->tm_year = bcd2bin(time->tm_year);
|
time->tm_year = bcd2bin(time->tm_year);
|
||||||
century = bcd2bin(century);
|
#ifdef CONFIG_ACPI
|
||||||
|
p.century = bcd2bin(p.century);
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef CONFIG_MACH_DECSTATION
|
#ifdef CONFIG_MACH_DECSTATION
|
||||||
time->tm_year += real_year - 72;
|
time->tm_year += p.real_year - 72;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (century > 20)
|
#ifdef CONFIG_ACPI
|
||||||
time->tm_year += (century - 19) * 100;
|
if (p.century > 20)
|
||||||
|
time->tm_year += (p.century - 19) * 100;
|
||||||
|
#endif
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Account for differences between how the RTC uses the values
|
* Account for differences between how the RTC uses the values
|
||||||
|
|
Loading…
Reference in New Issue