1 /* $NetBSD: led.c,v 1.8 2015/06/09 22:47:12 matt Exp $ */
2
3 /*-
4 * Copyright (c) 2001 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Jason R. Thorpe.
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 #include <sys/cdefs.h>
33 __KERNEL_RCSID(0, "$NetBSD: led.c,v 1.8 2015/06/09 22:47:12 matt Exp $");
34
35 #include "opt_algor_p4032.h"
36 #include "opt_algor_p5064.h"
37 #include "opt_algor_p6032.h"
38
39 #include <sys/param.h>
40
41 #include <mips/cpuregs.h>
42
43 #include <algor/autoconf.h>
44
45 #ifdef ALGOR_P4032
46 #include <algor/algor/algor_p4032reg.h>
47 #endif
48
49 #ifdef ALGOR_P5064
50 #include <algor/algor/algor_p5064reg.h>
51 #endif
52
53 #ifdef ALGOR_P6032
54 #include <algor/algor/algor_p6032reg.h>
55 #endif
56
57 #if defined(ALGOR_P4032)
58 #define LEDBASE MIPS_PHYS_TO_KSEG1(P4032_LED)
59 #define LED(x) ((3 - (x)) * 4)
60 #elif defined(ALGOR_P5064)
61 #define LEDBASE MIPS_PHYS_TO_KSEG1(P5064_LED1)
62 #define LED(x) ((3 - (x)) * 4)
63 #elif defined(ALGOR_P6032)
64 #define HD2532_STRIDE 4
65 #define HD2532_NFLASH_OFFSET 0x80
66 #define HD2532_CRAM (HD2532_NFLASH_OFFSET + (0x18 * HD2532_STRIDE))
67 #define LEDBASE MIPS_PHYS_TO_KSEG1(P6032_HDSP2532_BASE + HD2532_CRAM)
68 #define LED(x) ((x) * HD2532_STRIDE)
69 #endif
70
71 /*
72 * led_display:
73 *
74 * Set the LED display to the characters provided.
75 */
76 void
led_display(u_int8_t a,u_int8_t b,u_int8_t c,u_int8_t d)77 led_display(u_int8_t a, u_int8_t b, u_int8_t c, u_int8_t d)
78 {
79 u_int8_t *leds = (u_int8_t *) LEDBASE;
80
81 leds[LED(0)] = a;
82 leds[LED(1)] = b;
83 leds[LED(2)] = c;
84 leds[LED(3)] = d;
85 #if defined(ALGOR_P6032) /* XXX Should support these */
86 leds[LED(4)] = ' ';
87 leds[LED(5)] = ' ';
88 leds[LED(6)] = ' ';
89 leds[LED(7)] = ' ';
90 #endif
91 }
92