arm: Remove return code from irqchip_inject_pending

[jailhouse.git] / hypervisor / arch / arm / irqchip.c

diff --git a/hypervisor/arch/arm/irqchip.c b/hypervisor/arch/arm/irqchip.c
index 1d958197e14c16e465c6f977adf441b228bb0d4b..1e2a4e494a6a08a83bf81e3a6de58f6635b1ff25 100644 (file)
--- a/hypervisor/arch/arm/irqchip.c
+++ b/hypervisor/arch/arm/irqchip.c
@@ -34,12 +34,33 @@ unsigned long gicd_size;
 static bool irqchip_is_init;
 static struct irqchip_ops irqchip;
 
+bool spi_in_cell(struct cell *cell, unsigned int spi)
+{
+       /* FIXME: Change the configuration to a bitmask range */
+       u32 spi_mask;
+
+       if (spi >= 64)
+               return false;
+       else if (spi >= 32)
+               spi_mask = cell->arch.spis >> 32;
+       else
+               spi_mask = cell->arch.spis;
+
+       return spi_mask & (1 << (spi & 31));
+}
+
 static int irqchip_init_pending(struct per_cpu *cpu_data)
 {
-       struct pending_irq *pend_array = page_alloc(&mem_pool, 1);
+       struct pending_irq *pend_array;
+
+       if (cpu_data->pending_irqs == NULL) {
+               cpu_data->pending_irqs = pend_array = page_alloc(&mem_pool, 1);
+               if (pend_array == NULL)
+                       return -ENOMEM;
+       } else {
+               pend_array = cpu_data->pending_irqs;
+       }
 
-       if (pend_array == NULL)
-               return -ENOMEM;
        memset(pend_array, 0, PAGE_SIZE);
 
        cpu_data->pending_irqs = pend_array;
@@ -108,6 +129,18 @@ int irqchip_insert_pending(struct per_cpu *cpu_data, struct pending_irq *irq)
        return 0;
 }
 
+int irqchip_set_pending(struct per_cpu *cpu_data, u32 irq_id, bool try_inject)
+{
+       struct pending_irq pending;
+
+       pending.virt_id = irq_id;
+
+       if (try_inject && irqchip.inject_irq(cpu_data, &pending) == 0)
+               return 0;
+
+       return irqchip_insert_pending(cpu_data, &pending);
+}
+
 /*
  * Only executed by `irqchip_inject_pending' on a CPU to inject its own stuff.
  */
@@ -127,7 +160,7 @@ int irqchip_remove_pending(struct per_cpu *cpu_data, struct pending_irq *irq)
        return 0;
 }
 
-int irqchip_inject_pending(struct per_cpu *cpu_data)
+void irqchip_inject_pending(struct per_cpu *cpu_data)
 {
        int err;
        struct pending_irq *pending = cpu_data->first_pending;
@@ -150,8 +183,6 @@ int irqchip_inject_pending(struct per_cpu *cpu_data)
 
                pending = pending->next;
        }
-
-       return 0;
 }
 
 void irqchip_handle_irq(struct per_cpu *cpu_data)
@@ -159,6 +190,11 @@ void irqchip_handle_irq(struct per_cpu *cpu_data)
        irqchip.handle_irq(cpu_data);
 }
 
+void irqchip_eoi_irq(u32 irqn, bool deactivate)
+{
+       irqchip.eoi_irq(irqn, deactivate);
+}
+
 int irqchip_send_sgi(struct sgi *sgi)
 {
        return irqchip.send_sgi(sgi);
@@ -178,6 +214,73 @@ int irqchip_cpu_init(struct per_cpu *cpu_data)
        return 0;
 }
 
+int irqchip_cpu_reset(struct per_cpu *cpu_data)
+{
+       int err;
+
+       err = irqchip_init_pending(cpu_data);
+       if (err)
+               return err;
+
+       if (irqchip.cpu_reset)
+               return irqchip.cpu_reset(cpu_data, false);
+
+       return 0;
+}
+
+void irqchip_cpu_shutdown(struct per_cpu *cpu_data)
+{
+       /*
+        * The GIC backend must take care of only resetting the hyp interface if
+        * it has been initialised: this function may be executed during the
+        * setup phase.
+        */
+       if (irqchip.cpu_reset)
+               irqchip.cpu_reset(cpu_data, true);
+}
+
+static const struct jailhouse_irqchip *
+irqchip_find_config(struct jailhouse_cell_desc *config)
+{
+       const struct jailhouse_irqchip *irq_config =
+               jailhouse_cell_irqchips(config);
+
+       if (config->num_irqchips)
+               return irq_config;
+       else
+               return NULL;
+}
+
+int irqchip_cell_init(struct cell *cell)
+{
+       const struct jailhouse_irqchip *pins = irqchip_find_config(cell->config);
+
+       cell->arch.spis = (pins ? pins->pin_bitmap : 0);
+
+       return irqchip.cell_init(cell);
+}
+
+void irqchip_cell_exit(struct cell *cell)
+{
+       const struct jailhouse_irqchip *root_pins =
+               irqchip_find_config(root_cell.config);
+
+       /* might be called by arch_shutdown while rolling back
+        * a failed setup */
+       if (!irqchip_is_init)
+               return;
+
+       if (root_pins)
+               root_cell.arch.spis |= cell->arch.spis & root_pins->pin_bitmap;
+
+       irqchip.cell_exit(cell);
+}
+
+void irqchip_root_cell_shrink(struct cell *cell)
+{
+       root_cell.arch.spis &= ~(cell->arch.spis);
+}
+
 /* Only the GIC is implemented */
 extern struct irqchip_ops gic_irqchip;
 
@@ -209,7 +312,6 @@ int irqchip_init(void)
        pidr2 = mmio_read32(gicd_base + GICD_PIDR2);
        switch (GICD_PIDR2_ARCH(pidr2)) {
        case 0x2:
-               break;
        case 0x3:
        case 0x4:
                memcpy(&irqchip, &gic_irqchip, sizeof(struct irqchip_ops));