mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-15 00:34:10 +08:00
rtc: rzn1: Add alarm support
The RZN1 RTC can trigger an interrupt when reaching a particular date up to 7 days ahead. Bring support for this alarm. One drawback though, the granularity is about a minute. Signed-off-by: Miquel Raynal <miquel.raynal@bootlin.com> Signed-off-by: Alexandre Belloni <alexandre.belloni@bootlin.com> Link: https://lore.kernel.org/r/20220516082504.33913-4-miquel.raynal@bootlin.com
This commit is contained in:
parent
deeb4b5393
commit
b5ad1bf00d
@ -156,14 +156,107 @@ static int rzn1_rtc_set_time(struct device *dev, struct rtc_time *tm)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static irqreturn_t rzn1_rtc_alarm_irq(int irq, void *dev_id)
|
||||||
|
{
|
||||||
|
struct rzn1_rtc *rtc = dev_id;
|
||||||
|
|
||||||
|
rtc_update_irq(rtc->rtcdev, 1, RTC_AF | RTC_IRQF);
|
||||||
|
|
||||||
|
return IRQ_HANDLED;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int rzn1_rtc_alarm_irq_enable(struct device *dev, unsigned int enable)
|
||||||
|
{
|
||||||
|
struct rzn1_rtc *rtc = dev_get_drvdata(dev);
|
||||||
|
u32 ctl1 = readl(rtc->base + RZN1_RTC_CTL1);
|
||||||
|
|
||||||
|
if (enable)
|
||||||
|
ctl1 |= RZN1_RTC_CTL1_ALME;
|
||||||
|
else
|
||||||
|
ctl1 &= ~RZN1_RTC_CTL1_ALME;
|
||||||
|
|
||||||
|
writel(ctl1, rtc->base + RZN1_RTC_CTL1);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int rzn1_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
|
||||||
|
{
|
||||||
|
struct rzn1_rtc *rtc = dev_get_drvdata(dev);
|
||||||
|
struct rtc_time *tm = &alrm->time;
|
||||||
|
unsigned int min, hour, wday, delta_days;
|
||||||
|
time64_t alarm;
|
||||||
|
u32 ctl1;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = rzn1_rtc_read_time(dev, tm);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
min = readl(rtc->base + RZN1_RTC_ALM);
|
||||||
|
hour = readl(rtc->base + RZN1_RTC_ALH);
|
||||||
|
wday = readl(rtc->base + RZN1_RTC_ALW);
|
||||||
|
|
||||||
|
tm->tm_sec = 0;
|
||||||
|
tm->tm_min = bcd2bin(min);
|
||||||
|
tm->tm_hour = bcd2bin(hour);
|
||||||
|
delta_days = ((fls(wday) - 1) - tm->tm_wday + 7) % 7;
|
||||||
|
tm->tm_wday = fls(wday) - 1;
|
||||||
|
|
||||||
|
if (delta_days) {
|
||||||
|
alarm = rtc_tm_to_time64(tm) + (delta_days * 86400);
|
||||||
|
rtc_time64_to_tm(alarm, tm);
|
||||||
|
}
|
||||||
|
|
||||||
|
ctl1 = readl(rtc->base + RZN1_RTC_CTL1);
|
||||||
|
alrm->enabled = !!(ctl1 & RZN1_RTC_CTL1_ALME);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int rzn1_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
|
||||||
|
{
|
||||||
|
struct rzn1_rtc *rtc = dev_get_drvdata(dev);
|
||||||
|
struct rtc_time *tm = &alrm->time, tm_now;
|
||||||
|
unsigned long alarm, farest;
|
||||||
|
unsigned int days_ahead, wday;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = rzn1_rtc_read_time(dev, &tm_now);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
/* We cannot set alarms more than one week ahead */
|
||||||
|
farest = rtc_tm_to_time64(&tm_now) + (7 * 86400);
|
||||||
|
alarm = rtc_tm_to_time64(tm);
|
||||||
|
if (time_after(alarm, farest))
|
||||||
|
return -ERANGE;
|
||||||
|
|
||||||
|
/* Convert alarm day into week day */
|
||||||
|
days_ahead = tm->tm_mday - tm_now.tm_mday;
|
||||||
|
wday = (tm_now.tm_wday + days_ahead) % 7;
|
||||||
|
|
||||||
|
writel(bin2bcd(tm->tm_min), rtc->base + RZN1_RTC_ALM);
|
||||||
|
writel(bin2bcd(tm->tm_hour), rtc->base + RZN1_RTC_ALH);
|
||||||
|
writel(BIT(wday), rtc->base + RZN1_RTC_ALW);
|
||||||
|
|
||||||
|
rzn1_rtc_alarm_irq_enable(dev, alrm->enabled);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static const struct rtc_class_ops rzn1_rtc_ops = {
|
static const struct rtc_class_ops rzn1_rtc_ops = {
|
||||||
.read_time = rzn1_rtc_read_time,
|
.read_time = rzn1_rtc_read_time,
|
||||||
.set_time = rzn1_rtc_set_time,
|
.set_time = rzn1_rtc_set_time,
|
||||||
|
.read_alarm = rzn1_rtc_read_alarm,
|
||||||
|
.set_alarm = rzn1_rtc_set_alarm,
|
||||||
|
.alarm_irq_enable = rzn1_rtc_alarm_irq_enable,
|
||||||
};
|
};
|
||||||
|
|
||||||
static int rzn1_rtc_probe(struct platform_device *pdev)
|
static int rzn1_rtc_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct rzn1_rtc *rtc;
|
struct rzn1_rtc *rtc;
|
||||||
|
int alarm_irq;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
rtc = devm_kzalloc(&pdev->dev, sizeof(*rtc), GFP_KERNEL);
|
rtc = devm_kzalloc(&pdev->dev, sizeof(*rtc), GFP_KERNEL);
|
||||||
@ -176,6 +269,10 @@ static int rzn1_rtc_probe(struct platform_device *pdev)
|
|||||||
if (IS_ERR(rtc->base))
|
if (IS_ERR(rtc->base))
|
||||||
return dev_err_probe(&pdev->dev, PTR_ERR(rtc->base), "Missing reg\n");
|
return dev_err_probe(&pdev->dev, PTR_ERR(rtc->base), "Missing reg\n");
|
||||||
|
|
||||||
|
alarm_irq = platform_get_irq(pdev, 0);
|
||||||
|
if (alarm_irq < 0)
|
||||||
|
return alarm_irq;
|
||||||
|
|
||||||
rtc->rtcdev = devm_rtc_allocate_device(&pdev->dev);
|
rtc->rtcdev = devm_rtc_allocate_device(&pdev->dev);
|
||||||
if (IS_ERR(rtc->rtcdev))
|
if (IS_ERR(rtc->rtcdev))
|
||||||
return PTR_ERR(rtc);
|
return PTR_ERR(rtc);
|
||||||
@ -183,7 +280,7 @@ static int rzn1_rtc_probe(struct platform_device *pdev)
|
|||||||
rtc->rtcdev->range_min = RTC_TIMESTAMP_BEGIN_2000;
|
rtc->rtcdev->range_min = RTC_TIMESTAMP_BEGIN_2000;
|
||||||
rtc->rtcdev->range_max = RTC_TIMESTAMP_END_2099;
|
rtc->rtcdev->range_max = RTC_TIMESTAMP_END_2099;
|
||||||
rtc->rtcdev->ops = &rzn1_rtc_ops;
|
rtc->rtcdev->ops = &rzn1_rtc_ops;
|
||||||
clear_bit(RTC_FEATURE_ALARM, rtc->rtcdev->features);
|
set_bit(RTC_FEATURE_ALARM_RES_MINUTE, rtc->rtcdev->features);
|
||||||
clear_bit(RTC_FEATURE_UPDATE_INTERRUPT, rtc->rtcdev->features);
|
clear_bit(RTC_FEATURE_UPDATE_INTERRUPT, rtc->rtcdev->features);
|
||||||
|
|
||||||
devm_pm_runtime_enable(&pdev->dev);
|
devm_pm_runtime_enable(&pdev->dev);
|
||||||
@ -201,6 +298,13 @@ static int rzn1_rtc_probe(struct platform_device *pdev)
|
|||||||
/* Disable all interrupts */
|
/* Disable all interrupts */
|
||||||
writel(0, rtc->base + RZN1_RTC_CTL1);
|
writel(0, rtc->base + RZN1_RTC_CTL1);
|
||||||
|
|
||||||
|
ret = devm_request_irq(&pdev->dev, alarm_irq, rzn1_rtc_alarm_irq, 0,
|
||||||
|
dev_name(&pdev->dev), rtc);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(&pdev->dev, "RTC timer interrupt not available\n");
|
||||||
|
goto dis_runtime_pm;
|
||||||
|
}
|
||||||
|
|
||||||
ret = devm_rtc_register_device(rtc->rtcdev);
|
ret = devm_rtc_register_device(rtc->rtcdev);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto dis_runtime_pm;
|
goto dis_runtime_pm;
|
||||||
|
Loading…
Reference in New Issue
Block a user