kernel/io_port_manager.cpp

   1 /*
   2 lightOS kernel
   3 Copyright (C) 2008-2009 Jörg Pfähler
   4
   5 This program is free software; you can redistribute it and/or
   6 modify it under the terms of the GNU General Public License
   7 as published by the Free Software Foundation; either version 2
   8 of the License, or (at your option) any later version.
   9
  10 This program 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
  13 GNU General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program; if not, write to the Free Software
  17 Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA
  18 */
  19 #include <kernel/log.hpp>
  20 #include <kernel/io_port_manager.hpp>
  21
  22 SINGLETON_INSTANCE(kernel::io_port_manager);
  23
  24 kernel::io_port_manager::io_port_manager()
  25 {
  26 }
  27
  28 kernel::io_port_manager::~io_port_manager()
  29 {
  30 }
  31
  32 void kernel::io_port_manager::init()
  33 {
  34 /*
  35   io_port_range range;
  36   range.port = 0x0000;
  37   range.size = 0x10000;
  38   mList.push_back(range);
  39 */
  40 }
  41
  42 bool kernel::io_port_manager::allocate(io_port& ioport,
  43                                        libarch::ioport_t port,
  44                                        size_t size)
  45 {
  46 /*
  47   if (range.size == 0)return false;
  48
  49   LOCK(mLock);
  50
  51     std::vector<io_port_range>::iterator end = mList.end();
  52     for (std::vector<io_port_range>::iterator i = mList.begin();i != end;i++)
  53       if ((*i).port <= range.port &&
  54         ((*i).port + (*i).size) >= (range.port + range.size))
  55       {
  56         if ((*i).port == range.port)
  57         {
  58           (*i).port += range.size;
  59           (*i).size -= range.size;
  60         }
  61         else if (((*i).port + (*i).size) == (range.port + range.size))
  62         {
  63           (*i).size -= range.size;
  64         }
  65         else
  66         {
  67           io_port_range range2;
  68           range2.port = range.port + range.size;
  69           range2.size = ((*i).port + (*i).size) - range2.port;
  70           mList.push_back(range2);
  71           (*i).size = range.port - (*i).port;
  72         }
  73         UNLOCK(mLock);
  74         return true;
  75       }
  76
  77   UNLOCK(mLock);
  78 */
  79
  80   return false;
  81 }
  82
  83 void kernel::io_port_manager::free(io_port& port)
  84 {
  85 /*
  86   LOCK(mLock);
  87
  88     std::vector<io_port_range>::iterator end = mList.end();
  89     std::vector<io_port_range>::iterator i = mList.begin();
  90     for (;i != end;i++)
  91       if (range.port == ((*i).port + (*i).size))
  92       {
  93         (*i).size += range.size;
  94         break;
  95       }
  96
  97     std::vector<io_port_range>::iterator i2 = mList.begin();
  98     for (;i2 != end;i2++)
  99       if ((*i2).port == (range.port + range.size))
 100       {
 101         if (i == end)
 102         {
 103           (*i2).port = range.port;
 104           (*i2).size += range.size;
 105         }
 106         else
 107         {
 108           (*i).size += (*i2).size;
 109           mList.erase(i2);
 110         }
 111         UNLOCK(mLock);
 112         return;
 113       }
 114
 115     if (i == end)
 116       mList.push_back(range);
 117
 118   UNLOCK(mLock);
 119 */
 120 }