sysdeps/mach/hurd/i386/ioperm.c

   1 /* Access to hardware i/o ports.  Hurd/x86 version.
   2    Copyright (C) 2002 Free Software Foundation, Inc.
   3    This file is part of the GNU C Library.
   4
   5    The GNU C Library is free software; you can redistribute it and/or
   6    modify it under the terms of the GNU Lesser General Public
   7    License as published by the Free Software Foundation; either
   8    version 2.1 of the License, or (at your option) any later version.
   9
  10    The GNU C Library is distributed in the hope that it will be useful,
  11    but WITHOUT ANY WARRANTY; without even the implied warranty of
  12    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13    Lesser General Public License for more details.
  14
  15    You should have received a copy of the GNU Lesser General Public
  16    License along with the GNU C Library; if not, write to the Free
  17    Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  18    02111-1307 USA.  */
  19
  20 #include <sys/io.h>
  21 #include <hurd.h>
  22 #include <mach/i386/mach_i386.h>
  23
  24 int
  25 ioperm (unsigned long int from, unsigned long int num, int turn_on)
  26 {
  27 #if ! HAVE_I386_IO_PERM_MODIFY
  28   return __hurd_fail (ENOSYS);
  29 #else
  30   error_t err;
  31   device_t devmaster;
  32
  33   /* With the device master port we get a capability that represents
  34      this range of io ports.  */
  35   err = __get_privileged_ports (NULL, &devmaster);
  36   if (! err)
  37     {
  38       io_perm_t perm;
  39       err = __i386_io_perm_create (devmaster, from, from + num - 1, &perm);
  40       __mach_port_deallocate (__mach_task_self (), devmaster);
  41       if (! err)
  42         {
  43           /* Now we add or remove that set from our task's bitmap.  */
  44           err = __i386_io_perm_modify (__mach_task_self (), perm, turn_on);
  45           __mach_port_deallocate (__mach_task_self (), perm);
  46         }
  47
  48       if (err == MIG_BAD_ID)    /* Old kernels don't have these RPCs.  */
  49         err = ENOSYS;
  50     }
  51
  52   return err ? __hurd_fail (err) : 0;
  53 #endif
  54 }