123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323 |
- #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/interrupt.h>
- #include <linux/spinlock.h>
- #include <linux/platform_device.h>
- #include <linux/log2.h>
- #include <linux/pm.h>
- #include <linux/of.h>
- #include <linux/of_platform.h>
- #include <linux/mc146818rtc.h>
- struct cmos_rtc {
- struct rtc_device *rtc;
- struct device *dev;
- int irq;
- struct resource *iomem;
- time64_t alarm_expires;
- void (*wake_on)(struct device *);
- void (*wake_off)(struct device *);
- u8 enabled_wake;
- u8 suspend_ctrl;
-
- u8 day_alrm;
- u8 mon_alrm;
- u8 century;
- struct rtc_wkalrm saved_wkalrm;
- };
- #define is_valid_irq(n) ((n) > 0)
- static const char driver_name[] = "rtc_cmos";
- #define RTC_IRQMASK (RTC_PF | RTC_AF | RTC_UF)
- static inline int is_intr(u8 rtc_intr)
- {
- if (!(rtc_intr & RTC_IRQF))
- return 0;
- return rtc_intr & RTC_IRQMASK;
- }
- #ifdef CONFIG_HPET_EMULATE_RTC
- #include <asm/hpet.h>
- #else
- static inline int is_hpet_enabled(void)
- {
- return 0;
- }
- static inline int hpet_mask_rtc_irq_bit(unsigned long mask)
- {
- return 0;
- }
- static inline int hpet_set_rtc_irq_bit(unsigned long mask)
- {
- return 0;
- }
- static inline int
- hpet_set_alarm_time(unsigned char hrs, unsigned char min, unsigned char sec)
- {
- return 0;
- }
- static inline int hpet_set_periodic_freq(unsigned long freq)
- {
- return 0;
- }
- static inline int hpet_rtc_dropped_irq(void)
- {
- return 0;
- }
- static inline int hpet_rtc_timer_init(void)
- {
- return 0;
- }
- extern irq_handler_t hpet_rtc_interrupt;
- static inline int hpet_register_irq_handler(irq_handler_t handler)
- {
- return 0;
- }
- static inline int hpet_unregister_irq_handler(irq_handler_t handler)
- {
- return 0;
- }
- #endif
- #ifdef RTC_PORT
- #define can_bank2 true
- static inline unsigned char cmos_read_bank2(unsigned char addr)
- {
- outb(addr, RTC_PORT(2));
- return inb(RTC_PORT(3));
- }
- static inline void cmos_write_bank2(unsigned char val, unsigned char addr)
- {
- outb(addr, RTC_PORT(2));
- outb(val, RTC_PORT(3));
- }
- #else
- #define can_bank2 false
- static inline unsigned char cmos_read_bank2(unsigned char addr)
- {
- return 0;
- }
- static inline void cmos_write_bank2(unsigned char val, unsigned char addr)
- {
- }
- #endif
- static int cmos_read_time(struct device *dev, struct rtc_time *t)
- {
-
- mc146818_get_time(t);
- return 0;
- }
- static int cmos_set_time(struct device *dev, struct rtc_time *t)
- {
-
- return mc146818_set_time(t);
- }
- static int cmos_read_alarm(struct device *dev, struct rtc_wkalrm *t)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- unsigned char rtc_control;
- if (!is_valid_irq(cmos->irq))
- return -EIO;
-
- spin_lock_irq(&rtc_lock);
- t->time.tm_sec = CMOS_READ(RTC_SECONDS_ALARM);
- t->time.tm_min = CMOS_READ(RTC_MINUTES_ALARM);
- t->time.tm_hour = CMOS_READ(RTC_HOURS_ALARM);
- if (cmos->day_alrm) {
-
- t->time.tm_mday = CMOS_READ(cmos->day_alrm) & 0x3f;
- if (!t->time.tm_mday)
- t->time.tm_mday = -1;
- if (cmos->mon_alrm) {
- t->time.tm_mon = CMOS_READ(cmos->mon_alrm);
- if (!t->time.tm_mon)
- t->time.tm_mon = -1;
- }
- }
- rtc_control = CMOS_READ(RTC_CONTROL);
- spin_unlock_irq(&rtc_lock);
- if (!(rtc_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD) {
- if (((unsigned)t->time.tm_sec) < 0x60)
- t->time.tm_sec = bcd2bin(t->time.tm_sec);
- else
- t->time.tm_sec = -1;
- if (((unsigned)t->time.tm_min) < 0x60)
- t->time.tm_min = bcd2bin(t->time.tm_min);
- else
- t->time.tm_min = -1;
- if (((unsigned)t->time.tm_hour) < 0x24)
- t->time.tm_hour = bcd2bin(t->time.tm_hour);
- else
- t->time.tm_hour = -1;
- if (cmos->day_alrm) {
- if (((unsigned)t->time.tm_mday) <= 0x31)
- t->time.tm_mday = bcd2bin(t->time.tm_mday);
- else
- t->time.tm_mday = -1;
- if (cmos->mon_alrm) {
- if (((unsigned)t->time.tm_mon) <= 0x12)
- t->time.tm_mon = bcd2bin(t->time.tm_mon)-1;
- else
- t->time.tm_mon = -1;
- }
- }
- }
- t->enabled = !!(rtc_control & RTC_AIE);
- t->pending = 0;
- return 0;
- }
- static void cmos_checkintr(struct cmos_rtc *cmos, unsigned char rtc_control)
- {
- unsigned char rtc_intr;
-
- rtc_intr = CMOS_READ(RTC_INTR_FLAGS);
- if (is_hpet_enabled())
- return;
- rtc_intr &= (rtc_control & RTC_IRQMASK) | RTC_IRQF;
- if (is_intr(rtc_intr))
- rtc_update_irq(cmos->rtc, 1, rtc_intr);
- }
- static void cmos_irq_enable(struct cmos_rtc *cmos, unsigned char mask)
- {
- unsigned char rtc_control;
-
- rtc_control = CMOS_READ(RTC_CONTROL);
- cmos_checkintr(cmos, rtc_control);
- rtc_control |= mask;
- CMOS_WRITE(rtc_control, RTC_CONTROL);
- hpet_set_rtc_irq_bit(mask);
- cmos_checkintr(cmos, rtc_control);
- }
- static void cmos_irq_disable(struct cmos_rtc *cmos, unsigned char mask)
- {
- unsigned char rtc_control;
- rtc_control = CMOS_READ(RTC_CONTROL);
- rtc_control &= ~mask;
- CMOS_WRITE(rtc_control, RTC_CONTROL);
- hpet_mask_rtc_irq_bit(mask);
- cmos_checkintr(cmos, rtc_control);
- }
- static int cmos_set_alarm(struct device *dev, struct rtc_wkalrm *t)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- unsigned char mon, mday, hrs, min, sec, rtc_control;
- if (!is_valid_irq(cmos->irq))
- return -EIO;
- mon = t->time.tm_mon + 1;
- mday = t->time.tm_mday;
- hrs = t->time.tm_hour;
- min = t->time.tm_min;
- sec = t->time.tm_sec;
- rtc_control = CMOS_READ(RTC_CONTROL);
- if (!(rtc_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD) {
-
- mon = (mon <= 12) ? bin2bcd(mon) : 0xff;
- mday = (mday >= 1 && mday <= 31) ? bin2bcd(mday) : 0xff;
- hrs = (hrs < 24) ? bin2bcd(hrs) : 0xff;
- min = (min < 60) ? bin2bcd(min) : 0xff;
- sec = (sec < 60) ? bin2bcd(sec) : 0xff;
- }
- spin_lock_irq(&rtc_lock);
-
- cmos_irq_disable(cmos, RTC_AIE);
-
- CMOS_WRITE(hrs, RTC_HOURS_ALARM);
- CMOS_WRITE(min, RTC_MINUTES_ALARM);
- CMOS_WRITE(sec, RTC_SECONDS_ALARM);
-
- if (cmos->day_alrm) {
- CMOS_WRITE(mday, cmos->day_alrm);
- if (cmos->mon_alrm)
- CMOS_WRITE(mon, cmos->mon_alrm);
- }
-
- hpet_set_alarm_time(t->time.tm_hour, t->time.tm_min, t->time.tm_sec);
- if (t->enabled)
- cmos_irq_enable(cmos, RTC_AIE);
- spin_unlock_irq(&rtc_lock);
- cmos->alarm_expires = rtc_tm_to_time64(&t->time);
- return 0;
- }
- static int cmos_alarm_irq_enable(struct device *dev, unsigned int enabled)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- unsigned long flags;
- if (!is_valid_irq(cmos->irq))
- return -EINVAL;
- spin_lock_irqsave(&rtc_lock, flags);
- if (enabled)
- cmos_irq_enable(cmos, RTC_AIE);
- else
- cmos_irq_disable(cmos, RTC_AIE);
- spin_unlock_irqrestore(&rtc_lock, flags);
- return 0;
- }
- #if IS_ENABLED(CONFIG_RTC_INTF_PROC)
- static int cmos_procfs(struct device *dev, struct seq_file *seq)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- unsigned char rtc_control, valid;
- spin_lock_irq(&rtc_lock);
- rtc_control = CMOS_READ(RTC_CONTROL);
- valid = CMOS_READ(RTC_VALID);
- spin_unlock_irq(&rtc_lock);
-
- seq_printf(seq,
- "periodic_IRQ\t: %s\n"
- "update_IRQ\t: %s\n"
- "HPET_emulated\t: %s\n"
-
- "BCD\t\t: %s\n"
- "DST_enable\t: %s\n"
- "periodic_freq\t: %d\n"
- "batt_status\t: %s\n",
- (rtc_control & RTC_PIE) ? "yes" : "no",
- (rtc_control & RTC_UIE) ? "yes" : "no",
- is_hpet_enabled() ? "yes" : "no",
-
- (rtc_control & RTC_DM_BINARY) ? "no" : "yes",
- (rtc_control & RTC_DST_EN) ? "yes" : "no",
- cmos->rtc->irq_freq,
- (valid & RTC_VRT) ? "okay" : "dead");
- return 0;
- }
- #else
- #define cmos_procfs NULL
- #endif
- static const struct rtc_class_ops cmos_rtc_ops = {
- .read_time = cmos_read_time,
- .set_time = cmos_set_time,
- .read_alarm = cmos_read_alarm,
- .set_alarm = cmos_set_alarm,
- .proc = cmos_procfs,
- .alarm_irq_enable = cmos_alarm_irq_enable,
- };
- #define NVRAM_OFFSET (RTC_REG_D + 1)
- static ssize_t
- cmos_nvram_read(struct file *filp, struct kobject *kobj,
- struct bin_attribute *attr,
- char *buf, loff_t off, size_t count)
- {
- int retval;
- off += NVRAM_OFFSET;
- spin_lock_irq(&rtc_lock);
- for (retval = 0; count; count--, off++, retval++) {
- if (off < 128)
- *buf++ = CMOS_READ(off);
- else if (can_bank2)
- *buf++ = cmos_read_bank2(off);
- else
- break;
- }
- spin_unlock_irq(&rtc_lock);
- return retval;
- }
- static ssize_t
- cmos_nvram_write(struct file *filp, struct kobject *kobj,
- struct bin_attribute *attr,
- char *buf, loff_t off, size_t count)
- {
- struct cmos_rtc *cmos;
- int retval;
- cmos = dev_get_drvdata(container_of(kobj, struct device, kobj));
-
- off += NVRAM_OFFSET;
- spin_lock_irq(&rtc_lock);
- for (retval = 0; count; count--, off++, retval++) {
-
- if (off == cmos->day_alrm
- || off == cmos->mon_alrm
- || off == cmos->century)
- buf++;
- else if (off < 128)
- CMOS_WRITE(*buf++, off);
- else if (can_bank2)
- cmos_write_bank2(*buf++, off);
- else
- break;
- }
- spin_unlock_irq(&rtc_lock);
- return retval;
- }
- static struct bin_attribute nvram = {
- .attr = {
- .name = "nvram",
- .mode = S_IRUGO | S_IWUSR,
- },
- .read = cmos_nvram_read,
- .write = cmos_nvram_write,
-
- };
- static struct cmos_rtc cmos_rtc;
- static irqreturn_t cmos_interrupt(int irq, void *p)
- {
- u8 irqstat;
- u8 rtc_control;
- spin_lock(&rtc_lock);
-
- irqstat = CMOS_READ(RTC_INTR_FLAGS);
- rtc_control = CMOS_READ(RTC_CONTROL);
- if (is_hpet_enabled())
- irqstat = (unsigned long)irq & 0xF0;
-
- if (!cmos_rtc.suspend_ctrl)
- irqstat &= (rtc_control & RTC_IRQMASK) | RTC_IRQF;
- else
- irqstat &= (cmos_rtc.suspend_ctrl & RTC_IRQMASK) | RTC_IRQF;
-
- if (irqstat & RTC_AIE) {
- cmos_rtc.suspend_ctrl &= ~RTC_AIE;
- rtc_control &= ~RTC_AIE;
- CMOS_WRITE(rtc_control, RTC_CONTROL);
- hpet_mask_rtc_irq_bit(RTC_AIE);
- CMOS_READ(RTC_INTR_FLAGS);
- }
- spin_unlock(&rtc_lock);
- if (is_intr(irqstat)) {
- rtc_update_irq(p, 1, irqstat);
- return IRQ_HANDLED;
- } else
- return IRQ_NONE;
- }
- #ifdef CONFIG_PNP
- #define INITSECTION
- #else
- #define INITSECTION __init
- #endif
- static int INITSECTION
- cmos_do_probe(struct device *dev, struct resource *ports, int rtc_irq)
- {
- struct cmos_rtc_board_info *info = dev_get_platdata(dev);
- int retval = 0;
- unsigned char rtc_control;
- unsigned address_space;
- u32 flags = 0;
-
- if (cmos_rtc.dev)
- return -EBUSY;
- if (!ports)
- return -ENODEV;
-
- if (RTC_IOMAPPED)
- ports = request_region(ports->start, resource_size(ports),
- driver_name);
- else
- ports = request_mem_region(ports->start, resource_size(ports),
- driver_name);
- if (!ports) {
- dev_dbg(dev, "i/o registers already in use\n");
- return -EBUSY;
- }
- cmos_rtc.irq = rtc_irq;
- cmos_rtc.iomem = ports;
-
- #if defined(CONFIG_ATARI)
- address_space = 64;
- #elif defined(__i386__) || defined(__x86_64__) || defined(__arm__) \
- || defined(__sparc__) || defined(__mips__) \
- || defined(__powerpc__) || defined(CONFIG_MN10300)
- address_space = 128;
- #else
- #warning Assuming 128 bytes of RTC+NVRAM address space, not 64 bytes.
- address_space = 128;
- #endif
- if (can_bank2 && ports->end > (ports->start + 1))
- address_space = 256;
-
- if (info) {
- if (info->flags)
- flags = info->flags;
- if (info->address_space)
- address_space = info->address_space;
- if (info->rtc_day_alarm && info->rtc_day_alarm < 128)
- cmos_rtc.day_alrm = info->rtc_day_alarm;
- if (info->rtc_mon_alarm && info->rtc_mon_alarm < 128)
- cmos_rtc.mon_alrm = info->rtc_mon_alarm;
- if (info->rtc_century && info->rtc_century < 128)
- cmos_rtc.century = info->rtc_century;
- if (info->wake_on && info->wake_off) {
- cmos_rtc.wake_on = info->wake_on;
- cmos_rtc.wake_off = info->wake_off;
- }
- }
- cmos_rtc.dev = dev;
- dev_set_drvdata(dev, &cmos_rtc);
- cmos_rtc.rtc = rtc_device_register(driver_name, dev,
- &cmos_rtc_ops, THIS_MODULE);
- if (IS_ERR(cmos_rtc.rtc)) {
- retval = PTR_ERR(cmos_rtc.rtc);
- goto cleanup0;
- }
- rename_region(ports, dev_name(&cmos_rtc.rtc->dev));
- spin_lock_irq(&rtc_lock);
- if (!(flags & CMOS_RTC_FLAGS_NOFREQ)) {
-
- cmos_rtc.rtc->irq_freq = 1024;
- hpet_set_periodic_freq(cmos_rtc.rtc->irq_freq);
- CMOS_WRITE(RTC_REF_CLCK_32KHZ | 0x06, RTC_FREQ_SELECT);
- }
-
- if (is_valid_irq(rtc_irq))
- cmos_irq_disable(&cmos_rtc, RTC_PIE | RTC_AIE | RTC_UIE);
- rtc_control = CMOS_READ(RTC_CONTROL);
- spin_unlock_irq(&rtc_lock);
-
- if (is_valid_irq(rtc_irq) && !(rtc_control & RTC_24H)) {
- dev_warn(dev, "only 24-hr supported\n");
- retval = -ENXIO;
- goto cleanup1;
- }
- hpet_rtc_timer_init();
- if (is_valid_irq(rtc_irq)) {
- irq_handler_t rtc_cmos_int_handler;
- if (is_hpet_enabled()) {
- rtc_cmos_int_handler = hpet_rtc_interrupt;
- retval = hpet_register_irq_handler(cmos_interrupt);
- if (retval) {
- hpet_mask_rtc_irq_bit(RTC_IRQMASK);
- dev_warn(dev, "hpet_register_irq_handler "
- " failed in rtc_init().");
- goto cleanup1;
- }
- } else
- rtc_cmos_int_handler = cmos_interrupt;
- retval = request_irq(rtc_irq, rtc_cmos_int_handler,
- IRQF_SHARED, dev_name(&cmos_rtc.rtc->dev),
- cmos_rtc.rtc);
- if (retval < 0) {
- dev_dbg(dev, "IRQ %d is already in use\n", rtc_irq);
- goto cleanup1;
- }
- }
-
- nvram.size = address_space - NVRAM_OFFSET;
- retval = sysfs_create_bin_file(&dev->kobj, &nvram);
- if (retval < 0) {
- dev_dbg(dev, "can't create nvram file? %d\n", retval);
- goto cleanup2;
- }
- dev_info(dev, "%s%s, %zd bytes nvram%s\n",
- !is_valid_irq(rtc_irq) ? "no alarms" :
- cmos_rtc.mon_alrm ? "alarms up to one year" :
- cmos_rtc.day_alrm ? "alarms up to one month" :
- "alarms up to one day",
- cmos_rtc.century ? ", y3k" : "",
- nvram.size,
- is_hpet_enabled() ? ", hpet irqs" : "");
- return 0;
- cleanup2:
- if (is_valid_irq(rtc_irq))
- free_irq(rtc_irq, cmos_rtc.rtc);
- cleanup1:
- cmos_rtc.dev = NULL;
- rtc_device_unregister(cmos_rtc.rtc);
- cleanup0:
- if (RTC_IOMAPPED)
- release_region(ports->start, resource_size(ports));
- else
- release_mem_region(ports->start, resource_size(ports));
- return retval;
- }
- static void cmos_do_shutdown(int rtc_irq)
- {
- spin_lock_irq(&rtc_lock);
- if (is_valid_irq(rtc_irq))
- cmos_irq_disable(&cmos_rtc, RTC_IRQMASK);
- spin_unlock_irq(&rtc_lock);
- }
- static void cmos_do_remove(struct device *dev)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- struct resource *ports;
- cmos_do_shutdown(cmos->irq);
- sysfs_remove_bin_file(&dev->kobj, &nvram);
- if (is_valid_irq(cmos->irq)) {
- free_irq(cmos->irq, cmos->rtc);
- hpet_unregister_irq_handler(cmos_interrupt);
- }
- rtc_device_unregister(cmos->rtc);
- cmos->rtc = NULL;
- ports = cmos->iomem;
- if (RTC_IOMAPPED)
- release_region(ports->start, resource_size(ports));
- else
- release_mem_region(ports->start, resource_size(ports));
- cmos->iomem = NULL;
- cmos->dev = NULL;
- }
- static int cmos_aie_poweroff(struct device *dev)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- struct rtc_time now;
- time64_t t_now;
- int retval = 0;
- unsigned char rtc_control;
- if (!cmos->alarm_expires)
- return -EINVAL;
- spin_lock_irq(&rtc_lock);
- rtc_control = CMOS_READ(RTC_CONTROL);
- spin_unlock_irq(&rtc_lock);
-
- if (rtc_control & RTC_AIE)
- return -EBUSY;
- cmos_read_time(dev, &now);
- t_now = rtc_tm_to_time64(&now);
-
- if (cmos->alarm_expires == t_now + 1) {
- struct rtc_wkalrm alarm;
-
- rtc_time64_to_tm(t_now - 1, &alarm.time);
- alarm.enabled = 0;
- retval = cmos_set_alarm(dev, &alarm);
- } else if (cmos->alarm_expires > t_now + 1) {
- retval = -EBUSY;
- }
- return retval;
- }
- static int cmos_suspend(struct device *dev)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- unsigned char tmp;
-
- spin_lock_irq(&rtc_lock);
- cmos->suspend_ctrl = tmp = CMOS_READ(RTC_CONTROL);
- if (tmp & (RTC_PIE|RTC_AIE|RTC_UIE)) {
- unsigned char mask;
- if (device_may_wakeup(dev))
- mask = RTC_IRQMASK & ~RTC_AIE;
- else
- mask = RTC_IRQMASK;
- tmp &= ~mask;
- CMOS_WRITE(tmp, RTC_CONTROL);
- hpet_mask_rtc_irq_bit(mask);
- cmos_checkintr(cmos, tmp);
- }
- spin_unlock_irq(&rtc_lock);
- if (tmp & RTC_AIE) {
- cmos->enabled_wake = 1;
- if (cmos->wake_on)
- cmos->wake_on(dev);
- else
- enable_irq_wake(cmos->irq);
- }
- cmos_read_alarm(dev, &cmos->saved_wkalrm);
- dev_dbg(dev, "suspend%s, ctrl %02x\n",
- (tmp & RTC_AIE) ? ", alarm may wake" : "",
- tmp);
- return 0;
- }
- static inline int cmos_poweroff(struct device *dev)
- {
- if (!IS_ENABLED(CONFIG_PM))
- return -ENOSYS;
- return cmos_suspend(dev);
- }
- static void cmos_check_wkalrm(struct device *dev)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- struct rtc_wkalrm current_alarm;
- time64_t t_current_expires;
- time64_t t_saved_expires;
- cmos_read_alarm(dev, ¤t_alarm);
- t_current_expires = rtc_tm_to_time64(¤t_alarm.time);
- t_saved_expires = rtc_tm_to_time64(&cmos->saved_wkalrm.time);
- if (t_current_expires != t_saved_expires ||
- cmos->saved_wkalrm.enabled != current_alarm.enabled) {
- cmos_set_alarm(dev, &cmos->saved_wkalrm);
- }
- }
- static void cmos_check_acpi_rtc_status(struct device *dev,
- unsigned char *rtc_control);
- static int __maybe_unused cmos_resume(struct device *dev)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- unsigned char tmp;
- if (cmos->enabled_wake) {
- if (cmos->wake_off)
- cmos->wake_off(dev);
- else
- disable_irq_wake(cmos->irq);
- cmos->enabled_wake = 0;
- }
-
- cmos_check_wkalrm(dev);
- spin_lock_irq(&rtc_lock);
- tmp = cmos->suspend_ctrl;
- cmos->suspend_ctrl = 0;
-
- if (tmp & RTC_IRQMASK) {
- unsigned char mask;
- if (device_may_wakeup(dev))
- hpet_rtc_timer_init();
- do {
- CMOS_WRITE(tmp, RTC_CONTROL);
- hpet_set_rtc_irq_bit(tmp & RTC_IRQMASK);
- mask = CMOS_READ(RTC_INTR_FLAGS);
- mask &= (tmp & RTC_IRQMASK) | RTC_IRQF;
- if (!is_hpet_enabled() || !is_intr(mask))
- break;
-
- rtc_update_irq(cmos->rtc, 1, mask);
- tmp &= ~RTC_AIE;
- hpet_mask_rtc_irq_bit(RTC_AIE);
- } while (mask & RTC_AIE);
- if (tmp & RTC_AIE)
- cmos_check_acpi_rtc_status(dev, &tmp);
- }
- spin_unlock_irq(&rtc_lock);
- dev_dbg(dev, "resume, ctrl %02x\n", tmp);
- return 0;
- }
- static SIMPLE_DEV_PM_OPS(cmos_pm_ops, cmos_suspend, cmos_resume);
- #ifdef CONFIG_ACPI
- #include <linux/acpi.h>
- static u32 rtc_handler(void *context)
- {
- struct device *dev = context;
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- unsigned char rtc_control = 0;
- unsigned char rtc_intr;
- unsigned long flags;
- spin_lock_irqsave(&rtc_lock, flags);
- if (cmos_rtc.suspend_ctrl)
- rtc_control = CMOS_READ(RTC_CONTROL);
- if (rtc_control & RTC_AIE) {
- cmos_rtc.suspend_ctrl &= ~RTC_AIE;
- CMOS_WRITE(rtc_control, RTC_CONTROL);
- rtc_intr = CMOS_READ(RTC_INTR_FLAGS);
- rtc_update_irq(cmos->rtc, 1, rtc_intr);
- }
- spin_unlock_irqrestore(&rtc_lock, flags);
- pm_wakeup_event(dev, 0);
- acpi_clear_event(ACPI_EVENT_RTC);
- acpi_disable_event(ACPI_EVENT_RTC, 0);
- return ACPI_INTERRUPT_HANDLED;
- }
- static inline void rtc_wake_setup(struct device *dev)
- {
- acpi_install_fixed_event_handler(ACPI_EVENT_RTC, rtc_handler, dev);
-
- acpi_clear_event(ACPI_EVENT_RTC);
- acpi_disable_event(ACPI_EVENT_RTC, 0);
- }
- static void rtc_wake_on(struct device *dev)
- {
- acpi_clear_event(ACPI_EVENT_RTC);
- acpi_enable_event(ACPI_EVENT_RTC, 0);
- }
- static void rtc_wake_off(struct device *dev)
- {
- acpi_disable_event(ACPI_EVENT_RTC, 0);
- }
- static struct cmos_rtc_board_info acpi_rtc_info;
- static void cmos_wake_setup(struct device *dev)
- {
- if (acpi_disabled)
- return;
- rtc_wake_setup(dev);
- acpi_rtc_info.wake_on = rtc_wake_on;
- acpi_rtc_info.wake_off = rtc_wake_off;
-
- if (acpi_gbl_FADT.month_alarm && !acpi_gbl_FADT.day_alarm) {
- dev_dbg(dev, "bogus FADT month_alarm (%d)\n",
- acpi_gbl_FADT.month_alarm);
- acpi_gbl_FADT.month_alarm = 0;
- }
- acpi_rtc_info.rtc_day_alarm = acpi_gbl_FADT.day_alarm;
- acpi_rtc_info.rtc_mon_alarm = acpi_gbl_FADT.month_alarm;
- acpi_rtc_info.rtc_century = acpi_gbl_FADT.century;
-
- if (acpi_gbl_FADT.flags & ACPI_FADT_S4_RTC_WAKE)
- dev_info(dev, "RTC can wake from S4\n");
- dev->platform_data = &acpi_rtc_info;
-
- device_init_wakeup(dev, 1);
- }
- static void cmos_check_acpi_rtc_status(struct device *dev,
- unsigned char *rtc_control)
- {
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- acpi_event_status rtc_status;
- acpi_status status;
- if (acpi_gbl_FADT.flags & ACPI_FADT_FIXED_RTC)
- return;
- status = acpi_get_event_status(ACPI_EVENT_RTC, &rtc_status);
- if (ACPI_FAILURE(status)) {
- dev_err(dev, "Could not get RTC status\n");
- } else if (rtc_status & ACPI_EVENT_FLAG_SET) {
- unsigned char mask;
- *rtc_control &= ~RTC_AIE;
- CMOS_WRITE(*rtc_control, RTC_CONTROL);
- mask = CMOS_READ(RTC_INTR_FLAGS);
- rtc_update_irq(cmos->rtc, 1, mask);
- }
- }
- #else
- static void cmos_wake_setup(struct device *dev)
- {
- }
- static void cmos_check_acpi_rtc_status(struct device *dev,
- unsigned char *rtc_control)
- {
- }
- #endif
- #ifdef CONFIG_PNP
- #include <linux/pnp.h>
- static int cmos_pnp_probe(struct pnp_dev *pnp, const struct pnp_device_id *id)
- {
- cmos_wake_setup(&pnp->dev);
- if (pnp_port_start(pnp, 0) == 0x70 && !pnp_irq_valid(pnp, 0))
-
- return cmos_do_probe(&pnp->dev,
- pnp_get_resource(pnp, IORESOURCE_IO, 0), 8);
- else
- return cmos_do_probe(&pnp->dev,
- pnp_get_resource(pnp, IORESOURCE_IO, 0),
- pnp_irq(pnp, 0));
- }
- static void cmos_pnp_remove(struct pnp_dev *pnp)
- {
- cmos_do_remove(&pnp->dev);
- }
- static void cmos_pnp_shutdown(struct pnp_dev *pnp)
- {
- struct device *dev = &pnp->dev;
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- if (system_state == SYSTEM_POWER_OFF) {
- int retval = cmos_poweroff(dev);
- if (cmos_aie_poweroff(dev) < 0 && !retval)
- return;
- }
- cmos_do_shutdown(cmos->irq);
- }
- static const struct pnp_device_id rtc_ids[] = {
- { .id = "PNP0b00", },
- { .id = "PNP0b01", },
- { .id = "PNP0b02", },
- { },
- };
- MODULE_DEVICE_TABLE(pnp, rtc_ids);
- static struct pnp_driver cmos_pnp_driver = {
- .name = (char *) driver_name,
- .id_table = rtc_ids,
- .probe = cmos_pnp_probe,
- .remove = cmos_pnp_remove,
- .shutdown = cmos_pnp_shutdown,
-
- .flags = PNP_DRIVER_RES_DO_NOT_CHANGE,
- .driver = {
- .pm = &cmos_pm_ops,
- },
- };
- #endif
- #ifdef CONFIG_OF
- static const struct of_device_id of_cmos_match[] = {
- {
- .compatible = "motorola,mc146818",
- },
- { },
- };
- MODULE_DEVICE_TABLE(of, of_cmos_match);
- static __init void cmos_of_init(struct platform_device *pdev)
- {
- struct device_node *node = pdev->dev.of_node;
- struct rtc_time time;
- int ret;
- const __be32 *val;
- if (!node)
- return;
- val = of_get_property(node, "ctrl-reg", NULL);
- if (val)
- CMOS_WRITE(be32_to_cpup(val), RTC_CONTROL);
- val = of_get_property(node, "freq-reg", NULL);
- if (val)
- CMOS_WRITE(be32_to_cpup(val), RTC_FREQ_SELECT);
- cmos_read_time(&pdev->dev, &time);
- ret = rtc_valid_tm(&time);
- if (ret) {
- struct rtc_time def_time = {
- .tm_year = 1,
- .tm_mday = 1,
- };
- cmos_set_time(&pdev->dev, &def_time);
- }
- }
- #else
- static inline void cmos_of_init(struct platform_device *pdev) {}
- #endif
- static int __init cmos_platform_probe(struct platform_device *pdev)
- {
- struct resource *resource;
- int irq;
- cmos_of_init(pdev);
- cmos_wake_setup(&pdev->dev);
- if (RTC_IOMAPPED)
- resource = platform_get_resource(pdev, IORESOURCE_IO, 0);
- else
- resource = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- irq = platform_get_irq(pdev, 0);
- if (irq < 0)
- irq = -1;
- return cmos_do_probe(&pdev->dev, resource, irq);
- }
- static int cmos_platform_remove(struct platform_device *pdev)
- {
- cmos_do_remove(&pdev->dev);
- return 0;
- }
- static void cmos_platform_shutdown(struct platform_device *pdev)
- {
- struct device *dev = &pdev->dev;
- struct cmos_rtc *cmos = dev_get_drvdata(dev);
- if (system_state == SYSTEM_POWER_OFF) {
- int retval = cmos_poweroff(dev);
- if (cmos_aie_poweroff(dev) < 0 && !retval)
- return;
- }
- cmos_do_shutdown(cmos->irq);
- }
- MODULE_ALIAS("platform:rtc_cmos");
- static struct platform_driver cmos_platform_driver = {
- .remove = cmos_platform_remove,
- .shutdown = cmos_platform_shutdown,
- .driver = {
- .name = driver_name,
- .pm = &cmos_pm_ops,
- .of_match_table = of_match_ptr(of_cmos_match),
- }
- };
- #ifdef CONFIG_PNP
- static bool pnp_driver_registered;
- #endif
- static bool platform_driver_registered;
- static int __init cmos_init(void)
- {
- int retval = 0;
- #ifdef CONFIG_PNP
- retval = pnp_register_driver(&cmos_pnp_driver);
- if (retval == 0)
- pnp_driver_registered = true;
- #endif
- if (!cmos_rtc.dev) {
- retval = platform_driver_probe(&cmos_platform_driver,
- cmos_platform_probe);
- if (retval == 0)
- platform_driver_registered = true;
- }
- if (retval == 0)
- return 0;
- #ifdef CONFIG_PNP
- if (pnp_driver_registered)
- pnp_unregister_driver(&cmos_pnp_driver);
- #endif
- return retval;
- }
- module_init(cmos_init);
- static void __exit cmos_exit(void)
- {
- #ifdef CONFIG_PNP
- if (pnp_driver_registered)
- pnp_unregister_driver(&cmos_pnp_driver);
- #endif
- if (platform_driver_registered)
- platform_driver_unregister(&cmos_platform_driver);
- }
- module_exit(cmos_exit);
- MODULE_AUTHOR("David Brownell");
- MODULE_DESCRIPTION("Driver for PC-style 'CMOS' RTCs");
- MODULE_LICENSE("GPL");
|