| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681 |
- From 6462d09dad154b69ea6180c0acb2d009627ff1be Mon Sep 17 00:00:00 2001
- From: Alison Wang <[email protected]>
- Date: Thu, 4 Aug 2011 09:59:46 +0800
- Subject: [PATCH 27/52] Add RTC driver support on MCF5441x platform
- Support on-chip robust-RTC module on MCF5441x platform.
- Signed-off-by: Alison Wang <[email protected]>
- ---
- drivers/rtc/Kconfig | 9 +
- drivers/rtc/Makefile | 1 +
- drivers/rtc/rtc-m5441x.c | 638 ++++++++++++++++++++++++++++++++++++++++++++++
- 3 files changed, 648 insertions(+), 0 deletions(-)
- create mode 100644 drivers/rtc/rtc-m5441x.c
- --- a/drivers/rtc/Kconfig
- +++ b/drivers/rtc/Kconfig
- @@ -928,6 +928,15 @@ config RTC_MCF
-
- If you build it as a module it will be call mcf-rtc.
-
- +config RTC_M5441X
- + tristate "Freescale Coldfire M5441X platform Real Time Clock"
- + depends on COLDFIRE
- + help
- + If you say yes here you will get support for the on-chip Coldfire
- + Real-Time Clock for mcf5441x platform.
- +
- + If you build it as a module it will be call rtc-m5441x.
- +
- config RTC_DRV_PS3
- tristate "PS3 RTC"
- depends on PPC_PS3
- --- a/drivers/rtc/Makefile
- +++ b/drivers/rtc/Makefile
- @@ -103,3 +103,4 @@ obj-$(CONFIG_RTC_DRV_WM831X) += rtc-wm83
- obj-$(CONFIG_RTC_DRV_WM8350) += rtc-wm8350.o
- obj-$(CONFIG_RTC_DRV_X1205) += rtc-x1205.o
- obj-$(CONFIG_RTC_MCF) += rtc-mcf.o
- +obj-$(CONFIG_RTC_M5441X) += rtc-m5441x.o
- --- /dev/null
- +++ b/drivers/rtc/rtc-m5441x.c
- @@ -0,0 +1,638 @@
- +/*
- + * Copyright (C) 2010-2011 Freescale Semiconductor, Inc. All Rights Reserved.
- + *
- + * [email protected]
- + *
- + * The code contained herein is licensed under the GNU General Public
- + * License. You may obtain a copy of the GNU General Public License
- + * Version 2 or later at the following locations:
- + *
- + * http://www.opensource.org/licenses/gpl-license.html
- + * http://www.gnu.org/copyleft/gpl.html
- + */
- +
- +/*
- + * Implementation based on rtc-mcf.c
- + */
- +
- +/*
- + * RTC Real Time Clock (RTC) Driver
- + *
- + * @file rtc-m5441x.c
- + * @brief Real Time Clock interface
- + *
- + * This file contains Real Time Clock interface for Linux.
- + *
- + */
- +#include <linux/rtc.h>
- +#include <linux/module.h>
- +#include <linux/fs.h>
- +#include <linux/init.h>
- +#include <linux/interrupt.h>
- +#include <linux/platform_device.h>
- +#include <linux/clk.h>
- +#include <linux/uaccess.h>
- +#include <asm/mcfsim.h>
- +#include <linux/slab.h>
- +#include <linux/io.h>
- +
- +#ifdef readw
- +#undef readw
- +#endif
- +
- +#ifdef writew
- +#undef writew
- +#endif
- +
- +#define readw(addr) in_be16(addr)
- +#define writew(val, addr) out_be16((addr), (val))
- +
- +
- +#define PIT_ALL_ON (MCF_RTC_ISR_2HZ | MCF_RTC_ISR_SAM0 | MCF_RTC_ISR_SAM1 | \
- + MCF_RTC_ISR_SAM2 | MCF_RTC_ISR_SAM3 | MCF_RTC_ISR_SAM4 | \
- + MCF_RTC_ISR_SAM5 | MCF_RTC_ISR_SAM6 | MCF_RTC_ISR_SAM7)
- +
- +#define MAX_PIE_NUM 9
- +#define MAX_PIE_FREQ 512
- +const u32 PIE_BIT_DEF[MAX_PIE_NUM][2] = {
- + {2, MCF_RTC_ISR_2HZ},
- + {4, MCF_RTC_ISR_SAM0},
- + {8, MCF_RTC_ISR_SAM1},
- + {16, MCF_RTC_ISR_SAM2},
- + {32, MCF_RTC_ISR_SAM3},
- + {64, MCF_RTC_ISR_SAM4},
- + {128, MCF_RTC_ISR_SAM5},
- + {256, MCF_RTC_ISR_SAM6},
- + {MAX_PIE_FREQ, MCF_RTC_ISR_SAM7},
- +};
- +
- +/* Those are the bits from a classic RTC we want to mimic */
- +#define RTC_IRQF 0x80 /* any of the following 3 is active */
- +#define RTC_PF 0x40 /* Periodic interrupt */
- +#define RTC_AF 0x20 /* Alarm interrupt */
- +#define RTC_UF 0x10 /* Update interrupt for 1Hz RTC */
- +
- +#define MCF_RTC_TIME 0
- +#define MCF_RTC_ALARM 1
- +
- +struct rtc_plat_data {
- + struct rtc_device *rtc;
- + int irq;
- + unsigned int irqen;
- + int alrm_sec;
- + int alrm_min;
- + int alrm_hour;
- + int alrm_mday;
- +};
- +
- +static const int year_cal_basic = 2112;
- +
- +#define RTC_VERSION "0.1"
- +
- +static u32 rtc_freq = 2; /* minimun value for PIE */
- +static unsigned long rtc_status;
- +
- +static struct rtc_time g_rtc_alarm = {
- + .tm_year = 0,
- + .tm_mon = 0,
- + .tm_mday = 0,
- + .tm_hour = 0,
- + .tm_mon = 0,
- + .tm_sec = 0,
- +};
- +
- +static DEFINE_SPINLOCK(rtc_lock);
- +
- +
- +/*
- + * This funciton is used to disable RTC register write protection
- + */
- +static void disable_register_write_protection(void)
- +{
- + if (readw(MCF_RTC_SR) & MCF_RTC_SR_WPE) {
- + writew(0x0000, MCF_RTC_CR);
- + writew(0x0001, MCF_RTC_CR);
- + writew(0x0003, MCF_RTC_CR);
- + writew(0x0002, MCF_RTC_CR);
- + }
- +
- +}
- +
- +/*
- + * This function is used to obtain the RTC time or the alarm value in
- + * second.
- + *
- + * @param time_alarm use MCF_RTC_TIME for RTC time value;
- + * MCF_RTC_ALARM for alarm value
- + *
- + * @return The RTC time or alarm time in second.
- + */
- +static u32 get_alarm_or_time(struct device *dev, int time_alarm,
- + struct rtc_time *tm)
- +{
- + dev_dbg(dev, "debug function %s()!\n", __func__);
- +
- + if (time_alarm == MCF_RTC_TIME) {
- + /*check register information */
- + dev_dbg(dev, "RTC_YEARMON:0x%x,RTC_DAYS:0x%x,RTC_HOURMIN:0x%x,"
- + "RTC_SECONDS:0x%x\n", readw(MCF_RTC_YEARMON),
- + readw(MCF_RTC_DAYS), readw(MCF_RTC_HOURMIN),
- + readw(MCF_RTC_SECONDS));
- +
- + /* get year */
- + tm->tm_year = year_cal_basic +
- + (char)(MCF_RTC_YEARMON_YEAR_RD(readw(MCF_RTC_YEARMON)));
- + /* get month */
- + tm->tm_mon =
- + MCF_RTC_YEARMON_MON_RD(readw(MCF_RTC_YEARMON)) - 1;
- + /* get month day */
- + tm->tm_mday = MCF_RTC_DAYS_DAY_RD(readw(MCF_RTC_DAYS));
- + /* get year day */
- + tm->tm_yday = rtc_year_days(tm->tm_mday, tm->tm_mon,
- + tm->tm_year);
- + /* year minus 1900 */
- + tm->tm_year = tm->tm_year - 1900;
- + /* get week day */
- + tm->tm_wday = MCF_RTC_DAYS_DAYWEEK_RD(readw(MCF_RTC_DAYS));
- + /* get hours */
- + tm->tm_hour =
- + MCF_RTC_HOURMIN_HOURS_RD(readw(MCF_RTC_HOURMIN));
- + /* get minutes */
- + tm->tm_min =
- + MCF_RTC_HOURMIN_MINUTES_RD(readw(MCF_RTC_HOURMIN));
- + /* get seconds */
- + tm->tm_sec =
- + MCF_RTC_SECONDS_SECONDS_RD(readw(MCF_RTC_SECONDS));
- + /* no day saving time */
- + tm->tm_isdst = -1;
- +
- + /* check rtc_tm fileds information */
- + dev_dbg(dev, "RTC TIME --> year:%d,yday:%d,mon:%d,mday:%d,"
- + "wday:%d,hour:%d,min:%d,sec:%d\n", tm->tm_year,
- + tm->tm_yday, tm->tm_mon, tm->tm_mday, tm->tm_wday,
- + tm->tm_hour, tm->tm_min, tm->tm_sec);
- +
- + } else if (time_alarm == MCF_RTC_ALARM) {
- + tm->tm_year = year_cal_basic +
- + (char)MCF_RTC_YEARMON_YEAR_RD
- + (readw(MCF_RTC_ALRM_YRMON));
- + tm->tm_mon =
- + MCF_RTC_YEARMON_MON_RD(readw(MCF_RTC_ALRM_YRMON)) - 1;
- + tm->tm_mday = MCF_RTC_DAYS_DAY_RD(readw(MCF_RTC_ALRM_DAYS));
- + tm->tm_yday = rtc_year_days(tm->tm_mday, tm->tm_mon,
- + tm->tm_year);
- + tm->tm_year = tm->tm_year - 1900;
- + tm->tm_wday =
- + MCF_RTC_DAYS_DAYWEEK_RD(readw(MCF_RTC_ALRM_DAYS));
- + tm->tm_hour =
- + MCF_RTC_HOURMIN_HOURS_RD(readw(MCF_RTC_ALRM_HM));
- + tm->tm_min =
- + MCF_RTC_HOURMIN_MINUTES_RD(readw(MCF_RTC_ALRM_HM));
- + tm->tm_sec =
- + MCF_RTC_SECONDS_SECONDS_RD(readw(MCF_RTC_ALRM_SEC));
- + tm->tm_isdst = -1;
- +
- + /* debug information */
- + dev_dbg(dev, "RTC ALARM --> year:%d,yday:%d,mon:%d,mday:%d,"
- + "wday:%d,hour:%d,min:%d,sec:%d\n", tm->tm_year,
- + tm->tm_yday, tm->tm_mon, tm->tm_mday, tm->tm_wday,
- + tm->tm_hour, tm->tm_min, tm->tm_sec);
- +
- + } else {
- + panic("wrong value for time_alarm=%d\n", time_alarm);
- + }
- +
- + return 0;
- +}
- +
- +/*
- + * This function sets the RTC alarm value or the time value.
- + *
- + * @param time_alarm the new alarm value to be updated in the RTC
- + * @param time use MCF_RTC_TIME for RTC time value;
- + * MCF_RTC_ALARM for alarm value
- + */
- +static void set_alarm_or_time(struct device *dev, int time_alarm,
- + struct rtc_time *tm)
- +{
- + char year;
- +
- + dev_dbg(dev, "debug function %s()!\n", __func__);
- +
- + /* wirte enable setting */
- + disable_register_write_protection();
- +
- + if (time_alarm == MCF_RTC_TIME) {
- + /* check rtc_time fields information */
- + dev_dbg(dev, "RTC TIME --> year:%d,yday:%d,mon:%d,mday:%d,"
- + "wday:%d,hour:%d,min:%d,sec:%d\n", tm->tm_year,
- + tm->tm_yday, tm->tm_mon, tm->tm_mday, tm->tm_wday,
- + tm->tm_hour, tm->tm_min, tm->tm_sec);
- +
- + year = ((tm->tm_year + 1900) - year_cal_basic);
- + /* write RTC_YEARMON register */
- + writew((year << 8) | (tm->tm_mon + 1), MCF_RTC_YEARMON);
- +
- + /* write RTC_DAYS register */
- + writew(MCF_RTC_DAYS_DAYWEEK_SET(tm->tm_wday) |
- + MCF_RTC_DAYS_DAY_SET(tm->tm_mday), MCF_RTC_DAYS);
- +
- + /* write RTC_HOURMIN register */
- + writew(MCF_RTC_HOURMIN_HOURS_SET(tm->tm_hour) |
- + MCF_RTC_HOURMIN_MINUTES_SET(tm->tm_min),
- + MCF_RTC_HOURMIN);
- +
- + /* write RTC_SECONDS register */
- + writew(MCF_RTC_SECONDS_SECONDS_SET
- + (tm->tm_sec), MCF_RTC_SECONDS);
- +
- + /* debug information */
- + dev_dbg(dev, "RTC_YEARMON:0x%x, RTC_DAYS:0x%x, "
- + "RTC_HOURMIN:0x%x, RTC_SECONDS:0x%x\n",
- + readw(MCF_RTC_YEARMON), readw(MCF_RTC_DAYS),
- + readw(MCF_RTC_HOURMIN), readw(MCF_RTC_SECONDS));
- + } else if (time_alarm == MCF_RTC_ALARM) {
- +
- + year = ((tm->tm_year + 1900) - year_cal_basic);
- + /* write RTC_YEARMON register */
- + writew((year << 8) | (tm->tm_mon + 1), MCF_RTC_ALRM_YRMON);
- +
- + /* write RTC_DAYS register */
- + writew(MCF_RTC_DAYS_DAYWEEK_SET(tm->tm_wday) |
- + MCF_RTC_DAYS_DAY_SET(tm->tm_mday), MCF_RTC_ALRM_DAYS);
- +
- + /* write RTC_HOURMIN register */
- + writew(MCF_RTC_HOURMIN_HOURS_SET(tm->tm_hour) |
- + MCF_RTC_HOURMIN_MINUTES_SET(tm->tm_min),
- + MCF_RTC_ALRM_HM);
- +
- + /* write RTC_SECONDS register */
- + writew(MCF_RTC_SECONDS_SECONDS_SET
- + (tm->tm_sec), MCF_RTC_ALRM_SEC);
- +
- + /* debug information */
- + dev_dbg(dev, "ALRM_YRMON:0x%x,ALRM_DAYS:0x%x,ALRM_HM:0x%x,"
- + "ALRM_SEC:0x%x\n", readw(MCF_RTC_ALRM_YRMON),
- + readw(MCF_RTC_ALRM_DAYS), readw(MCF_RTC_ALRM_HM),
- + readw(MCF_RTC_ALRM_SEC));
- + } else {
- + panic("wrong value for time_alarm=%d\n", time_alarm);
- + }
- +}
- +
- +/*!
- + * This function updates the RTC alarm registers and then clears all the
- + * interrupt status bits.
- + *
- + * @param alrm the new alarm value to be updated in the RTC
- + *
- + * @return 0 if successful; non-zero otherwise.
- + */
- +static int rtc_update_alarm(struct device *dev, struct rtc_time *alrm)
- +{
- + /* clear all the interrupt status bits */
- + disable_register_write_protection();
- +
- + writew(readw(MCF_RTC_ISR), MCF_RTC_ISR);
- +
- + set_alarm_or_time(dev, MCF_RTC_ALARM, alrm);
- +
- + return 0;
- +}
- +
- +/*!
- + * This function is the RTC interrupt service routine.
- + *
- + * @param irq RTC IRQ number
- + * @param dev_id device ID which is not used
- + *
- + * @return IRQ_HANDLED as defined in the include/linux/interrupt.h file.
- + */
- +static irqreturn_t mcf_rtc_interrupt(int irq, void *dev_id)
- +{
- + struct platform_device *pdev = dev_id;
- + struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
- + u16 status = 0;
- + u32 events = 0;
- +
- + spin_lock(&rtc_lock);
- +
- + /* clear interrupt sources */
- + status = readw(MCF_RTC_ISR) & readw(MCF_RTC_IER);
- +
- + disable_register_write_protection();
- +
- + writew(status, MCF_RTC_ISR);
- +
- + /* clear alarm interrupt if it has occurred */
- + if (status & MCF_RTC_ISR_ALM)
- + status &= ~MCF_RTC_ISR_ALM;
- +
- + /* update irq data & counter */
- + if (status & MCF_RTC_ISR_ALM)
- + events |= (RTC_AF | RTC_IRQF);
- + if (status & MCF_RTC_ISR_1HZ)
- + events |= (RTC_UF | RTC_IRQF);
- + if (status & PIT_ALL_ON)
- + events |= (RTC_PF | RTC_IRQF);
- +
- + if ((status & MCF_RTC_ISR_ALM) && rtc_valid_tm(&g_rtc_alarm))
- + rtc_update_alarm(&pdev->dev, &g_rtc_alarm);
- +
- + spin_unlock(&rtc_lock);
- + rtc_update_irq(pdata->rtc, 1, events);
- + return IRQ_HANDLED;
- +}
- +
- +/*!
- + * clear all interrupts and release the IRQ
- + */
- +static void mcf_rtc_release(struct device *dev)
- +{
- + spin_lock_irq(&rtc_lock);
- +
- + disable_register_write_protection();
- +
- + writew(0, MCF_RTC_IER); /* Disable all rtc interrupts */
- + writew(readw(MCF_RTC_ISR), MCF_RTC_ISR);
- + spin_unlock_irq(&rtc_lock);
- + rtc_status = 0;
- +}
- +
- +/*!
- + * This function is used to support some ioctl calls directly.
- + * Other ioctl calls are supported indirectly through the
- + * arm/common/rtctime.c file.
- + *
- + * @param cmd ioctl command as defined in include/linux/rtc.h
- + * @param arg value for the ioctl command
- + *
- + * @return 0 if successful or negative value otherwise.
- + */
- +static int mcf_rtc_ioctl(struct device *dev, unsigned int cmd,
- + unsigned long arg)
- +{
- + int i;
- +
- + disable_register_write_protection();
- +
- + switch (cmd) {
- + case RTC_PIE_OFF:
- + writew((readw(MCF_RTC_IER) & ~PIT_ALL_ON), MCF_RTC_IER);
- + return 0;
- + case RTC_IRQP_SET:
- + if (arg < 2 || arg > MAX_PIE_FREQ || (arg % 2) != 0)
- + return -EINVAL; /* Also make sure a power of 2Hz */
- + if ((arg > 64) && (!capable(CAP_SYS_RESOURCE)))
- + return -EACCES;
- + rtc_freq = arg;
- + return 0;
- + case RTC_IRQP_READ:
- + return put_user(rtc_freq, (u32 *) arg);
- + case RTC_PIE_ON:
- + for (i = 0; i < MAX_PIE_NUM; i++) {
- + if (PIE_BIT_DEF[i][0] == rtc_freq)
- + break;
- + }
- + if (i == MAX_PIE_NUM)
- + return -EACCES;
- + spin_lock_irq(&rtc_lock);
- + writew((readw(MCF_RTC_IER) | PIE_BIT_DEF[i][1]), MCF_RTC_IER);
- + spin_unlock_irq(&rtc_lock);
- + return 0;
- + case RTC_AIE_OFF:
- + spin_lock_irq(&rtc_lock);
- + writew((readw(MCF_RTC_IER) & ~MCF_RTC_ISR_ALM), MCF_RTC_IER);
- + spin_unlock_irq(&rtc_lock);
- + return 0;
- +
- + case RTC_AIE_ON:
- + spin_lock_irq(&rtc_lock);
- + writew((readw(MCF_RTC_IER) | MCF_RTC_ISR_ALM), MCF_RTC_IER);
- + spin_unlock_irq(&rtc_lock);
- + return 0;
- +
- + case RTC_UIE_OFF: /* UIE is for the 1Hz interrupt */
- + spin_lock_irq(&rtc_lock);
- + writew((readw(MCF_RTC_IER) & ~MCF_RTC_ISR_1HZ), MCF_RTC_IER);
- + spin_unlock_irq(&rtc_lock);
- + return 0;
- +
- + case RTC_UIE_ON:
- + spin_lock_irq(&rtc_lock);
- + writew((readw(MCF_RTC_IER) | MCF_RTC_ISR_1HZ), MCF_RTC_IER);
- + spin_unlock_irq(&rtc_lock);
- + return 0;
- + }
- + return -ENOIOCTLCMD;
- +}
- +
- +/*!
- + * This function reads the current RTC time into tm in Gregorian date.
- + *
- + * @param tm contains the RTC time value upon return
- + *
- + * @return 0 if successful; non-zero otherwise.
- + */
- +static int mcf_rtc_read_time(struct device *dev, struct rtc_time *tm)
- +{
- + do {
- + get_alarm_or_time(dev, MCF_RTC_TIME, tm);
- + } while (0);
- +
- + return 0;
- +}
- +
- +/*!
- + * This function sets the internal RTC time based on tm in Gregorian date.
- + *
- + * @param tm the time value to be set in the RTC
- + *
- + * @return 0 if successful; non-zero otherwise.
- + */
- +static int mcf_rtc_set_time(struct device *dev, struct rtc_time *tm)
- +{
- + do {
- + set_alarm_or_time(dev, MCF_RTC_TIME, tm);
- + } while (0);
- +
- + return 0;
- +}
- +
- +/*!
- + * This function reads the current alarm value into the passed in \b alrm
- + * argument. It updates the \b alrm's pending field value based on the whether
- + * an alarm interrupt occurs or not.
- + *
- + * @param alrm contains the RTC alarm value upon return
- + *
- + * @return 0 if successful; non-zero otherwise.
- + */
- +static int mcf_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
- +{
- + do {
- + get_alarm_or_time(dev, MCF_RTC_ALARM, &alrm->time);
- + } while (0);
- +
- + alrm->pending = ((readw(MCF_RTC_ISR) & MCF_RTC_ISR_ALM) != 0) ? 1 : 0;
- +
- + return 0;
- +}
- +
- +/*!
- + * This function sets the RTC alarm based on passed in alrm.
- + *
- + * @param alrm the alarm value to be set in the RTC
- + *
- + * @return 0 if successful; non-zero otherwise.
- + */
- +static int mcf_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
- +{
- + int ret;
- +
- + spin_lock_irq(&rtc_lock);
- +
- + disable_register_write_protection();
- +
- + if (rtc_valid_tm(&alrm->time)) {
- + if (alrm->time.tm_sec > 59 ||
- + alrm->time.tm_hour > 23 || alrm->time.tm_min > 59) {
- + ret = -EINVAL;
- + goto out;
- + }
- + ret = rtc_update_alarm(dev, &alrm->time);
- + } else {
- + ret = rtc_valid_tm(&alrm->time);
- + if (ret)
- + goto out;
- + ret = rtc_update_alarm(dev, &alrm->time);
- + }
- +
- + if (ret == 0) {
- + memcpy(&g_rtc_alarm, &alrm->time, sizeof(struct rtc_time));
- +
- + if (alrm->enabled) {
- + writew((readw(MCF_RTC_IER) | MCF_RTC_ISR_ALM),
- + MCF_RTC_IER);
- + } else {
- + writew((readw(MCF_RTC_IER) & ~MCF_RTC_ISR_ALM),
- + MCF_RTC_IER);
- + }
- + }
- +out:
- + spin_unlock_irq(&rtc_lock);
- +
- + return ret;
- +}
- +
- +/*!
- + * The RTC driver structure
- + */
- +static struct rtc_class_ops mcf_rtc_ops = {
- + .ioctl = mcf_rtc_ioctl,
- + .read_time = mcf_rtc_read_time,
- + .set_time = mcf_rtc_set_time,
- + .read_alarm = mcf_rtc_read_alarm,
- + .set_alarm = mcf_rtc_set_alarm,
- +};
- +
- +static int __devinit mcf_rtc_probe(struct platform_device *pdev)
- +{
- + struct rtc_device *rtc;
- + struct rtc_plat_data *pdata = NULL;
- + u32 ret = 0;
- +
- + disable_register_write_protection();
- + /* Clear interrupt before request irq */
- + writew(0x0100, MCF_RTC_CR);
- + writew(0x0001, MCF_RTC_IER);
- +
- + if (!(readw(MCF_RTC_CFG_DATA) & MCF_RTC_CFG_DATA_OSCEN))
- + writew(MCF_RTC_CFG_DATA_OSCEN, MCF_RTC_CFG_DATA);
- +
- + pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
- + if (!pdata)
- + return -ENOMEM;
- +
- + pdata->irq = MCFINT_VECBASE + MCFINT_RTC;
- + if (request_irq(pdata->irq, mcf_rtc_interrupt, IRQF_DISABLED,
- + pdev->name, pdev) < 0) {
- + dev_warn(&pdev->dev, "interrupt not available.\n");
- + pdata->irq = -1;
- + }
- +
- + if (test_and_set_bit(1, &rtc_status))
- + return -EBUSY;
- +
- + rtc = rtc_device_register(pdev->name, &pdev->dev, &mcf_rtc_ops,
- + THIS_MODULE);
- + if (IS_ERR(rtc)) {
- + ret = PTR_ERR(rtc);
- + if (pdata->irq >= 0)
- + free_irq(pdata->irq, pdev);
- + kfree(pdata);
- + return ret;
- + }
- + pdata->rtc = rtc;
- + platform_set_drvdata(pdev, pdata);
- +
- + dev_dbg(&pdev->dev, "RTC_CR:0x%x, RTC_SR:0x%x\n", readw(MCF_RTC_CR),
- + readw(MCF_RTC_SR));
- +
- + printk(KERN_INFO "Real Time Clock Driver v%s\n", RTC_VERSION);
- + return ret;
- +}
- +
- +static int __devexit mcf_rtc_remove(struct platform_device *pdev)
- +{
- + struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
- +
- + rtc_device_unregister(pdata->rtc);
- + if (pdata->irq >= 0)
- + free_irq(pdata->irq, pdev);
- + kfree(pdata);
- + mcf_rtc_release(NULL);
- + return 0;
- +}
- +
- +/*!
- + * Contains pointers to the power management callback functions.
- + */
- +MODULE_ALIAS("rtc-m5441x");
- +static struct platform_driver mcf_rtc_driver = {
- + .driver = {
- + .name = "rtc-m5441x",
- + .owner = THIS_MODULE,
- + },
- + .probe = mcf_rtc_probe,
- + .remove = __devexit_p(mcf_rtc_remove),
- +};
- +
- +/*!
- + * This function creates the /proc/driver/rtc file and registers the device RTC
- + * in the /dev/misc directory. It also reads the RTC value from external source
- + * and setup the internal RTC properly.
- + *
- + * @return -1 if RTC is failed to initialize; 0 is successful.
- + */
- +static int __init mcf_rtc_init(void)
- +{
- + return platform_driver_register(&mcf_rtc_driver);
- +}
- +
- +/*!
- + * This function removes the /proc/driver/rtc file and un-registers the
- + * device RTC from the /dev/misc directory.
- + */
- +static void __exit mcf_rtc_exit(void)
- +{
- + platform_driver_unregister(&mcf_rtc_driver);
- +
- +}
- +
- +module_init(mcf_rtc_init);
- +module_exit(mcf_rtc_exit);
- +
- +MODULE_AUTHOR("Freescale Semiconductor, Inc.");
- +MODULE_DESCRIPTION("Real Time Clock Driver (MCF)");
- +MODULE_LICENSE("GPL V2");
|