157 lines
3.8 KiB
C
157 lines
3.8 KiB
C
/* $NetBSD: leds.c,v 1.2 2001/05/16 05:36:56 matt Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1997 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Gordon W. Ross and der Mouse.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
/*
|
|
* Functions to flash the LEDs with some pattern.
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/proc.h>
|
|
|
|
#include <machine/cpu.h>
|
|
#include <machine/sid.h>
|
|
#include <machine/leds.h>
|
|
|
|
#include "opt_cputype.h"
|
|
|
|
static volatile u_short *diagreg = 0;
|
|
static u_char led_countdown = 0;
|
|
static u_char led_px = 0;
|
|
|
|
/*
|
|
* Initial value is the default pattern set.
|
|
*/
|
|
static struct led_patterns ledpat = {
|
|
16, /* divisor */
|
|
12, /* patlen */
|
|
{ /* patterns */
|
|
0x03, 0x06, 0x0c, 0x18,
|
|
0x30, 0x60, 0xc0, 0x60,
|
|
0x30, 0x18, 0x0c, 0x06,
|
|
}
|
|
};
|
|
|
|
void
|
|
ledsattach(int a)
|
|
{
|
|
switch (vax_boardtype) {
|
|
#if VAX46 || VAXANY
|
|
case VAX_BTYP_46: {
|
|
extern struct vs_cpu *ka46_cpu;
|
|
diagreg = (volatile u_short *)(&ka46_cpu->vc_diagdsp);
|
|
break;
|
|
}
|
|
#endif
|
|
#if VAX48 || VAXANY
|
|
case VAX_BTYP_48: {
|
|
extern struct vs_cpu *ka48_cpu;
|
|
diagreg = (volatile u_short *)(&ka48_cpu->vc_diagdsp);
|
|
break;
|
|
}
|
|
#endif
|
|
#if VAX49 || VAXANY
|
|
case VAX_BTYP_49:
|
|
diagreg = (volatile u_short *)vax_map_physmem(0x25800000, 1);
|
|
diagreg += 2;
|
|
break;
|
|
#endif
|
|
default:
|
|
return;
|
|
}
|
|
|
|
/* Turn on some lights. */
|
|
leds_intr();
|
|
}
|
|
|
|
/*
|
|
* This is called by the clock interrupt.
|
|
*/
|
|
void
|
|
leds_intr()
|
|
{
|
|
register u_char i;
|
|
|
|
if (diagreg == 0)
|
|
return;
|
|
|
|
if (led_countdown) {
|
|
led_countdown--;
|
|
return;
|
|
}
|
|
|
|
led_countdown = ledpat.divisor - 1;
|
|
i = led_px;
|
|
|
|
*diagreg = ~ledpat.pat[i];
|
|
|
|
i = i+1;
|
|
if (i == ledpat.patlen)
|
|
i = 0;
|
|
led_px = i;
|
|
}
|
|
|
|
/*
|
|
* This is called by mem.c to handle /dev/leds
|
|
*/
|
|
int
|
|
leds_uio(struct uio *uio)
|
|
{
|
|
int cnt, error;
|
|
int off; /* NOT off_t */
|
|
caddr_t va;
|
|
|
|
off = uio->uio_offset;
|
|
if ((off < 0) || (off > sizeof(ledpat)))
|
|
return (EIO);
|
|
|
|
cnt = min(uio->uio_resid, (sizeof(ledpat) - off));
|
|
if (cnt == 0)
|
|
return (0); /* EOF */
|
|
|
|
va = ((char*)(&ledpat)) + off;
|
|
error = uiomove(va, cnt, uio);
|
|
|
|
return (error);
|
|
}
|
|
|