31
31
#define DPRINTF(fmt, args...) \
32
32
do { printf("TIMER: " fmt , ##args); } while (0)
34
#define DPRINTF(fmt, args...)
34
#define DPRINTF(fmt, args...) do {} while (0)
57
57
uint32_t count, counthigh, reached;
61
61
struct SLAVIO_TIMERState *master;
64
unsigned int num_slaves;
65
65
struct SLAVIO_TIMERState *slave[MAX_CPUS];
66
66
uint32_t slave_mode;
67
67
} SLAVIO_TIMERState;
69
#define TIMER_MAXADDR 0x1f
70
69
#define SYS_TIMER_SIZE 0x14
71
70
#define CPU_TIMER_SIZE 0x10
123
122
slavio_timer_get_out(s);
124
123
DPRINTF("callback: count %x%08x\n", s->counthigh, s->count);
125
if (!slavio_timer_is_user(s)) {
126
s->reached = TIMER_REACHED;
124
s->reached = TIMER_REACHED;
125
if (!slavio_timer_is_user(s))
127
126
qemu_irq_raise(s->irq);
131
129
static uint32_t slavio_timer_mem_readl(void *opaque, target_phys_addr_t addr)
188
186
DPRINTF("write " TARGET_FMT_plx " %08x\n", addr, val);
189
saddr = (addr & TIMER_MAXADDR) >> 2;
191
189
case TIMER_LIMIT:
192
190
if (slavio_timer_is_user(s)) {
193
193
// set user counter MSW, reset counter
194
qemu_irq_lower(s->irq);
195
194
s->limit = TIMER_MAX_COUNT64;
196
DPRINTF("processor %d user timer reset\n", s->slave_index);
195
s->counthigh = val & (TIMER_MAX_COUNT64 >> 32);
197
count = ((uint64_t)s->counthigh << 32) | s->count;
198
DPRINTF("processor %d user timer set to %016llx\n", s->slave_index,
198
ptimer_set_limit(s->timer, LIMIT_TO_PERIODS(s->limit), 1);
201
ptimer_set_count(s->timer, LIMIT_TO_PERIODS(s->limit - count));
200
203
// set limit, reset counter
201
204
qemu_irq_lower(s->irq);
202
205
s->limit = val & TIMER_MAX_COUNT32;
204
207
if (s->limit == 0) /* free-run */
205
ptimer_set_limit(s->timer, LIMIT_TO_PERIODS(TIMER_MAX_COUNT32), 1);
208
ptimer_set_limit(s->timer,
209
LIMIT_TO_PERIODS(TIMER_MAX_COUNT32), 1);
207
211
ptimer_set_limit(s->timer, LIMIT_TO_PERIODS(s->limit), 1);
211
215
case TIMER_COUNTER:
212
216
if (slavio_timer_is_user(s)) {
213
219
// set user counter LSW, reset counter
214
qemu_irq_lower(s->irq);
215
220
s->limit = TIMER_MAX_COUNT64;
216
DPRINTF("processor %d user timer reset\n", s->slave_index);
221
s->count = val & TIMER_MAX_COUNT64;
223
count = ((uint64_t)s->counthigh) << 32 | s->count;
224
DPRINTF("processor %d user timer set to %016llx\n", s->slave_index,
218
ptimer_set_limit(s->timer, LIMIT_TO_PERIODS(s->limit), 1);
227
ptimer_set_count(s->timer, LIMIT_TO_PERIODS(s->limit - count));
220
229
DPRINTF("not user timer\n");
224
233
s->limit = val & TIMER_MAX_COUNT32;
226
235
if (s->limit == 0) /* free-run */
227
ptimer_set_limit(s->timer, LIMIT_TO_PERIODS(TIMER_MAX_COUNT32), 0);
236
ptimer_set_limit(s->timer,
237
LIMIT_TO_PERIODS(TIMER_MAX_COUNT32), 0);
229
239
ptimer_set_limit(s->timer, LIMIT_TO_PERIODS(s->limit), 0);
252
262
for (i = 0; i < s->num_slaves; i++) {
253
if (val & (1 << i)) {
254
qemu_irq_lower(s->slave[i]->irq);
255
s->slave[i]->limit = -1ULL;
257
ptimer_stop(s->slave[i]->timer);
259
if ((val & (1 << i)) != (s->slave_mode & (1 << i))) {
260
ptimer_stop(s->slave[i]->timer);
261
ptimer_set_limit(s->slave[i]->timer,
262
LIMIT_TO_PERIODS(s->slave[i]->limit), 1);
263
DPRINTF("processor %d timer changed\n",
264
s->slave[i]->slave_index);
265
ptimer_run(s->slave[i]->timer, 0);
263
unsigned int processor = 1 << i;
265
// check for a change in timer mode for this processor
266
if ((val & processor) != (s->slave_mode & processor)) {
267
if (val & processor) { // counter -> user timer
268
qemu_irq_lower(s->slave[i]->irq);
269
// counters are always running
270
ptimer_stop(s->slave[i]->timer);
271
s->slave[i]->running = 0;
272
// user timer limit is always the same
273
s->slave[i]->limit = TIMER_MAX_COUNT64;
274
ptimer_set_limit(s->slave[i]->timer,
275
LIMIT_TO_PERIODS(s->slave[i]->limit),
277
// set this processors user timer bit in config
279
s->slave_mode |= processor;
280
DPRINTF("processor %d changed from counter to user "
281
"timer\n", s->slave[i]->slave_index);
282
} else { // user timer -> counter
283
// stop the user timer if it is running
284
if (s->slave[i]->running)
285
ptimer_stop(s->slave[i]->timer);
287
ptimer_run(s->slave[i]->timer, 0);
288
s->slave[i]->running = 1;
289
// clear this processors user timer bit in config
291
s->slave_mode &= ~processor;
292
DPRINTF("processor %d changed from user timer to "
293
"counter\n", s->slave[i]->slave_index);
268
s->slave_mode = val & ((1 << s->num_slaves) - 1);
270
298
DPRINTF("not system timer\n");
337
365
static SLAVIO_TIMERState *slavio_timer_init(target_phys_addr_t addr,
339
367
SLAVIO_TIMERState *master,
368
uint32_t slave_index)
342
370
int slavio_timer_io_memory;
343
371
SLAVIO_TIMERState *s;
346
374
s = qemu_mallocz(sizeof(SLAVIO_TIMERState));
350
376
s->master = master;
351
377
s->slave_index = slave_index;