Logo Search packages:      
Sourcecode: linux version File versions

io.c

/*
 * $Id: io.c,v 1.4 2003/08/03 03:05:10 lethal Exp $
 * by Greg Banks <gbanks@pocketpenguins.com>
 * (c) 2000 PocketPenguins Inc
 *
 * Derived from io_hd64461.c, which bore the message:
 * Copyright (C) 2000 YAEGASHI Takeshi
 *
 * Typical I/O routines for HD64465 system.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <asm/io.h>
#include <asm/hd64465/hd64465.h>


#define HD64465_DEBUG 0

#if HD64465_DEBUG
#define DPRINTK(args...)      printk(args)
#define DIPRINTK(n, args...)  if (hd64465_io_debug>(n)) printk(args)
#else
#define DPRINTK(args...)
#define DIPRINTK(n, args...)
#endif



/* This is a hack suitable only for debugging IO port problems */
int hd64465_io_debug;
EXPORT_SYMBOL(hd64465_io_debug);

/* Low iomap maps port 0-1K to addresses in 8byte chunks */
#define HD64465_IOMAP_LO_THRESH 0x400
#define HD64465_IOMAP_LO_SHIFT      3
#define HD64465_IOMAP_LO_MASK ((1<<HD64465_IOMAP_LO_SHIFT)-1)
#define HD64465_IOMAP_LO_NMAP (HD64465_IOMAP_LO_THRESH>>HD64465_IOMAP_LO_SHIFT)
static unsigned long    hd64465_iomap_lo[HD64465_IOMAP_LO_NMAP];
static unsigned char    hd64465_iomap_lo_shift[HD64465_IOMAP_LO_NMAP];

/* High iomap maps port 1K-64K to addresses in 1K chunks */
#define HD64465_IOMAP_HI_THRESH 0x10000
#define HD64465_IOMAP_HI_SHIFT      10
#define HD64465_IOMAP_HI_MASK ((1<<HD64465_IOMAP_HI_SHIFT)-1)
#define HD64465_IOMAP_HI_NMAP (HD64465_IOMAP_HI_THRESH>>HD64465_IOMAP_HI_SHIFT)
static unsigned long    hd64465_iomap_hi[HD64465_IOMAP_HI_NMAP];
static unsigned char    hd64465_iomap_hi_shift[HD64465_IOMAP_HI_NMAP];

#define PORT2ADDR(x) (sh_mv.mv_isa_port2addr(x))

void hd64465_port_map(unsigned short baseport, unsigned int nports,
                  unsigned long addr, unsigned char shift)
{
      unsigned int port, endport = baseport + nports;

      DPRINTK("hd64465_port_map(base=0x%04hx, n=0x%04hx, addr=0x%08lx,endport=0x%04x)\n",
          baseport, nports, addr,endport);
          
      for (port = baseport ;
           port < endport && port < HD64465_IOMAP_LO_THRESH ;
           port += (1<<HD64465_IOMAP_LO_SHIFT)) {
          DPRINTK("    maplo[0x%x] = 0x%08lx\n", port, addr);
          hd64465_iomap_lo[port>>HD64465_IOMAP_LO_SHIFT] = addr;
          hd64465_iomap_lo_shift[port>>HD64465_IOMAP_LO_SHIFT] = shift;
          addr += (1<<(HD64465_IOMAP_LO_SHIFT));
      }

      for (port = max_t(unsigned int, baseport, HD64465_IOMAP_LO_THRESH);
           port < endport && port < HD64465_IOMAP_HI_THRESH ;
           port += (1<<HD64465_IOMAP_HI_SHIFT)) {
          DPRINTK("    maphi[0x%x] = 0x%08lx\n", port, addr);
          hd64465_iomap_hi[port>>HD64465_IOMAP_HI_SHIFT] = addr;
          hd64465_iomap_hi_shift[port>>HD64465_IOMAP_HI_SHIFT] = shift;
          addr += (1<<(HD64465_IOMAP_HI_SHIFT));
      }
}
EXPORT_SYMBOL(hd64465_port_map);

void hd64465_port_unmap(unsigned short baseport, unsigned int nports)
{
      unsigned int port, endport = baseport + nports;
      
      DPRINTK("hd64465_port_unmap(base=0x%04hx, n=0x%04hx)\n",
          baseport, nports);

      for (port = baseport ;
           port < endport && port < HD64465_IOMAP_LO_THRESH ;
           port += (1<<HD64465_IOMAP_LO_SHIFT)) {
          hd64465_iomap_lo[port>>HD64465_IOMAP_LO_SHIFT] = 0;
      }

      for (port = max_t(unsigned int, baseport, HD64465_IOMAP_LO_THRESH);
           port < endport && port < HD64465_IOMAP_HI_THRESH ;
           port += (1<<HD64465_IOMAP_HI_SHIFT)) {
          hd64465_iomap_hi[port>>HD64465_IOMAP_HI_SHIFT] = 0;
      }
}
EXPORT_SYMBOL(hd64465_port_unmap);

unsigned long hd64465_isa_port2addr(unsigned long port)
{
      unsigned long addr = 0;
      unsigned char shift;

      /* handle remapping of low IO ports */
      if (port < HD64465_IOMAP_LO_THRESH) {
          addr = hd64465_iomap_lo[port >> HD64465_IOMAP_LO_SHIFT];
          shift = hd64465_iomap_lo_shift[port >> HD64465_IOMAP_LO_SHIFT];
          if (addr != 0)
            addr += (port & HD64465_IOMAP_LO_MASK) << shift;
          else
            printk(KERN_NOTICE "io_hd64465: access to un-mapped port %lx\n", port);
      } else if (port < HD64465_IOMAP_HI_THRESH) {
          addr = hd64465_iomap_hi[port >> HD64465_IOMAP_HI_SHIFT];
          shift = hd64465_iomap_hi_shift[port >> HD64465_IOMAP_HI_SHIFT];
          if (addr != 0)
            addr += (port & HD64465_IOMAP_HI_MASK) << shift;
          else
            printk(KERN_NOTICE "io_hd64465: access to un-mapped port %lx\n", port);
      }
            
      /* HD64465 internal devices (0xb0000000) */
      else if (port < 0x20000)
          addr = CONFIG_HD64465_IOBASE + port - 0x10000;

      /* Whole physical address space (0xa0000000) */
      else
          addr = P2SEGADDR(port);

      DIPRINTK(2, "PORT2ADDR(0x%08lx) = 0x%08lx\n", port, addr);

      return addr;
}

static inline void delay(void)
{
      ctrl_inw(0xa0000000);
}

unsigned char hd64465_inb(unsigned long port)
{
      unsigned long addr = PORT2ADDR(port);
      unsigned long b = (addr == 0 ? 0 : *(volatile unsigned char*)addr);

      DIPRINTK(0, "inb(%08lx) = %02x\n", addr, (unsigned)b);
      return b;
}

unsigned char hd64465_inb_p(unsigned long port)
{
      unsigned long v;
      unsigned long addr = PORT2ADDR(port);

      v = (addr == 0 ? 0 : *(volatile unsigned char*)addr);
      delay();
      DIPRINTK(0, "inb_p(%08lx) = %02x\n", addr, (unsigned)v);
      return v;
}

unsigned short hd64465_inw(unsigned long port)
{
      unsigned long addr = PORT2ADDR(port);
      unsigned long b = (addr == 0 ? 0 : *(volatile unsigned short*)addr);
      DIPRINTK(0, "inw(%08lx) = %04lx\n", addr, b);
      return b;
}

unsigned int hd64465_inl(unsigned long port)
{
      unsigned long addr = PORT2ADDR(port);
      unsigned int b = (addr == 0 ? 0 : *(volatile unsigned long*)addr);
      DIPRINTK(0, "inl(%08lx) = %08x\n", addr, b);
      return b;
}

void hd64465_outb(unsigned char b, unsigned long port)
{
      unsigned long addr = PORT2ADDR(port);

      DIPRINTK(0, "outb(%02x, %08lx)\n", (unsigned)b, addr);
      if (addr != 0)
          *(volatile unsigned char*)addr = b;
}

void hd64465_outb_p(unsigned char b, unsigned long port)
{
      unsigned long addr = PORT2ADDR(port);

      DIPRINTK(0, "outb_p(%02x, %08lx)\n", (unsigned)b, addr);
      if (addr != 0)
          *(volatile unsigned char*)addr = b;
      delay();
}

void hd64465_outw(unsigned short b, unsigned long port)
{
      unsigned long addr = PORT2ADDR(port);
      DIPRINTK(0, "outw(%04x, %08lx)\n", (unsigned)b, addr);
      if (addr != 0)
          *(volatile unsigned short*)addr = b;
}

void hd64465_outl(unsigned int b, unsigned long port)
{
      unsigned long addr = PORT2ADDR(port);
      DIPRINTK(0, "outl(%08x, %08lx)\n", b, addr);
      if (addr != 0)
            *(volatile unsigned long*)addr = b;
}


Generated by  Doxygen 1.6.0   Back to index