200 lines
4.9 KiB
C
200 lines
4.9 KiB
C
/* $NetBSD: timer_hb.c,v 1.1 2001/07/07 15:27:22 tsutsui Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1996 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Jason R. Thorpe.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the NetBSD
|
|
* Foundation, Inc. and its contributors.
|
|
* 4. Neither the name of The NetBSD Foundation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <uvm/uvm_extern.h>
|
|
|
|
#include <machine/cpu.h>
|
|
#include <machine/bus.h>
|
|
|
|
#include <dev/clock_subr.h>
|
|
|
|
#include <news68k/news68k/isr.h>
|
|
#include <news68k/news68k/clockvar.h>
|
|
|
|
#include <news68k/dev/hbvar.h>
|
|
|
|
/*
|
|
* interrupt level for clock
|
|
*/
|
|
|
|
#define TIMER_LEVEL 6
|
|
#define TIMER_SIZE 8 /* XXX */
|
|
|
|
int timer_hb_match(struct device *, struct cfdata *, void *);
|
|
void timer_hb_attach(struct device *, struct device *, void *);
|
|
void timer_hb_initclocks(int, int);
|
|
void clock_intr(struct clockframe *);
|
|
|
|
static __inline void leds_intr __P((void));
|
|
|
|
extern void _isr_clock __P((void)); /* locore.s */
|
|
|
|
struct cfattach timer_hb_ca = {
|
|
sizeof(struct device), timer_hb_match, timer_hb_attach
|
|
};
|
|
|
|
static volatile u_int8_t *ctrl_timer; /* XXX */
|
|
|
|
extern volatile u_char *ctrl_led; /* XXX */
|
|
extern struct cfdriver timer_cd;
|
|
|
|
int
|
|
timer_hb_match(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
struct hb_attach_args *ha = aux;
|
|
static int timer_hb_matched;
|
|
|
|
/* Only one timer, please. */
|
|
if (timer_hb_matched)
|
|
return (0);
|
|
|
|
if (strcmp(ha->ha_name, timer_cd.cd_name))
|
|
return (0);
|
|
|
|
if (ha->ha_ipl == -1)
|
|
ha->ha_ipl = TIMER_LEVEL;
|
|
|
|
ha->ha_size = TIMER_SIZE;
|
|
|
|
timer_hb_matched = 1;
|
|
|
|
return 1;
|
|
}
|
|
|
|
void
|
|
timer_hb_attach(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
{
|
|
struct hb_attach_args *ha = aux;
|
|
|
|
if (ha->ha_ipl != TIMER_LEVEL)
|
|
panic("clock_hb_attach: wrong interrupt level");
|
|
|
|
ctrl_timer = (u_int8_t *)IIOV(ha->ha_address); /* XXX needs bus_space */
|
|
|
|
printf("\n");
|
|
|
|
timer_config(timer_hb_initclocks);
|
|
|
|
#if 0 /* XXX this will be done in timer_hb_initclocks() */
|
|
isrlink_custom(ha->ha_ipl, (void *)_isr_clock);
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Set up the interval timer (enable clock interrupts).
|
|
* Leave stathz 0 since there is no secondary clock available.
|
|
* Note that clock interrupts MUST STAY DISABLED until here.
|
|
*/
|
|
void
|
|
timer_hb_initclocks(tick, statint)
|
|
int tick, statint;
|
|
{
|
|
int s;
|
|
|
|
s = splhigh();
|
|
|
|
/* Install isr (in locore.s) that calls clock_intr(). */
|
|
isrlink_custom(TIMER_LEVEL, (void *)_isr_clock);
|
|
|
|
/* enable the clock */
|
|
*ctrl_timer = 1;
|
|
splx(s);
|
|
}
|
|
|
|
/*
|
|
* Clock interrupt handler.
|
|
* This is is called by the "custom" interrupt handler.
|
|
*
|
|
* from sun3/sun3x/clock.c -tsutsui
|
|
*/
|
|
void
|
|
clock_intr(cf)
|
|
struct clockframe *cf;
|
|
{
|
|
#ifdef LED_IDLE_CHECK
|
|
extern char _Idle[]; /* locore.s */
|
|
#endif
|
|
|
|
/* Pulse the clock intr. enable low. */
|
|
*ctrl_timer = 0;
|
|
*ctrl_timer = 1;
|
|
intrcnt[TIMER_LEVEL]++;
|
|
|
|
/* Entertainment! */
|
|
#ifdef LED_IDLE_CHECK
|
|
if (cf.cf_pc == (long)_Idle)
|
|
#endif
|
|
leds_intr();
|
|
|
|
/* Call common clock interrupt handler. */
|
|
hardclock(cf);
|
|
uvmexp.intrs++;
|
|
}
|
|
|
|
/* heartbeat LED */
|
|
#define LED0 0x01
|
|
#define LED1 0x02
|
|
|
|
static __inline void
|
|
leds_intr()
|
|
{
|
|
static u_char led_countdown, led_stat;
|
|
u_char i;
|
|
|
|
if (led_countdown) {
|
|
led_countdown--;
|
|
return;
|
|
}
|
|
|
|
i = led_stat ^ LED0;
|
|
*ctrl_led = i;
|
|
led_stat = i;
|
|
led_countdown = hz;
|
|
}
|
|
|