Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 1518e7ed authored by David S. Miller's avatar David S. Miller
Browse files

sparc64: Convert Mostek rtc to use generic RTC layer driver. 



Based largely upon a patch by Krzysztof Helt <krzysztof.h1@poczta.fm>

Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent a0b31b57

arch/sparc64/Kconfig

+1 −0
Original line number Diff line number Diff line
@@ -20,6 +20,7 @@ config SPARC64 
	select HAVE_ARCH_TRACEHOOK

	select ARCH_WANT_OPTIONAL_GPIOLIB

	select RTC_CLASS

	select RTC_DRV_M48T59



config GENERIC_TIME

	bool

arch/sparc64/kernel/sparc64_ksyms.c

+0 −3
Original line number Diff line number Diff line
@@ -36,7 +36,6 @@ 
#include <asm/elf.h>

#include <asm/head.h>

#include <asm/smp.h>

#include <asm/mostek.h>

#include <asm/ptrace.h>

#include <asm/uaccess.h>

#include <asm/checksum.h>
@@ -152,8 +151,6 @@ EXPORT_SYMBOL(flush_dcache_page); 
EXPORT_SYMBOL(__flush_dcache_range);

#endif



EXPORT_SYMBOL(mostek_lock);

EXPORT_SYMBOL(mstk48t02_regs);

#ifdef CONFIG_SUN_AUXIO

EXPORT_SYMBOL(auxio_set_led);

EXPORT_SYMBOL(auxio_set_lte);

arch/sparc64/kernel/time.c

+102 −314
Original line number Diff line number Diff line
@@ -30,13 +30,14 @@ 
#include <linux/percpu.h>

#include <linux/miscdevice.h>

#include <linux/rtc.h>

#include <linux/rtc/m48t59.h>

#include <linux/kernel_stat.h>

#include <linux/clockchips.h>

#include <linux/clocksource.h>

#include <linux/of_device.h>

#include <linux/platform_device.h>



#include <asm/oplib.h>

#include <asm/mostek.h>

#include <asm/timer.h>

#include <asm/irq.h>

#include <asm/io.h>
@@ -50,17 +51,12 @@ 


#include "entry.h"



DEFINE_SPINLOCK(mostek_lock);

DEFINE_SPINLOCK(rtc_lock);

void __iomem *mstk48t02_regs = NULL;

#ifdef CONFIG_PCI

unsigned long ds1287_regs = 0UL;

static void __iomem *bq4802_regs;

#endif



static void __iomem *mstk48t08_regs;

static void __iomem *mstk48t59_regs;



static int set_rtc_mmss(unsigned long);



#define TICK_PRIV_BIT	(1UL << 63)
@@ -413,144 +409,10 @@ int update_persistent_clock(struct timespec now) 
	return set_rtc_mmss(now.tv_sec);

}



/* Kick start a stopped clock (procedure from the Sun NVRAM/hostid FAQ). */

static void __init kick_start_clock(void)

{

	void __iomem *regs = mstk48t02_regs;

	u8 sec, tmp;

	int i, count;



	prom_printf("CLOCK: Clock was stopped. Kick start ");



	spin_lock_irq(&mostek_lock);



	/* Turn on the kick start bit to start the oscillator. */

	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp |= MSTK_CREG_WRITE;

	mostek_write(regs + MOSTEK_CREG, tmp);

	tmp = mostek_read(regs + MOSTEK_SEC);

	tmp &= ~MSTK_STOP;

	mostek_write(regs + MOSTEK_SEC, tmp);

	tmp = mostek_read(regs + MOSTEK_HOUR);

	tmp |= MSTK_KICK_START;

	mostek_write(regs + MOSTEK_HOUR, tmp);

	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp &= ~MSTK_CREG_WRITE;

	mostek_write(regs + MOSTEK_CREG, tmp);



	spin_unlock_irq(&mostek_lock);



	/* Delay to allow the clock oscillator to start. */

	sec = MSTK_REG_SEC(regs);

	for (i = 0; i < 3; i++) {

		while (sec == MSTK_REG_SEC(regs))

			for (count = 0; count < 100000; count++)

				/* nothing */ ;

		prom_printf(".");

		sec = MSTK_REG_SEC(regs);

	}

	prom_printf("\n");



	spin_lock_irq(&mostek_lock);



	/* Turn off kick start and set a "valid" time and date. */

	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp |= MSTK_CREG_WRITE;

	mostek_write(regs + MOSTEK_CREG, tmp);

	tmp = mostek_read(regs + MOSTEK_HOUR);

	tmp &= ~MSTK_KICK_START;

	mostek_write(regs + MOSTEK_HOUR, tmp);

	MSTK_SET_REG_SEC(regs,0);

	MSTK_SET_REG_MIN(regs,0);

	MSTK_SET_REG_HOUR(regs,0);

	MSTK_SET_REG_DOW(regs,5);

	MSTK_SET_REG_DOM(regs,1);

	MSTK_SET_REG_MONTH(regs,8);

	MSTK_SET_REG_YEAR(regs,1996 - MSTK_YEAR_ZERO);

	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp &= ~MSTK_CREG_WRITE;

	mostek_write(regs + MOSTEK_CREG, tmp);



	spin_unlock_irq(&mostek_lock);



	/* Ensure the kick start bit is off. If it isn't, turn it off. */

	while (mostek_read(regs + MOSTEK_HOUR) & MSTK_KICK_START) {

		prom_printf("CLOCK: Kick start still on!\n");



		spin_lock_irq(&mostek_lock);



		tmp = mostek_read(regs + MOSTEK_CREG);

		tmp |= MSTK_CREG_WRITE;

		mostek_write(regs + MOSTEK_CREG, tmp);



		tmp = mostek_read(regs + MOSTEK_HOUR);

		tmp &= ~MSTK_KICK_START;

		mostek_write(regs + MOSTEK_HOUR, tmp);



		tmp = mostek_read(regs + MOSTEK_CREG);

		tmp &= ~MSTK_CREG_WRITE;

		mostek_write(regs + MOSTEK_CREG, tmp);



		spin_unlock_irq(&mostek_lock);

	}



	prom_printf("CLOCK: Kick start procedure successful.\n");

}



/* Return nonzero if the clock chip battery is low. */

static int __init has_low_battery(void)

{

	void __iomem *regs = mstk48t02_regs;

	u8 data1, data2;



	spin_lock_irq(&mostek_lock);



	data1 = mostek_read(regs + MOSTEK_EEPROM);	/* Read some data. */

	mostek_write(regs + MOSTEK_EEPROM, ~data1);	/* Write back the complement. */

	data2 = mostek_read(regs + MOSTEK_EEPROM);	/* Read back the complement. */

	mostek_write(regs + MOSTEK_EEPROM, data1);	/* Restore original value. */



	spin_unlock_irq(&mostek_lock);



	return (data1 == data2);	/* Was the write blocked? */

}



static void __init mostek_set_system_time(void __iomem *mregs)

{

	unsigned int year, mon, day, hour, min, sec;

	u8 tmp;



	spin_lock_irq(&mostek_lock);



	/* Traditional Mostek chip. */

	tmp = mostek_read(mregs + MOSTEK_CREG);

	tmp |= MSTK_CREG_READ;

	mostek_write(mregs + MOSTEK_CREG, tmp);



	sec = MSTK_REG_SEC(mregs);

	min = MSTK_REG_MIN(mregs);

	hour = MSTK_REG_HOUR(mregs);

	day = MSTK_REG_DOM(mregs);

	mon = MSTK_REG_MONTH(mregs);

	year = MSTK_CVT_YEAR( MSTK_REG_YEAR(mregs) );



	xtime.tv_sec = mktime(year, mon, day, hour, min, sec);

	xtime.tv_nsec = (INITIAL_JIFFIES % HZ) * (NSEC_PER_SEC / HZ);

	set_normalized_timespec(&wall_to_monotonic,

 	                        -xtime.tv_sec, -xtime.tv_nsec);



	tmp = mostek_read(mregs + MOSTEK_CREG);

	tmp &= ~MSTK_CREG_READ;

	mostek_write(mregs + MOSTEK_CREG, tmp);



	spin_unlock_irq(&mostek_lock);

}



/* Probe for the real time clock chip. */

static void __init set_system_time(void)

{

	unsigned int year, mon, day, hour, min, sec;

	void __iomem *mregs = mstk48t02_regs;

#ifdef CONFIG_PCI

	unsigned long dregs = ds1287_regs;

	void __iomem *bregs = bq4802_regs;
@@ -559,16 +421,11 @@ static void __init set_system_time(void) 
	void __iomem *bregs = 0UL;

#endif



	if (!mregs && !dregs && !bregs) {

	if (!dregs && !bregs) {

		prom_printf("Something wrong, clock regs not mapped yet.\n");

		prom_halt();

	}		



	if (mregs) {

		mostek_set_system_time(mregs);

		return;

	}



	if (bregs) {

		unsigned char val = readb(bregs + 0x0e);

		unsigned int century;
@@ -689,12 +546,9 @@ static int hypervisor_set_time(u32 secs) 
	return -EOPNOTSUPP;

}



static int __init clock_model_matches(const char *model)

static int __init rtc_model_matches(const char *model)

{

	if (strcmp(model, "mk48t02") &&

	    strcmp(model, "mk48t08") &&

	    strcmp(model, "mk48t59") &&

	    strcmp(model, "m5819") &&

	if (strcmp(model, "m5819") &&

	    strcmp(model, "m5819p") &&

	    strcmp(model, "m5823") &&

	    strcmp(model, "ds1287") &&
@@ -704,7 +558,7 @@ static int __init clock_model_matches(const char *model) 
	return 1;

}



static int __devinit clock_probe(struct of_device *op, const struct of_device_id *match)

static int __devinit rtc_probe(struct of_device *op, const struct of_device_id *match)

{

	struct device_node *dp = op->node;

	const char *model = of_get_property(dp, "model", NULL);
@@ -715,14 +569,7 @@ static int __devinit clock_probe(struct of_device *op, const struct of_device_id 
	if (!model)

		model = compat;



	if (!model || !clock_model_matches(model))

		return -ENODEV;



	/* On an Enterprise system there can be multiple mostek clocks.

	 * We should only match the one that is on the central FHC bus.

	 */

	if (!strcmp(dp->parent->name, "fhc") &&

	    strcmp(dp->parent->parent->name, "central") != 0)

	if (!model || !rtc_model_matches(model))

		return -ENODEV;



	size = (op->resource[0].end - op->resource[0].start) + 1;
@@ -738,32 +585,12 @@ static int __devinit clock_probe(struct of_device *op, const struct of_device_id 
		ds1287_regs = (unsigned long) regs;

	} else if (!strcmp(model, "bq4802")) {

		bq4802_regs = regs;

	} else

#endif

	if (model[5] == '0' && model[6] == '2') {

		mstk48t02_regs = regs;

	} else if(model[5] == '0' && model[6] == '8') {

		mstk48t08_regs = regs;

		mstk48t02_regs = mstk48t08_regs + MOSTEK_48T08_48T02;

	} else {

		mstk48t59_regs = regs;

		mstk48t02_regs = mstk48t59_regs + MOSTEK_48T59_48T02;

	}



#endif

	printk(KERN_INFO "%s: Clock regs at %p\n", dp->full_name, regs);



	local_irq_save(flags);



	if (mstk48t02_regs != NULL) {

		/* Report a low battery voltage condition. */

		if (has_low_battery())

			prom_printf("NVRAM: Low battery voltage!\n");



		/* Kick start the clock if it is completely stopped. */

		if (mostek_read(mstk48t02_regs + MOSTEK_SEC) & MSTK_STOP)

			kick_start_clock();

	}



	set_system_time();

	

	local_irq_restore(flags);
@@ -771,21 +598,102 @@ static int __devinit clock_probe(struct of_device *op, const struct of_device_id 
	return 0;

}



static struct of_device_id clock_match[] = {

static struct of_device_id rtc_match[] = {

	{

		.name = "eeprom",

		.name = "rtc",

	},

	{

	{},

};



static struct of_platform_driver rtc_driver = {

	.match_table	= rtc_match,

	.probe		= rtc_probe,

	.driver		= {

		.name	= "rtc",

	},

};



static unsigned char mostek_read_byte(struct device *dev, u32 ofs)

{

	struct platform_device *pdev = to_platform_device(dev);

	void __iomem *regs;

	unsigned char val;



	regs = (void __iomem *) pdev->resource[0].start;

	val = readb(regs + ofs);



	/* the year 0 is 1968 */

	if (ofs == M48T59_YEAR) {

		val += 0x68;

		if ((val & 0xf) > 9)

			val += 6;

	}

	return val;

}



static void mostek_write_byte(struct device *dev, u32 ofs, u8 val)

{

	struct platform_device *pdev = to_platform_device(dev);

	void __iomem *regs;



	regs = (void __iomem *) pdev->resource[0].start;

	if (ofs == M48T59_YEAR) {

		if (val < 0x68)

			val += 0x32;

		else

			val -= 0x68;

		if ((val & 0xf) > 9)

			val += 6;

		if ((val & 0xf0) > 0x9A)

			val += 0x60;

	}

	writeb(val, regs + ofs);

}



static struct m48t59_plat_data m48t59_data = {

	.read_byte	= mostek_read_byte,

	.write_byte	= mostek_write_byte,

};



static struct platform_device m48t59_rtc = {

	.name		= "rtc-m48t59",

	.id		= 0,

	.num_resources	= 1,

	.dev	= {

		.platform_data = &m48t59_data,

	},

};



static int __devinit mostek_probe(struct of_device *op, const struct of_device_id *match)

{

	struct device_node *dp = op->node;



	/* On an Enterprise system there can be multiple mostek clocks.

	 * We should only match the one that is on the central FHC bus.

	 */

	if (!strcmp(dp->parent->name, "fhc") &&

	    strcmp(dp->parent->parent->name, "central") != 0)

		return -ENODEV;



	printk(KERN_INFO "%s: Mostek regs at 0x%lx\n",

	       dp->full_name, op->resource[0].start);



	m48t59_rtc.resource = &op->resource[0];

	return platform_device_register(&m48t59_rtc);

}



static struct of_device_id mostek_match[] = {

	{

		.name = "eeprom",

	},

	{},

};



static struct of_platform_driver clock_driver = {

	.match_table	= clock_match,

	.probe		= clock_probe,

static struct of_platform_driver mostek_driver = {

	.match_table	= mostek_match,

	.probe		= mostek_probe,

	.driver		= {

		.name	= "clock",

		.name	= "mostek",

	},

};
@@ -806,7 +714,10 @@ static int __init clock_init(void) 
		return 0;

	}



	return of_register_driver(&clock_driver, &of_platform_bus_type);

	(void) of_register_driver(&rtc_driver, &of_platform_bus_type);

	(void) of_register_driver(&mostek_driver, &of_platform_bus_type);



	return 0;

}



/* Must be after subsys_initcall() so that busses are probed.  Must
@@ -1078,7 +989,6 @@ unsigned long long sched_clock(void) 
static int set_rtc_mmss(unsigned long nowtime)

{

	int real_seconds, real_minutes, chip_minutes;

	void __iomem *mregs = mstk48t02_regs;

#ifdef CONFIG_PCI

	unsigned long dregs = ds1287_regs;

	void __iomem *bregs = bq4802_regs;
@@ -1087,62 +997,15 @@ static int set_rtc_mmss(unsigned long nowtime) 
	void __iomem *bregs = 0UL;

#endif

	unsigned long flags;

	u8 tmp;



	/* 

	 * Not having a register set can lead to trouble.

	 * Also starfire doesn't have a tod clock.

	 */

	if (!mregs && !dregs && !bregs)

	if (!dregs && !bregs)

		return -1;



	if (mregs) {

		spin_lock_irqsave(&mostek_lock, flags);



		/* Read the current RTC minutes. */

		tmp = mostek_read(mregs + MOSTEK_CREG);

		tmp |= MSTK_CREG_READ;

		mostek_write(mregs + MOSTEK_CREG, tmp);



		chip_minutes = MSTK_REG_MIN(mregs);



		tmp = mostek_read(mregs + MOSTEK_CREG);

		tmp &= ~MSTK_CREG_READ;

		mostek_write(mregs + MOSTEK_CREG, tmp);



		/*

		 * since we're only adjusting minutes and seconds,

		 * don't interfere with hour overflow. This avoids

		 * messing with unknown time zones but requires your

		 * RTC not to be off by more than 15 minutes

		 */

		real_seconds = nowtime % 60;

		real_minutes = nowtime / 60;

		if (((abs(real_minutes - chip_minutes) + 15)/30) & 1)

			real_minutes += 30;	/* correct for half hour time zone */

		real_minutes %= 60;



		if (abs(real_minutes - chip_minutes) < 30) {

			tmp = mostek_read(mregs + MOSTEK_CREG);

			tmp |= MSTK_CREG_WRITE;

			mostek_write(mregs + MOSTEK_CREG, tmp);



			MSTK_SET_REG_SEC(mregs,real_seconds);

			MSTK_SET_REG_MIN(mregs,real_minutes);



			tmp = mostek_read(mregs + MOSTEK_CREG);

			tmp &= ~MSTK_CREG_WRITE;

			mostek_write(mregs + MOSTEK_CREG, tmp);



			spin_unlock_irqrestore(&mostek_lock, flags);



			return 0;

		} else {

			spin_unlock_irqrestore(&mostek_lock, flags);



			return -1;

		}

	} else if (bregs) {

	if (bregs) {

		int retval = 0;

		unsigned char val = readb(bregs + 0x0e);
@@ -1485,74 +1348,6 @@ static int cmos_set_rtc_time(struct rtc_time *rtc_tm) 
}

#endif /* CONFIG_PCI */



static void mostek_get_rtc_time(struct rtc_time *rtc_tm)

{

	void __iomem *regs = mstk48t02_regs;

	u8 tmp;



	spin_lock_irq(&mostek_lock);



	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp |= MSTK_CREG_READ;

	mostek_write(regs + MOSTEK_CREG, tmp);



	rtc_tm->tm_sec = MSTK_REG_SEC(regs);

	rtc_tm->tm_min = MSTK_REG_MIN(regs);

	rtc_tm->tm_hour = MSTK_REG_HOUR(regs);

	rtc_tm->tm_mday = MSTK_REG_DOM(regs);

	rtc_tm->tm_mon = MSTK_REG_MONTH(regs);

	rtc_tm->tm_year = MSTK_CVT_YEAR( MSTK_REG_YEAR(regs) );

	rtc_tm->tm_wday = MSTK_REG_DOW(regs);



	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp &= ~MSTK_CREG_READ;

	mostek_write(regs + MOSTEK_CREG, tmp);



	spin_unlock_irq(&mostek_lock);



	rtc_tm->tm_mon--;

	rtc_tm->tm_wday--;

	rtc_tm->tm_year -= 1900;

}



static int mostek_set_rtc_time(struct rtc_time *rtc_tm)

{

	unsigned char mon, day, hrs, min, sec, wday;

	void __iomem *regs = mstk48t02_regs;

	unsigned int yrs;

	u8 tmp;



	yrs = rtc_tm->tm_year + 1900;

	mon = rtc_tm->tm_mon + 1;

	day = rtc_tm->tm_mday;

	wday = rtc_tm->tm_wday + 1;

	hrs = rtc_tm->tm_hour;

	min = rtc_tm->tm_min;

	sec = rtc_tm->tm_sec;



	spin_lock_irq(&mostek_lock);



	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp |= MSTK_CREG_WRITE;

	mostek_write(regs + MOSTEK_CREG, tmp);



	MSTK_SET_REG_SEC(regs, sec);

	MSTK_SET_REG_MIN(regs, min);

	MSTK_SET_REG_HOUR(regs, hrs);

	MSTK_SET_REG_DOW(regs, wday);

	MSTK_SET_REG_DOM(regs, day);

	MSTK_SET_REG_MONTH(regs, mon);

	MSTK_SET_REG_YEAR(regs, yrs - MSTK_YEAR_ZERO);



	tmp = mostek_read(regs + MOSTEK_CREG);

	tmp &= ~MSTK_CREG_WRITE;

	mostek_write(regs + MOSTEK_CREG, tmp);



	spin_unlock_irq(&mostek_lock);



	return 0;

}



struct mini_rtc_ops {

	void (*get_rtc_time)(struct rtc_time *);

	int (*set_rtc_time)(struct rtc_time *);
@@ -1580,11 +1375,6 @@ static struct mini_rtc_ops cmos_rtc_ops = { 
};

#endif /* CONFIG_PCI */



static struct mini_rtc_ops mostek_rtc_ops = {

	.get_rtc_time = mostek_get_rtc_time,

	.set_rtc_time = mostek_set_rtc_time,

};



static struct mini_rtc_ops *mini_rtc_ops;



static inline void mini_get_rtc_time(struct rtc_time *time)
@@ -1717,8 +1507,6 @@ static int __init rtc_mini_init(void) 
	else if (ds1287_regs)

		mini_rtc_ops = &cmos_rtc_ops;

#endif /* CONFIG_PCI */

	else if (mstk48t02_regs)

		mini_rtc_ops = &mostek_rtc_ops;

	else

		return -ENODEV;