G:/work/subversion/scol-technologies/trunk/plugins/OpenNiSCOL/OpenNiSCOL/DeviceManager.cpp

/*
-----------------------------------------------------------------------------
This source file is part of OpenSpace3D
For the latest info, see http://www.openspace3d.com

Copyright (c) 2010 I-maginer

This program is free software; you can redistribute it and/or modify it under
the terms of the GNU Lesser 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 Lesser General Public License for more details.

You should have received a copy of the GNU Lesser General Public License along with
this program; if not, write to the Free Software Foundation, Inc., 59 Temple
Place - Suite 330, Boston, MA 02111-1307, USA, or go to
http://www.gnu.org/copyleft/lesser.txt

You may alternatively use this source under the terms of a specific version of
the OpenSpace3D Unrestricted License provided you have obtained such a license from
I-maginer.
-----------------------------------------------------------------------------
*/

#include "lib/common.h"
#include "DeviceManager.h"
#include "objects/KinectDevice.h"
#include "ScolPlugin.h"
#include "Core/Exception.h"

namespace NIDevice
{
  namespace Core
  {
    template<> NIDevice::DeviceManager* Core::Singleton<NIDevice::DeviceManager>::instance = 0;
  }

  // Constructor and Destructor
  DeviceManager::DeviceManager() 
  {
  }

  DeviceManager::~DeviceManager()
  {
    // Close device manager
    close();
  }

  // Get singleton instance
  DeviceManager& DeviceManager::GetSingleton()
  {
    assert(instance);
    return *instance;
  }

  DeviceManager* DeviceManager::GetSingletonPtr()
  {
    return instance;
  }

  void DeviceManager::close()
  {
    listOfKinectDevice.clear();
  }

  unsigned int DeviceManager::createId()
  {
    int idFound = 0;
    while (listOfKinectDevice.find(idFound) != listOfKinectDevice.end())
    {
      idFound++;
    }

    return idFound;
  }

  NIDevice::Objects::KinectDevice* DeviceManager::CreateKinectDevice()
  {
    NIDevice::Objects::KinectDevice* newKinectDevice = new NIDevice::Objects::KinectDevice(createId());

    addKinectDevice(newKinectDevice);
    return newKinectDevice;
  }

  void DeviceManager::DestroyKinectDevice(NIDevice::Objects::KinectDevice* existingKinectDevice)
  {
    KinectDeviceMap::iterator iKinectDeviceSearched = listOfKinectDevice.find(existingKinectDevice->GetId());
    if (iKinectDeviceSearched != listOfKinectDevice.end())
    {
      listOfKinectDevice.erase(iKinectDeviceSearched);
      SAFE_DELETE(existingKinectDevice);
    }
    else
    {
      KINECT_EXCEPT(Core::ExceptionKinect, "Can't remove Kinect Device", "DeviceManagerManager::DestroyKinectDevice");
    }
  }

  void DeviceManager::addKinectDevice(NIDevice::Objects::KinectDevice* existingKinectDevice)
  {
    KinectDeviceMap::iterator iKinectDeviceSearched = listOfKinectDevice.find(existingKinectDevice->GetId());
    if (iKinectDeviceSearched == listOfKinectDevice.end())
    {
      listOfKinectDevice.insert(std::make_pair(existingKinectDevice->GetId(), existingKinectDevice));
    }
    else
    {
      // Kinect already exist in the handled nodes list.
      KINECT_EXCEPT(Core::ExceptionKinect, "Kinect Device already Exists", "DeviceManager::addKinectDevice");
    }
  }

  NIDevice::Objects::KinectDevice* DeviceManager::GetKinectDevice(unsigned int id)
  {
    KinectDeviceMap::iterator iKinectDeviceSearched = listOfKinectDevice.find(id);
    if(iKinectDeviceSearched != listOfKinectDevice.end())
    {
      return iKinectDeviceSearched->second;
    }
    return 0;
  }
}