res.c

Go to the documentation of this file.

/* $Id: res.c,v 1.12 2004/02/18 22:34:12 reuther Exp $ */
/*****************************************************************************/
/* (c) 2003 Technische Universitaet Dresden
 * This file is part of DROPS, which is distributed under the terms of the
 * GNU General Public License 2. Please see the COPYING file for details.
 */

/* L4 */
#include <l4/generic_io/libio.h>

#include <l4/dde_linux/dde.h>
#include <l4/env/errno.h>

/* Linux */
#include <linux/ioport.h>

#include <l4/log/l4log.h>

/* local */
#include "__config.h"
#include "internal.h"

static struct dde_region *regions = NULL;

struct resource *request_region(unsigned long start, unsigned long n,
                                const char *name)
{
  int err;

  LOGdL(DEBUG_RES_TRACE, "io_addr=%p, size=%ld, name=\"%s\"", (void*)start, n, name);
  err = l4io_request_region((l4_addr_t) start, (l4_size_t) n);

  if (err)
    {
      LOGdL(DEBUG_ERRORS, "Error: in l4io_request_region(0x%04lx, %ld) (%d)", start, n, err);
      return 0;
    }

  return (struct resource *) 1;
}

struct resource *request_mem_region(unsigned long start, unsigned long n,
                                    const char *name)
{
  l4_addr_t vaddr;
  l4_addr_t offset;

  LOGdL(DEBUG_RES_TRACE, "phys_addr=%p, size=%ld, name=\"%s\"", (void*)start, n, name);
  vaddr = l4io_request_mem_region((l4_addr_t) start, (l4_size_t) n, &offset);

  if (!vaddr)
    {
      LOGdL(DEBUG_ERRORS, "Error: in l4io_request_mem_region(%p, %ld)", 
            (void*)start, n);
      return 0;
    }
  /* keep region info */
  dde_add_region(&regions, vaddr+offset, start, n);

  return (struct resource *) 1;
}

void release_region(unsigned long start, unsigned long n)
{
  int err;

  LOGdL(DEBUG_RES_TRACE, "io_addr=%p, size=%ld", (void*)start, n);
  err = l4io_release_region((l4_addr_t) start, (l4_size_t) n);

  if (err)
    LOG_Error("release_region(0x%04lx, %ld) failed (%d)", start, n, err);
}

void release_mem_region(unsigned long start, unsigned long n)
{
  int err;

  LOGdL(DEBUG_RES_TRACE, "phys_addr=%p, size=%ld", (void*)start, n);
  err = l4io_release_mem_region((l4_addr_t) start, (l4_size_t) n);

  if(err)
    {
      LOGdL(DEBUG_ERRORS, "Error: release_mem_region(%p, %ld) failed (%d)", 
            (void*)start, n, err);
      return;
    }

  /* keep region info */
  dde_remove_region(&regions, 0, start, n);
}

int release_resource(struct resource *res)
{
  LOG_Error("%s not implemented", __FUNCTION__);

  return -L4_EINVAL;
}

int check_region(unsigned long start, unsigned long n)
{
  return 0;
}

int check_mem_region(unsigned long start, unsigned long n)
{
  return 0;
}

void *ioremap(unsigned long phys_addr, unsigned long size)
{
  struct dde_region *p;
  void *pp;

  LOGdL(DEBUG_RES_TRACE, "phys_addr=%p, size=%ld", (void*)phys_addr, size);

#if !LATER
#warning it is not later
  /* look in I/O region table/list */
  p = regions;
  while (p)
    {
      if ((p->pa <= phys_addr) &&
          (p->pa + p->size >= phys_addr + size))
        {
          pp = (void *) (p->va + (phys_addr - p->pa));
          LOGd(DEBUG_RES, "ioremap: %p => %p", (void*)phys_addr, pp);
          return pp;
        }
      p = p->next;
    }
#else /* LATER, whatever this means */
  if ((pp=(void*)__va(phys_addr)) && __va(phys_addr+size))
    {
      LOGd(DEBUG_RES, "ioremap: <%p-%p> => <%p-%p>",
           phys_addr, phys_addr+size, pp, pp+size);
      return pp;
    }
#endif /* LATER */

  LOG_Error("no ioremap address found for %p", (void*)phys_addr);
  return (void *) 0;
}

void *ioremap_nocache(unsigned long phys_addr, unsigned long size)
{
  LOGdL(DEBUG_RES_TRACE, "phys_addr=%p, size=%ld\n", (void*)phys_addr, size);

  return ioremap(phys_addr, size);
}

void iounmap(void *addr)
{
  LOGdL(DEBUG_RES_TRACE, "addr=%p", addr);
}

---