[Qemu-devel] [PATCH 3/3] Stelaris 16-bit timer mode.

[Logan Gunthorpe]

- Finished the 16-bit timer mode in the stelaris module which was previously 
marked as a TODO.
---
 hw/stellaris.c |   35 ++++++++++++++++++++++++-----------
 1 files changed, 24 insertions(+), 11 deletions(-)

diff --git a/hw/stellaris.c b/hw/stellaris.c
index 4fadeec..f23fb87 100644
--- a/hw/stellaris.c
+++ b/hw/stellaris.c
@@ -60,14 +60,16 @@ typedef struct gptm_state {
     QEMUTimer *timer[2];
     /* The timers have an alternate output used to trigger the ADC.  */
     qemu_irq trigger;
-    qemu_irq irq;
+    qemu_irq irq[2];
 } gptm_state;
 
 static void gptm_update_irq(gptm_state *s)
 {
     int level;
-    level = (s->state & s->mask) != 0;
-    qemu_set_irq(s->irq, level);
+    level = ((s->state & s->mask) & 0xf) != 0;
+    qemu_set_irq(s->irq[0], level);
+    level = ((s->state & s->mask) & 0xf00) != 0;
+    qemu_set_irq(s->irq[1], level);
 }
 
 static void gptm_stop(gptm_state *s, int n)
@@ -94,7 +96,7 @@ static void gptm_reload(gptm_state *s, int n, int reset)
     } else if (s->mode[n] == 0xa) {
         /* PWM mode.  Not implemented.  */
     } else {
-        hw_error("TODO: 16-bit timer mode 0x%x\n", s->mode[n]);
+        tick += (int64_t) s->load[n] * system_clock_scale * (s->prescale[n]+1);
     }
     s->tick[n] = tick;
     qemu_mod_timer(s->timer[n], tick);
@@ -135,7 +137,15 @@ static void gptm_tick(void *opaque)
     } else if (s->mode[n] == 0xa) {
         /* PWM mode.  Not implemented.  */
     } else {
-        hw_error("TODO: 16-bit timer mode 0x%x\n", s->mode[n]);
+        s->state |= 1 << n*8;
+
+        if (s->mode[n] & 1) {
+            /* One-shot.  */
+            s->control &= ~(1 << n*8);
+        } else {
+            /* Periodic.  */
+            gptm_reload(s, n, 0);
+        }
     }
     gptm_update_irq(s);
 }
@@ -226,11 +236,12 @@ static void gptm_write(void *opaque, target_phys_addr_t 
offset, uint32_t value)
         }
         break;
     case 0x18: /* IMR */
-        s->mask = value & 0x77;
+        s->mask = value & 0x0707;
         gptm_update_irq(s);
         break;
     case 0x24: /* CR */
         s->state &= ~value;
+        gptm_update_irq(s);
         break;
     case 0x28: /* TAILR */
         s->load[0] = value & 0xffff;
@@ -265,7 +276,6 @@ static void gptm_write(void *opaque, target_phys_addr_t 
offset, uint32_t value)
     default:
         hw_error("gptm_write: Bad offset 0x%x\n", (int)offset);
     }
-    gptm_update_irq(s);
 }
 
 static CPUReadMemoryFunc *gptm_readfn[] = {
@@ -344,7 +354,9 @@ static void stellaris_gptm_init(SysBusDevice *dev)
     int iomemtype;
     gptm_state *s = FROM_SYSBUS(gptm_state, dev);
 
-    sysbus_init_irq(dev, &s->irq);
+    sysbus_init_irq(dev, &s->irq[0]);
+    sysbus_init_irq(dev, &s->irq[1]);
+
     qdev_init_gpio_out(&dev->qdev, &s->trigger, 1);
 
     iomemtype = cpu_register_io_memory(gptm_readfn,
@@ -1317,9 +1329,10 @@ static void stellaris_init(const char *kernel_filename, 
const char *cpu_model,
     }
     for (i = 0; i < 4; i++) {
         if (board->dc2 & (0x10000 << i)) {
-            dev = sysbus_create_simple("stellaris-gptm",
-                                       0x40030000 + i * 0x1000,
-                                       pic[timer_irq[i]]);
+            dev = sysbus_create_varargs("stellaris-gptm",
+                                        0x40030000 + i * 0x1000,
+                                        pic[timer_irq[i]],
+                                        pic[timer_irq[i]+1], NULL);
             /* TODO: This is incorrect, but we get away with it because
                the ADC output is only ever pulsed.  */
             qdev_connect_gpio_out(dev, 0, adc);
-- 
1.5.6.5