| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * On-Chip RTC Support available on RZ/G3S SoC
- *
- * Copyright (C) 2024 Renesas Electronics Corp.
- */
- #include <linux/bcd.h>
- #include <linux/bitfield.h>
- #include <linux/cleanup.h>
- #include <linux/clk.h>
- #include <linux/completion.h>
- #include <linux/delay.h>
- #include <linux/iopoll.h>
- #include <linux/interrupt.h>
- #include <linux/jiffies.h>
- #include <linux/of.h>
- #include <linux/platform_device.h>
- #include <linux/pm_runtime.h>
- #include <linux/reset.h>
- #include <linux/rtc.h>
- /* Counter registers. */
- #define RTCA3_RSECCNT 0x2
- #define RTCA3_RSECCNT_SEC GENMASK(6, 0)
- #define RTCA3_RMINCNT 0x4
- #define RTCA3_RMINCNT_MIN GENMASK(6, 0)
- #define RTCA3_RHRCNT 0x6
- #define RTCA3_RHRCNT_HR GENMASK(5, 0)
- #define RTCA3_RHRCNT_PM BIT(6)
- #define RTCA3_RWKCNT 0x8
- #define RTCA3_RWKCNT_WK GENMASK(2, 0)
- #define RTCA3_RDAYCNT 0xa
- #define RTCA3_RDAYCNT_DAY GENMASK(5, 0)
- #define RTCA3_RMONCNT 0xc
- #define RTCA3_RMONCNT_MONTH GENMASK(4, 0)
- #define RTCA3_RYRCNT 0xe
- #define RTCA3_RYRCNT_YEAR GENMASK(7, 0)
- /* Alarm registers. */
- #define RTCA3_RSECAR 0x10
- #define RTCA3_RSECAR_SEC GENMASK(6, 0)
- #define RTCA3_RMINAR 0x12
- #define RTCA3_RMINAR_MIN GENMASK(6, 0)
- #define RTCA3_RHRAR 0x14
- #define RTCA3_RHRAR_HR GENMASK(5, 0)
- #define RTCA3_RHRAR_PM BIT(6)
- #define RTCA3_RWKAR 0x16
- #define RTCA3_RWKAR_DAYW GENMASK(2, 0)
- #define RTCA3_RDAYAR 0x18
- #define RTCA3_RDAYAR_DATE GENMASK(5, 0)
- #define RTCA3_RMONAR 0x1a
- #define RTCA3_RMONAR_MON GENMASK(4, 0)
- #define RTCA3_RYRAR 0x1c
- #define RTCA3_RYRAR_YR GENMASK(7, 0)
- #define RTCA3_RYRAREN 0x1e
- /* Alarm enable bit (for all alarm registers). */
- #define RTCA3_AR_ENB BIT(7)
- /* Control registers. */
- #define RTCA3_RCR1 0x22
- #define RTCA3_RCR1_AIE BIT(0)
- #define RTCA3_RCR1_CIE BIT(1)
- #define RTCA3_RCR1_PIE BIT(2)
- #define RTCA3_RCR1_PES GENMASK(7, 4)
- #define RTCA3_RCR1_PES_1_64_SEC 0x8
- #define RTCA3_RCR2 0x24
- #define RTCA3_RCR2_START BIT(0)
- #define RTCA3_RCR2_RESET BIT(1)
- #define RTCA3_RCR2_AADJE BIT(4)
- #define RTCA3_RCR2_ADJP BIT(5)
- #define RTCA3_RCR2_HR24 BIT(6)
- #define RTCA3_RCR2_CNTMD BIT(7)
- #define RTCA3_RSR 0x20
- #define RTCA3_RSR_AF BIT(0)
- #define RTCA3_RSR_CF BIT(1)
- #define RTCA3_RSR_PF BIT(2)
- #define RTCA3_RADJ 0x2e
- #define RTCA3_RADJ_ADJ GENMASK(5, 0)
- #define RTCA3_RADJ_ADJ_MAX 0x3f
- #define RTCA3_RADJ_PMADJ GENMASK(7, 6)
- #define RTCA3_RADJ_PMADJ_NONE 0
- #define RTCA3_RADJ_PMADJ_ADD 1
- #define RTCA3_RADJ_PMADJ_SUB 2
- /* Polling operation timeouts. */
- #define RTCA3_DEFAULT_TIMEOUT_US 150
- #define RTCA3_IRQSET_TIMEOUT_US 5000
- #define RTCA3_START_TIMEOUT_US 150000
- #define RTCA3_RESET_TIMEOUT_US 200000
- /**
- * enum rtca3_alrm_set_step - RTCA3 alarm set steps
- * @RTCA3_ALRM_SSTEP_DONE: alarm setup done step
- * @RTCA3_ALRM_SSTEP_IRQ: two 1/64 periodic IRQs were generated step
- * @RTCA3_ALRM_SSTEP_INIT: alarm setup initialization step
- */
- enum rtca3_alrm_set_step {
- RTCA3_ALRM_SSTEP_DONE = 0,
- RTCA3_ALRM_SSTEP_IRQ = 1,
- RTCA3_ALRM_SSTEP_INIT = 3,
- };
- /**
- * struct rtca3_ppb_per_cycle - PPB per cycle
- * @ten_sec: PPB per cycle in 10 seconds adjutment mode
- * @sixty_sec: PPB per cycle in 60 seconds adjustment mode
- */
- struct rtca3_ppb_per_cycle {
- int ten_sec;
- int sixty_sec;
- };
- /**
- * struct rtca3_priv - RTCA3 private data structure
- * @base: base address
- * @rtc_dev: RTC device
- * @rstc: reset control
- * @set_alarm_completion: alarm setup completion
- * @alrm_sstep: alarm setup step (see enum rtca3_alrm_set_step)
- * @lock: device lock
- * @ppb: ppb per cycle for each the available adjustment modes
- * @wakeup_irq: wakeup IRQ
- */
- struct rtca3_priv {
- void __iomem *base;
- struct rtc_device *rtc_dev;
- struct reset_control *rstc;
- struct completion set_alarm_completion;
- atomic_t alrm_sstep;
- spinlock_t lock;
- struct rtca3_ppb_per_cycle ppb;
- int wakeup_irq;
- };
- static void rtca3_byte_update_bits(struct rtca3_priv *priv, u8 off, u8 mask, u8 val)
- {
- u8 tmp;
- tmp = readb(priv->base + off);
- tmp &= ~mask;
- tmp |= (val & mask);
- writeb(tmp, priv->base + off);
- }
- static u8 rtca3_alarm_handler_helper(struct rtca3_priv *priv)
- {
- u8 val, pending;
- val = readb(priv->base + RTCA3_RSR);
- pending = val & RTCA3_RSR_AF;
- writeb(val & ~pending, priv->base + RTCA3_RSR);
- if (pending)
- rtc_update_irq(priv->rtc_dev, 1, RTC_AF | RTC_IRQF);
- return pending;
- }
- static irqreturn_t rtca3_alarm_handler(int irq, void *dev_id)
- {
- struct rtca3_priv *priv = dev_id;
- u8 pending;
- guard(spinlock)(&priv->lock);
- pending = rtca3_alarm_handler_helper(priv);
- return IRQ_RETVAL(pending);
- }
- static irqreturn_t rtca3_periodic_handler(int irq, void *dev_id)
- {
- struct rtca3_priv *priv = dev_id;
- u8 val, pending;
- guard(spinlock)(&priv->lock);
- val = readb(priv->base + RTCA3_RSR);
- pending = val & RTCA3_RSR_PF;
- if (pending) {
- writeb(val & ~pending, priv->base + RTCA3_RSR);
- if (atomic_read(&priv->alrm_sstep) > RTCA3_ALRM_SSTEP_IRQ) {
- /* Alarm setup in progress. */
- atomic_dec(&priv->alrm_sstep);
- if (atomic_read(&priv->alrm_sstep) == RTCA3_ALRM_SSTEP_IRQ) {
- /*
- * We got 2 * 1/64 periodic interrupts. Disable
- * interrupt and let alarm setup continue.
- */
- rtca3_byte_update_bits(priv, RTCA3_RCR1,
- RTCA3_RCR1_PIE, 0);
- readb_poll_timeout_atomic(priv->base + RTCA3_RCR1, val,
- !(val & RTCA3_RCR1_PIE),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- complete(&priv->set_alarm_completion);
- }
- }
- }
- return IRQ_RETVAL(pending);
- }
- static void rtca3_prepare_cntalrm_regs_for_read(struct rtca3_priv *priv, bool cnt)
- {
- /* Offset b/w time and alarm registers. */
- u8 offset = cnt ? 0 : 0xe;
- /*
- * According to HW manual (section 22.6.4. Notes on writing to and
- * reading from registers) after writing to count registers, alarm
- * registers, year alarm enable register, bits RCR2.AADJE, AADJP,
- * and HR24 register, we need to do 3 empty reads before being
- * able to fetch the registers content.
- */
- for (u8 i = 0; i < 3; i++) {
- readb(priv->base + RTCA3_RSECCNT + offset);
- readb(priv->base + RTCA3_RMINCNT + offset);
- readb(priv->base + RTCA3_RHRCNT + offset);
- readb(priv->base + RTCA3_RWKCNT + offset);
- readb(priv->base + RTCA3_RDAYCNT + offset);
- readw(priv->base + RTCA3_RYRCNT + offset);
- if (!cnt)
- readb(priv->base + RTCA3_RYRAREN);
- }
- }
- static int rtca3_read_time(struct device *dev, struct rtc_time *tm)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- u8 sec, min, hour, wday, mday, month, tmp;
- u8 trials = 0;
- u32 year100;
- u16 year;
- guard(spinlock_irqsave)(&priv->lock);
- tmp = readb(priv->base + RTCA3_RCR2);
- if (!(tmp & RTCA3_RCR2_START))
- return -EINVAL;
- do {
- /* Clear carry interrupt. */
- rtca3_byte_update_bits(priv, RTCA3_RSR, RTCA3_RSR_CF, 0);
- /* Read counters. */
- sec = readb(priv->base + RTCA3_RSECCNT);
- min = readb(priv->base + RTCA3_RMINCNT);
- hour = readb(priv->base + RTCA3_RHRCNT);
- wday = readb(priv->base + RTCA3_RWKCNT);
- mday = readb(priv->base + RTCA3_RDAYCNT);
- month = readb(priv->base + RTCA3_RMONCNT);
- year = readw(priv->base + RTCA3_RYRCNT);
- tmp = readb(priv->base + RTCA3_RSR);
- /*
- * We cannot generate carries due to reading 64Hz counter as
- * the driver doesn't implement carry, thus, carries will be
- * generated once per seconds. Add a timeout of 5 trials here
- * to avoid infinite loop, if any.
- */
- } while ((tmp & RTCA3_RSR_CF) && ++trials < 5);
- if (trials >= 5)
- return -ETIMEDOUT;
- tm->tm_sec = bcd2bin(FIELD_GET(RTCA3_RSECCNT_SEC, sec));
- tm->tm_min = bcd2bin(FIELD_GET(RTCA3_RMINCNT_MIN, min));
- tm->tm_hour = bcd2bin(FIELD_GET(RTCA3_RHRCNT_HR, hour));
- tm->tm_wday = bcd2bin(FIELD_GET(RTCA3_RWKCNT_WK, wday));
- tm->tm_mday = bcd2bin(FIELD_GET(RTCA3_RDAYCNT_DAY, mday));
- tm->tm_mon = bcd2bin(FIELD_GET(RTCA3_RMONCNT_MONTH, month)) - 1;
- year = FIELD_GET(RTCA3_RYRCNT_YEAR, year);
- year100 = bcd2bin((year == 0x99) ? 0x19 : 0x20);
- tm->tm_year = (year100 * 100 + bcd2bin(year)) - 1900;
- return 0;
- }
- static int rtca3_set_time(struct device *dev, struct rtc_time *tm)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- u8 rcr2, tmp;
- int ret;
- guard(spinlock_irqsave)(&priv->lock);
- /* Stop the RTC. */
- rcr2 = readb(priv->base + RTCA3_RCR2);
- writeb(rcr2 & ~RTCA3_RCR2_START, priv->base + RTCA3_RCR2);
- ret = readb_poll_timeout_atomic(priv->base + RTCA3_RCR2, tmp,
- !(tmp & RTCA3_RCR2_START),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- if (ret)
- return ret;
- /* Update time. */
- writeb(bin2bcd(tm->tm_sec), priv->base + RTCA3_RSECCNT);
- writeb(bin2bcd(tm->tm_min), priv->base + RTCA3_RMINCNT);
- writeb(bin2bcd(tm->tm_hour), priv->base + RTCA3_RHRCNT);
- writeb(bin2bcd(tm->tm_wday), priv->base + RTCA3_RWKCNT);
- writeb(bin2bcd(tm->tm_mday), priv->base + RTCA3_RDAYCNT);
- writeb(bin2bcd(tm->tm_mon + 1), priv->base + RTCA3_RMONCNT);
- writew(bin2bcd(tm->tm_year % 100), priv->base + RTCA3_RYRCNT);
- /* Make sure we can read back the counters. */
- rtca3_prepare_cntalrm_regs_for_read(priv, true);
- /* Start RTC. */
- writeb(rcr2 | RTCA3_RCR2_START, priv->base + RTCA3_RCR2);
- return readb_poll_timeout_atomic(priv->base + RTCA3_RCR2, tmp,
- (tmp & RTCA3_RCR2_START),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- }
- static int rtca3_alarm_irq_set_helper(struct rtca3_priv *priv,
- u8 interrupts,
- unsigned int enabled)
- {
- u8 tmp, val;
- if (enabled) {
- /*
- * AIE, CIE, PIE bit indexes in RSR corresponds with
- * those on RCR1. Same interrupts mask can be used.
- */
- rtca3_byte_update_bits(priv, RTCA3_RSR, interrupts, 0);
- val = interrupts;
- } else {
- val = 0;
- }
- rtca3_byte_update_bits(priv, RTCA3_RCR1, interrupts, val);
- return readb_poll_timeout_atomic(priv->base + RTCA3_RCR1, tmp,
- ((tmp & interrupts) == val),
- 10, RTCA3_IRQSET_TIMEOUT_US);
- }
- static int rtca3_alarm_irq_enable(struct device *dev, unsigned int enabled)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- guard(spinlock_irqsave)(&priv->lock);
- return rtca3_alarm_irq_set_helper(priv, RTCA3_RCR1_AIE, enabled);
- }
- static int rtca3_read_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- u8 sec, min, hour, wday, mday, month;
- struct rtc_time *tm = &wkalrm->time;
- u32 year100;
- u16 year;
- guard(spinlock_irqsave)(&priv->lock);
- sec = readb(priv->base + RTCA3_RSECAR);
- min = readb(priv->base + RTCA3_RMINAR);
- hour = readb(priv->base + RTCA3_RHRAR);
- wday = readb(priv->base + RTCA3_RWKAR);
- mday = readb(priv->base + RTCA3_RDAYAR);
- month = readb(priv->base + RTCA3_RMONAR);
- year = readw(priv->base + RTCA3_RYRAR);
- tm->tm_sec = bcd2bin(FIELD_GET(RTCA3_RSECAR_SEC, sec));
- tm->tm_min = bcd2bin(FIELD_GET(RTCA3_RMINAR_MIN, min));
- tm->tm_hour = bcd2bin(FIELD_GET(RTCA3_RHRAR_HR, hour));
- tm->tm_wday = bcd2bin(FIELD_GET(RTCA3_RWKAR_DAYW, wday));
- tm->tm_mday = bcd2bin(FIELD_GET(RTCA3_RDAYAR_DATE, mday));
- tm->tm_mon = bcd2bin(FIELD_GET(RTCA3_RMONAR_MON, month)) - 1;
- year = FIELD_GET(RTCA3_RYRAR_YR, year);
- year100 = bcd2bin((year == 0x99) ? 0x19 : 0x20);
- tm->tm_year = (year100 * 100 + bcd2bin(year)) - 1900;
- wkalrm->enabled = !!(readb(priv->base + RTCA3_RCR1) & RTCA3_RCR1_AIE);
- return 0;
- }
- static int rtca3_set_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- struct rtc_time *tm = &wkalrm->time;
- u8 rcr1, tmp;
- int ret;
- scoped_guard(spinlock_irqsave, &priv->lock) {
- tmp = readb(priv->base + RTCA3_RCR2);
- if (!(tmp & RTCA3_RCR2_START))
- return -EPERM;
- /* Disable AIE to prevent false interrupts. */
- rcr1 = readb(priv->base + RTCA3_RCR1);
- rcr1 &= ~RTCA3_RCR1_AIE;
- writeb(rcr1, priv->base + RTCA3_RCR1);
- ret = readb_poll_timeout_atomic(priv->base + RTCA3_RCR1, tmp,
- !(tmp & RTCA3_RCR1_AIE),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- if (ret)
- return ret;
- /* Set the time and enable the alarm. */
- writeb(RTCA3_AR_ENB | bin2bcd(tm->tm_sec), priv->base + RTCA3_RSECAR);
- writeb(RTCA3_AR_ENB | bin2bcd(tm->tm_min), priv->base + RTCA3_RMINAR);
- writeb(RTCA3_AR_ENB | bin2bcd(tm->tm_hour), priv->base + RTCA3_RHRAR);
- writeb(RTCA3_AR_ENB | bin2bcd(tm->tm_wday), priv->base + RTCA3_RWKAR);
- writeb(RTCA3_AR_ENB | bin2bcd(tm->tm_mday), priv->base + RTCA3_RDAYAR);
- writeb(RTCA3_AR_ENB | bin2bcd(tm->tm_mon + 1), priv->base + RTCA3_RMONAR);
- writew(bin2bcd(tm->tm_year % 100), priv->base + RTCA3_RYRAR);
- writeb(RTCA3_AR_ENB, priv->base + RTCA3_RYRAREN);
- /* Make sure we can read back the counters. */
- rtca3_prepare_cntalrm_regs_for_read(priv, false);
- /* Need to wait for 2 * 1/64 periodic interrupts to be generated. */
- atomic_set(&priv->alrm_sstep, RTCA3_ALRM_SSTEP_INIT);
- reinit_completion(&priv->set_alarm_completion);
- /* Enable periodic interrupt. */
- rcr1 |= RTCA3_RCR1_PIE;
- writeb(rcr1, priv->base + RTCA3_RCR1);
- ret = readb_poll_timeout_atomic(priv->base + RTCA3_RCR1, tmp,
- (tmp & RTCA3_RCR1_PIE),
- 10, RTCA3_IRQSET_TIMEOUT_US);
- }
- if (ret)
- goto setup_failed;
- /* Wait for the 2 * 1/64 periodic interrupts. */
- ret = wait_for_completion_interruptible_timeout(&priv->set_alarm_completion,
- msecs_to_jiffies(500));
- if (ret <= 0) {
- ret = -ETIMEDOUT;
- goto setup_failed;
- }
- scoped_guard(spinlock_irqsave, &priv->lock) {
- ret = rtca3_alarm_irq_set_helper(priv, RTCA3_RCR1_AIE, wkalrm->enabled);
- atomic_set(&priv->alrm_sstep, RTCA3_ALRM_SSTEP_DONE);
- }
- return ret;
- setup_failed:
- scoped_guard(spinlock_irqsave, &priv->lock) {
- /*
- * Disable PIE to avoid interrupt storm in case HW needed more than
- * specified timeout for setup.
- */
- writeb(rcr1 & ~RTCA3_RCR1_PIE, priv->base + RTCA3_RCR1);
- readb_poll_timeout_atomic(priv->base + RTCA3_RCR1, tmp, !(tmp & ~RTCA3_RCR1_PIE),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- atomic_set(&priv->alrm_sstep, RTCA3_ALRM_SSTEP_DONE);
- }
- return ret;
- }
- static int rtca3_read_offset(struct device *dev, long *offset)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- u8 val, radj, cycles;
- u32 ppb_per_cycle;
- scoped_guard(spinlock_irqsave, &priv->lock) {
- radj = readb(priv->base + RTCA3_RADJ);
- val = readb(priv->base + RTCA3_RCR2);
- }
- cycles = FIELD_GET(RTCA3_RADJ_ADJ, radj);
- if (!cycles) {
- *offset = 0;
- return 0;
- }
- if (val & RTCA3_RCR2_ADJP)
- ppb_per_cycle = priv->ppb.ten_sec;
- else
- ppb_per_cycle = priv->ppb.sixty_sec;
- *offset = cycles * ppb_per_cycle;
- val = FIELD_GET(RTCA3_RADJ_PMADJ, radj);
- if (val == RTCA3_RADJ_PMADJ_SUB)
- *offset = -(*offset);
- return 0;
- }
- static int rtca3_set_offset(struct device *dev, long offset)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- int cycles, cycles10, cycles60;
- u8 radj, adjp, tmp;
- int ret;
- /*
- * Automatic time error adjustment could be set at intervals of 10
- * or 60 seconds.
- */
- cycles10 = DIV_ROUND_CLOSEST(offset, priv->ppb.ten_sec);
- cycles60 = DIV_ROUND_CLOSEST(offset, priv->ppb.sixty_sec);
- /* We can set b/w 1 and 63 clock cycles. */
- if (cycles60 >= -RTCA3_RADJ_ADJ_MAX &&
- cycles60 <= RTCA3_RADJ_ADJ_MAX) {
- cycles = cycles60;
- adjp = 0;
- } else if (cycles10 >= -RTCA3_RADJ_ADJ_MAX &&
- cycles10 <= RTCA3_RADJ_ADJ_MAX) {
- cycles = cycles10;
- adjp = RTCA3_RCR2_ADJP;
- } else {
- return -ERANGE;
- }
- radj = FIELD_PREP(RTCA3_RADJ_ADJ, abs(cycles));
- if (!cycles)
- radj |= FIELD_PREP(RTCA3_RADJ_PMADJ, RTCA3_RADJ_PMADJ_NONE);
- else if (cycles > 0)
- radj |= FIELD_PREP(RTCA3_RADJ_PMADJ, RTCA3_RADJ_PMADJ_ADD);
- else
- radj |= FIELD_PREP(RTCA3_RADJ_PMADJ, RTCA3_RADJ_PMADJ_SUB);
- guard(spinlock_irqsave)(&priv->lock);
- tmp = readb(priv->base + RTCA3_RCR2);
- if ((tmp & RTCA3_RCR2_ADJP) != adjp) {
- /* RADJ.PMADJ need to be set to zero before setting RCR2.ADJP. */
- writeb(0, priv->base + RTCA3_RADJ);
- ret = readb_poll_timeout_atomic(priv->base + RTCA3_RADJ, tmp, !tmp,
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- if (ret)
- return ret;
- rtca3_byte_update_bits(priv, RTCA3_RCR2, RTCA3_RCR2_ADJP, adjp);
- ret = readb_poll_timeout_atomic(priv->base + RTCA3_RCR2, tmp,
- ((tmp & RTCA3_RCR2_ADJP) == adjp),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- if (ret)
- return ret;
- }
- writeb(radj, priv->base + RTCA3_RADJ);
- return readb_poll_timeout_atomic(priv->base + RTCA3_RADJ, tmp, (tmp == radj),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- }
- static const struct rtc_class_ops rtca3_ops = {
- .read_time = rtca3_read_time,
- .set_time = rtca3_set_time,
- .read_alarm = rtca3_read_alarm,
- .set_alarm = rtca3_set_alarm,
- .alarm_irq_enable = rtca3_alarm_irq_enable,
- .set_offset = rtca3_set_offset,
- .read_offset = rtca3_read_offset,
- };
- static int rtca3_initial_setup(struct clk *clk, struct rtca3_priv *priv)
- {
- unsigned long osc32k_rate;
- u8 val, tmp, mask;
- u32 sleep_us;
- int ret;
- osc32k_rate = clk_get_rate(clk);
- if (!osc32k_rate)
- return -EINVAL;
- sleep_us = DIV_ROUND_UP_ULL(1000000ULL, osc32k_rate) * 6;
- priv->ppb.ten_sec = DIV_ROUND_CLOSEST_ULL(1000000000ULL, (osc32k_rate * 10));
- priv->ppb.sixty_sec = DIV_ROUND_CLOSEST_ULL(1000000000ULL, (osc32k_rate * 60));
- /*
- * According to HW manual (section 22.4.2. Clock and count mode setting procedure)
- * we need to wait at least 6 cycles of the 32KHz clock after clock was enabled.
- */
- usleep_range(sleep_us, sleep_us + 10);
- mask = RTCA3_RCR2_START | RTCA3_RCR2_HR24;
- val = readb(priv->base + RTCA3_RCR2);
- /* Only disable the interrupts if already started in 24 hours and calendar count mode. */
- if ((val & mask) == mask) {
- /* Disable all interrupts. */
- mask = RTCA3_RCR1_AIE | RTCA3_RCR1_CIE | RTCA3_RCR1_PIE;
- return rtca3_alarm_irq_set_helper(priv, mask, 0);
- }
- /* Reconfigure the RTC in 24 hours and calendar count mode. */
- mask = RTCA3_RCR2_START | RTCA3_RCR2_CNTMD;
- writeb(0, priv->base + RTCA3_RCR2);
- ret = readb_poll_timeout(priv->base + RTCA3_RCR2, tmp, !(tmp & mask),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- if (ret)
- return ret;
- /*
- * Set 24 hours mode. According to HW manual (section 22.3.19. RTC Control
- * Register 2) this needs to be done separate from stop operation.
- */
- mask = RTCA3_RCR2_HR24;
- val = RTCA3_RCR2_HR24;
- writeb(val, priv->base + RTCA3_RCR2);
- ret = readb_poll_timeout(priv->base + RTCA3_RCR2, tmp, (tmp & mask),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- if (ret)
- return ret;
- /* Execute reset. */
- mask = RTCA3_RCR2_RESET;
- writeb(val | RTCA3_RCR2_RESET, priv->base + RTCA3_RCR2);
- ret = readb_poll_timeout(priv->base + RTCA3_RCR2, tmp, !(tmp & mask),
- 10, RTCA3_RESET_TIMEOUT_US);
- if (ret)
- return ret;
- /*
- * According to HW manual (section 22.6.3. Notes on writing to and reading
- * from registers) after reset we need to wait 6 clock cycles before
- * writing to RTC registers.
- */
- usleep_range(sleep_us, sleep_us + 10);
- /* Set no adjustment. */
- writeb(0, priv->base + RTCA3_RADJ);
- ret = readb_poll_timeout(priv->base + RTCA3_RADJ, tmp, !tmp, 10,
- RTCA3_DEFAULT_TIMEOUT_US);
- /* Start the RTC and enable automatic time error adjustment. */
- mask = RTCA3_RCR2_START | RTCA3_RCR2_AADJE;
- val |= RTCA3_RCR2_START | RTCA3_RCR2_AADJE;
- writeb(val, priv->base + RTCA3_RCR2);
- ret = readb_poll_timeout(priv->base + RTCA3_RCR2, tmp, ((tmp & mask) == mask),
- 10, RTCA3_START_TIMEOUT_US);
- if (ret)
- return ret;
- /*
- * According to HW manual (section 22.6.4. Notes on writing to and reading
- * from registers) we need to wait 1/128 seconds while the clock is operating
- * (RCR2.START bit = 1) to be able to read the counters after a return from
- * reset.
- */
- usleep_range(8000, 9000);
- /* Set period interrupt to 1/64 seconds. It is necessary for alarm setup. */
- val = FIELD_PREP(RTCA3_RCR1_PES, RTCA3_RCR1_PES_1_64_SEC);
- rtca3_byte_update_bits(priv, RTCA3_RCR1, RTCA3_RCR1_PES, val);
- return readb_poll_timeout(priv->base + RTCA3_RCR1, tmp, ((tmp & RTCA3_RCR1_PES) == val),
- 10, RTCA3_DEFAULT_TIMEOUT_US);
- }
- static int rtca3_request_irqs(struct platform_device *pdev, struct rtca3_priv *priv)
- {
- struct device *dev = &pdev->dev;
- int ret, irq;
- irq = platform_get_irq_byname(pdev, "alarm");
- if (irq < 0)
- return dev_err_probe(dev, irq, "Failed to get alarm IRQ!\n");
- ret = devm_request_irq(dev, irq, rtca3_alarm_handler, 0, "rtca3-alarm", priv);
- if (ret)
- return dev_err_probe(dev, ret, "Failed to request alarm IRQ!\n");
- priv->wakeup_irq = irq;
- irq = platform_get_irq_byname(pdev, "period");
- if (irq < 0)
- return dev_err_probe(dev, irq, "Failed to get period IRQ!\n");
- ret = devm_request_irq(dev, irq, rtca3_periodic_handler, 0, "rtca3-period", priv);
- if (ret)
- return dev_err_probe(dev, ret, "Failed to request period IRQ!\n");
- /*
- * Driver doesn't implement carry handler. Just get the IRQ here
- * for backward compatibility, in case carry support will be added later.
- */
- irq = platform_get_irq_byname(pdev, "carry");
- if (irq < 0)
- return dev_err_probe(dev, irq, "Failed to get carry IRQ!\n");
- return 0;
- }
- static void rtca3_action(void *data)
- {
- struct device *dev = data;
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- int ret;
- ret = reset_control_assert(priv->rstc);
- if (ret)
- dev_err(dev, "Failed to de-assert reset!");
- ret = pm_runtime_put_sync(dev);
- if (ret < 0)
- dev_err(dev, "Failed to runtime suspend!");
- }
- static int rtca3_probe(struct platform_device *pdev)
- {
- struct device *dev = &pdev->dev;
- struct rtca3_priv *priv;
- struct clk *clk;
- int ret;
- priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
- if (!priv)
- return -ENOMEM;
- priv->base = devm_platform_ioremap_resource(pdev, 0);
- if (IS_ERR(priv->base))
- return PTR_ERR(priv->base);
- ret = devm_pm_runtime_enable(dev);
- if (ret)
- return ret;
- priv->rstc = devm_reset_control_array_get_shared(dev);
- if (IS_ERR(priv->rstc))
- return PTR_ERR(priv->rstc);
- ret = pm_runtime_resume_and_get(dev);
- if (ret)
- return ret;
- ret = reset_control_deassert(priv->rstc);
- if (ret) {
- pm_runtime_put_sync(dev);
- return ret;
- }
- dev_set_drvdata(dev, priv);
- ret = devm_add_action_or_reset(dev, rtca3_action, dev);
- if (ret)
- return ret;
- /*
- * This must be an always-on clock to keep the RTC running even after
- * driver is unbinded.
- */
- clk = devm_clk_get_enabled(dev, "counter");
- if (IS_ERR(clk))
- return PTR_ERR(clk);
- spin_lock_init(&priv->lock);
- atomic_set(&priv->alrm_sstep, RTCA3_ALRM_SSTEP_DONE);
- init_completion(&priv->set_alarm_completion);
- ret = rtca3_initial_setup(clk, priv);
- if (ret)
- return dev_err_probe(dev, ret, "Failed to setup the RTC!\n");
- ret = rtca3_request_irqs(pdev, priv);
- if (ret)
- return ret;
- device_init_wakeup(&pdev->dev, true);
- priv->rtc_dev = devm_rtc_allocate_device(&pdev->dev);
- if (IS_ERR(priv->rtc_dev))
- return PTR_ERR(priv->rtc_dev);
- priv->rtc_dev->ops = &rtca3_ops;
- priv->rtc_dev->range_min = RTC_TIMESTAMP_BEGIN_2000;
- priv->rtc_dev->range_max = RTC_TIMESTAMP_END_2099;
- return devm_rtc_register_device(priv->rtc_dev);
- }
- static void rtca3_remove(struct platform_device *pdev)
- {
- struct rtca3_priv *priv = platform_get_drvdata(pdev);
- guard(spinlock_irqsave)(&priv->lock);
- /*
- * Disable alarm, periodic interrupts. The RTC device cannot
- * power up the system.
- */
- rtca3_alarm_irq_set_helper(priv, RTCA3_RCR1_AIE | RTCA3_RCR1_PIE, 0);
- }
- static int rtca3_suspend(struct device *dev)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- if (!device_may_wakeup(dev))
- return 0;
- /* Alarm setup in progress. */
- if (atomic_read(&priv->alrm_sstep) != RTCA3_ALRM_SSTEP_DONE)
- return -EBUSY;
- enable_irq_wake(priv->wakeup_irq);
- return 0;
- }
- static int rtca3_clean_alarm(struct rtca3_priv *priv)
- {
- struct rtc_device *rtc_dev = priv->rtc_dev;
- time64_t alarm_time, now;
- struct rtc_wkalrm alarm;
- struct rtc_time tm;
- u8 pending;
- int ret;
- ret = rtc_read_alarm(rtc_dev, &alarm);
- if (ret)
- return ret;
- if (!alarm.enabled)
- return 0;
- ret = rtc_read_time(rtc_dev, &tm);
- if (ret)
- return ret;
- alarm_time = rtc_tm_to_time64(&alarm.time);
- now = rtc_tm_to_time64(&tm);
- if (alarm_time >= now)
- return 0;
- /*
- * Heuristically, it has been determined that when returning from deep
- * sleep state the RTCA3_RSR.AF is zero even though the alarm expired.
- * Call again the rtc_update_irq() if alarm helper detects this.
- */
- guard(spinlock_irqsave)(&priv->lock);
- pending = rtca3_alarm_handler_helper(priv);
- if (!pending)
- rtc_update_irq(priv->rtc_dev, 1, RTC_AF | RTC_IRQF);
- return 0;
- }
- static int rtca3_resume(struct device *dev)
- {
- struct rtca3_priv *priv = dev_get_drvdata(dev);
- if (!device_may_wakeup(dev))
- return 0;
- disable_irq_wake(priv->wakeup_irq);
- /*
- * According to the HW manual (section 22.6.4 Notes on writing to
- * and reading from registers) we need to wait 1/128 seconds while
- * RCR2.START = 1 to be able to read the counters after a return from low
- * power consumption state.
- */
- mdelay(8);
- /*
- * The alarm cannot wake the system from deep sleep states. In case
- * we return from deep sleep states and the alarm expired we need
- * to disable it to avoid failures when setting another alarm.
- */
- return rtca3_clean_alarm(priv);
- }
- static DEFINE_SIMPLE_DEV_PM_OPS(rtca3_pm_ops, rtca3_suspend, rtca3_resume);
- static const struct of_device_id rtca3_of_match[] = {
- { .compatible = "renesas,rz-rtca3", },
- { /* sentinel */ }
- };
- MODULE_DEVICE_TABLE(of, rtca3_of_match);
- static struct platform_driver rtca3_platform_driver = {
- .driver = {
- .name = "rtc-rtca3",
- .pm = pm_ptr(&rtca3_pm_ops),
- .of_match_table = rtca3_of_match,
- },
- .probe = rtca3_probe,
- .remove = rtca3_remove,
- };
- module_platform_driver(rtca3_platform_driver);
- MODULE_DESCRIPTION("Renesas RTCA-3 RTC driver");
- MODULE_AUTHOR("Claudiu Beznea <claudiu.beznea.uj@bp.renesas.com>");
- MODULE_LICENSE("GPL");
|