qemu/hw/timer/imx_gpt.c
<<
>>
Prefs
   1/*
   2 * IMX GPT Timer
   3 *
   4 * Copyright (c) 2008 OK Labs
   5 * Copyright (c) 2011 NICTA Pty Ltd
   6 * Originally written by Hans Jiang
   7 * Updated by Peter Chubb
   8 * Updated by Jean-Christophe Dubois <jcd@tribudubois.net>
   9 *
  10 * This code is licensed under GPL version 2 or later.  See
  11 * the COPYING file in the top-level directory.
  12 *
  13 */
  14
  15#include "qemu/osdep.h"
  16#include "hw/timer/imx_gpt.h"
  17#include "hw/misc/imx_ccm.h"
  18#include "qemu/main-loop.h"
  19
  20#ifndef DEBUG_IMX_GPT
  21#define DEBUG_IMX_GPT 0
  22#endif
  23
  24#define DPRINTF(fmt, args...) \
  25    do { \
  26        if (DEBUG_IMX_GPT) { \
  27            fprintf(stderr, "[%s]%s: " fmt , TYPE_IMX_GPT, \
  28                                             __func__, ##args); \
  29        } \
  30    } while (0)
  31
  32static char const *imx_gpt_reg_name(uint32_t reg)
  33{
  34    switch (reg) {
  35    case 0:
  36        return "CR";
  37    case 1:
  38        return "PR";
  39    case 2:
  40        return "SR";
  41    case 3:
  42        return "IR";
  43    case 4:
  44        return "OCR1";
  45    case 5:
  46        return "OCR2";
  47    case 6:
  48        return "OCR3";
  49    case 7:
  50        return "ICR1";
  51    case 8:
  52        return "ICR2";
  53    case 9:
  54        return "CNT";
  55    default:
  56        return "[?]";
  57    }
  58}
  59
  60static const VMStateDescription vmstate_imx_timer_gpt = {
  61    .name = TYPE_IMX_GPT,
  62    .version_id = 3,
  63    .minimum_version_id = 3,
  64    .fields = (VMStateField[]) {
  65        VMSTATE_UINT32(cr, IMXGPTState),
  66        VMSTATE_UINT32(pr, IMXGPTState),
  67        VMSTATE_UINT32(sr, IMXGPTState),
  68        VMSTATE_UINT32(ir, IMXGPTState),
  69        VMSTATE_UINT32(ocr1, IMXGPTState),
  70        VMSTATE_UINT32(ocr2, IMXGPTState),
  71        VMSTATE_UINT32(ocr3, IMXGPTState),
  72        VMSTATE_UINT32(icr1, IMXGPTState),
  73        VMSTATE_UINT32(icr2, IMXGPTState),
  74        VMSTATE_UINT32(cnt, IMXGPTState),
  75        VMSTATE_UINT32(next_timeout, IMXGPTState),
  76        VMSTATE_UINT32(next_int, IMXGPTState),
  77        VMSTATE_UINT32(freq, IMXGPTState),
  78        VMSTATE_PTIMER(timer, IMXGPTState),
  79        VMSTATE_END_OF_LIST()
  80    }
  81};
  82
  83static const IMXClk imx_gpt_clocks[] = {
  84    CLK_NONE,      /* 000 No clock source */
  85    CLK_IPG,       /* 001 ipg_clk, 532MHz*/
  86    CLK_IPG_HIGH,  /* 010 ipg_clk_highfreq */
  87    CLK_NONE,      /* 011 not defined */
  88    CLK_32k,       /* 100 ipg_clk_32k */
  89    CLK_NONE,      /* 101 not defined */
  90    CLK_NONE,      /* 110 not defined */
  91    CLK_NONE,      /* 111 not defined */
  92};
  93
  94static void imx_gpt_set_freq(IMXGPTState *s)
  95{
  96    uint32_t clksrc = extract32(s->cr, GPT_CR_CLKSRC_SHIFT, 3);
  97
  98    s->freq = imx_ccm_get_clock_frequency(s->ccm,
  99                                imx_gpt_clocks[clksrc]) / (1 + s->pr);
 100
 101    DPRINTF("Setting clksrc %d to frequency %d\n", clksrc, s->freq);
 102
 103    if (s->freq) {
 104        ptimer_set_freq(s->timer, s->freq);
 105    }
 106}
 107
 108static void imx_gpt_update_int(IMXGPTState *s)
 109{
 110    if ((s->sr & s->ir) && (s->cr & GPT_CR_EN)) {
 111        qemu_irq_raise(s->irq);
 112    } else {
 113        qemu_irq_lower(s->irq);
 114    }
 115}
 116
 117static uint32_t imx_gpt_update_count(IMXGPTState *s)
 118{
 119    s->cnt = s->next_timeout - (uint32_t)ptimer_get_count(s->timer);
 120
 121    return s->cnt;
 122}
 123
 124static inline uint32_t imx_gpt_find_limit(uint32_t count, uint32_t reg,
 125                                          uint32_t timeout)
 126{
 127    if ((count < reg) && (timeout > reg)) {
 128        timeout = reg;
 129    }
 130
 131    return timeout;
 132}
 133
 134static void imx_gpt_compute_next_timeout(IMXGPTState *s, bool event)
 135{
 136    uint32_t timeout = GPT_TIMER_MAX;
 137    uint32_t count;
 138    long long limit;
 139
 140    if (!(s->cr & GPT_CR_EN)) {
 141        /* if not enabled just return */
 142        return;
 143    }
 144
 145    /* update the count */
 146    count = imx_gpt_update_count(s);
 147
 148    if (event) {
 149        /*
 150         * This is an event (the ptimer reached 0 and stopped), and the
 151         * timer counter is now equal to s->next_timeout.
 152         */
 153        if (!(s->cr & GPT_CR_FRR) && (count == s->ocr1)) {
 154            /* We are in restart mode and we crossed the compare channel 1
 155             * value. We need to reset the counter to 0.
 156             */
 157            count = s->cnt = s->next_timeout = 0;
 158        } else if (count == GPT_TIMER_MAX) {
 159            /* We reached GPT_TIMER_MAX so we need to rollover */
 160            count = s->cnt = s->next_timeout = 0;
 161        }
 162    }
 163
 164    /* now, find the next timeout related to count */
 165
 166    if (s->ir & GPT_IR_OF1IE) {
 167        timeout = imx_gpt_find_limit(count, s->ocr1, timeout);
 168    }
 169    if (s->ir & GPT_IR_OF2IE) {
 170        timeout = imx_gpt_find_limit(count, s->ocr2, timeout);
 171    }
 172    if (s->ir & GPT_IR_OF3IE) {
 173        timeout = imx_gpt_find_limit(count, s->ocr3, timeout);
 174    }
 175
 176    /* find the next set of interrupts to raise for next timer event */
 177
 178    s->next_int = 0;
 179    if ((s->ir & GPT_IR_OF1IE) && (timeout == s->ocr1)) {
 180        s->next_int |= GPT_SR_OF1;
 181    }
 182    if ((s->ir & GPT_IR_OF2IE) && (timeout == s->ocr2)) {
 183        s->next_int |= GPT_SR_OF2;
 184    }
 185    if ((s->ir & GPT_IR_OF3IE) && (timeout == s->ocr3)) {
 186        s->next_int |= GPT_SR_OF3;
 187    }
 188    if ((s->ir & GPT_IR_ROVIE) && (timeout == GPT_TIMER_MAX)) {
 189        s->next_int |= GPT_SR_ROV;
 190    }
 191
 192    /* the new range to count down from */
 193    limit = timeout - imx_gpt_update_count(s);
 194
 195    if (limit < 0) {
 196        /*
 197         * if we reach here, then QEMU is running too slow and we pass the
 198         * timeout limit while computing it. Let's deliver the interrupt
 199         * and compute a new limit.
 200         */
 201        s->sr |= s->next_int;
 202
 203        imx_gpt_compute_next_timeout(s, event);
 204
 205        imx_gpt_update_int(s);
 206    } else {
 207        /* New timeout value */
 208        s->next_timeout = timeout;
 209
 210        /* reset the limit to the computed range */
 211        ptimer_set_limit(s->timer, limit, 1);
 212    }
 213}
 214
 215static uint64_t imx_gpt_read(void *opaque, hwaddr offset, unsigned size)
 216{
 217    IMXGPTState *s = IMX_GPT(opaque);
 218    uint32_t reg_value = 0;
 219
 220    switch (offset >> 2) {
 221    case 0: /* Control Register */
 222        reg_value = s->cr;
 223        break;
 224
 225    case 1: /* prescaler */
 226        reg_value = s->pr;
 227        break;
 228
 229    case 2: /* Status Register */
 230        reg_value = s->sr;
 231        break;
 232
 233    case 3: /* Interrupt Register */
 234        reg_value = s->ir;
 235        break;
 236
 237    case 4: /* Output Compare Register 1 */
 238        reg_value = s->ocr1;
 239        break;
 240
 241    case 5: /* Output Compare Register 2 */
 242        reg_value = s->ocr2;
 243        break;
 244
 245    case 6: /* Output Compare Register 3 */
 246        reg_value = s->ocr3;
 247        break;
 248
 249    case 7: /* input Capture Register 1 */
 250        qemu_log_mask(LOG_UNIMP, "[%s]%s: icr1 feature is not implemented\n",
 251                      TYPE_IMX_GPT, __func__);
 252        reg_value = s->icr1;
 253        break;
 254
 255    case 8: /* input Capture Register 2 */
 256        qemu_log_mask(LOG_UNIMP, "[%s]%s: icr2 feature is not implemented\n",
 257                      TYPE_IMX_GPT, __func__);
 258        reg_value = s->icr2;
 259        break;
 260
 261    case 9: /* cnt */
 262        imx_gpt_update_count(s);
 263        reg_value = s->cnt;
 264        break;
 265
 266    default:
 267        qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%"
 268                      HWADDR_PRIx "\n", TYPE_IMX_GPT, __func__, offset);
 269        break;
 270    }
 271
 272    DPRINTF("(%s) = 0x%08x\n", imx_gpt_reg_name(offset >> 2), reg_value);
 273
 274    return reg_value;
 275}
 276
 277static void imx_gpt_reset(DeviceState *dev)
 278{
 279    IMXGPTState *s = IMX_GPT(dev);
 280
 281    /* stop timer */
 282    ptimer_stop(s->timer);
 283
 284    /*
 285     * Soft reset doesn't touch some bits; hard reset clears them
 286     */
 287    s->cr &= ~(GPT_CR_EN|GPT_CR_ENMOD|GPT_CR_STOPEN|GPT_CR_DOZEN|
 288               GPT_CR_WAITEN|GPT_CR_DBGEN);
 289    s->sr = 0;
 290    s->pr = 0;
 291    s->ir = 0;
 292    s->cnt = 0;
 293    s->ocr1 = GPT_TIMER_MAX;
 294    s->ocr2 = GPT_TIMER_MAX;
 295    s->ocr3 = GPT_TIMER_MAX;
 296    s->icr1 = 0;
 297    s->icr2 = 0;
 298
 299    s->next_timeout = GPT_TIMER_MAX;
 300    s->next_int = 0;
 301
 302    /* compute new freq */
 303    imx_gpt_set_freq(s);
 304
 305    /* reset the limit to GPT_TIMER_MAX */
 306    ptimer_set_limit(s->timer, GPT_TIMER_MAX, 1);
 307
 308    /* if the timer is still enabled, restart it */
 309    if (s->freq && (s->cr & GPT_CR_EN)) {
 310        ptimer_run(s->timer, 1);
 311    }
 312}
 313
 314static void imx_gpt_write(void *opaque, hwaddr offset, uint64_t value,
 315                          unsigned size)
 316{
 317    IMXGPTState *s = IMX_GPT(opaque);
 318    uint32_t oldreg;
 319
 320    DPRINTF("(%s, value = 0x%08x)\n", imx_gpt_reg_name(offset >> 2),
 321            (uint32_t)value);
 322
 323    switch (offset >> 2) {
 324    case 0:
 325        oldreg = s->cr;
 326        s->cr = value & ~0x7c14;
 327        if (s->cr & GPT_CR_SWR) { /* force reset */
 328            /* handle the reset */
 329            imx_gpt_reset(DEVICE(s));
 330        } else {
 331            /* set our freq, as the source might have changed */
 332            imx_gpt_set_freq(s);
 333
 334            if ((oldreg ^ s->cr) & GPT_CR_EN) {
 335                if (s->cr & GPT_CR_EN) {
 336                    if (s->cr & GPT_CR_ENMOD) {
 337                        s->next_timeout = GPT_TIMER_MAX;
 338                        ptimer_set_count(s->timer, GPT_TIMER_MAX);
 339                        imx_gpt_compute_next_timeout(s, false);
 340                    }
 341                    ptimer_run(s->timer, 1);
 342                } else {
 343                    /* stop timer */
 344                    ptimer_stop(s->timer);
 345                }
 346            }
 347        }
 348        break;
 349
 350    case 1: /* Prescaler */
 351        s->pr = value & 0xfff;
 352        imx_gpt_set_freq(s);
 353        break;
 354
 355    case 2: /* SR */
 356        s->sr &= ~(value & 0x3f);
 357        imx_gpt_update_int(s);
 358        break;
 359
 360    case 3: /* IR -- interrupt register */
 361        s->ir = value & 0x3f;
 362        imx_gpt_update_int(s);
 363
 364        imx_gpt_compute_next_timeout(s, false);
 365
 366        break;
 367
 368    case 4: /* OCR1 -- output compare register */
 369        s->ocr1 = value;
 370
 371        /* In non-freerun mode, reset count when this register is written */
 372        if (!(s->cr & GPT_CR_FRR)) {
 373            s->next_timeout = GPT_TIMER_MAX;
 374            ptimer_set_limit(s->timer, GPT_TIMER_MAX, 1);
 375        }
 376
 377        /* compute the new timeout */
 378        imx_gpt_compute_next_timeout(s, false);
 379
 380        break;
 381
 382    case 5: /* OCR2 -- output compare register */
 383        s->ocr2 = value;
 384
 385        /* compute the new timeout */
 386        imx_gpt_compute_next_timeout(s, false);
 387
 388        break;
 389
 390    case 6: /* OCR3 -- output compare register */
 391        s->ocr3 = value;
 392
 393        /* compute the new timeout */
 394        imx_gpt_compute_next_timeout(s, false);
 395
 396        break;
 397
 398    default:
 399        qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%"
 400                      HWADDR_PRIx "\n", TYPE_IMX_GPT, __func__, offset);
 401        break;
 402    }
 403}
 404
 405static void imx_gpt_timeout(void *opaque)
 406{
 407    IMXGPTState *s = IMX_GPT(opaque);
 408
 409    DPRINTF("\n");
 410
 411    s->sr |= s->next_int;
 412    s->next_int = 0;
 413
 414    imx_gpt_compute_next_timeout(s, true);
 415
 416    imx_gpt_update_int(s);
 417
 418    if (s->freq && (s->cr & GPT_CR_EN)) {
 419        ptimer_run(s->timer, 1);
 420    }
 421}
 422
 423static const MemoryRegionOps imx_gpt_ops = {
 424    .read = imx_gpt_read,
 425    .write = imx_gpt_write,
 426    .endianness = DEVICE_NATIVE_ENDIAN,
 427};
 428
 429
 430static void imx_gpt_realize(DeviceState *dev, Error **errp)
 431{
 432    IMXGPTState *s = IMX_GPT(dev);
 433    SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
 434    QEMUBH *bh;
 435
 436    sysbus_init_irq(sbd, &s->irq);
 437    memory_region_init_io(&s->iomem, OBJECT(s), &imx_gpt_ops, s, TYPE_IMX_GPT,
 438                          0x00001000);
 439    sysbus_init_mmio(sbd, &s->iomem);
 440
 441    bh = qemu_bh_new(imx_gpt_timeout, s);
 442    s->timer = ptimer_init(bh);
 443}
 444
 445static void imx_gpt_class_init(ObjectClass *klass, void *data)
 446{
 447    DeviceClass *dc = DEVICE_CLASS(klass);
 448
 449    dc->realize = imx_gpt_realize;
 450    dc->reset = imx_gpt_reset;
 451    dc->vmsd = &vmstate_imx_timer_gpt;
 452    dc->desc = "i.MX general timer";
 453}
 454
 455static const TypeInfo imx_gpt_info = {
 456    .name = TYPE_IMX_GPT,
 457    .parent = TYPE_SYS_BUS_DEVICE,
 458    .instance_size = sizeof(IMXGPTState),
 459    .class_init = imx_gpt_class_init,
 460};
 461
 462static void imx_gpt_register_types(void)
 463{
 464    type_register_static(&imx_gpt_info);
 465}
 466
 467type_init(imx_gpt_register_types)
 468