initial push

m68k/utils/bdmreset.c

@@ -0,0 +1,224 @@
+/*
+ * Reset the target connected to the BDM port.
+ *
+ * $ gcc -o bdmreset bdmreset.c -lBDM
+ *
+ */
+
+#include <sys/types.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <BDMlib.h>
+
+void
+clean_exit (int exit_code)
+{
+  if (bdmIsOpen ())
+  {
+    bdmSetDriverDebugFlag (0);
+    bdmClose ();
+  }
+  exit (exit_code);
+}
+  
+void
+show_error (char *msg)
+{
+  printf ("%s failed: %s\n", msg, bdmErrorString ());
+  clean_exit (1);
+}
+
+void
+do_reset (int cpu, int verbose)
+{
+  unsigned long csr;
+  
+  /*
+   * Reset the target
+   */
+  if (bdmReset () < 0)
+    show_error ("Reset");
+
+  /*
+   * Get the target status
+   */
+  if (cpu == BDM_COLDFIRE)
+  {
+    if (bdmReadSystemRegister (BDM_REG_CSR, &csr) < 0)
+      show_error ("reading CSR");
+    
+    if ((csr & 0x01000000) == 0)
+    {
+      printf ("CSR break not set, target failed to break, CSR = 0x%08lx\n", csr);
+      clean_exit (1);
+    }
+
+    if (verbose)
+    {
+      printf ("CSR break set, target stopped.\n");
+      printf ("Debug module version is %d, (%s)\n",
+              (unsigned char) (csr >> 20) & 0x0f,
+              ((csr >> 20) & 0x0f) == 0 ? "5206(e)" : "5307");
+    }
+  }
+}
+
+void
+usage ()
+{
+  printf ("bdmreset -d [level] -D [delay] -v [device]\n"
+   " where :\n"
+   "    -d [level]   : enable driver debug output\n"
+   "    -D [delay]   : delay count for the clock generation\n"
+   "    -v           : verbose\n"
+   "    [device]     : the bdm device, eg /dev/bdmcf0\n");
+  exit (1);
+}
+
+int
+main (int argc, char **argv)
+{
+  char          *dev = NULL;
+  int           arg;
+  int           delay_counter = 0;
+  int           debug_level = 0;
+  int           verbose = 0;
+  unsigned int  ver;
+  int           cpu;
+  int           iface;
+
+  if (argc <= 1)
+    usage ();
+
+  for (arg = 1; arg < argc; arg++)
+  {
+    if (argv[arg][0] != '-')
+    {
+      if (dev)
+      {
+        printf(" device name specified more then once");
+        exit (1);
+      }
+      dev = argv[arg];
+    }
+    else
+    {
+      switch (argv[arg][1])
+      {
+        case 'd':
+          arg++;
+          if (arg == argc)
+          {
+            printf (" -d option requires a parameter");
+            exit (1);
+          }
+          debug_level = strtoul (argv[arg], NULL, 0);
+          break;
+
+        case 'D':
+          arg++;
+          if (arg == argc)
+          {
+            printf (" -D option requires a parameter");
+            exit (1);
+          }
+          delay_counter = strtoul (argv[arg], NULL, 0);
+          break;
+
+        case 'v':
+          verbose = 1;
+          break;
+          
+        default:
+          printf(" unknown option!");
+    
+        case '?':
+        case 'h':
+          usage ();
+          break;
+      }
+    }
+  }
+
+  if (!dev)
+  {
+    printf(" ERROR: no device set, check your options as some require parameters.\n");
+    exit (1);
+  }
+
+  /*
+   * Open the BDM interface driver
+   */
+  if (bdmOpen (dev) < 0)
+    show_error ("open");
+
+  if (debug_level)
+    bdmSetDriverDebugFlag (debug_level);
+
+  if (delay_counter)
+    bdmSetDelay (delay_counter);
+
+  /*
+   * Get the driver version
+   */
+
+  if (verbose)
+  {
+    if (bdmGetDrvVersion (&ver) < 0)
+      show_error ("GetDrvVersion");
+
+    printf ("Driver Ver : %i.%i\n", ver >> 8, ver & 0xff);
+
+    /*
+     * Get the processor
+     */
+    if (bdmGetProcessor (&cpu) < 0)
+      show_error ("GetProcessor");
+
+    switch (cpu)
+    {
+      case BDM_CPU32:
+        printf ("Processor  : CPU32\n");
+        break;
+      case BDM_COLDFIRE:
+        printf ("Processor  : Coldfire\n");
+        break;
+      default:
+        printf ("unknown processor type!\n");
+        clean_exit (1);
+      break;
+    }
+  
+    /*
+     * Get the interface
+     */
+    if (bdmGetInterface (&iface) < 0)
+      show_error ("GetInterface");
+    
+    switch (iface) {
+      case BDM_CPU32_ERIC:
+        printf ("Interface  : Eric's CPU32\n");
+        break;
+      case BDM_COLDFIRE_TBLCF:
+        printf ("Interface: TBLCF USB Coldfire\n");
+        break;
+      case BDM_COLDFIRE:
+        printf ("Interface  : P&E Coldfire\n");
+        break;
+      case BDM_CPU32_ICD:
+        printf ("Interface  : ICD CPU32\n");
+        break;
+      default:
+        printf ("unknown interface type!\n");
+        clean_exit (1);
+      break;
+    }
+  }
+  
+  do_reset (cpu, verbose);
+  
+  clean_exit (0);
+
+  return 0;
+}