initial commit
[freebsd-arm:freebsd-arm.git] / arm / xscale / i80321 / i80321_wdog.c
1 /*      $NetBSD: i80321_wdog.c,v 1.6 2003/07/15 00:24:54 lukem Exp $    */
2
3 /*-
4  * Copyright (c) 2005 Olivier Houchard
5  * Copyright (c) 2002 Wasabi Systems, Inc.
6  * All rights reserved.
7  *
8  * Written by Jason R. Thorpe for Wasabi Systems, Inc.
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  * 3. All advertising materials mentioning features or use of this software
19  *    must display the following acknowledgement:
20  *      This product includes software developed for the NetBSD Project by
21  *      Wasabi Systems, Inc.
22  * 4. The name of Wasabi Systems, Inc. may not be used to endorse
23  *    or promote products derived from this software without specific prior
24  *    written permission.
25  *
26  * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
27  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36  * POSSIBILITY OF SUCH DAMAGE.
37  */
38
39 /*
40  * Watchdog timer support for the Intel i80321 I/O processor.
41  */
42
43 #include <sys/cdefs.h>
44 __FBSDID("$FreeBSD$");
45
46 #include <sys/param.h>
47 #include <sys/systm.h>
48 #include <sys/watchdog.h>
49 #include <sys/bus.h>
50 #include <sys/kernel.h>
51 #include <sys/module.h>
52
53 #include <machine/bus.h>
54 #include <machine/cpufunc.h>
55 #include <machine/machdep.h>
56
57 #include <arm/xscale/i80321/i80321reg.h>
58 #include <arm/xscale/i80321/i80321var.h>
59
60
61 struct iopwdog_softc {
62         device_t dev;
63         int armed;
64         int wdog_period;
65 };
66
67 static __inline void
68 wdtcr_write(uint32_t val)
69 {
70
71 #ifdef CPU_XSCALE_81342
72         __asm __volatile("mcr p6, 0, %0, c7, c9, 0"
73 #else
74         __asm __volatile("mcr p6, 0, %0, c7, c1, 0"
75 #endif
76                 :
77                 : "r" (val));
78 }
79
80 static void
81 iopwdog_tickle(void *arg)
82 {
83         struct iopwdog_softc *sc = arg;
84
85         if (!sc->armed)
86                 return;
87         wdtcr_write(WDTCR_ENABLE1);
88         wdtcr_write(WDTCR_ENABLE2);
89 }
90
91 static int
92 iopwdog_probe(device_t dev)
93 {
94         struct iopwdog_softc *sc = device_get_softc(dev);
95         char buf[128];
96
97         /*
98          * XXX Should compute the period based on processor speed.
99          * For a 600MHz XScale core, the wdog must be tickled approx.
100          * every 7 seconds.
101          */
102
103         sc->wdog_period = 7;
104         sprintf(buf, "i80321 Watchdog, must be tickled every %d seconds",
105             sc->wdog_period);
106         device_set_desc_copy(dev, buf);
107
108         return (0);
109 }
110
111 static void
112 iopwdog_watchdog_fn(void *private, u_int cmd, int *error)
113 {
114         struct iopwdog_softc *sc = private;
115
116         cmd &= WD_INTERVAL;
117         if (cmd > 0 && cmd <= 63
118             && (uint64_t)1<<cmd <= (uint64_t)sc->wdog_period * 1000000000) {
119                 /* Valid value -> Enable watchdog */
120                 iopwdog_tickle(sc);
121                 sc->armed = 1;
122                 *error = 0;
123         } else {
124                 /* Can't disable this watchdog! */
125                 if (sc->armed)
126                         *error = EOPNOTSUPP;
127         }
128 }
129
130 static int
131 iopwdog_attach(device_t dev)
132 {
133         struct iopwdog_softc *sc = device_get_softc(dev);
134         
135         sc->dev = dev;
136         sc->armed = 0;
137         EVENTHANDLER_REGISTER(watchdog_list, iopwdog_watchdog_fn, sc, 0);
138         return (0);
139 }
140
141 static device_method_t iopwdog_methods[] = {
142         DEVMETHOD(device_probe, iopwdog_probe),
143         DEVMETHOD(device_attach, iopwdog_attach),
144         {0, 0},
145 };
146
147 static driver_t iopwdog_driver = {
148         "iopwdog",
149         iopwdog_methods,
150         sizeof(struct iopwdog_softc),
151 };
152 static devclass_t iopwdog_devclass;
153
154 DRIVER_MODULE(iopwdog, iq, iopwdog_driver, iopwdog_devclass, 0, 0);