1 files changed, 121 insertions, 0 deletions
diff --git a/utils/eim_peek_poke.c b/utils/eim_peek_poke.c
new file mode 100644
index 0000000..9a8143c
--- /dev/null
+++ b/utils/eim_peek_poke.c
@@ -0,0 +1,121 @@
+/*
+ * eim_peek_poke.c
+ * ---------------
+ * Read or write a 32-bit word via the EIM bus.  This is mostly
+ * intended for use as part of the FPGA initialization sequence.
+ *
+ * Authors: Paul Selkirk, Rob Austein
+ * Copyright (c) 2015, SUNET
+ *
+ * Redistribution and use in source and binary forms, with or
+ * without modification, are permitted provided that the following
+ * conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ *
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
+ * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
+ * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
+ * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <stdarg.h>
+#include <string.h>
+
+#include "novena-eim.h"
+
+static int string_match(const char *s1, ...)
+{
+  const char *s2;
+
+  if (s1 == NULL)
+    return 0;
+
+  va_list ap;
+  va_start(ap, s1);
+  for (s2 = va_arg(ap, const char *); s2 != NULL; s2 = va_arg(ap, const char *))
+    if (!strcmp(s1, s2))
+      break;
+  va_end(ap);
+
+  return s2 != NULL;
+}
+  
+static int parse_value(const char *s, uint32_t *value)
+{
+  if (s == NULL || value == NULL)
+    return 0;
+
+  char *e;
+  *value = strtoul(s, &e, 0);
+
+  return *s != '\0' && *e == '\0';
+}
+
+static int parse_offset(const char *s, off_t *offset)
+{
+  uint32_t value;
+
+  if (offset == NULL || !parse_value(s, &value))
+    return 0;
+
+  *offset = (off_t) value;
+  return 1;
+}
+
+static void usage(const int code, const char *jane)
+{
+  FILE *f = code ? stderr : stdout;
+  fprintf(f, "usage: %s { --read  offset | --write offset value }\n", jane);
+  exit(code);
+}
+
+int main(int argc, char *argv[])
+{
+  off_t offset = 0;
+  uint32_t value;
+
+  if (argc == 1 || string_match(argv[1], "-?", "-h", "--help"))
+    usage(EXIT_SUCCESS, argv[0]);
+
+  if (eim_setup() != 0) {
+    fprintf(stderr, "EIM setup failed\n");
+    return EXIT_FAILURE;
+  }
+
+  if (string_match(argv[1], "r", "-r", "--read", "--peek")) {
+    if (argc != 3 || !parse_offset(argv[2], &offset))
+      usage(EXIT_FAILURE, argv[0]);
+    eim_read_32(offset, &value);
+    printf("%08x\n", value);
+  }
+
+  else if (string_match(argv[1], "w", "-w", "--write", "--poke")) {
+    if (argc != 4 || !parse_offset(argv[2], &offset) || !parse_value(argv[3], &value))
+      usage(EXIT_FAILURE, argv[0]);
+    eim_write_32(offset, &value);
+    exit(EXIT_SUCCESS);
+  }
+
+  else {
+    usage(EXIT_FAILURE, argv[0]);
+  }
+
+  return EXIT_SUCCESS;
+}