win-bdm.c

WaitForSingleObject 摩托罗拉的68k源程序

/*
 * Motorola Background Debug Mode Driver
 * Copyright (C) 1998  Chris Johns
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 * Windows support by:
 * Chris Johns
 * Cybertec Pty Ltd.
 *
 * [e-mail], [e-mail]
 *
 * Michael Cooper
 * Integrated Chipware
 * 1861 Wiehle Ave.
 * Reston, Virginia  20190, USA
 *
 * [e-mail]
 *
 * Rick Haubenstricker
 * Perceptron, Inc
 * 47827 Halyard Dr
 * Plymouth, Michigan 48170, USA
 *
 * [e-mail]
 *
 */

#include <errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <stdarg.h>
#include <unistd.h>
#include <sys/param.h>
#include <sys/stat.h>
#include <windows.h>
#include <win/win-io.h>

#define BDM_DEFAULT_DEBUG 0

static int debugLevel = BDM_DEFAULT_DEBUG;

/*
 ************************************************************************
 *     Override the C library function.                                 *
 ************************************************************************
 */

int
remote_close (int fd)
{
  return close (fd);
}

int
remote_read (int fd, char *buf, size_t count)
{
  return read (fd, buf, count);
}

int
remote_write (int fd, char *buf, size_t count)
{
  return write (fd, buf, count);
}

int
stat (const char *file_name, struct stat *buf)
{
  if (strncmp (file_name, "/dev/bdm", sizeof ("/dev/bdm") - 1) == 0 )
  {
     return 0 ;
  }
  else /* Check for real file */
  {
     int fd = open(file_name,O_RDONLY);

     if ( fd > 0 )
     {
        int status = fstat(fd, buf);

        close(fd);

        return status;
     }
     else
     {
        return fd;
     }
  }
}

#define open  win_bdm_open
#define close win_bdm_close
#define ioctl win_bdm_ioctl
#define read  win_bdm_read
#define write win_bdm_write

/*
 ************************************************************************
 *   Windows driver support routines                                    *
 ************************************************************************
 */

#if defined (__CYGWIN__)

#define udelay usleep

#else

#ifndef HZ
#define HZ 1000
#endif

void
udelay(int usecs)
{
  LARGE_INTEGER lpc;
  LONGLONG      lpc2;
  LONGLONG      current_usecs;
  LONGLONG      final_usecs;

  static int           first_time = 1;
  static LARGE_INTEGER lpf;
  static LONGLONG      lpf2;

  /*
   * First time through, get frequency of high-resolution
   *  performance counter  (value is counts per second)
   */
  if (first_time) {
    QueryPerformanceFrequency (&lpf);
    lpf2 = *(LONGLONG *) &lpf;
    first_time = 0;
  }

  /*
   * Get current value of high-resolution performance counter
   *  (value in counts)
   */
  QueryPerformanceCounter (&lpc);
  lpc2 = *(LONGLONG *)&lpc;

  /*
   * Calculate desired final time in usecs
   */
  final_usecs = ((lpc2 * (LONGLONG) 1000000) / lpf2) + (LONGLONG) usecs;

  /*
   * Loop until current count when converted to usecs is greater
   *  than final time
   */
  do {
    /*
     * Get current value of high-resolution performance
     *  counter (value in counts)
     */
    QueryPerformanceCounter (&lpc);
    lpc2 = *(LONGLONG *) &lpc;

    /*
     * Calculate current time in usecs
     */
    current_usecs = (lpc2 * (LONGLONG) 1000000 / lpf2);
  }
  while (current_usecs < final_usecs);
}

#endif

/*
 * Delay for a while so target can keep up.
 */
void
bdm_delay (int counter)
{
  while (counter--) {

#if defined (__GNUC__)
    asm volatile ("nop");
#else
    __asm nop
#endif

  }
}

/*
 * Delay specified number of milliseconds
 */
void
bdm_sleep (unsigned long time)
{
  udelay (time * (1000 * (1000 / HZ)));
}

/*
 ************************************************************************
 *     OS worker functions.                                             *
 ************************************************************************
 */

int
os_claim_io_ports (char *name, unsigned int base, unsigned int num)
{
  /*
   * FIXME: Not sure what happens here. Dos Win9x how someelse has
   * port through some sort of virtual device driver thingy ?
   */
  return 0;
}

int
os_release_io_ports (unsigned int base, unsigned int num)
{
  /*
   * FIXME: See comment above.
   */
  return 0;
}

#define os_move_in os_copy_in

int
os_copy_in (void *dst, void *src, int size)
{
  /*
   * We run in the application and talk directly to the hardware.
   */
  memcpy (dst, src, size);
  return 0;
}

#define os_move_out os_copy_out

int
os_copy_out (void *dst, void *src, int size)
{
  memcpy (dst, src, size);
  return 0;
}

void
os_lock_module ()
{
}

void
os_unlock_module ()
{
}

#ifdef interface
#undef interface
#endif

/*
 ************************************************************************
 *       Include the driver code                                        *
 ************************************************************************
 */

#include "bdm.c"

/*
 ************************************************************************
 *       Good old-fashioned UNIX driver entry points                    *
 ************************************************************************
 */

static int bdm_dev_registered = 0;

/*
 * Unhook module from kernel
 */
static void bdm_cleanup_module (void)
{
  if (bdm_dev_registered) {
    bdm_dev_registered = 0;
    printf ("BDM driver unregistered.\n");
  }
}

/*
 * Basically just detect the port.
 */
int
win_bdm_init ()
{
  int           minor;
  HANDLE        h;
  OSVERSIONINFO osvi;
  BOOL          bOsVersionInfoEx;

  /*
   * Determine which operating system in use, if NT or 2000,
   * we need to enable the port.
   */
  ZeroMemory (&osvi, sizeof(OSVERSIONINFO));
  osvi.dwOSVersionInfoSize = sizeof(OSVERSIONINFO);

  if (!(bOsVersionInfoEx = GetVersionEx ((LPOSVERSIONINFO) &osvi))) {
    /*
     * If OSVERSIONINFOEX doesn't work, try OSVERSIONINFO.
     */
     osvi.dwOSVersionInfoSize = sizeof (OSVERSIONINFO);
     if (! GetVersionEx ((OSVERSIONINFO *) &osvi))
        return FALSE;
  }

  if (osvi.dwPlatformId == VER_PLATFORM_WIN32_NT) {
    /*
     * Open access to parallel port using giveio
     */
    h = CreateFile ("\\\\.\\giveio", GENERIC_READ, 0, NULL,
                    OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL);
    if (h == INVALID_HANDLE_VALUE) {
      printf ("error: could not access the GiveIO device.\n");
      return -1;
    }
    CloseHandle (h);
  }

#ifdef BDM_VER_MESSAGE
  printf ("bdm_init %d.%d, " __DATE__ ", " __TIME__ "\n",
          BDM_DRV_VERSION >> 8, BDM_DRV_VERSION & 0xff);
#endif

  bdm_dev_registered = 1;

  /*
   * Set up port numbers
   */
  for (minor = 0 ;
       minor < (sizeof(bdm_device_info) / sizeof(bdm_device_info[0])) ;
       minor++) {
    unsigned short port;
    struct BDM *self = &bdm_device_info[minor];

    /*
     * First set the default debug level.
     */

    self->debugFlag = BDM_DEFAULT_DEBUG;

    /*
     * Choose a port number
     */
    switch (BDM_IFACE_MINOR (minor)) {
      case 0:  port = 0x378;  break;  /* LPT1 */
      case 1:  port = 0x278;  break;  /* LPT2 */
      case 2:  port = 0x3bc;  break;  /* LPT3 */
      case 3:  port = 0x2bc;  break;  /* LPT4, ccj - made this up :-) */
      default:
        printf ("BDM driver has no address for LPT%d.\n",
                               BDM_IFACE_MINOR (minor) + 1);
        bdm_cleanup_module();
        return -EIO;
    }

    /*
     * See if the port exists
     */

    self->exists = 1;

    outb (0x00, port);
    udelay (50);
    if (inb (port) != 0x00) {
      self->exists = 0;
      if (self->debugFlag)
        printf ("BDM driver cannot detect LPT%d.\n",
                               BDM_IFACE_MINOR (minor) + 1);
      continue;
    }

    sprintf (self->name, "bdm%d", minor);
    self->portBase    = self->dataPort = port;
    self->statusPort  = port + 1;
    self->controlPort = port + 2;
    self->delayTimer  = 0;

    switch (BDM_IFACE (minor)) {
      case BDM_CPU32_PD:     cpu32_pd_init_self (self); break;
      case BDM_CPU32_ICD:    cpu32_icd_init_self (self); break;
      case BDM_COLDFIRE_PE:  cf_pe_init_self (self); break;
      default:
        printf ("BDM driver has no interface for minor number\n");
        bdm_cleanup_module();
        return -EIO;
    }
  }

  return 0;
}

/*
 * The device is a device name of the form /dev/bdmcpu320 or
 * /dev/bdmcf0 where the /dev/bdm must be present
 * the next field can be cpu32 or cf followed by
 * a number which is the port.
 */

int
win_bdm_open (const char *device, int flags, ...)
{
  int port = 0;

  if (!bdm_dev_registered)
     win_bdm_init ();

  if (strncmp (device, "/dev/bdm", sizeof ("/dev/bdm") - 1))
  {
    errno = ENOENT;
    return -1;
  }

  device += sizeof ("/dev/bdm") - 1;

  if (strncmp (device, "cpu32", 5) == 0)
  {
    port = 0;
    device += 5;  /* s.b. 5 */
  }
  /* Allow ICD access under cygwin */
  else if (strncmp (device, "icd", 3) == 0)
  {
    port = 8;
    device += 3;
  }
  else if (strncmp (device, "cf", 2) == 0)
  {
    port = 4;
    device += 2;
  }
  else
  {
    errno = ENOENT;
    return -1;
  }

  port += strtoul (device, 0, 0);

  errno = bdm_open (port);
  if (errno)
    return -1;
  return port;
}

int
win_bdm_close (int fd)
{
  bdm_close (fd);
  return 0;
}

unsigned long
win_bdm_read (int fd, char *buf, unsigned long count)
{
  errno = bdm_read (fd, buf, count);
  if (errno)
    return -1;
  return count;
}

unsigned long
win_bdm_write (int fd, char *buf, unsigned long count)
{
  errno = bdm_write (fd, buf, count);
  if (errno)
    return -1;
  return count;
}

int
win_bdm_ioctl (int fd, unsigned int cmd, ...)
{
  va_list       args;
  unsigned long *arg;

  int iarg;
  int err = 0;

  va_start (args, cmd);

  arg = va_arg (args, unsigned long *);

  /*
   * Pick up the argument
   */
  if (!bdm_dev_registered) {

    switch (cmd) {
      case BDM_DEBUG:
        err = os_copy_in ((void*) &iarg, (void*) arg, sizeof iarg);
        break;
    }
    if (err)
      return err;

    if (debugLevel > 3)
      printf ("win_bdm_ioctl cmd:0x%08x\n", cmd);

    switch (cmd) {
      case BDM_DEBUG:
        debugLevel = iarg;
        break;
    }
  }

  errno = bdm_ioctl (fd, cmd, (unsigned long) arg);
  if (errno)
    return -1;
  return 0;
}