| 1 |
/* |
|---|
| 2 |
* Copyright (C) 2005-2008 by Daniel Wagner |
|---|
| 3 |
* Copyright (C) 2005-2008 by Pieter Palmers |
|---|
| 4 |
* |
|---|
| 5 |
* This file is part of FFADO |
|---|
| 6 |
* FFADO = Free Firewire (pro-)audio drivers for linux |
|---|
| 7 |
* |
|---|
| 8 |
* FFADO is based upon FreeBoB. |
|---|
| 9 |
* |
|---|
| 10 |
* This program is free software: you can redistribute it and/or modify |
|---|
| 11 |
* it under the terms of the GNU General Public License as published by |
|---|
| 12 |
* the Free Software Foundation, either version 2 of the License, or |
|---|
| 13 |
* (at your option) version 3 of the License. |
|---|
| 14 |
* |
|---|
| 15 |
* This program is distributed in the hope that it will be useful, |
|---|
| 16 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|---|
| 17 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|---|
| 18 |
* GNU General Public License for more details. |
|---|
| 19 |
* |
|---|
| 20 |
* You should have received a copy of the GNU General Public License |
|---|
| 21 |
* along with this program. If not, see <http://www.gnu.org/licenses/>. |
|---|
| 22 |
* |
|---|
| 23 |
*/ |
|---|
| 24 |
|
|---|
| 25 |
#include "fbtypes.h" |
|---|
| 26 |
|
|---|
| 27 |
#include "devicemanager.h" |
|---|
| 28 |
#include "ffadodevice.h" |
|---|
| 29 |
#include "DeviceStringParser.h" |
|---|
| 30 |
|
|---|
| 31 |
#include "libieee1394/configrom.h" |
|---|
| 32 |
#include "libieee1394/ieee1394service.h" |
|---|
| 33 |
#include "libieee1394/IsoHandlerManager.h" |
|---|
| 34 |
|
|---|
| 35 |
#include "libstreaming/generic/StreamProcessor.h" |
|---|
| 36 |
#include "libstreaming/StreamProcessorManager.h" |
|---|
| 37 |
|
|---|
| 38 |
#include "debugmodule/debugmodule.h" |
|---|
| 39 |
|
|---|
| 40 |
#include "libutil/PosixMutex.h" |
|---|
| 41 |
|
|---|
| 42 |
#ifdef ENABLE_BEBOB |
|---|
| 43 |
#include "bebob/bebob_avdevice.h" |
|---|
| 44 |
#endif |
|---|
| 45 |
|
|---|
| 46 |
#ifdef ENABLE_GENERICAVC |
|---|
| 47 |
#include "genericavc/avc_avdevice.h" |
|---|
| 48 |
#endif |
|---|
| 49 |
|
|---|
| 50 |
#ifdef ENABLE_FIREWORKS |
|---|
| 51 |
#include "fireworks/fireworks_device.h" |
|---|
| 52 |
#endif |
|---|
| 53 |
|
|---|
| 54 |
#ifdef ENABLE_MOTU |
|---|
| 55 |
#include "motu/motu_avdevice.h" |
|---|
| 56 |
#endif |
|---|
| 57 |
|
|---|
| 58 |
#include <iostream> |
|---|
| 59 |
#include <sstream> |
|---|
| 60 |
|
|---|
| 61 |
#include <algorithm> |
|---|
| 62 |
|
|---|
| 63 |
using namespace std; |
|---|
| 64 |
|
|---|
| 65 |
IMPL_DEBUG_MODULE( DeviceManager, DeviceManager, DEBUG_LEVEL_NORMAL ); |
|---|
| 66 |
|
|---|
| 67 |
DeviceManager::DeviceManager() |
|---|
| 68 |
: Control::Container(NULL, "devicemanager") // this is the control root node |
|---|
| 69 |
, m_DeviceListLock( new Util::PosixMutex("DEVLST") ) |
|---|
| 70 |
, m_BusResetLock( new Util::PosixMutex("DEVBR") ) |
|---|
| 71 |
, m_processorManager( new Streaming::StreamProcessorManager( *this ) ) |
|---|
| 72 |
, m_deviceStringParser( new DeviceStringParser() ) |
|---|
| 73 |
, m_configuration ( new Util::Configuration() ) |
|---|
| 74 |
, m_used_cache_last_time( false ) |
|---|
| 75 |
, m_thread_realtime( false ) |
|---|
| 76 |
, m_thread_priority( 0 ) |
|---|
| 77 |
{ |
|---|
| 78 |
addOption(Util::OptionContainer::Option("slaveMode",false)); |
|---|
| 79 |
addOption(Util::OptionContainer::Option("snoopMode",false)); |
|---|
| 80 |
} |
|---|
| 81 |
|
|---|
| 82 |
DeviceManager::~DeviceManager() |
|---|
| 83 |
{ |
|---|
| 84 |
// save configuration |
|---|
| 85 |
if(!m_configuration->save()) { |
|---|
| 86 |
debugWarning("could not save configuration\n"); |
|---|
| 87 |
} |
|---|
| 88 |
|
|---|
| 89 |
m_BusResetLock->Lock(); // make sure we are not handling a busreset. |
|---|
| 90 |
m_DeviceListLock->Lock(); // make sure nobody is using this |
|---|
| 91 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 92 |
it != m_avDevices.end(); |
|---|
| 93 |
++it ) |
|---|
| 94 |
{ |
|---|
| 95 |
if (!deleteElement(*it)) { |
|---|
| 96 |
debugWarning("failed to remove AvDevice from Control::Container\n"); |
|---|
| 97 |
} |
|---|
| 98 |
delete *it; |
|---|
| 99 |
} |
|---|
| 100 |
m_DeviceListLock->Unlock(); |
|---|
| 101 |
|
|---|
| 102 |
// the SP's are automatically unregistered from the SPM |
|---|
| 103 |
delete m_processorManager; |
|---|
| 104 |
|
|---|
| 105 |
// the device list is empty, so wake up any waiting |
|---|
| 106 |
// reset handlers |
|---|
| 107 |
m_BusResetLock->Unlock(); |
|---|
| 108 |
|
|---|
| 109 |
// remove the bus-reset handlers |
|---|
| 110 |
for ( FunctorVectorIterator it = m_busreset_functors.begin(); |
|---|
| 111 |
it != m_busreset_functors.end(); |
|---|
| 112 |
++it ) |
|---|
| 113 |
{ |
|---|
| 114 |
delete *it; |
|---|
| 115 |
} |
|---|
| 116 |
|
|---|
| 117 |
for ( Ieee1394ServiceVectorIterator it = m_1394Services.begin(); |
|---|
| 118 |
it != m_1394Services.end(); |
|---|
| 119 |
++it ) |
|---|
| 120 |
{ |
|---|
| 121 |
delete *it; |
|---|
| 122 |
} |
|---|
| 123 |
|
|---|
| 124 |
delete m_DeviceListLock; |
|---|
| 125 |
delete m_BusResetLock; |
|---|
| 126 |
delete m_deviceStringParser; |
|---|
| 127 |
} |
|---|
| 128 |
|
|---|
| 129 |
bool |
|---|
| 130 |
DeviceManager::setThreadParameters(bool rt, int priority) { |
|---|
| 131 |
if (!m_processorManager->setThreadParameters(rt, priority)) { |
|---|
| 132 |
debugError("Could not set processor manager thread parameters\n"); |
|---|
| 133 |
return false; |
|---|
| 134 |
} |
|---|
| 135 |
for ( Ieee1394ServiceVectorIterator it = m_1394Services.begin(); |
|---|
| 136 |
it != m_1394Services.end(); |
|---|
| 137 |
++it ) |
|---|
| 138 |
{ |
|---|
| 139 |
if (!(*it)->setThreadParameters(rt, priority)) { |
|---|
| 140 |
debugError("Could not set 1394 service thread parameters\n"); |
|---|
| 141 |
return false; |
|---|
| 142 |
} |
|---|
| 143 |
} |
|---|
| 144 |
m_thread_realtime = rt; |
|---|
| 145 |
m_thread_priority = priority; |
|---|
| 146 |
return true; |
|---|
| 147 |
} |
|---|
| 148 |
|
|---|
| 149 |
bool |
|---|
| 150 |
DeviceManager::initialize() |
|---|
| 151 |
{ |
|---|
| 152 |
assert(m_1394Services.size() == 0); |
|---|
| 153 |
assert(m_busreset_functors.size() == 0); |
|---|
| 154 |
|
|---|
| 155 |
m_configuration->openFile( "temporary", Util::Configuration::eFM_Temporary ); |
|---|
| 156 |
m_configuration->openFile( USER_CONFIG_FILE, Util::Configuration::eFM_ReadWrite ); |
|---|
| 157 |
m_configuration->openFile( SYSTEM_CONFIG_FILE, Util::Configuration::eFM_ReadOnly ); |
|---|
| 158 |
|
|---|
| 159 |
int nb_detected_ports = Ieee1394Service::detectNbPorts(); |
|---|
| 160 |
if (nb_detected_ports < 0) { |
|---|
| 161 |
debugFatal("Failed to detect the number of 1394 adapters. Is the IEEE1394 stack loaded (raw1394)?\n"); |
|---|
| 162 |
return false; |
|---|
| 163 |
} |
|---|
| 164 |
if (nb_detected_ports == 0) { |
|---|
| 165 |
debugFatal("No firewire adapters (ports) found.\n"); |
|---|
| 166 |
return false; |
|---|
| 167 |
} |
|---|
| 168 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Found %d firewire adapters (ports)\n", nb_detected_ports); |
|---|
| 169 |
for (unsigned int port = 0; port < (unsigned int)nb_detected_ports; port++) { |
|---|
| 170 |
Ieee1394Service* tmp1394Service = new Ieee1394Service(); |
|---|
| 171 |
if ( !tmp1394Service ) { |
|---|
| 172 |
debugFatal( "Could not create Ieee1349Service object for port %d\n", port ); |
|---|
| 173 |
return false; |
|---|
| 174 |
} |
|---|
| 175 |
tmp1394Service->setVerboseLevel( getDebugLevel() ); |
|---|
| 176 |
m_1394Services.push_back(tmp1394Service); |
|---|
| 177 |
|
|---|
| 178 |
if(!tmp1394Service->useConfiguration(m_configuration)) { |
|---|
| 179 |
debugWarning("Could not load config to 1394service\n"); |
|---|
| 180 |
} |
|---|
| 181 |
|
|---|
| 182 |
tmp1394Service->setThreadParameters(m_thread_realtime, m_thread_priority); |
|---|
| 183 |
if ( !tmp1394Service->initialize( port ) ) { |
|---|
| 184 |
debugFatal( "Could not initialize Ieee1349Service object for port %d\n", port ); |
|---|
| 185 |
return false; |
|---|
| 186 |
} |
|---|
| 187 |
// add the bus reset handler |
|---|
| 188 |
Util::Functor* tmp_busreset_functor = new Util::MemberFunctor1< DeviceManager*, |
|---|
| 189 |
void (DeviceManager::*)(Ieee1394Service &), Ieee1394Service & > |
|---|
| 190 |
( this, &DeviceManager::busresetHandler, *tmp1394Service, false ); |
|---|
| 191 |
if ( !tmp_busreset_functor ) { |
|---|
| 192 |
debugFatal( "Could not create busreset handler for port %d\n", port ); |
|---|
| 193 |
return false; |
|---|
| 194 |
} |
|---|
| 195 |
m_busreset_functors.push_back(tmp_busreset_functor); |
|---|
| 196 |
|
|---|
| 197 |
tmp1394Service->addBusResetHandler( tmp_busreset_functor ); |
|---|
| 198 |
} |
|---|
| 199 |
|
|---|
| 200 |
return true; |
|---|
| 201 |
} |
|---|
| 202 |
|
|---|
| 203 |
bool |
|---|
| 204 |
DeviceManager::addSpecString(char *s) { |
|---|
| 205 |
std::string spec = s; |
|---|
| 206 |
if(isSpecStringValid(spec)) { |
|---|
| 207 |
debugOutput(DEBUG_LEVEL_VERBOSE, "Adding spec string %s\n", spec.c_str()); |
|---|
| 208 |
assert(m_deviceStringParser); |
|---|
| 209 |
m_deviceStringParser->parseString(spec); |
|---|
| 210 |
return true; |
|---|
| 211 |
} else { |
|---|
| 212 |
debugError("Invalid spec string: %s\n", spec.c_str()); |
|---|
| 213 |
return false; |
|---|
| 214 |
} |
|---|
| 215 |
} |
|---|
| 216 |
|
|---|
| 217 |
bool |
|---|
| 218 |
DeviceManager::isSpecStringValid(std::string s) { |
|---|
| 219 |
assert(m_deviceStringParser); |
|---|
| 220 |
return m_deviceStringParser->isValidString(s); |
|---|
| 221 |
} |
|---|
| 222 |
|
|---|
| 223 |
void |
|---|
| 224 |
DeviceManager::busresetHandler(Ieee1394Service &service) |
|---|
| 225 |
{ |
|---|
| 226 |
// serialize bus reset handling since it can be that a new one occurs while we're |
|---|
| 227 |
// doing stuff. |
|---|
| 228 |
debugOutput( DEBUG_LEVEL_NORMAL, "Bus reset detected on service %p...\n", &service ); |
|---|
| 229 |
Util::MutexLockHelper lock(*m_BusResetLock); |
|---|
| 230 |
debugOutput( DEBUG_LEVEL_NORMAL, " handling busreset...\n" ); |
|---|
| 231 |
|
|---|
| 232 |
// FIXME: what if the devices are gone? (device should detect this!) |
|---|
| 233 |
// propagate the bus reset to all avDevices |
|---|
| 234 |
m_DeviceListLock->Lock(); // make sure nobody is using this |
|---|
| 235 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 236 |
it != m_avDevices.end(); |
|---|
| 237 |
++it ) |
|---|
| 238 |
{ |
|---|
| 239 |
if(&service == &((*it)->get1394Service())) { |
|---|
| 240 |
debugOutput(DEBUG_LEVEL_NORMAL, |
|---|
| 241 |
"issue busreset on device GUID %s\n", |
|---|
| 242 |
(*it)->getConfigRom().getGuidString().c_str()); |
|---|
| 243 |
(*it)->handleBusReset(); |
|---|
| 244 |
} else { |
|---|
| 245 |
debugOutput(DEBUG_LEVEL_NORMAL, |
|---|
| 246 |
"skipping device GUID %s since not on service %p\n", |
|---|
| 247 |
(*it)->getConfigRom().getGuidString().c_str(), &service); |
|---|
| 248 |
} |
|---|
| 249 |
} |
|---|
| 250 |
m_DeviceListLock->Unlock(); |
|---|
| 251 |
|
|---|
| 252 |
// now that the devices have been updates, we can request to update the iso streams |
|---|
| 253 |
if(!service.getIsoHandlerManager().handleBusReset()) { |
|---|
| 254 |
debugError("IsoHandlerManager failed to handle busreset\n"); |
|---|
| 255 |
} |
|---|
| 256 |
|
|---|
| 257 |
// notify the streamprocessormanager of the busreset |
|---|
| 258 |
// if(m_processorManager) { |
|---|
| 259 |
// m_processorManager->handleBusReset(service); |
|---|
| 260 |
// } else { |
|---|
| 261 |
// debugWarning("No valid SPM\n"); |
|---|
| 262 |
// } |
|---|
| 263 |
|
|---|
| 264 |
// rediscover to find new devices |
|---|
| 265 |
// (only for the control server ATM, streaming can't dynamically add/remove devices) |
|---|
| 266 |
if(!discover(m_used_cache_last_time, true)) { |
|---|
| 267 |
debugError("Could not rediscover devices\n"); |
|---|
| 268 |
} |
|---|
| 269 |
|
|---|
| 270 |
// notify any clients |
|---|
| 271 |
signalNotifiers(m_busResetNotifiers); |
|---|
| 272 |
|
|---|
| 273 |
// display the new state |
|---|
| 274 |
if(getDebugLevel() >= DEBUG_LEVEL_VERBOSE) { |
|---|
| 275 |
showDeviceInfo(); |
|---|
| 276 |
} |
|---|
| 277 |
} |
|---|
| 278 |
|
|---|
| 279 |
void |
|---|
| 280 |
DeviceManager::signalNotifiers(notif_vec_t& list) |
|---|
| 281 |
{ |
|---|
| 282 |
for ( notif_vec_t::iterator it = list.begin(); |
|---|
| 283 |
it != list.end(); |
|---|
| 284 |
++it ) |
|---|
| 285 |
{ |
|---|
| 286 |
Util::Functor* func = *it; |
|---|
| 287 |
debugOutput( DEBUG_LEVEL_VERBOSE, " running notifier %p...\n", func ); |
|---|
| 288 |
( *func )(); |
|---|
| 289 |
} |
|---|
| 290 |
} |
|---|
| 291 |
|
|---|
| 292 |
bool |
|---|
| 293 |
DeviceManager::registerNotification(notif_vec_t& list, Util::Functor *handler) |
|---|
| 294 |
{ |
|---|
| 295 |
debugOutput( DEBUG_LEVEL_VERBOSE, "register %p...\n", handler); |
|---|
| 296 |
assert(handler); |
|---|
| 297 |
for ( notif_vec_t::iterator it = list.begin(); |
|---|
| 298 |
it != list.end(); |
|---|
| 299 |
++it ) |
|---|
| 300 |
{ |
|---|
| 301 |
if ( *it == handler ) { |
|---|
| 302 |
debugOutput(DEBUG_LEVEL_VERBOSE, "already registered\n"); |
|---|
| 303 |
return false; |
|---|
| 304 |
} |
|---|
| 305 |
} |
|---|
| 306 |
list.push_back(handler); |
|---|
| 307 |
return true; |
|---|
| 308 |
} |
|---|
| 309 |
|
|---|
| 310 |
bool |
|---|
| 311 |
DeviceManager::unregisterNotification(notif_vec_t& list, Util::Functor *handler) |
|---|
| 312 |
{ |
|---|
| 313 |
debugOutput( DEBUG_LEVEL_VERBOSE, "unregister %p...\n", handler); |
|---|
| 314 |
assert(handler); |
|---|
| 315 |
|
|---|
| 316 |
for ( notif_vec_t::iterator it = list.begin(); |
|---|
| 317 |
it != list.end(); |
|---|
| 318 |
++it ) |
|---|
| 319 |
{ |
|---|
| 320 |
if ( *it == handler ) { |
|---|
| 321 |
list.erase(it); |
|---|
| 322 |
return true; |
|---|
| 323 |
} |
|---|
| 324 |
} |
|---|
| 325 |
debugError("Could not find handler (%p)\n", handler); |
|---|
| 326 |
return false; //not found |
|---|
| 327 |
} |
|---|
| 328 |
|
|---|
| 329 |
bool |
|---|
| 330 |
DeviceManager::discover( bool useCache, bool rediscover ) |
|---|
| 331 |
{ |
|---|
| 332 |
debugOutput( DEBUG_LEVEL_NORMAL, "Starting discovery...\n" ); |
|---|
| 333 |
useCache = useCache && ENABLE_DISCOVERY_CACHE; |
|---|
| 334 |
m_used_cache_last_time = useCache; |
|---|
| 335 |
bool slaveMode=false; |
|---|
| 336 |
if(!getOption("slaveMode", slaveMode)) { |
|---|
| 337 |
debugWarning("Could not retrieve slaveMode parameter, defauling to false\n"); |
|---|
| 338 |
} |
|---|
| 339 |
bool snoopMode=false; |
|---|
| 340 |
if(!getOption("snoopMode", snoopMode)) { |
|---|
| 341 |
debugWarning("Could not retrieve snoopMode parameter, defauling to false\n"); |
|---|
| 342 |
} |
|---|
| 343 |
|
|---|
| 344 |
setVerboseLevel(getDebugLevel()); |
|---|
| 345 |
|
|---|
| 346 |
// FIXME: it could be that a 1394service has disappeared (cardbus) |
|---|
| 347 |
|
|---|
| 348 |
ConfigRomVector configRoms; |
|---|
| 349 |
// build a list of configroms on the bus. |
|---|
| 350 |
for ( Ieee1394ServiceVectorIterator it = m_1394Services.begin(); |
|---|
| 351 |
it != m_1394Services.end(); |
|---|
| 352 |
++it ) |
|---|
| 353 |
{ |
|---|
| 354 |
Ieee1394Service *portService = *it; |
|---|
| 355 |
for ( fb_nodeid_t nodeId = 0; |
|---|
| 356 |
nodeId < portService->getNodeCount(); |
|---|
| 357 |
++nodeId ) |
|---|
| 358 |
{ |
|---|
| 359 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Probing node %d...\n", nodeId ); |
|---|
| 360 |
|
|---|
| 361 |
if (nodeId == portService->getLocalNodeId()) { |
|---|
| 362 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Skipping local node (%d)...\n", nodeId ); |
|---|
| 363 |
continue; |
|---|
| 364 |
} |
|---|
| 365 |
|
|---|
| 366 |
ConfigRom * configRom = new ConfigRom( *portService, nodeId ); |
|---|
| 367 |
if ( !configRom->initialize() ) { |
|---|
| 368 |
// \todo If a PHY on the bus is in power safe mode then |
|---|
| 369 |
// the config rom is missing. So this might be just |
|---|
| 370 |
// such this case and we can safely skip it. But it might |
|---|
| 371 |
// be there is a real software problem on our side. |
|---|
| 372 |
// This should be handlede more carefuly. |
|---|
| 373 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 374 |
"Could not read config rom from device (node id %d). " |
|---|
| 375 |
"Skip device discovering for this node\n", |
|---|
| 376 |
nodeId ); |
|---|
| 377 |
continue; |
|---|
| 378 |
} |
|---|
| 379 |
configRoms.push_back(configRom); |
|---|
| 380 |
} |
|---|
| 381 |
} |
|---|
| 382 |
|
|---|
| 383 |
|
|---|
| 384 |
// notify that we are going to manipulate the list |
|---|
| 385 |
signalNotifiers(m_preUpdateNotifiers); |
|---|
| 386 |
m_DeviceListLock->Lock(); // make sure nobody starts using the list |
|---|
| 387 |
if(rediscover) { |
|---|
| 388 |
|
|---|
| 389 |
FFADODeviceVector discovered_devices_on_bus; |
|---|
| 390 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 391 |
it != m_avDevices.end(); |
|---|
| 392 |
++it ) |
|---|
| 393 |
{ |
|---|
| 394 |
bool seen_device = false; |
|---|
| 395 |
for ( ConfigRomVectorIterator it2 = configRoms.begin(); |
|---|
| 396 |
it2 != configRoms.end(); |
|---|
| 397 |
++it2 ) |
|---|
| 398 |
{ |
|---|
| 399 |
seen_device |= ((*it)->getConfigRom().getGuid() == (*it2)->getGuid()); |
|---|
| 400 |
} |
|---|
| 401 |
|
|---|
| 402 |
if(seen_device) { |
|---|
| 403 |
debugOutput( DEBUG_LEVEL_VERBOSE, |
|---|
| 404 |
"Already discovered device with GUID: %s\n", |
|---|
| 405 |
(*it)->getConfigRom().getGuidString().c_str() ); |
|---|
| 406 |
// we already discovered this device, and it is still here. keep it |
|---|
| 407 |
discovered_devices_on_bus.push_back(*it); |
|---|
| 408 |
} else { |
|---|
| 409 |
debugOutput( DEBUG_LEVEL_VERBOSE, |
|---|
| 410 |
"Device with GUID: %s disappeared from bus, removing...\n", |
|---|
| 411 |
(*it)->getConfigRom().getGuidString().c_str() ); |
|---|
| 412 |
|
|---|
| 413 |
// the device has disappeared, remove it from the control tree |
|---|
| 414 |
if (!deleteElement(*it)) { |
|---|
| 415 |
debugWarning("failed to remove AvDevice from Control::Container\n"); |
|---|
| 416 |
} |
|---|
| 417 |
// delete the device |
|---|
| 418 |
// FIXME: this will mess up the any code that waits for bus resets to |
|---|
| 419 |
// occur |
|---|
| 420 |
delete *it; |
|---|
| 421 |
} |
|---|
| 422 |
} |
|---|
| 423 |
// prune the devices that disappeared |
|---|
| 424 |
m_avDevices = discovered_devices_on_bus; |
|---|
| 425 |
} else { // remove everything since we are not rediscovering |
|---|
| 426 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 427 |
it != m_avDevices.end(); |
|---|
| 428 |
++it ) |
|---|
| 429 |
{ |
|---|
| 430 |
if (!deleteElement(*it)) { |
|---|
| 431 |
debugWarning("failed to remove AvDevice from Control::Container\n"); |
|---|
| 432 |
} |
|---|
| 433 |
delete *it; |
|---|
| 434 |
} |
|---|
| 435 |
|
|---|
| 436 |
m_avDevices.clear(); |
|---|
| 437 |
} |
|---|
| 438 |
|
|---|
| 439 |
// delete the config rom list entries |
|---|
| 440 |
// FIXME: we should reuse it |
|---|
| 441 |
for ( ConfigRomVectorIterator it = configRoms.begin(); |
|---|
| 442 |
it != configRoms.end(); |
|---|
| 443 |
++it ) |
|---|
| 444 |
{ |
|---|
| 445 |
delete *it; |
|---|
| 446 |
} |
|---|
| 447 |
|
|---|
| 448 |
assert(m_deviceStringParser); |
|---|
| 449 |
// show the spec strings we're going to use |
|---|
| 450 |
if(getDebugLevel() >= DEBUG_LEVEL_VERBOSE) { |
|---|
| 451 |
m_deviceStringParser->show(); |
|---|
| 452 |
} |
|---|
| 453 |
|
|---|
| 454 |
if (!slaveMode) { |
|---|
| 455 |
// for the devices that are still in the list check if they require re-discovery |
|---|
| 456 |
FFADODeviceVector failed_to_rediscover; |
|---|
| 457 |
for ( FFADODeviceVectorIterator it_dev = m_avDevices.begin(); |
|---|
| 458 |
it_dev != m_avDevices.end(); |
|---|
| 459 |
++it_dev ) |
|---|
| 460 |
{ |
|---|
| 461 |
FFADODevice* avDevice = *it_dev; |
|---|
| 462 |
if(avDevice->needsRediscovery()) { |
|---|
| 463 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 464 |
"Device with GUID %s requires rediscovery (state changed)...\n", |
|---|
| 465 |
avDevice->getConfigRom().getGuidString().c_str()); |
|---|
| 466 |
|
|---|
| 467 |
bool isFromCache = false; |
|---|
| 468 |
if ( useCache && avDevice->loadFromCache() ) { |
|---|
| 469 |
debugOutput( DEBUG_LEVEL_VERBOSE, "could load from cache\n" ); |
|---|
| 470 |
isFromCache = true; |
|---|
| 471 |
// restore the debug level for everything that was loaded |
|---|
| 472 |
avDevice->setVerboseLevel( getDebugLevel() ); |
|---|
| 473 |
} else if ( avDevice->discover() ) { |
|---|
| 474 |
debugOutput( DEBUG_LEVEL_VERBOSE, "discovery successful\n" ); |
|---|
| 475 |
} else { |
|---|
| 476 |
debugError( "could not discover device\n" ); |
|---|
| 477 |
failed_to_rediscover.push_back(avDevice); |
|---|
| 478 |
continue; |
|---|
| 479 |
} |
|---|
| 480 |
if ( !isFromCache && !avDevice->saveCache() ) { |
|---|
| 481 |
debugOutput( DEBUG_LEVEL_VERBOSE, "No cached version of AVC model created\n" ); |
|---|
| 482 |
} |
|---|
| 483 |
} else { |
|---|
| 484 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 485 |
"Device with GUID %s does not require rediscovery...\n", |
|---|
| 486 |
avDevice->getConfigRom().getGuidString().c_str()); |
|---|
| 487 |
} |
|---|
| 488 |
} |
|---|
| 489 |
// remove devices that failed to rediscover |
|---|
| 490 |
// FIXME: surely there has to be a better way to do this |
|---|
| 491 |
FFADODeviceVector to_keep; |
|---|
| 492 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 493 |
it != m_avDevices.end(); |
|---|
| 494 |
++it ) |
|---|
| 495 |
{ |
|---|
| 496 |
bool keep_this_device = true; |
|---|
| 497 |
for ( FFADODeviceVectorIterator it2 = failed_to_rediscover.begin(); |
|---|
| 498 |
it2 != failed_to_rediscover.end(); |
|---|
| 499 |
++it2 ) |
|---|
| 500 |
{ |
|---|
| 501 |
if(*it == *it2) { |
|---|
| 502 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 503 |
"Removing device with GUID %s due to failed discovery...\n", |
|---|
| 504 |
(*it)->getConfigRom().getGuidString().c_str()); |
|---|
| 505 |
keep_this_device = false; |
|---|
| 506 |
break; |
|---|
| 507 |
} |
|---|
| 508 |
} |
|---|
| 509 |
if(keep_this_device) { |
|---|
| 510 |
to_keep.push_back(*it); |
|---|
| 511 |
} |
|---|
| 512 |
} |
|---|
| 513 |
for ( FFADODeviceVectorIterator it2 = failed_to_rediscover.begin(); |
|---|
| 514 |
it2 != failed_to_rediscover.end(); |
|---|
| 515 |
++it2 ) |
|---|
| 516 |
{ |
|---|
| 517 |
if (!deleteElement(*it2)) { |
|---|
| 518 |
debugWarning("failed to remove AvDevice from Control::Container\n"); |
|---|
| 519 |
} |
|---|
| 520 |
delete *it2; |
|---|
| 521 |
} |
|---|
| 522 |
m_avDevices = to_keep; |
|---|
| 523 |
|
|---|
| 524 |
// pick up new devices |
|---|
| 525 |
for ( Ieee1394ServiceVectorIterator it = m_1394Services.begin(); |
|---|
| 526 |
it != m_1394Services.end(); |
|---|
| 527 |
++it ) |
|---|
| 528 |
{ |
|---|
| 529 |
Ieee1394Service *portService = *it; |
|---|
| 530 |
for ( fb_nodeid_t nodeId = 0; |
|---|
| 531 |
nodeId < portService->getNodeCount(); |
|---|
| 532 |
++nodeId ) |
|---|
| 533 |
{ |
|---|
| 534 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Probing node %d...\n", nodeId ); |
|---|
| 535 |
|
|---|
| 536 |
if (nodeId == portService->getLocalNodeId()) { |
|---|
| 537 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Skipping local node (%d)...\n", nodeId ); |
|---|
| 538 |
continue; |
|---|
| 539 |
} |
|---|
| 540 |
|
|---|
| 541 |
ConfigRom *configRom = new ConfigRom( *portService, nodeId ); |
|---|
| 542 |
if ( !configRom->initialize() ) { |
|---|
| 543 |
// \todo If a PHY on the bus is in power safe mode then |
|---|
| 544 |
// the config rom is missing. So this might be just |
|---|
| 545 |
// such this case and we can safely skip it. But it might |
|---|
| 546 |
// be there is a real software problem on our side. |
|---|
| 547 |
// This should be handlede more carefuly. |
|---|
| 548 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 549 |
"Could not read config rom from device (node id %d). " |
|---|
| 550 |
"Skip device discovering for this node\n", |
|---|
| 551 |
nodeId ); |
|---|
| 552 |
continue; |
|---|
| 553 |
} |
|---|
| 554 |
|
|---|
| 555 |
bool already_in_vector = false; |
|---|
| 556 |
for ( FFADODeviceVectorIterator it_dev = m_avDevices.begin(); |
|---|
| 557 |
it_dev != m_avDevices.end(); |
|---|
| 558 |
++it_dev ) |
|---|
| 559 |
{ |
|---|
| 560 |
if ((*it_dev)->getConfigRom().getGuid() == configRom->getGuid()) { |
|---|
| 561 |
already_in_vector = true; |
|---|
| 562 |
break; |
|---|
| 563 |
} |
|---|
| 564 |
} |
|---|
| 565 |
if(already_in_vector) { |
|---|
| 566 |
if(!rediscover) { |
|---|
| 567 |
debugWarning("Device with GUID %s already discovered on other port, skipping device...\n", |
|---|
| 568 |
configRom->getGuidString().c_str()); |
|---|
| 569 |
} |
|---|
| 570 |
continue; |
|---|
| 571 |
} |
|---|
| 572 |
|
|---|
| 573 |
if(getDebugLevel() >= DEBUG_LEVEL_VERBOSE) { |
|---|
| 574 |
configRom->printConfigRomDebug(); |
|---|
| 575 |
} |
|---|
| 576 |
|
|---|
| 577 |
// if spec strings are given, only add those devices |
|---|
| 578 |
// that match the spec string(s). |
|---|
| 579 |
// if no (valid) spec strings are present, grab all |
|---|
| 580 |
// supported devices. |
|---|
| 581 |
if(m_deviceStringParser->countDeviceStrings() && |
|---|
| 582 |
!m_deviceStringParser->match(*configRom)) { |
|---|
| 583 |
debugOutput(DEBUG_LEVEL_VERBOSE, "Device doesn't match any of the spec strings. skipping...\n"); |
|---|
| 584 |
continue; |
|---|
| 585 |
} |
|---|
| 586 |
|
|---|
| 587 |
// find a driver |
|---|
| 588 |
FFADODevice* avDevice = getDriverForDevice( configRom, |
|---|
| 589 |
nodeId ); |
|---|
| 590 |
|
|---|
| 591 |
if ( avDevice ) { |
|---|
| 592 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 593 |
"driver found for device %d\n", |
|---|
| 594 |
nodeId ); |
|---|
| 595 |
|
|---|
| 596 |
avDevice->setVerboseLevel( getDebugLevel() ); |
|---|
| 597 |
bool isFromCache = false; |
|---|
| 598 |
if ( useCache && avDevice->loadFromCache() ) { |
|---|
| 599 |
debugOutput( DEBUG_LEVEL_VERBOSE, "could load from cache\n" ); |
|---|
| 600 |
isFromCache = true; |
|---|
| 601 |
// restore the debug level for everything that was loaded |
|---|
| 602 |
avDevice->setVerboseLevel( getDebugLevel() ); |
|---|
| 603 |
} else if ( avDevice->discover() ) { |
|---|
| 604 |
debugOutput( DEBUG_LEVEL_VERBOSE, "discovery successful\n" ); |
|---|
| 605 |
} else { |
|---|
| 606 |
debugError( "could not discover device\n" ); |
|---|
| 607 |
delete avDevice; |
|---|
| 608 |
continue; |
|---|
| 609 |
} |
|---|
| 610 |
|
|---|
| 611 |
if (snoopMode) { |
|---|
| 612 |
debugOutput( DEBUG_LEVEL_VERBOSE, |
|---|
| 613 |
"Enabling snoop mode on node %d...\n", nodeId ); |
|---|
| 614 |
|
|---|
| 615 |
if(!avDevice->setOption("snoopMode", snoopMode)) { |
|---|
| 616 |
debugWarning("Could not set snoop mode for device on node %d\n", nodeId); |
|---|
| 617 |
delete avDevice; |
|---|
| 618 |
continue; |
|---|
| 619 |
} |
|---|
| 620 |
} |
|---|
| 621 |
|
|---|
| 622 |
if ( !isFromCache && !avDevice->saveCache() ) { |
|---|
| 623 |
debugOutput( DEBUG_LEVEL_VERBOSE, "No cached version of AVC model created\n" ); |
|---|
| 624 |
} |
|---|
| 625 |
m_avDevices.push_back( avDevice ); |
|---|
| 626 |
|
|---|
| 627 |
if (!addElement(avDevice)) { |
|---|
| 628 |
debugWarning("failed to add AvDevice to Control::Container\n"); |
|---|
| 629 |
} |
|---|
| 630 |
|
|---|
| 631 |
debugOutput( DEBUG_LEVEL_NORMAL, "discovery of node %d on port %d done...\n", nodeId, portService->getPort() ); |
|---|
| 632 |
} else { |
|---|
| 633 |
// we didn't get a device, hence we have to delete the configrom ptr manually |
|---|
| 634 |
delete configRom; |
|---|
| 635 |
} |
|---|
| 636 |
} |
|---|
| 637 |
} |
|---|
| 638 |
|
|---|
| 639 |
debugOutput( DEBUG_LEVEL_NORMAL, "Discovery finished...\n" ); |
|---|
| 640 |
// FIXME: do better sorting |
|---|
| 641 |
// sort the m_avDevices vector on their GUID |
|---|
| 642 |
// then assign reassign the id's to the devices |
|---|
| 643 |
// the side effect of this is that for the same set of attached devices, |
|---|
| 644 |
// a device id always corresponds to the same device |
|---|
| 645 |
sort(m_avDevices.begin(), m_avDevices.end(), FFADODevice::compareGUID); |
|---|
| 646 |
int i=0; |
|---|
| 647 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 648 |
it != m_avDevices.end(); |
|---|
| 649 |
++it ) |
|---|
| 650 |
{ |
|---|
| 651 |
if ( !(*it)->setId( i++ ) ) { |
|---|
| 652 |
debugError( "setting Id failed\n" ); |
|---|
| 653 |
} |
|---|
| 654 |
} |
|---|
| 655 |
showDeviceInfo(); |
|---|
| 656 |
|
|---|
| 657 |
} else { // slave mode |
|---|
| 658 |
// notify any clients |
|---|
| 659 |
signalNotifiers(m_preUpdateNotifiers); |
|---|
| 660 |
Ieee1394Service *portService = m_1394Services.at(0); |
|---|
| 661 |
fb_nodeid_t nodeId = portService->getLocalNodeId(); |
|---|
| 662 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Starting in slave mode on node %d...\n", nodeId ); |
|---|
| 663 |
|
|---|
| 664 |
std::auto_ptr<ConfigRom> configRom = |
|---|
| 665 |
std::auto_ptr<ConfigRom>( new ConfigRom( *portService, |
|---|
| 666 |
nodeId ) ); |
|---|
| 667 |
if ( !configRom->initialize() ) { |
|---|
| 668 |
// \todo If a PHY on the bus is in power safe mode then |
|---|
| 669 |
// the config rom is missing. So this might be just |
|---|
| 670 |
// such this case and we can safely skip it. But it might |
|---|
| 671 |
// be there is a real software problem on our side. |
|---|
| 672 |
// This should be handled more carefuly. |
|---|
| 673 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 674 |
"Could not read config rom from device (node id %d). " |
|---|
| 675 |
"Skip device discovering for this node\n", |
|---|
| 676 |
nodeId ); |
|---|
| 677 |
return false; |
|---|
| 678 |
} |
|---|
| 679 |
|
|---|
| 680 |
// remove any already present devices |
|---|
| 681 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 682 |
it != m_avDevices.end(); |
|---|
| 683 |
++it ) |
|---|
| 684 |
{ |
|---|
| 685 |
if (!deleteElement(*it)) { |
|---|
| 686 |
debugWarning("failed to remove AvDevice from Control::Container\n"); |
|---|
| 687 |
} |
|---|
| 688 |
delete *it; |
|---|
| 689 |
} |
|---|
| 690 |
|
|---|
| 691 |
m_avDevices.clear(); |
|---|
| 692 |
|
|---|
| 693 |
// get the slave driver |
|---|
| 694 |
FFADODevice* avDevice = getSlaveDriver( configRom ); |
|---|
| 695 |
if ( avDevice ) { |
|---|
| 696 |
debugOutput( DEBUG_LEVEL_NORMAL, |
|---|
| 697 |
"driver found for device %d\n", |
|---|
| 698 |
nodeId ); |
|---|
| 699 |
|
|---|
| 700 |
avDevice->setVerboseLevel( getDebugLevel() ); |
|---|
| 701 |
|
|---|
| 702 |
if ( !avDevice->discover() ) { |
|---|
| 703 |
debugError( "could not discover device\n" ); |
|---|
| 704 |
delete avDevice; |
|---|
| 705 |
return false; |
|---|
| 706 |
} |
|---|
| 707 |
|
|---|
| 708 |
if ( !avDevice->setId( m_avDevices.size() ) ) { |
|---|
| 709 |
debugError( "setting Id failed\n" ); |
|---|
| 710 |
} |
|---|
| 711 |
if ( getDebugLevel() >= DEBUG_LEVEL_VERBOSE ) { |
|---|
| 712 |
avDevice->showDevice(); |
|---|
| 713 |
} |
|---|
| 714 |
m_avDevices.push_back( avDevice ); |
|---|
| 715 |
debugOutput( DEBUG_LEVEL_NORMAL, "discovery of node %d on port %d done...\n", nodeId, portService->getPort() ); |
|---|
| 716 |
} |
|---|
| 717 |
|
|---|
| 718 |
debugOutput( DEBUG_LEVEL_NORMAL, "discovery finished...\n" ); |
|---|
| 719 |
} |
|---|
| 720 |
|
|---|
| 721 |
m_DeviceListLock->Unlock(); |
|---|
| 722 |
// notify any clients |
|---|
| 723 |
signalNotifiers(m_postUpdateNotifiers); |
|---|
| 724 |
return true; |
|---|
| 725 |
} |
|---|
| 726 |
|
|---|
| 727 |
bool |
|---|
| 728 |
DeviceManager::initStreaming() |
|---|
| 729 |
{ |
|---|
| 730 |
// iterate over the found devices |
|---|
| 731 |
// add the stream processors of the devices to the managers |
|---|
| 732 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 733 |
it != m_avDevices.end(); |
|---|
| 734 |
++it ) |
|---|
| 735 |
{ |
|---|
| 736 |
FFADODevice *device = *it; |
|---|
| 737 |
assert(device); |
|---|
| 738 |
|
|---|
| 739 |
debugOutput(DEBUG_LEVEL_VERBOSE, "Locking device (%p)\n", device); |
|---|
| 740 |
|
|---|
| 741 |
if (!device->lock()) { |
|---|
| 742 |
debugWarning("Could not lock device, skipping device (%p)!\n", device); |
|---|
| 743 |
continue; |
|---|
| 744 |
} |
|---|
| 745 |
|
|---|
| 746 |
debugOutput(DEBUG_LEVEL_VERBOSE, "Setting samplerate to %d for (%p)\n", |
|---|
| 747 |
m_processorManager->getNominalRate(), device); |
|---|
| 748 |
|
|---|
| 749 |
// Set the device's sampling rate to that requested |
|---|
| 750 |
// FIXME: does this really belong here? If so we need to handle errors. |
|---|
| 751 |
if (!device->setSamplingFrequency(m_processorManager->getNominalRate())) { |
|---|
| 752 |
debugOutput(DEBUG_LEVEL_VERBOSE, " => Retry setting samplerate to %d for (%p)\n", |
|---|
| 753 |
m_processorManager->getNominalRate(), device); |
|---|
| 754 |
|
|---|
| 755 |
// try again: |
|---|
| 756 |
if (!device->setSamplingFrequency(m_processorManager->getNominalRate())) { |
|---|
| 757 |
debugFatal("Could not set sampling frequency to %d\n",m_processorManager->getNominalRate()); |
|---|
| 758 |
return false; |
|---|
| 759 |
} |
|---|
| 760 |
} |
|---|
| 761 |
// prepare the device |
|---|
| 762 |
device->prepare(); |
|---|
| 763 |
} |
|---|
| 764 |
|
|---|
| 765 |
// set the sync source |
|---|
| 766 |
if (!m_processorManager->setSyncSource(getSyncSource())) { |
|---|
| 767 |
debugWarning("Could not set processorManager sync source (%p)\n", |
|---|
| 768 |
getSyncSource()); |
|---|
| 769 |
} |
|---|
| 770 |
|
|---|
| 771 |
return true; |
|---|
| 772 |
} |
|---|
| 773 |
|
|---|
| 774 |
bool |
|---|
| 775 |
DeviceManager::prepareStreaming() |
|---|
| 776 |
{ |
|---|
| 777 |
if (!m_processorManager->prepare()) { |
|---|
| 778 |
debugFatal("Could not prepare streaming...\n"); |
|---|
| 779 |
return false; |
|---|
| 780 |
} |
|---|
| 781 |
return true; |
|---|
| 782 |
} |
|---|
| 783 |
|
|---|
| 784 |
bool |
|---|
| 785 |
DeviceManager::finishStreaming() { |
|---|
| 786 |
bool result = true; |
|---|
| 787 |
// iterate over the found devices |
|---|
| 788 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 789 |
it != m_avDevices.end(); |
|---|
| 790 |
++it ) |
|---|
| 791 |
{ |
|---|
| 792 |
debugOutput(DEBUG_LEVEL_VERBOSE, "Unlocking device (%p)\n", *it); |
|---|
| 793 |
|
|---|
| 794 |
if (!(*it)->unlock()) { |
|---|
| 795 |
debugWarning("Could not unlock device (%p)!\n", *it); |
|---|
| 796 |
result = false; |
|---|
| 797 |
} |
|---|
| 798 |
} |
|---|
| 799 |
return result; |
|---|
| 800 |
} |
|---|
| 801 |
|
|---|
| 802 |
bool |
|---|
| 803 |
DeviceManager::startStreaming() { |
|---|
| 804 |
// create the connections for all devices |
|---|
| 805 |
// iterate over the found devices |
|---|
| 806 |
// add the stream processors of the devices to the managers |
|---|
| 807 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 808 |
it != m_avDevices.end(); |
|---|
| 809 |
++it ) |
|---|
| 810 |
{ |
|---|
| 811 |
FFADODevice *device = *it; |
|---|
| 812 |
assert(device); |
|---|
| 813 |
|
|---|
| 814 |
int j=0; |
|---|
| 815 |
for(j=0; j < device->getStreamCount(); j++) { |
|---|
| 816 |
debugOutput(DEBUG_LEVEL_VERBOSE,"Starting stream %d of device %p\n", j, device); |
|---|
| 817 |
// start the stream |
|---|
| 818 |
if (!device->startStreamByIndex(j)) { |
|---|
| 819 |
debugWarning("Could not start stream %d of device %p\n", j, device); |
|---|
| 820 |
continue; |
|---|
| 821 |
} |
|---|
| 822 |
} |
|---|
| 823 |
|
|---|
| 824 |
if (!device->enableStreaming()) { |
|---|
| 825 |
debugWarning("Could not enable streaming on device %p!\n", device); |
|---|
| 826 |
} |
|---|
| 827 |
} |
|---|
| 828 |
|
|---|
| 829 |
if(m_processorManager->start()) { |
|---|
| 830 |
return true; |
|---|
| 831 |
} else { |
|---|
| 832 |
stopStreaming(); |
|---|
| 833 |
return false; |
|---|
| 834 |
} |
|---|
| 835 |
} |
|---|
| 836 |
|
|---|
| 837 |
bool |
|---|
| 838 |
DeviceManager::resetStreaming() { |
|---|
| 839 |
return true; |
|---|
| 840 |
} |
|---|
| 841 |
|
|---|
| 842 |
bool |
|---|
| 843 |
DeviceManager::stopStreaming() |
|---|
| 844 |
{ |
|---|
| 845 |
bool result = true; |
|---|
| 846 |
m_processorManager->stop(); |
|---|
| 847 |
|
|---|
| 848 |
// create the connections for all devices |
|---|
| 849 |
// iterate over the found devices |
|---|
| 850 |
// add the stream processors of the devices to the managers |
|---|
| 851 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 852 |
it != m_avDevices.end(); |
|---|
| 853 |
++it ) |
|---|
| 854 |
{ |
|---|
| 855 |
FFADODevice *device = *it; |
|---|
| 856 |
assert(device); |
|---|
| 857 |
|
|---|
| 858 |
if (!device->disableStreaming()) { |
|---|
| 859 |
debugWarning("Could not disable streaming on device %p!\n", device); |
|---|
| 860 |
} |
|---|
| 861 |
|
|---|
| 862 |
int j=0; |
|---|
| 863 |
for(j=0; j < device->getStreamCount(); j++) { |
|---|
| 864 |
debugOutput(DEBUG_LEVEL_VERBOSE,"Stopping stream %d of device %p\n", j, device); |
|---|
| 865 |
// stop the stream |
|---|
| 866 |
// start the stream |
|---|
| 867 |
if (!device->stopStreamByIndex(j)) { |
|---|
| 868 |
debugWarning("Could not stop stream %d of device %p\n", j, device); |
|---|
| 869 |
result = false; |
|---|
| 870 |
continue; |
|---|
| 871 |
} |
|---|
| 872 |
} |
|---|
| 873 |
} |
|---|
| 874 |
return result; |
|---|
| 875 |
} |
|---|
| 876 |
|
|---|
| 877 |
enum DeviceManager::eWaitResult |
|---|
| 878 |
DeviceManager::waitForPeriod() { |
|---|
| 879 |
if(m_processorManager->waitForPeriod()) { |
|---|
| 880 |
return eWR_OK; |
|---|
| 881 |
} else { |
|---|
| 882 |
if(m_processorManager->shutdownNeeded()) { |
|---|
| 883 |
debugWarning("Shutdown requested\n"); |
|---|
| 884 |
return eWR_Shutdown; |
|---|
| 885 |
} else { |
|---|
| 886 |
debugWarning("XRUN detected\n"); |
|---|
| 887 |
// do xrun recovery |
|---|
| 888 |
if(m_processorManager->handleXrun()) { |
|---|
| 889 |
return eWR_Xrun; |
|---|
| 890 |
} else { |
|---|
| 891 |
debugError("Could not handle XRUN\n"); |
|---|
| 892 |
return eWR_Error; |
|---|
| 893 |
} |
|---|
| 894 |
} |
|---|
| 895 |
} |
|---|
| 896 |
} |
|---|
| 897 |
|
|---|
| 898 |
bool |
|---|
| 899 |
DeviceManager::setStreamingParams(unsigned int period, unsigned int rate, unsigned int nb_buffers) { |
|---|
| 900 |
m_processorManager->setPeriodSize(period); |
|---|
| 901 |
m_processorManager->setNominalRate(rate); |
|---|
| 902 |
m_processorManager->setNbBuffers(nb_buffers); |
|---|
| 903 |
return true; |
|---|
| 904 |
} |
|---|
| 905 |
|
|---|
| 906 |
FFADODevice* |
|---|
| 907 |
DeviceManager::getDriverForDeviceDo( ConfigRom *configRom, |
|---|
| 908 |
int id, bool generic ) |
|---|
| 909 |
{ |
|---|
| 910 |
#ifdef ENABLE_BEBOB |
|---|
| 911 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Trying BeBoB...\n" ); |
|---|
| 912 |
if ( BeBoB::AvDevice::probe( getConfiguration(), *configRom, generic ) ) { |
|---|
| 913 |
return BeBoB::AvDevice::createDevice( *this, std::auto_ptr<ConfigRom>( configRom ) ); |
|---|
| 914 |
} |
|---|
| 915 |
#endif |
|---|
| 916 |
|
|---|
| 917 |
#ifdef ENABLE_FIREWORKS |
|---|
| 918 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Trying ECHO Audio FireWorks...\n" ); |
|---|
| 919 |
if ( FireWorks::Device::probe( getConfiguration(), *configRom, generic ) ) { |
|---|
| 920 |
return FireWorks::Device::createDevice( *this, std::auto_ptr<ConfigRom>( configRom ) ); |
|---|
| 921 |
} |
|---|
| 922 |
#endif |
|---|
| 923 |
|
|---|
| 924 |
// we want to try the non-generic AV/C platforms before trying the generic ones |
|---|
| 925 |
#ifdef ENABLE_GENERICAVC |
|---|
| 926 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Trying Generic AV/C...\n" ); |
|---|
| 927 |
if ( GenericAVC::AvDevice::probe( getConfiguration(), *configRom, generic ) ) { |
|---|
| 928 |
return GenericAVC::AvDevice::createDevice( *this, std::auto_ptr<ConfigRom>( configRom ) ); |
|---|
| 929 |
} |
|---|
| 930 |
#endif |
|---|
| 931 |
|
|---|
| 932 |
#ifdef ENABLE_MOTU |
|---|
| 933 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Trying Motu...\n" ); |
|---|
| 934 |
if ( Motu::MotuDevice::probe( getConfiguration(), *configRom, generic ) ) { |
|---|
| 935 |
return Motu::MotuDevice::createDevice( *this, std::auto_ptr<ConfigRom>( configRom ) ); |
|---|
| 936 |
} |
|---|
| 937 |
#endif |
|---|
| 938 |
|
|---|
| 939 |
return NULL; |
|---|
| 940 |
} |
|---|
| 941 |
|
|---|
| 942 |
FFADODevice* |
|---|
| 943 |
DeviceManager::getDriverForDevice( ConfigRom *configRom, |
|---|
| 944 |
int id ) |
|---|
| 945 |
{ |
|---|
| 946 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Probing for supported device...\n" ); |
|---|
| 947 |
FFADODevice* dev = getDriverForDeviceDo(configRom, id, false); |
|---|
| 948 |
if(dev) { |
|---|
| 949 |
debugOutput( DEBUG_LEVEL_VERBOSE, " found supported device...\n" ); |
|---|
| 950 |
return dev; |
|---|
| 951 |
} |
|---|
| 952 |
|
|---|
| 953 |
debugOutput( DEBUG_LEVEL_VERBOSE, " no supported device found, trying generic support...\n" ); |
|---|
| 954 |
dev = getDriverForDeviceDo(configRom, id, true); |
|---|
| 955 |
if(dev) { |
|---|
| 956 |
debugOutput( DEBUG_LEVEL_VERBOSE, " found generic support for device...\n" ); |
|---|
| 957 |
return dev; |
|---|
| 958 |
} |
|---|
| 959 |
debugOutput( DEBUG_LEVEL_VERBOSE, " device not supported...\n" ); |
|---|
| 960 |
return 0; |
|---|
| 961 |
} |
|---|
| 962 |
|
|---|
| 963 |
FFADODevice* |
|---|
| 964 |
DeviceManager::getSlaveDriver( std::auto_ptr<ConfigRom>( configRom ) ) |
|---|
| 965 |
{ |
|---|
| 966 |
return 0; |
|---|
| 967 |
} |
|---|
| 968 |
|
|---|
| 969 |
bool |
|---|
| 970 |
DeviceManager::isValidNode(int node) |
|---|
| 971 |
{ |
|---|
| 972 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 973 |
it != m_avDevices.end(); |
|---|
| 974 |
++it ) |
|---|
| 975 |
{ |
|---|
| 976 |
FFADODevice* avDevice = *it; |
|---|
| 977 |
|
|---|
| 978 |
if (avDevice->getConfigRom().getNodeId() == node) { |
|---|
| 979 |
return true; |
|---|
| 980 |
} |
|---|
| 981 |
} |
|---|
| 982 |
return false; |
|---|
| 983 |
} |
|---|
| 984 |
|
|---|
| 985 |
int |
|---|
| 986 |
DeviceManager::getNbDevices() |
|---|
| 987 |
{ |
|---|
| 988 |
return m_avDevices.size(); |
|---|
| 989 |
} |
|---|
| 990 |
|
|---|
| 991 |
int |
|---|
| 992 |
DeviceManager::getDeviceNodeId( int deviceNr ) |
|---|
| 993 |
{ |
|---|
| 994 |
if ( ! ( deviceNr < getNbDevices() ) ) { |
|---|
| 995 |
debugError( "Device number out of range (%d)\n", deviceNr ); |
|---|
| 996 |
return -1; |
|---|
| 997 |
} |
|---|
| 998 |
|
|---|
| 999 |
FFADODevice* avDevice = m_avDevices.at( deviceNr ); |
|---|
| 1000 |
|
|---|
| 1001 |
if ( !avDevice ) { |
|---|
| 1002 |
debugError( "Could not get device at position (%d)\n", deviceNr ); |
|---|
| 1003 |
} |
|---|
| 1004 |
|
|---|
| 1005 |
return avDevice->getConfigRom().getNodeId(); |
|---|
| 1006 |
} |
|---|
| 1007 |
|
|---|
| 1008 |
FFADODevice* |
|---|
| 1009 |
DeviceManager::getAvDevice( int nodeId ) |
|---|
| 1010 |
{ |
|---|
| 1011 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 1012 |
it != m_avDevices.end(); |
|---|
| 1013 |
++it ) |
|---|
| 1014 |
{ |
|---|
| 1015 |
FFADODevice* avDevice = *it; |
|---|
| 1016 |
if ( avDevice->getConfigRom().getNodeId() == nodeId ) { |
|---|
| 1017 |
return avDevice; |
|---|
| 1018 |
} |
|---|
| 1019 |
} |
|---|
| 1020 |
|
|---|
| 1021 |
return 0; |
|---|
| 1022 |
} |
|---|
| 1023 |
|
|---|
| 1024 |
FFADODevice* |
|---|
| 1025 |
DeviceManager::getAvDeviceByIndex( int idx ) |
|---|
| 1026 |
{ |
|---|
| 1027 |
return m_avDevices.at(idx); |
|---|
| 1028 |
} |
|---|
| 1029 |
|
|---|
| 1030 |
unsigned int |
|---|
| 1031 |
DeviceManager::getAvDeviceCount( ) |
|---|
| 1032 |
{ |
|---|
| 1033 |
return m_avDevices.size(); |
|---|
| 1034 |
} |
|---|
| 1035 |
|
|---|
| 1036 |
/** |
|---|
| 1037 |
* Return the streamprocessor that is to be used as |
|---|
| 1038 |
* the sync source. |
|---|
| 1039 |
* |
|---|
| 1040 |
* Algorithm still to be determined |
|---|
| 1041 |
* |
|---|
| 1042 |
* @return StreamProcessor that is sync source |
|---|
| 1043 |
*/ |
|---|
| 1044 |
Streaming::StreamProcessor * |
|---|
| 1045 |
DeviceManager::getSyncSource() { |
|---|
| 1046 |
FFADODevice* device = getAvDeviceByIndex(0); |
|---|
| 1047 |
|
|---|
| 1048 |
bool slaveMode=false; |
|---|
| 1049 |
if(!getOption("slaveMode", slaveMode)) { |
|---|
| 1050 |
debugOutput(DEBUG_LEVEL_NORMAL, |
|---|
| 1051 |
"Could not retrieve slaveMode parameter, defauling to false\n"); |
|---|
| 1052 |
} |
|---|
| 1053 |
return device->getStreamProcessorByIndex(0); |
|---|
| 1054 |
} |
|---|
| 1055 |
|
|---|
| 1056 |
bool |
|---|
| 1057 |
DeviceManager::deinitialize() |
|---|
| 1058 |
{ |
|---|
| 1059 |
return true; |
|---|
| 1060 |
} |
|---|
| 1061 |
|
|---|
| 1062 |
void |
|---|
| 1063 |
DeviceManager::setVerboseLevel(int l) |
|---|
| 1064 |
{ |
|---|
| 1065 |
setDebugLevel(l); |
|---|
| 1066 |
Control::Element::setVerboseLevel(l); |
|---|
| 1067 |
m_processorManager->setVerboseLevel(l); |
|---|
| 1068 |
m_deviceStringParser->setVerboseLevel(l); |
|---|
| 1069 |
m_configuration->setVerboseLevel(l); |
|---|
| 1070 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 1071 |
it != m_avDevices.end(); |
|---|
| 1072 |
++it ) |
|---|
| 1073 |
{ |
|---|
| 1074 |
(*it)->setVerboseLevel(l); |
|---|
| 1075 |
} |
|---|
| 1076 |
for ( Ieee1394ServiceVectorIterator it = m_1394Services.begin(); |
|---|
| 1077 |
it != m_1394Services.end(); |
|---|
| 1078 |
++it ) |
|---|
| 1079 |
{ |
|---|
| 1080 |
(*it)->setVerboseLevel(l); |
|---|
| 1081 |
} |
|---|
| 1082 |
debugOutput( DEBUG_LEVEL_VERBOSE, "Setting verbose level to %d...\n", l ); |
|---|
| 1083 |
} |
|---|
| 1084 |
|
|---|
| 1085 |
void |
|---|
| 1086 |
DeviceManager::showDeviceInfo() { |
|---|
| 1087 |
debugOutput(DEBUG_LEVEL_NORMAL, "===== Device Manager =====\n"); |
|---|
| 1088 |
Control::Element::show(); |
|---|
| 1089 |
|
|---|
| 1090 |
int i=0; |
|---|
| 1091 |
for ( Ieee1394ServiceVectorIterator it = m_1394Services.begin(); |
|---|
| 1092 |
it != m_1394Services.end(); |
|---|
| 1093 |
++it ) |
|---|
| 1094 |
{ |
|---|
| 1095 |
debugOutput(DEBUG_LEVEL_NORMAL, "--- IEEE1394 Service %2d ---\n", i++); |
|---|
| 1096 |
(*it)->show(); |
|---|
| 1097 |
} |
|---|
| 1098 |
|
|---|
| 1099 |
i=0; |
|---|
| 1100 |
for ( FFADODeviceVectorIterator it = m_avDevices.begin(); |
|---|
| 1101 |
it != m_avDevices.end(); |
|---|
| 1102 |
++it ) |
|---|
| 1103 |
{ |
|---|
| 1104 |
FFADODevice* avDevice = *it; |
|---|
| 1105 |
debugOutput(DEBUG_LEVEL_NORMAL, "--- Device %2d ---\n", i++); |
|---|
| 1106 |
avDevice->showDevice(); |
|---|
| 1107 |
|
|---|
| 1108 |
debugOutput(DEBUG_LEVEL_NORMAL, "Clock sync sources:\n"); |
|---|
| 1109 |
FFADODevice::ClockSourceVector sources=avDevice->getSupportedClockSources(); |
|---|
| 1110 |
for ( FFADODevice::ClockSourceVector::const_iterator it |
|---|
| 1111 |
= sources.begin(); |
|---|
| 1112 |
it != sources.end(); |
|---|
| 1113 |
++it ) |
|---|
| 1114 |
{ |
|---|
| 1115 |
FFADODevice::ClockSource c=*it; |
|---|
| 1116 |
debugOutput(DEBUG_LEVEL_NORMAL, " Type: %s, Id: %2d, Valid: %1d, Active: %1d, Locked %1d, Slipping: %1d, Description: %s\n", |
|---|
| 1117 |
FFADODevice::ClockSourceTypeToString(c.type), c.id, c.valid, c.active, c.locked, c.slipping, c.description.c_str()); |
|---|
| 1118 |
} |
|---|
| 1119 |
} |
|---|
| 1120 |
} |
|---|
| 1121 |
void |
|---|
| 1122 |
DeviceManager::showStreamingInfo() { |
|---|
| 1123 |
m_processorManager->dumpInfo(); |
|---|
| 1124 |
} |
|---|