~ahs3/+junk/cq-qemu

« back to all changes in this revision

Viewing changes to hw/syborg_timer.c

  • Committer: Al Stone
  • Date: 2012-02-09 01:17:20 UTC
  • Revision ID: albert.stone@canonical.com-20120209011720-tztl7ik3qayz80p4
first commit to bzr for qemu

Show diffs side-by-side

added added

removed removed

Lines of Context:
 
1
/*
 
2
 * Syborg Interval Timer.
 
3
 *
 
4
 * Copyright (c) 2008 CodeSourcery
 
5
 *
 
6
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 
7
 * of this software and associated documentation files (the "Software"), to deal
 
8
 * in the Software without restriction, including without limitation the rights
 
9
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 
10
 * copies of the Software, and to permit persons to whom the Software is
 
11
 * furnished to do so, subject to the following conditions:
 
12
 *
 
13
 * The above copyright notice and this permission notice shall be included in
 
14
 * all copies or substantial portions of the Software.
 
15
 *
 
16
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 
17
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 
18
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 
19
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 
20
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 
21
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 
22
 * THE SOFTWARE.
 
23
 */
 
24
 
 
25
#include "sysbus.h"
 
26
#include "qemu-timer.h"
 
27
#include "syborg.h"
 
28
 
 
29
//#define DEBUG_SYBORG_TIMER
 
30
 
 
31
#ifdef DEBUG_SYBORG_TIMER
 
32
#define DPRINTF(fmt, ...) \
 
33
do { printf("syborg_timer: " fmt , ##args); } while (0)
 
34
#define BADF(fmt, ...) \
 
35
do { fprintf(stderr, "syborg_timer: error: " fmt , ## __VA_ARGS__); \
 
36
    exit(1);} while (0)
 
37
#else
 
38
#define DPRINTF(fmt, ...) do {} while(0)
 
39
#define BADF(fmt, ...) \
 
40
do { fprintf(stderr, "syborg_timer: error: " fmt , ## __VA_ARGS__);} while (0)
 
41
#endif
 
42
 
 
43
enum {
 
44
    TIMER_ID          = 0,
 
45
    TIMER_RUNNING     = 1,
 
46
    TIMER_ONESHOT     = 2,
 
47
    TIMER_LIMIT       = 3,
 
48
    TIMER_VALUE       = 4,
 
49
    TIMER_INT_ENABLE  = 5,
 
50
    TIMER_INT_STATUS  = 6,
 
51
    TIMER_FREQ        = 7
 
52
};
 
53
 
 
54
typedef struct {
 
55
    SysBusDevice busdev;
 
56
    ptimer_state *timer;
 
57
    int running;
 
58
    int oneshot;
 
59
    uint32_t limit;
 
60
    uint32_t freq;
 
61
    uint32_t int_level;
 
62
    uint32_t int_enabled;
 
63
    qemu_irq irq;
 
64
} SyborgTimerState;
 
65
 
 
66
static void syborg_timer_update(SyborgTimerState *s)
 
67
{
 
68
    /* Update interrupt.  */
 
69
    if (s->int_level && s->int_enabled) {
 
70
        qemu_irq_raise(s->irq);
 
71
    } else {
 
72
        qemu_irq_lower(s->irq);
 
73
    }
 
74
}
 
75
 
 
76
static void syborg_timer_tick(void *opaque)
 
77
{
 
78
    SyborgTimerState *s = (SyborgTimerState *)opaque;
 
79
    //DPRINTF("Timer Tick\n");
 
80
    s->int_level = 1;
 
81
    if (s->oneshot)
 
82
        s->running = 0;
 
83
    syborg_timer_update(s);
 
84
}
 
85
 
 
86
static uint32_t syborg_timer_read(void *opaque, target_phys_addr_t offset)
 
87
{
 
88
    SyborgTimerState *s = (SyborgTimerState *)opaque;
 
89
 
 
90
    DPRINTF("Reg read %d\n", (int)offset);
 
91
    offset &= 0xfff;
 
92
    switch (offset >> 2) {
 
93
    case TIMER_ID:
 
94
        return SYBORG_ID_TIMER;
 
95
    case TIMER_RUNNING:
 
96
        return s->running;
 
97
    case TIMER_ONESHOT:
 
98
        return s->oneshot;
 
99
    case TIMER_LIMIT:
 
100
        return s->limit;
 
101
    case TIMER_VALUE:
 
102
        return ptimer_get_count(s->timer);
 
103
    case TIMER_INT_ENABLE:
 
104
        return s->int_enabled;
 
105
    case TIMER_INT_STATUS:
 
106
        return s->int_level;
 
107
    case TIMER_FREQ:
 
108
        return s->freq;
 
109
    default:
 
110
        cpu_abort(cpu_single_env, "syborg_timer_read: Bad offset %x\n",
 
111
                  (int)offset);
 
112
        return 0;
 
113
    }
 
114
}
 
115
 
 
116
static void syborg_timer_write(void *opaque, target_phys_addr_t offset,
 
117
                               uint32_t value)
 
118
{
 
119
    SyborgTimerState *s = (SyborgTimerState *)opaque;
 
120
 
 
121
    DPRINTF("Reg write %d\n", (int)offset);
 
122
    offset &= 0xfff;
 
123
    switch (offset >> 2) {
 
124
    case TIMER_RUNNING:
 
125
        if (value == s->running)
 
126
            break;
 
127
        s->running = value;
 
128
        if (value) {
 
129
            ptimer_run(s->timer, s->oneshot);
 
130
        } else {
 
131
            ptimer_stop(s->timer);
 
132
        }
 
133
        break;
 
134
    case TIMER_ONESHOT:
 
135
        if (s->running) {
 
136
            ptimer_stop(s->timer);
 
137
        }
 
138
        s->oneshot = value;
 
139
        if (s->running) {
 
140
            ptimer_run(s->timer, s->oneshot);
 
141
        }
 
142
        break;
 
143
    case TIMER_LIMIT:
 
144
        s->limit = value;
 
145
        ptimer_set_limit(s->timer, value, 1);
 
146
        break;
 
147
    case TIMER_VALUE:
 
148
        ptimer_set_count(s->timer, value);
 
149
        break;
 
150
    case TIMER_INT_ENABLE:
 
151
        s->int_enabled = value;
 
152
        syborg_timer_update(s);
 
153
        break;
 
154
    case TIMER_INT_STATUS:
 
155
        s->int_level &= ~value;
 
156
        syborg_timer_update(s);
 
157
        break;
 
158
    default:
 
159
        cpu_abort(cpu_single_env, "syborg_timer_write: Bad offset %x\n",
 
160
                  (int)offset);
 
161
        break;
 
162
    }
 
163
}
 
164
 
 
165
static CPUReadMemoryFunc * const syborg_timer_readfn[] = {
 
166
    syborg_timer_read,
 
167
    syborg_timer_read,
 
168
    syborg_timer_read
 
169
};
 
170
 
 
171
static CPUWriteMemoryFunc * const syborg_timer_writefn[] = {
 
172
    syborg_timer_write,
 
173
    syborg_timer_write,
 
174
    syborg_timer_write
 
175
};
 
176
 
 
177
static const VMStateDescription vmstate_syborg_timer = {
 
178
    .name = "syborg_timer",
 
179
    .version_id = 1,
 
180
    .minimum_version_id = 1,
 
181
    .minimum_version_id_old = 1,
 
182
    .fields      = (VMStateField[]) {
 
183
        VMSTATE_INT32(running, SyborgTimerState),
 
184
        VMSTATE_INT32(oneshot, SyborgTimerState),
 
185
        VMSTATE_UINT32(limit, SyborgTimerState),
 
186
        VMSTATE_UINT32(int_level, SyborgTimerState),
 
187
        VMSTATE_UINT32(int_enabled, SyborgTimerState),
 
188
        VMSTATE_PTIMER(timer, SyborgTimerState),
 
189
        VMSTATE_END_OF_LIST()
 
190
    }
 
191
};
 
192
 
 
193
static int syborg_timer_init(SysBusDevice *dev)
 
194
{
 
195
    SyborgTimerState *s = FROM_SYSBUS(SyborgTimerState, dev);
 
196
    QEMUBH *bh;
 
197
    int iomemtype;
 
198
 
 
199
    if (s->freq == 0) {
 
200
        fprintf(stderr, "syborg_timer: Zero/unset frequency\n");
 
201
        exit(1);
 
202
    }
 
203
    sysbus_init_irq(dev, &s->irq);
 
204
    iomemtype = cpu_register_io_memory(syborg_timer_readfn,
 
205
                                       syborg_timer_writefn, s,
 
206
                                       DEVICE_NATIVE_ENDIAN);
 
207
    sysbus_init_mmio(dev, 0x1000, iomemtype);
 
208
 
 
209
    bh = qemu_bh_new(syborg_timer_tick, s);
 
210
    s->timer = ptimer_init(bh);
 
211
    ptimer_set_freq(s->timer, s->freq);
 
212
    vmstate_register(&dev->qdev, -1, &vmstate_syborg_timer, s);
 
213
    return 0;
 
214
}
 
215
 
 
216
static SysBusDeviceInfo syborg_timer_info = {
 
217
    .init = syborg_timer_init,
 
218
    .qdev.name  = "syborg,timer",
 
219
    .qdev.size  = sizeof(SyborgTimerState),
 
220
    .qdev.props = (Property[]) {
 
221
        DEFINE_PROP_UINT32("frequency",SyborgTimerState, freq, 0),
 
222
        DEFINE_PROP_END_OF_LIST(),
 
223
    }
 
224
};
 
225
 
 
226
static void syborg_timer_register_devices(void)
 
227
{
 
228
    sysbus_register_withprop(&syborg_timer_info);
 
229
}
 
230
 
 
231
device_init(syborg_timer_register_devices)