[linux-block.git] / arch / mips / sgi-ip27 / ip27-timer.c

/*
 * Copytight (C) 1999, 2000, 05, 06 Ralf Baechle (ralf@linux-mips.org)
 * Copytight (C) 1999, 2000 Silicon Graphics, Inc.
 */
#include <linux/bcd.h>
#include <linux/clockchips.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/interrupt.h>
#include <linux/kernel_stat.h>
#include <linux/param.h>
#include <linux/time.h>
#include <linux/timex.h>
#include <linux/mm.h>

#include <asm/time.h>
#include <asm/pgtable.h>
#include <asm/sgialib.h>
#include <asm/sn/ioc3.h>
#include <asm/m48t35.h>
#include <asm/sn/klconfig.h>
#include <asm/sn/arch.h>
#include <asm/sn/addrs.h>
#include <asm/sn/sn_private.h>
#include <asm/sn/sn0/ip27.h>
#include <asm/sn/sn0/hub.h>

#define TICK_SIZE (tick_nsec / 1000)

#if 0
static int set_rtc_mmss(unsigned long nowtime)
{
	int retval = 0;
	int real_seconds, real_minutes, cmos_minutes;
	struct m48t35_rtc *rtc;
	nasid_t nid;

	nid = get_nasid();
	rtc = (struct m48t35_rtc *)(KL_CONFIG_CH_CONS_INFO(nid)->memory_base +
							IOC3_BYTEBUS_DEV0);

	rtc->control |= M48T35_RTC_READ;
	cmos_minutes = BCD2BIN(rtc->min);
	rtc->control &= ~M48T35_RTC_READ;

	/*
	 * 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 - cmos_minutes) + 15)/30) & 1)
		real_minutes += 30;	/* correct for half hour time zone */
	real_minutes %= 60;

	if (abs(real_minutes - cmos_minutes) < 30) {
		real_seconds = BIN2BCD(real_seconds);
		real_minutes = BIN2BCD(real_minutes);
		rtc->control |= M48T35_RTC_SET;
		rtc->sec = real_seconds;
		rtc->min = real_minutes;
		rtc->control &= ~M48T35_RTC_SET;
	} else {
		printk(KERN_WARNING
		       "set_rtc_mmss: can't update from %d to %d\n",
		       cmos_minutes, real_minutes);
		retval = -1;
	}

	return retval;
}
#endif

/* Includes for ioc3_init().  */
#include <asm/sn/types.h>
#include <asm/sn/sn0/addrs.h>
#include <asm/sn/sn0/hubni.h>
#include <asm/sn/sn0/hubio.h>
#include <asm/pci/bridge.h>

unsigned long read_persistent_clock(void)
{
        unsigned int year, month, date, hour, min, sec;
	struct m48t35_rtc *rtc;
	nasid_t nid;

	nid = get_nasid();
	rtc = (struct m48t35_rtc *)(KL_CONFIG_CH_CONS_INFO(nid)->memory_base +
							IOC3_BYTEBUS_DEV0);

	rtc->control |= M48T35_RTC_READ;
	sec = rtc->sec;
	min = rtc->min;
	hour = rtc->hour;
	date = rtc->date;
	month = rtc->month;
	year = rtc->year;
	rtc->control &= ~M48T35_RTC_READ;

        sec = BCD2BIN(sec);
        min = BCD2BIN(min);
        hour = BCD2BIN(hour);
        date = BCD2BIN(date);
        month = BCD2BIN(month);
        year = BCD2BIN(year);

        year += 1970;

        return mktime(year, month, date, hour, min, sec);
}

static void enable_rt_irq(unsigned int irq)
{
}

static void disable_rt_irq(unsigned int irq)
{
}

static struct irq_chip rt_irq_type = {
	.name		= "SN HUB RT timer",
	.ack		= disable_rt_irq,
	.mask		= disable_rt_irq,
	.mask_ack	= disable_rt_irq,
	.unmask		= enable_rt_irq,
	.eoi		= enable_rt_irq,
};

static int rt_next_event(unsigned long delta, struct clock_event_device *evt)
{
	unsigned int cpu = smp_processor_id();
	int slice = cputoslice(cpu) == 0;
	unsigned long cnt;

	cnt = LOCAL_HUB_L(PI_RT_COUNT);
	cnt += delta;
	LOCAL_HUB_S(slice ? PI_RT_COMPARE_A : PI_RT_COMPARE_B, cnt);

	return LOCAL_HUB_L(PI_RT_COUNT) >= cnt ? -ETIME : 0;
}

static void rt_set_mode(enum clock_event_mode mode,
		struct clock_event_device *evt)
{
	switch (mode) {
	case CLOCK_EVT_MODE_ONESHOT:
		/* The only mode supported */
		break;

	case CLOCK_EVT_MODE_PERIODIC:
	case CLOCK_EVT_MODE_UNUSED:
	case CLOCK_EVT_MODE_SHUTDOWN:
	case CLOCK_EVT_MODE_RESUME:
		/* Nothing to do  */
		break;
	}
}

unsigned int rt_timer_irq;

static irqreturn_t hub_rt_counter_handler(int irq, void *dev_id)
{
	struct clock_event_device *cd = dev_id;
	unsigned int cpu = smp_processor_id();
	int slice = cputoslice(cpu) == 0;

	LOCAL_HUB_S(slice ? PI_RT_PEND_A : PI_RT_PEND_B, 0);	/* Ack  */
	cd->event_handler(cd);

	return IRQ_HANDLED;
}

struct irqaction hub_rt_irqaction = {
	.handler	= hub_rt_counter_handler,
	.flags		= IRQF_DISABLED | IRQF_PERCPU,
	.name		= "hub-rt",
};

/*
 * This is a hack; we really need to figure these values out dynamically
 *
 * Since 800 ns works very well with various HUB frequencies, such as
 * 360, 380, 390 and 400 MHZ, we use 800 ns rtc cycle time.
 *
 * Ralf: which clock rate is used to feed the counter?
 */
#define NSEC_PER_CYCLE		800
#define CYCLES_PER_SEC		(NSEC_PER_SEC / NSEC_PER_CYCLE)

static DEFINE_PER_CPU(struct clock_event_device, hub_rt_clockevent);
static DEFINE_PER_CPU(char [11], hub_rt_name);

static void __cpuinit hub_rt_clock_event_init(void)
{
	unsigned int cpu = smp_processor_id();
	struct clock_event_device *cd = &per_cpu(hub_rt_clockevent, cpu);
	unsigned char *name = per_cpu(hub_rt_name, cpu);
	int irq = rt_timer_irq;

	sprintf(name, "hub-rt %d", cpu);
	cd->name		= "HUB-RT",
	cd->features		= CLOCK_EVT_FEAT_ONESHOT,
	clockevent_set_clock(cd, CYCLES_PER_SEC);
	cd->max_delta_ns        = clockevent_delta2ns(0xfffffffffffff, cd);
	cd->min_delta_ns        = clockevent_delta2ns(0x300, cd);
	cd->rating		= 200,
	cd->irq			= irq,
	cd->cpumask		= cpumask_of_cpu(cpu),
	cd->rating		= 300,
	cd->set_next_event	= rt_next_event,
	cd->set_mode		= rt_set_mode,
	clockevents_register_device(cd);
}

static void __init hub_rt_clock_event_global_init(void)
{
	unsigned int irq;

	do {
		smp_wmb();
		irq = rt_timer_irq;
		if (irq)
			break;

		irq = allocate_irqno();
		if (irq < 0)
			panic("Allocation of irq number for timer failed");
	} while (xchg(&rt_timer_irq, irq));

	set_irq_chip_and_handler(irq, &rt_irq_type, handle_percpu_irq);
	setup_irq(irq, &hub_rt_irqaction);
}

static cycle_t hub_rt_read(void)
{
	return REMOTE_HUB_L(cputonasid(0), PI_RT_COUNT);
}

struct clocksource hub_rt_clocksource = {
	.name	= "HUB-RT",
	.rating	= 200,
	.read	= hub_rt_read,
	.mask	= CLOCKSOURCE_MASK(52),
	.flags	= CLOCK_SOURCE_IS_CONTINUOUS,
};

static void __init hub_rt_clocksource_init(void)
{
	struct clocksource *cs = &hub_rt_clocksource;

	clocksource_set_clock(cs, CYCLES_PER_SEC);
	clocksource_register(cs);
}

void __init plat_time_init(void)
{
	hub_rt_clocksource_init();
	hub_rt_clock_event_global_init();
}

void __cpuinit cpu_time_init(void)
{
	lboard_t *board;
	klcpu_t *cpu;
	int cpuid;

	/* Don't use ARCS.  ARCS is fragile.  Klconfig is simple and sane.  */
	board = find_lboard(KL_CONFIG_INFO(get_nasid()), KLTYPE_IP27);
	if (!board)
		panic("Can't find board info for myself.");

	cpuid = LOCAL_HUB_L(PI_CPU_NUM) ? IP27_CPU0_INDEX : IP27_CPU1_INDEX;
	cpu = (klcpu_t *) KLCF_COMP(board, cpuid);
	if (!cpu)
		panic("No information about myself?");

	printk("CPU %d clock is %dMHz.\n", smp_processor_id(), cpu->cpu_speed);

	hub_rt_clock_event_init();
	set_c0_status(SRB_TIMOCLK);
}

void __init hub_rtc_init(cnodeid_t cnode)
{
	/*
	 * We only need to initialize the current node.
	 * If this is not the current node then it is a cpuless
	 * node and timeouts will not happen there.
	 */
	if (get_compact_nodeid() == cnode) {
		LOCAL_HUB_S(PI_RT_EN_A, 1);
		LOCAL_HUB_S(PI_RT_EN_B, 1);
		LOCAL_HUB_S(PI_PROF_EN_A, 0);
		LOCAL_HUB_S(PI_PROF_EN_B, 0);
		LOCAL_HUB_S(PI_RT_COUNT, 0);
		LOCAL_HUB_S(PI_RT_PEND_A, 0);
		LOCAL_HUB_S(PI_RT_PEND_B, 0);
	}
}
Commit	Line	Data
1da177e4	1	/*
54d0a216	2	* Copytight (C) 1999, 2000, 05, 06 Ralf Baechle (ralf@linux-mips.org)
1da177e4 LT	3	* Copytight (C) 1999, 2000 Silicon Graphics, Inc.
	4	*/
	5	#include <linux/bcd.h>
e887b245	6	#include <linux/clockchips.h>
1da177e4 LT	7	#include <linux/init.h>
	8	#include <linux/kernel.h>
	9	#include <linux/sched.h>
	10	#include <linux/interrupt.h>
	11	#include <linux/kernel_stat.h>
	12	#include <linux/param.h>
	13	#include <linux/time.h>
	14	#include <linux/timex.h>
	15	#include <linux/mm.h>
	16
	17	#include <asm/time.h>
	18	#include <asm/pgtable.h>
	19	#include <asm/sgialib.h>
	20	#include <asm/sn/ioc3.h>
	21	#include <asm/m48t35.h>
	22	#include <asm/sn/klconfig.h>
	23	#include <asm/sn/arch.h>
	24	#include <asm/sn/addrs.h>
	25	#include <asm/sn/sn_private.h>
	26	#include <asm/sn/sn0/ip27.h>
	27	#include <asm/sn/sn0/hub.h>
	28
1da177e4 LT	29	#define TICK_SIZE (tick_nsec / 1000)
1da177e4 LT	30
1da177e4 LT	31	#if 0
	32	static int set_rtc_mmss(unsigned long nowtime)
	33	{
	34	int retval = 0;
	35	int real_seconds, real_minutes, cmos_minutes;
	36	struct m48t35_rtc *rtc;
	37	nasid_t nid;
	38
	39	nid = get_nasid();
	40	rtc = (struct m48t35_rtc *)(KL_CONFIG_CH_CONS_INFO(nid)->memory_base +
	41	IOC3_BYTEBUS_DEV0);
	42
	43	rtc->control \|= M48T35_RTC_READ;
	44	cmos_minutes = BCD2BIN(rtc->min);
	45	rtc->control &= ~M48T35_RTC_READ;
	46
	47	/*
	48	* Since we're only adjusting minutes and seconds, don't interfere with
	49	* hour overflow. This avoids messing with unknown time zones but
	50	* requires your RTC not to be off by more than 15 minutes
	51	*/
	52	real_seconds = nowtime % 60;
	53	real_minutes = nowtime / 60;
	54	if (((abs(real_minutes - cmos_minutes) + 15)/30) & 1)
	55	real_minutes += 30; /* correct for half hour time zone */
	56	real_minutes %= 60;
	57
	58	if (abs(real_minutes - cmos_minutes) < 30) {
	59	real_seconds = BIN2BCD(real_seconds);
	60	real_minutes = BIN2BCD(real_minutes);
	61	rtc->control \|= M48T35_RTC_SET;
	62	rtc->sec = real_seconds;
	63	rtc->min = real_minutes;
	64	rtc->control &= ~M48T35_RTC_SET;
	65	} else {
	66	printk(KERN_WARNING
	67	"set_rtc_mmss: can't update from %d to %d\n",
	68	cmos_minutes, real_minutes);
	69	retval = -1;
	70	}
	71
	72	return retval;
	73	}
	74	#endif
	75
1da177e4 LT	76	/* Includes for ioc3_init(). */
	77	#include <asm/sn/types.h>
	78	#include <asm/sn/sn0/addrs.h>
	79	#include <asm/sn/sn0/hubni.h>
	80	#include <asm/sn/sn0/hubio.h>
	81	#include <asm/pci/bridge.h>
	82
4b550488	83	unsigned long read_persistent_clock(void)
1da177e4 LT	84	{
	85	unsigned int year, month, date, hour, min, sec;
	86	struct m48t35_rtc *rtc;
	87	nasid_t nid;
	88
	89	nid = get_nasid();
	90	rtc = (struct m48t35_rtc *)(KL_CONFIG_CH_CONS_INFO(nid)->memory_base +
	91	IOC3_BYTEBUS_DEV0);
	92
	93	rtc->control \|= M48T35_RTC_READ;
	94	sec = rtc->sec;
	95	min = rtc->min;
	96	hour = rtc->hour;
	97	date = rtc->date;
	98	month = rtc->month;
	99	year = rtc->year;
	100	rtc->control &= ~M48T35_RTC_READ;
	101
	102	sec = BCD2BIN(sec);
	103	min = BCD2BIN(min);
	104	hour = BCD2BIN(hour);
	105	date = BCD2BIN(date);
	106	month = BCD2BIN(month);
	107	year = BCD2BIN(year);
	108
	109	year += 1970;
	110
	111	return mktime(year, month, date, hour, min, sec);
	112	}
	113
06d428d7 RB	114	static void enable_rt_irq(unsigned int irq)
	115	{
	116	}
	117
	118	static void disable_rt_irq(unsigned int irq)
	119	{
	120	}
	121
	122	static struct irq_chip rt_irq_type = {
	123	.name = "SN HUB RT timer",
	124	.ack = disable_rt_irq,
	125	.mask = disable_rt_irq,
	126	.mask_ack = disable_rt_irq,
	127	.unmask = enable_rt_irq,
	128	.eoi = enable_rt_irq,
	129	};
	130
	131	static int rt_next_event(unsigned long delta, struct clock_event_device *evt)
e887b245 RB	132	{
	133	unsigned int cpu = smp_processor_id();
	134	int slice = cputoslice(cpu) == 0;
	135	unsigned long cnt;
	136
	137	cnt = LOCAL_HUB_L(PI_RT_COUNT);
	138	cnt += delta;
	139	LOCAL_HUB_S(slice ? PI_RT_COMPARE_A : PI_RT_COMPARE_B, cnt);
	140
	141	return LOCAL_HUB_L(PI_RT_COUNT) >= cnt ? -ETIME : 0;
	142	}
	143
	144	static void rt_set_mode(enum clock_event_mode mode,
	145	struct clock_event_device *evt)
	146	{
	147	switch (mode) {
06d428d7	148	case CLOCK_EVT_MODE_ONESHOT:
e887b245 RB	149	/* The only mode supported */
	150	break;
	151
06d428d7	152	case CLOCK_EVT_MODE_PERIODIC:
e887b245 RB	153	case CLOCK_EVT_MODE_UNUSED:
e887b245 RB	154	case CLOCK_EVT_MODE_SHUTDOWN:
e887b245 RB	155	case CLOCK_EVT_MODE_RESUME:
	156	/* Nothing to do */
	157	break;
	158	}
	159	}
	160
e887b245 RB	161	unsigned int rt_timer_irq;
e887b245 RB	162
06d428d7	163	static irqreturn_t hub_rt_counter_handler(int irq, void *dev_id)
e887b245	164	{
06d428d7	165	struct clock_event_device *cd = dev_id;
e887b245 RB	166	unsigned int cpu = smp_processor_id();
	167	int slice = cputoslice(cpu) == 0;
	168
	169	LOCAL_HUB_S(slice ? PI_RT_PEND_A : PI_RT_PEND_B, 0); /* Ack */
	170	cd->event_handler(cd);
	171
	172	return IRQ_HANDLED;
	173	}
	174
06d428d7 RB	175	struct irqaction hub_rt_irqaction = {
	176	.handler = hub_rt_counter_handler,
	177	.flags = IRQF_DISABLED \| IRQF_PERCPU,
	178	.name = "hub-rt",
3c009442 RB	179	};
3c009442 RB	180
e887b245 RB	181	/*
	182	* This is a hack; we really need to figure these values out dynamically
	183	*
	184	* Since 800 ns works very well with various HUB frequencies, such as
	185	* 360, 380, 390 and 400 MHZ, we use 800 ns rtc cycle time.
	186	*
	187	* Ralf: which clock rate is used to feed the counter?
	188	*/
	189	#define NSEC_PER_CYCLE 800
	190	#define CYCLES_PER_SEC (NSEC_PER_SEC / NSEC_PER_CYCLE)
	191
06d428d7 RB	192	static DEFINE_PER_CPU(struct clock_event_device, hub_rt_clockevent);
	193	static DEFINE_PER_CPU(char [11], hub_rt_name);
	194
	195	static void __cpuinit hub_rt_clock_event_init(void)
1da177e4	196	{
e887b245	197	unsigned int cpu = smp_processor_id();
06d428d7 RB	198	struct clock_event_device *cd = &per_cpu(hub_rt_clockevent, cpu);
	199	unsigned char *name = per_cpu(hub_rt_name, cpu);
	200	int irq = rt_timer_irq;
	201
	202	sprintf(name, "hub-rt %d", cpu);
	203	cd->name = "HUB-RT",
	204	cd->features = CLOCK_EVT_FEAT_ONESHOT,
	205	clockevent_set_clock(cd, CYCLES_PER_SEC);
	206	cd->max_delta_ns = clockevent_delta2ns(0xfffffffffffff, cd);
	207	cd->min_delta_ns = clockevent_delta2ns(0x300, cd);
	208	cd->rating = 200,
e887b245 RB	209	cd->irq = irq,
e887b245 RB	210	cd->cpumask = cpumask_of_cpu(cpu),
06d428d7 RB	211	cd->rating = 300,
	212	cd->set_next_event = rt_next_event,
	213	cd->set_mode = rt_set_mode,
e887b245	214	clockevents_register_device(cd);
06d428d7 RB	215	}
	216
	217	static void __init hub_rt_clock_event_global_init(void)
	218	{
	219	unsigned int irq;
	220
	221	do {
	222	smp_wmb();
	223	irq = rt_timer_irq;
	224	if (irq)
	225	break;
	226
	227	irq = allocate_irqno();
	228	if (irq < 0)
	229	panic("Allocation of irq number for timer failed");
	230	} while (xchg(&rt_timer_irq, irq));
e887b245 RB	231
e887b245 RB	232	set_irq_chip_and_handler(irq, &rt_irq_type, handle_percpu_irq);
06d428d7	233	setup_irq(irq, &hub_rt_irqaction);
1da177e4 LT	234	}
1da177e4 LT	235
87b2335d	236	static cycle_t hub_rt_read(void)
16b7b2ac AN	237	{
	238	return REMOTE_HUB_L(cputonasid(0), PI_RT_COUNT);
	239	}
	240
06d428d7	241	struct clocksource hub_rt_clocksource = {
e887b245	242	.name = "HUB-RT",
87b2335d RB	243	.rating = 200,
	244	.read = hub_rt_read,
	245	.mask = CLOCKSOURCE_MASK(52),
87b2335d RB	246	.flags = CLOCK_SOURCE_IS_CONTINUOUS,
	247	};
	248
06d428d7	249	static void __init hub_rt_clocksource_init(void)
1da177e4	250	{
06d428d7 RB	251	struct clocksource *cs = &hub_rt_clocksource;
	252
	253	clocksource_set_clock(cs, CYCLES_PER_SEC);
	254	clocksource_register(cs);
1da177e4 LT	255	}
1da177e4 LT	256
e887b245 RB	257	void __init plat_time_init(void)
e887b245 RB	258	{
06d428d7 RB	259	hub_rt_clocksource_init();
06d428d7 RB	260	hub_rt_clock_event_global_init();
e887b245 RB	261	}
e887b245 RB	262
06d428d7	263	void __cpuinit cpu_time_init(void)
1da177e4 LT	264	{
	265	lboard_t *board;
	266	klcpu_t *cpu;
	267	int cpuid;
	268
	269	/* Don't use ARCS. ARCS is fragile. Klconfig is simple and sane. */
	270	board = find_lboard(KL_CONFIG_INFO(get_nasid()), KLTYPE_IP27);
	271	if (!board)
	272	panic("Can't find board info for myself.");
	273
	274	cpuid = LOCAL_HUB_L(PI_CPU_NUM) ? IP27_CPU0_INDEX : IP27_CPU1_INDEX;
	275	cpu = (klcpu_t *) KLCF_COMP(board, cpuid);
	276	if (!cpu)
	277	panic("No information about myself?");
	278
	279	printk("CPU %d clock is %dMHz.\n", smp_processor_id(), cpu->cpu_speed);
	280
06d428d7	281	hub_rt_clock_event_init();
1da177e4 LT	282	set_c0_status(SRB_TIMOCLK);
	283	}
	284
	285	void __init hub_rtc_init(cnodeid_t cnode)
	286	{
	287	/*
	288	* We only need to initialize the current node.
	289	* If this is not the current node then it is a cpuless
	290	* node and timeouts will not happen there.
	291	*/
	292	if (get_compact_nodeid() == cnode) {
1da177e4 LT	293	LOCAL_HUB_S(PI_RT_EN_A, 1);
	294	LOCAL_HUB_S(PI_RT_EN_B, 1);
	295	LOCAL_HUB_S(PI_PROF_EN_A, 0);
	296	LOCAL_HUB_S(PI_PROF_EN_B, 0);
1da177e4 LT	297	LOCAL_HUB_S(PI_RT_COUNT, 0);
1da177e4 LT	298	LOCAL_HUB_S(PI_RT_PEND_A, 0);
1da177e4 LT	299	LOCAL_HUB_S(PI_RT_PEND_B, 0);
	300	}
	301	}