diff options
Diffstat (limited to 'target/linux/coldfire/patches/027-Add-RTC-driver-support-on-MCF5441x-platform.patch')
| -rw-r--r-- | target/linux/coldfire/patches/027-Add-RTC-driver-support-on-MCF5441x-platform.patch | 681 |
1 files changed, 681 insertions, 0 deletions
diff --git a/target/linux/coldfire/patches/027-Add-RTC-driver-support-on-MCF5441x-platform.patch b/target/linux/coldfire/patches/027-Add-RTC-driver-support-on-MCF5441x-platform.patch new file mode 100644 index 000000000..78ae75d35 --- /dev/null +++ b/target/linux/coldfire/patches/027-Add-RTC-driver-support-on-MCF5441x-platform.patch @@ -0,0 +1,681 @@ +From 6462d09dad154b69ea6180c0acb2d009627ff1be Mon Sep 17 00:00:00 2001 +From: Alison Wang <b18965@freescale.com> +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 <b18965@freescale.com> +--- + 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. ++ * ++ * Lanttor.Guo@freescale.com ++ * ++ * 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"); |