root / hw / wdt_ib700.c @ e8f27c72
History | View | Annotate | Download (3.3 kB)
1 |
/*
|
---|---|
2 |
* Virtual hardware watchdog.
|
3 |
*
|
4 |
* Copyright (C) 2009 Red Hat Inc.
|
5 |
*
|
6 |
* This program is free software; you can redistribute it and/or
|
7 |
* modify it under the terms of the GNU General Public License
|
8 |
* as published by the Free Software Foundation; either version 2
|
9 |
* of the License, or (at your option) any later version.
|
10 |
*
|
11 |
* This program is distributed in the hope that it will be useful,
|
12 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
14 |
* GNU General Public License for more details.
|
15 |
*
|
16 |
* You should have received a copy of the GNU General Public License
|
17 |
* along with this program; if not, see <http://www.gnu.org/licenses/>.
|
18 |
*
|
19 |
* By Richard W.M. Jones (rjones@redhat.com).
|
20 |
*/
|
21 |
|
22 |
#include "qemu-common.h" |
23 |
#include "qemu-timer.h" |
24 |
#include "watchdog.h" |
25 |
#include "hw.h" |
26 |
#include "isa.h" |
27 |
#include "pc.h" |
28 |
|
29 |
/*#define IB700_DEBUG 1*/
|
30 |
|
31 |
#ifdef IB700_DEBUG
|
32 |
#define ib700_debug(fs,...) \
|
33 |
fprintf(stderr,"ib700: %s: "fs,__func__,##__VA_ARGS__) |
34 |
#else
|
35 |
#define ib700_debug(fs,...)
|
36 |
#endif
|
37 |
|
38 |
typedef struct IB700state { |
39 |
ISADevice dev; |
40 |
QEMUTimer *timer; |
41 |
} IB700State; |
42 |
|
43 |
/* This is the timer. We use a global here because the watchdog
|
44 |
* code ensures there is only one watchdog (it is located at a fixed,
|
45 |
* unchangable IO port, so there could only ever be one anyway).
|
46 |
*/
|
47 |
|
48 |
/* A write to this register enables the timer. */
|
49 |
static void ib700_write_enable_reg(void *vp, uint32_t addr, uint32_t data) |
50 |
{ |
51 |
IB700State *s = vp; |
52 |
static int time_map[] = { |
53 |
30, 28, 26, 24, 22, 20, 18, 16, |
54 |
14, 12, 10, 8, 6, 4, 2, 0 |
55 |
}; |
56 |
int64 timeout; |
57 |
|
58 |
ib700_debug("addr = %x, data = %x\n", addr, data);
|
59 |
|
60 |
timeout = (int64_t) time_map[data & 0xF] * get_ticks_per_sec();
|
61 |
qemu_mod_timer(s->timer, qemu_get_clock (vm_clock) + timeout); |
62 |
} |
63 |
|
64 |
/* A write (of any value) to this register disables the timer. */
|
65 |
static void ib700_write_disable_reg(void *vp, uint32_t addr, uint32_t data) |
66 |
{ |
67 |
IB700State *s = vp; |
68 |
|
69 |
ib700_debug("addr = %x, data = %x\n", addr, data);
|
70 |
|
71 |
qemu_del_timer(s->timer); |
72 |
} |
73 |
|
74 |
/* This is called when the watchdog expires. */
|
75 |
static void ib700_timer_expired(void *vp) |
76 |
{ |
77 |
IB700State *s = vp; |
78 |
|
79 |
ib700_debug("watchdog expired\n");
|
80 |
|
81 |
watchdog_perform_action(); |
82 |
qemu_del_timer(s->timer); |
83 |
} |
84 |
|
85 |
static void ib700_save(QEMUFile *f, void *vp) |
86 |
{ |
87 |
IB700State *s = vp; |
88 |
|
89 |
qemu_put_timer(f, s->timer); |
90 |
} |
91 |
|
92 |
static int ib700_load(QEMUFile *f, void *vp, int version) |
93 |
{ |
94 |
IB700State *s = vp; |
95 |
|
96 |
if (version != 0) |
97 |
return -EINVAL;
|
98 |
|
99 |
qemu_get_timer(f, s->timer); |
100 |
|
101 |
return 0; |
102 |
} |
103 |
|
104 |
static int wdt_ib700_init(ISADevice *dev) |
105 |
{ |
106 |
IB700State *s = DO_UPCAST(IB700State, dev, dev); |
107 |
|
108 |
s->timer = qemu_new_timer(vm_clock, ib700_timer_expired, s); |
109 |
register_savevm("ib700_wdt", -1, 0, ib700_save, ib700_load, s); |
110 |
register_ioport_write(0x441, 2, 1, ib700_write_disable_reg, s); |
111 |
register_ioport_write(0x443, 2, 1, ib700_write_enable_reg, s); |
112 |
|
113 |
return 0; |
114 |
} |
115 |
|
116 |
static WatchdogTimerModel model = {
|
117 |
.wdt_name = "ib700",
|
118 |
.wdt_description = "iBASE 700",
|
119 |
}; |
120 |
|
121 |
static ISADeviceInfo wdt_ib700_info = {
|
122 |
.qdev.name = "ib700",
|
123 |
.qdev.size = sizeof(IB700State),
|
124 |
.init = wdt_ib700_init, |
125 |
}; |
126 |
|
127 |
static void wdt_ib700_register_devices(void) |
128 |
{ |
129 |
watchdog_add_model(&model); |
130 |
isa_qdev_register(&wdt_ib700_info); |
131 |
} |
132 |
|
133 |
device_init(wdt_ib700_register_devices); |