Added set_gpio command

Grzegorz Jabłoński
1 parent f93de95a
Showing 3 changed files with 27 additions and 1 deletions
hw/at91_pio.c
monitor.c
qemu-monitor.hx
@@ -86,7 +86,7 @@ typedef struct PIOState {
     uint32_t unknown_state;
 } PIOState;
  
-static void at91_pio_set_pin(void *opaque, int pin, int level)
+void at91_pio_set_pin(void *opaque, int pin, int level)
 {
     PIOState *s = opaque;
     int mask = 1 << (pin % PIO_PINS);
@@ -322,9 +322,12 @@ static void at91_pio_reset(void *opaque)
     s->unknown_state = 0xffffffff;
 }
  
+void* at91_io_state = NULL;
+
 static void at91_pio_init(SysBusDevice *dev)
 {
     PIOState *s = FROM_SYSBUS(typeof (*s), dev);
+    at91_io_state = s;
     int pio_regs;
  
     sysbus_init_irq(dev, &s->parent_irq);
@@ -519,6 +519,20 @@ static void do_screen_dump(Monitor *mon, const char *filename)
     vga_hw_screen_dump(filename);
 }
  
+static void do_set_gpio(Monitor* mon, const char* port, const char* value)
+{
+  extern void* at91_io_state;
+  extern void at91_pio_set_pin(void *opaque, int pin, int level);
+  if (at91_io_state)
+  {
+     printf("Setting gpio: %s %s\n", port, value);
+     at91_pio_set_pin(at91_io_state, atoi(port), atoi(value));
+  }
+  else
+     printf("Cannot set pin: device pointer is NULL\n");
+
+}
+
 static void do_logfile(Monitor *mon, const char *filename)
 {
     cpu_set_log_filename(filename);
@@ -646,6 +646,15 @@ Close the file descriptor previously assigned to @var{fdname} using the
 used by another monitor command.
 ETEXI
  
+
+    { "set_gpio", "ss", do_set_gpio, "set_gpio pin value",
+      "set a value of a given gpio pio" },
+STEXI
+@item set_gpio @var{pin} @var{value}
+Set the value of the given gpio pin to a specific value
+ETEXI
+
+
 STEXI
 @end table
 ETEXI