Home | History | Annotate | Line # | Download | only in vsa
leds.c revision 1.8 
      1 /*	$NetBSD: leds.c,v 1.8 2008/05/04 00:10:42 jklos Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1997 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Gordon W. Ross and der Mouse.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 /*
     33  * Functions to flash the LEDs with some pattern.
     34  */
     35 
     36 #include <sys/cdefs.h>
     37 __KERNEL_RCSID(0, "$NetBSD: leds.c,v 1.8 2008/05/04 00:10:42 jklos Exp $");
     38 
     39 #include <sys/param.h>
     40 #include <sys/systm.h>
     41 #include <sys/device.h>
     42 #include <sys/conf.h>
     43 #include <sys/buf.h>
     44 #include <sys/malloc.h>
     45 #include <sys/proc.h>
     46 
     47 #include <machine/cpu.h>
     48 #include <machine/sid.h>
     49 #include <machine/leds.h>
     50 
     51 #include "opt_cputype.h"
     52 
     53 static volatile u_short *diagreg = 0;
     54 static u_char led_countdown = 0;
     55 static u_char led_px = 0;
     56 
     57 /*
     58  * Initial value is the default pattern set.
     59  */
     60 struct led_patterns ledpat = {
     61 	16,	/* divisor */
     62 	12,	/* patlen */
     63 	{	/* patterns */
     64 		0x03, 0x06, 0x0c, 0x18,
     65 		0x30, 0x60, 0xc0, 0x60,
     66 		0x30, 0x18, 0x0c, 0x06,
     67 	}
     68 };
     69 
     70 void
     71 ledsattach(int a)
     72 {
     73 	switch (vax_boardtype) {
     74 #if VAX46 || VAXANY
     75 	case VAX_BTYP_46: {
     76 		extern struct vs_cpu *ka46_cpu;
     77 		diagreg = (volatile u_short *)(&ka46_cpu->vc_diagdsp);
     78 		break;
     79 		}
     80 #endif
     81 #if VAX48 || VAXANY
     82 	case VAX_BTYP_48: {
     83 		extern struct vs_cpu *ka48_cpu;
     84 		diagreg = (volatile u_short *)(&ka48_cpu->vc_diagdsp);
     85 		break;
     86 		}
     87 #endif
     88 #if VAX49 || VAXANY
     89 	case VAX_BTYP_49:
     90 		diagreg = (volatile u_short *)vax_map_physmem(0x25800000, 1);
     91 		diagreg += 2;
     92 		break;
     93 #endif
     94 	default:
     95 		return;
     96 	}
     97 
     98 	/* Turn on some lights. */
     99 	leds_intr();
    100 }
    101 
    102 /*
    103  * This is called by the clock interrupt.
    104  */
    105 void
    106 leds_intr(void)
    107 {
    108 	register u_char i;
    109 
    110 	if (diagreg == 0)
    111 		return;
    112 
    113 	if (led_countdown) {
    114 		led_countdown--;
    115 		return;
    116 	}
    117 
    118 	led_countdown = ledpat.divisor - 1;
    119 	i = led_px;
    120 
    121 	*diagreg = ~ledpat.pat[i];
    122 
    123 	i = i+1;
    124 	if (i == ledpat.patlen)
    125 		i = 0;
    126 	led_px = i;
    127 }
    128 
    129 /*
    130  * This is called by mem.c to handle /dev/leds
    131  */
    132 int
    133 leds_uio(struct uio *uio)
    134 {
    135 	int cnt, error;
    136 	int off;	/* NOT off_t */
    137 	char *va;
    138 
    139 	off = uio->uio_offset;
    140 	if ((off < 0) || (off > sizeof(ledpat)))
    141 		return (EIO);
    142 
    143 	cnt = min(uio->uio_resid, (sizeof(ledpat) - off));
    144 	if (cnt == 0)
    145 		return (0); /* EOF */
    146 
    147 
    148 	va = (char *)&ledpat;
    149 	va = va + off;
    150 	error = uiomove(va, cnt, uio);
    151 
    152 	return (error);
    153 }
    154 
    155