qemu/hw/timer/sh_timer.c
<<
>>
Prefs
   1/*
   2 * SuperH Timer modules.
   3 *
   4 * Copyright (c) 2007 Magnus Damm
   5 * Based on arm_timer.c by Paul Brook
   6 * Copyright (c) 2005-2006 CodeSourcery.
   7 *
   8 * This code is licensed under the GPL.
   9 */
  10
  11#include "qemu/osdep.h"
  12#include "exec/memory.h"
  13#include "qemu/log.h"
  14#include "hw/irq.h"
  15#include "hw/sh4/sh.h"
  16#include "hw/timer/tmu012.h"
  17#include "hw/ptimer.h"
  18#include "trace.h"
  19
  20#define TIMER_TCR_TPSC          (7 << 0)
  21#define TIMER_TCR_CKEG          (3 << 3)
  22#define TIMER_TCR_UNIE          (1 << 5)
  23#define TIMER_TCR_ICPE          (3 << 6)
  24#define TIMER_TCR_UNF           (1 << 8)
  25#define TIMER_TCR_ICPF          (1 << 9)
  26#define TIMER_TCR_RESERVED      (0x3f << 10)
  27
  28#define TIMER_FEAT_CAPT   (1 << 0)
  29#define TIMER_FEAT_EXTCLK (1 << 1)
  30
  31#define OFFSET_TCOR   0
  32#define OFFSET_TCNT   1
  33#define OFFSET_TCR    2
  34#define OFFSET_TCPR   3
  35
  36typedef struct {
  37    ptimer_state *timer;
  38    uint32_t tcnt;
  39    uint32_t tcor;
  40    uint32_t tcr;
  41    uint32_t tcpr;
  42    int freq;
  43    int int_level;
  44    int old_level;
  45    int feat;
  46    int enabled;
  47    qemu_irq irq;
  48} SHTimerState;
  49
  50/* Check all active timers, and schedule the next timer interrupt. */
  51
  52static void sh_timer_update(SHTimerState *s)
  53{
  54    int new_level = s->int_level && (s->tcr & TIMER_TCR_UNIE);
  55
  56    if (new_level != s->old_level) {
  57        qemu_set_irq(s->irq, new_level);
  58    }
  59    s->old_level = s->int_level;
  60    s->int_level = new_level;
  61}
  62
  63static uint32_t sh_timer_read(void *opaque, hwaddr offset)
  64{
  65    SHTimerState *s = opaque;
  66
  67    switch (offset >> 2) {
  68    case OFFSET_TCOR:
  69        return s->tcor;
  70    case OFFSET_TCNT:
  71        return ptimer_get_count(s->timer);
  72    case OFFSET_TCR:
  73        return s->tcr | (s->int_level ? TIMER_TCR_UNF : 0);
  74    case OFFSET_TCPR:
  75        if (s->feat & TIMER_FEAT_CAPT) {
  76            return s->tcpr;
  77        }
  78    }
  79    qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset 0x%" HWADDR_PRIx "\n",
  80                  __func__, offset);
  81    return 0;
  82}
  83
  84static void sh_timer_write(void *opaque, hwaddr offset, uint32_t value)
  85{
  86    SHTimerState *s = opaque;
  87    int freq;
  88
  89    switch (offset >> 2) {
  90    case OFFSET_TCOR:
  91        s->tcor = value;
  92        ptimer_transaction_begin(s->timer);
  93        ptimer_set_limit(s->timer, s->tcor, 0);
  94        ptimer_transaction_commit(s->timer);
  95        break;
  96    case OFFSET_TCNT:
  97        s->tcnt = value;
  98        ptimer_transaction_begin(s->timer);
  99        ptimer_set_count(s->timer, s->tcnt);
 100        ptimer_transaction_commit(s->timer);
 101        break;
 102    case OFFSET_TCR:
 103        ptimer_transaction_begin(s->timer);
 104        if (s->enabled) {
 105            /*
 106             * Pause the timer if it is running. This may cause some inaccuracy
 107             * due to rounding, but avoids a whole lot of other messiness
 108             */
 109            ptimer_stop(s->timer);
 110        }
 111        freq = s->freq;
 112        /* ??? Need to recalculate expiry time after changing divisor.  */
 113        switch (value & TIMER_TCR_TPSC) {
 114        case 0:
 115            freq >>= 2;
 116            break;
 117        case 1:
 118            freq >>= 4;
 119            break;
 120        case 2:
 121            freq >>= 6;
 122            break;
 123        case 3:
 124            freq >>= 8;
 125            break;
 126        case 4:
 127            freq >>= 10;
 128            break;
 129        case 6:
 130        case 7:
 131            if (s->feat & TIMER_FEAT_EXTCLK) {
 132                break;
 133            }
 134            /* fallthrough */
 135        default:
 136            qemu_log_mask(LOG_GUEST_ERROR,
 137                          "%s: Reserved TPSC value\n", __func__);
 138        }
 139        switch ((value & TIMER_TCR_CKEG) >> 3) {
 140        case 0:
 141            break;
 142        case 1:
 143        case 2:
 144        case 3:
 145            if (s->feat & TIMER_FEAT_EXTCLK) {
 146                break;
 147            }
 148            /* fallthrough */
 149        default:
 150            qemu_log_mask(LOG_GUEST_ERROR,
 151                          "%s: Reserved CKEG value\n", __func__);
 152        }
 153        switch ((value & TIMER_TCR_ICPE) >> 6) {
 154        case 0:
 155            break;
 156        case 2:
 157        case 3:
 158            if (s->feat & TIMER_FEAT_CAPT) {
 159                break;
 160            }
 161            /* fallthrough */
 162        default:
 163            qemu_log_mask(LOG_GUEST_ERROR,
 164                          "%s: Reserved ICPE value\n", __func__);
 165        }
 166        if ((value & TIMER_TCR_UNF) == 0) {
 167            s->int_level = 0;
 168        }
 169
 170        value &= ~TIMER_TCR_UNF;
 171
 172        if ((value & TIMER_TCR_ICPF) && (!(s->feat & TIMER_FEAT_CAPT))) {
 173            qemu_log_mask(LOG_GUEST_ERROR,
 174                          "%s: Reserved ICPF value\n", __func__);
 175        }
 176
 177        value &= ~TIMER_TCR_ICPF; /* capture not supported */
 178
 179        if (value & TIMER_TCR_RESERVED) {
 180            qemu_log_mask(LOG_GUEST_ERROR,
 181                          "%s: Reserved TCR bits set\n", __func__);
 182        }
 183        s->tcr = value;
 184        ptimer_set_limit(s->timer, s->tcor, 0);
 185        ptimer_set_freq(s->timer, freq);
 186        if (s->enabled) {
 187            /* Restart the timer if still enabled.  */
 188            ptimer_run(s->timer, 0);
 189        }
 190        ptimer_transaction_commit(s->timer);
 191        break;
 192    case OFFSET_TCPR:
 193        if (s->feat & TIMER_FEAT_CAPT) {
 194            s->tcpr = value;
 195            break;
 196        }
 197        /* fallthrough */
 198    default:
 199        qemu_log_mask(LOG_GUEST_ERROR,
 200                      "%s: Bad offset 0x%" HWADDR_PRIx "\n", __func__, offset);
 201    }
 202    sh_timer_update(s);
 203}
 204
 205static void sh_timer_start_stop(void *opaque, int enable)
 206{
 207    SHTimerState *s = opaque;
 208
 209    trace_sh_timer_start_stop(enable, s->enabled);
 210    ptimer_transaction_begin(s->timer);
 211    if (s->enabled && !enable) {
 212        ptimer_stop(s->timer);
 213    }
 214    if (!s->enabled && enable) {
 215        ptimer_run(s->timer, 0);
 216    }
 217    ptimer_transaction_commit(s->timer);
 218    s->enabled = !!enable;
 219}
 220
 221static void sh_timer_tick(void *opaque)
 222{
 223    SHTimerState *s = opaque;
 224    s->int_level = s->enabled;
 225    sh_timer_update(s);
 226}
 227
 228static void *sh_timer_init(uint32_t freq, int feat, qemu_irq irq)
 229{
 230    SHTimerState *s;
 231
 232    s = g_malloc0(sizeof(*s));
 233    s->freq = freq;
 234    s->feat = feat;
 235    s->tcor = 0xffffffff;
 236    s->tcnt = 0xffffffff;
 237    s->tcpr = 0xdeadbeef;
 238    s->tcr = 0;
 239    s->enabled = 0;
 240    s->irq = irq;
 241
 242    s->timer = ptimer_init(sh_timer_tick, s, PTIMER_POLICY_DEFAULT);
 243
 244    sh_timer_write(s, OFFSET_TCOR >> 2, s->tcor);
 245    sh_timer_write(s, OFFSET_TCNT >> 2, s->tcnt);
 246    sh_timer_write(s, OFFSET_TCPR >> 2, s->tcpr);
 247    sh_timer_write(s, OFFSET_TCR  >> 2, s->tcpr);
 248    /* ??? Save/restore.  */
 249    return s;
 250}
 251
 252typedef struct {
 253    MemoryRegion iomem;
 254    MemoryRegion iomem_p4;
 255    MemoryRegion iomem_a7;
 256    void *timer[3];
 257    int level[3];
 258    uint32_t tocr;
 259    uint32_t tstr;
 260    int feat;
 261} tmu012_state;
 262
 263static uint64_t tmu012_read(void *opaque, hwaddr offset, unsigned size)
 264{
 265    tmu012_state *s = opaque;
 266
 267    trace_sh_timer_read(offset);
 268    if (offset >= 0x20) {
 269        if (!(s->feat & TMU012_FEAT_3CHAN)) {
 270            qemu_log_mask(LOG_GUEST_ERROR,
 271                          "%s: Bad channel offset 0x%" HWADDR_PRIx "\n",
 272                          __func__, offset);
 273        }
 274        return sh_timer_read(s->timer[2], offset - 0x20);
 275    }
 276
 277    if (offset >= 0x14) {
 278        return sh_timer_read(s->timer[1], offset - 0x14);
 279    }
 280    if (offset >= 0x08) {
 281        return sh_timer_read(s->timer[0], offset - 0x08);
 282    }
 283    if (offset == 4) {
 284        return s->tstr;
 285    }
 286    if ((s->feat & TMU012_FEAT_TOCR) && offset == 0) {
 287        return s->tocr;
 288    }
 289
 290    qemu_log_mask(LOG_GUEST_ERROR,
 291                  "%s: Bad offset 0x%" HWADDR_PRIx "\n", __func__, offset);
 292    return 0;
 293}
 294
 295static void tmu012_write(void *opaque, hwaddr offset,
 296                        uint64_t value, unsigned size)
 297{
 298    tmu012_state *s = opaque;
 299
 300    trace_sh_timer_write(offset, value);
 301    if (offset >= 0x20) {
 302        if (!(s->feat & TMU012_FEAT_3CHAN)) {
 303            qemu_log_mask(LOG_GUEST_ERROR,
 304                          "%s: Bad channel offset 0x%" HWADDR_PRIx "\n",
 305                          __func__, offset);
 306        }
 307        sh_timer_write(s->timer[2], offset - 0x20, value);
 308        return;
 309    }
 310
 311    if (offset >= 0x14) {
 312        sh_timer_write(s->timer[1], offset - 0x14, value);
 313        return;
 314    }
 315
 316    if (offset >= 0x08) {
 317        sh_timer_write(s->timer[0], offset - 0x08, value);
 318        return;
 319    }
 320
 321    if (offset == 4) {
 322        sh_timer_start_stop(s->timer[0], value & (1 << 0));
 323        sh_timer_start_stop(s->timer[1], value & (1 << 1));
 324        if (s->feat & TMU012_FEAT_3CHAN) {
 325            sh_timer_start_stop(s->timer[2], value & (1 << 2));
 326        } else {
 327            if (value & (1 << 2)) {
 328                qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad channel\n", __func__);
 329            }
 330        }
 331
 332        s->tstr = value;
 333        return;
 334    }
 335
 336    if ((s->feat & TMU012_FEAT_TOCR) && offset == 0) {
 337        s->tocr = value & (1 << 0);
 338    }
 339}
 340
 341static const MemoryRegionOps tmu012_ops = {
 342    .read = tmu012_read,
 343    .write = tmu012_write,
 344    .endianness = DEVICE_NATIVE_ENDIAN,
 345};
 346
 347void tmu012_init(MemoryRegion *sysmem, hwaddr base, int feat, uint32_t freq,
 348                 qemu_irq ch0_irq, qemu_irq ch1_irq,
 349                 qemu_irq ch2_irq0, qemu_irq ch2_irq1)
 350{
 351    tmu012_state *s;
 352    int timer_feat = (feat & TMU012_FEAT_EXTCLK) ? TIMER_FEAT_EXTCLK : 0;
 353
 354    s = g_malloc0(sizeof(*s));
 355    s->feat = feat;
 356    s->timer[0] = sh_timer_init(freq, timer_feat, ch0_irq);
 357    s->timer[1] = sh_timer_init(freq, timer_feat, ch1_irq);
 358    if (feat & TMU012_FEAT_3CHAN) {
 359        s->timer[2] = sh_timer_init(freq, timer_feat | TIMER_FEAT_CAPT,
 360                                    ch2_irq0); /* ch2_irq1 not supported */
 361    }
 362
 363    memory_region_init_io(&s->iomem, NULL, &tmu012_ops, s, "timer", 0x30);
 364
 365    memory_region_init_alias(&s->iomem_p4, NULL, "timer-p4",
 366                             &s->iomem, 0, memory_region_size(&s->iomem));
 367    memory_region_add_subregion(sysmem, P4ADDR(base), &s->iomem_p4);
 368
 369    memory_region_init_alias(&s->iomem_a7, NULL, "timer-a7",
 370                             &s->iomem, 0, memory_region_size(&s->iomem));
 371    memory_region_add_subregion(sysmem, A7ADDR(base), &s->iomem_a7);
 372    /* ??? Save/restore.  */
 373}
 374