- IOReturn rval = kIOReturnError;
- OSCollectionIterator *iterator = NULL;
-
- if (reporters == NULL || channelList == NULL || result == NULL) {
- rval = kIOReturnBadArgument;
- goto finish;
- }
-
- switch (action) {
-
- case kIOReportGetDimensions:
- case kIOReportEnable:
- case kIOReportDisable:
- {
- OSObject * object;
- iterator = OSCollectionIterator::withCollection(reporters);
-
- while ((object = iterator->getNextObject())) {
-
- IOReporter *rep = OSDynamicCast(IOReporter, object);
-
- if (rep) {
- (void)rep->configureReport(channelList, action, result, destination);
- } else {
- rval = kIOReturnUnsupported; // kIOReturnNotFound?
- goto finish;
- }
- }
-
- break;
- }
-
- case kIOReportTraceOnChange:
- case kIOReportNotifyHubOnChange:
- default:
- rval = kIOReturnUnsupported;
- goto finish;
- }
-
- rval = kIOReturnSuccess;
-
+ IOReturn rval = kIOReturnError;
+ OSCollectionIterator *iterator = NULL;
+
+ if (reporters == NULL || channelList == NULL || result == NULL) {
+ rval = kIOReturnBadArgument;
+ goto finish;
+ }
+
+ switch (action) {
+ case kIOReportGetDimensions:
+ case kIOReportEnable:
+ case kIOReportDisable:
+ {
+ OSObject * object;
+ iterator = OSCollectionIterator::withCollection(reporters);
+
+ while ((object = iterator->getNextObject())) {
+ IOReporter *rep = OSDynamicCast(IOReporter, object);
+
+ if (rep) {
+ (void)rep->configureReport(channelList, action, result, destination);
+ } else {
+ rval = kIOReturnUnsupported; // kIOReturnNotFound?
+ goto finish;
+ }
+ }
+
+ break;
+ }
+
+ case kIOReportTraceOnChange:
+ case kIOReportNotifyHubOnChange:
+ default:
+ rval = kIOReturnUnsupported;
+ goto finish;
+ }
+
+ rval = kIOReturnSuccess;
+
- IOReturn rval = kIOReturnError;
- OSCollectionIterator *iterator = NULL;
-
- if (reporters == NULL ||
- channelList == NULL ||
- result == NULL ||
- destination == NULL) {
- rval = kIOReturnBadArgument;
- goto finish;
- }
-
- switch (action) {
-
- case kIOReportCopyChannelData:
- {
- OSObject * object;
- iterator = OSCollectionIterator::withCollection(reporters);
-
- while ((object = iterator->getNextObject())) {
-
- IOReporter *rep = OSDynamicCast(IOReporter, object);
-
- if (rep) {
- (void)rep->updateReport(channelList, action, result, destination);
- } else {
- rval = kIOReturnUnsupported; // kIOReturnNotFound?
- goto finish;
- }
- }
-
- break;
- }
-
- case kIOReportTraceChannelData:
- default:
- rval = kIOReturnUnsupported;
- goto finish;
- }
-
- rval = kIOReturnSuccess;
+ IOReturn rval = kIOReturnError;
+ OSCollectionIterator *iterator = NULL;
+
+ if (reporters == NULL ||
+ channelList == NULL ||
+ result == NULL ||
+ destination == NULL) {
+ rval = kIOReturnBadArgument;
+ goto finish;
+ }
+
+ switch (action) {
+ case kIOReportCopyChannelData:
+ {
+ OSObject * object;
+ iterator = OSCollectionIterator::withCollection(reporters);
+
+ while ((object = iterator->getNextObject())) {
+ IOReporter *rep = OSDynamicCast(IOReporter, object);
+
+ if (rep) {
+ (void)rep->updateReport(channelList, action, result, destination);
+ } else {
+ rval = kIOReturnUnsupported; // kIOReturnNotFound?
+ goto finish;
+ }
+ }
+
+ break;
+ }
+
+ case kIOReportTraceChannelData:
+ default:
+ rval = kIOReturnUnsupported;
+ goto finish;
+ }
+
+ rval = kIOReturnSuccess;
- bool success = false;
-
- // ::free() relies on these being initialized
- _reporterLock = NULL;
- _configLock = NULL;
- _elements = NULL;
- _enableCounts = NULL;
- _channelNames = NULL;
-
- if (channelType.report_format == kIOReportInvalidFormat) {
- IORLOG("init ERROR: Channel Type ill-defined");
- goto finish;
- }
-
- _driver_id = reportingService->getRegistryEntryID();
- if (_driver_id == 0) {
- IORLOG("init() ERROR: no registry ID");
- goto finish;
- }
-
- if (!super::init()) return false;
-
- _channelDimension = channelType.nelements;
- _channelType = channelType;
- // FIXME: need to look up dynamically
- if (unit == kIOReportUnitHWTicks) {
-#if defined(__i386__) || defined(__x86_64__)
- // Most, but not all Macs use 1GHz
- unit = kIOReportUnit1GHzTicks;
+ bool success = false;
+
+ // ::free() relies on these being initialized
+ _reporterLock = NULL;
+ _configLock = NULL;
+ _elements = NULL;
+ _enableCounts = NULL;
+ _channelNames = NULL;
+
+ if (channelType.report_format == kIOReportInvalidFormat) {
+ IORLOG("init ERROR: Channel Type ill-defined");
+ goto finish;
+ }
+
+ _driver_id = reportingService->getRegistryEntryID();
+ if (_driver_id == 0) {
+ IORLOG("init() ERROR: no registry ID");
+ goto finish;
+ }
+
+ if (!super::init()) {
+ return false;
+ }
+
+ _channelDimension = channelType.nelements;
+ _channelType = channelType;
+ // FIXME: need to look up dynamically
+ if (unit == kIOReportUnitHWTicks) {
+#if defined(__arm__) || defined(__arm64__)
+ unit = kIOReportUnit24MHzTicks;
+#elif defined(__i386__) || defined(__x86_64__)
+ // Most, but not all Macs use 1GHz
+ unit = kIOReportUnit1GHzTicks;
- }
- _unit = unit;
-
- // Allocate a reporter (data) lock
- _reporterLock = IOSimpleLockAlloc();
- if (!_reporterLock) goto finish;
- _reporterIsLocked = false;
-
- // Allocate a config lock
- _configLock = IOLockAlloc();
- if (!_configLock) goto finish;
- _reporterConfigIsLocked = false;
-
- // Allocate channel names array
- _channelNames = OSArray::withCapacity(1);
- if (!_channelNames) goto finish;
-
- // success
- success = true;
+ }
+ _unit = unit;
+
+ // Allocate a reporter (data) lock
+ _reporterLock = IOSimpleLockAlloc();
+ if (!_reporterLock) {
+ goto finish;
+ }
+ _reporterIsLocked = false;
+
+ // Allocate a config lock
+ _configLock = IOLockAlloc();
+ if (!_configLock) {
+ goto finish;
+ }
+ _reporterConfigIsLocked = false;
+
+ // Allocate channel names array
+ _channelNames = OSArray::withCapacity(1);
+ if (!_channelNames) {
+ goto finish;
+ }
+
+ // success
+ success = true;
-{
- if (_configLock) IOLockFree(_configLock);
- if (_reporterLock) IOSimpleLockFree(_reporterLock);
-
- if (_elements) {
- PREFL_MEMOP_PANIC(_nElements, IOReportElement);
- IOFree(_elements, (size_t)_nElements * sizeof(IOReportElement));
- }
- if (_enableCounts) {
- PREFL_MEMOP_PANIC(_nChannels, int);
- IOFree(_enableCounts, (size_t)_nChannels * sizeof(int));
- }
-
- super::free();
+{
+ OSSafeReleaseNULL(_channelNames);
+
+ if (_configLock) {
+ IOLockFree(_configLock);
+ }
+ if (_reporterLock) {
+ IOSimpleLockFree(_reporterLock);
+ }
+
+ if (_elements) {
+ PREFL_MEMOP_PANIC(_nElements, IOReportElement);
+ IOFree(_elements, (size_t)_nElements * sizeof(IOReportElement));
+ }
+ if (_enableCounts) {
+ PREFL_MEMOP_PANIC(_nChannels, int);
+ IOFree(_enableCounts, (size_t)_nChannels * sizeof(int));
+ }
+
+ super::free();
- IOReturn res = kIOReturnError, kerr;
- const OSSymbol *symChannelName = NULL;
- int oldNChannels, newNChannels = 0, freeNChannels = 0;
-
- IORLOG("IOReporter::addChannel %llx", channelID);
-
- // protect instance variables (but not contents)
- lockReporterConfig();
-
- // FIXME: Check if any channel is already present and return error
-
- // addChannel() always adds one channel
- oldNChannels = _nChannels;
- if (oldNChannels < 0 || oldNChannels > INT_MAX - 1) {
- res = kIOReturnOverrun;
- goto finish;
- }
- newNChannels = oldNChannels + 1;
- freeNChannels = newNChannels; // until swap success
-
- // Expand addChannel()-specific data structure
- if (_channelNames->ensureCapacity((unsigned)newNChannels) <
- (unsigned)newNChannels) {
- res = kIOReturnNoMemory; goto finish;
- }
- if (channelName) {
- symChannelName = OSSymbol::withCString(channelName);
- if (!symChannelName) {
- res = kIOReturnNoMemory; goto finish;
- }
- } else {
- // grab a reference to our shared global
- symChannelName = gIOReportNoChannelName;
- symChannelName->retain();
- }
-
- // allocate new buffers into _swap* variables
- if ((kerr = handleSwapPrepare(newNChannels))) {
- // on error, channels are *not* swapped
- res = kerr; goto finish;
- }
-
- // exchange main and _swap* buffers with buffer contents protected
- // IOReporter::handleAddChannelSwap() also increments _nElements, etc
- lockReporter();
- res = handleAddChannelSwap(channelID, symChannelName);
- unlockReporter();
- // On failure, handleAddChannelSwap() leaves *new* buffers in _swap*.
- // On success, it's the old buffers, so we put the right size in here.
- if (res == kIOReturnSuccess) {
- freeNChannels = oldNChannels;
- }
+ IOReturn res = kIOReturnError, kerr;
+ const OSSymbol *symChannelName = NULL;
+ int oldNChannels, newNChannels = 0, freeNChannels = 0;
+
+ IORLOG("IOReporter::addChannel %llx", channelID);
+
+ // protect instance variables (but not contents)
+ lockReporterConfig();
+
+ // FIXME: Check if any channel is already present and return error
+
+ // addChannel() always adds one channel
+ oldNChannels = _nChannels;
+ if (oldNChannels < 0 || oldNChannels > INT_MAX - 1) {
+ res = kIOReturnOverrun;
+ goto finish;
+ }
+ newNChannels = oldNChannels + 1;
+ freeNChannels = newNChannels; // until swap success
+
+ // Expand addChannel()-specific data structure
+ if (_channelNames->ensureCapacity((unsigned)newNChannels) <
+ (unsigned)newNChannels) {
+ res = kIOReturnNoMemory; goto finish;
+ }
+ if (channelName) {
+ symChannelName = OSSymbol::withCString(channelName);
+ if (!symChannelName) {
+ res = kIOReturnNoMemory; goto finish;
+ }
+ } else {
+ // grab a reference to our shared global
+ symChannelName = gIOReportNoChannelName;
+ symChannelName->retain();
+ }
+
+ // allocate new buffers into _swap* variables
+ if ((kerr = handleSwapPrepare(newNChannels))) {
+ // on error, channels are *not* swapped
+ res = kerr; goto finish;
+ }
+
+ // exchange main and _swap* buffers with buffer contents protected
+ // IOReporter::handleAddChannelSwap() also increments _nElements, etc
+ lockReporter();
+ res = handleAddChannelSwap(channelID, symChannelName);
+ unlockReporter();
+ // On failure, handleAddChannelSwap() leaves *new* buffers in _swap*.
+ // On success, it's the old buffers, so we put the right size in here.
+ if (res == kIOReturnSuccess) {
+ freeNChannels = oldNChannels;
+ }
- IOReturn res = kIOReturnError;
- int newNElements;
- size_t newElementsSize, newECSize;
-
- // analyzer appeasement
- newElementsSize = newECSize = 0;
-
- //IORLOG("IOReporter::handleSwapPrepare");
-
- IOREPORTER_CHECK_CONFIG_LOCK();
-
- if (newNChannels < _nChannels) {
- panic("%s doesn't support shrinking", __func__);
- }
- if (newNChannels <= 0 || _channelDimension <= 0) {
- res = kIOReturnUnderrun;
- goto finish;
- }
- if (_swapElements || _swapEnableCounts) {
- panic("IOReporter::_swap* already in use");
- }
-
- // calculate the number of elements given #ch & the dimension of each
- if (newNChannels < 0 || newNChannels > INT_MAX / _channelDimension) {
- res = kIOReturnOverrun;
- goto finish;
- }
- newNElements = newNChannels * _channelDimension;
-
- // Allocate memory for the new array of report elements
- PREFL_MEMOP_FAIL(newNElements, IOReportElement);
- newElementsSize = (size_t)newNElements * sizeof(IOReportElement);
- _swapElements = (IOReportElement *)IOMalloc(newElementsSize);
- if (_swapElements == NULL) {
- res = kIOReturnNoMemory; goto finish;
- }
- memset(_swapElements, 0, newElementsSize);
-
- // Allocate memory for the new array of channel watch counts
- PREFL_MEMOP_FAIL(newNChannels, int);
- newECSize = (size_t)newNChannels * sizeof(int);
- _swapEnableCounts = (int *)IOMalloc(newECSize);
- if (_swapEnableCounts == NULL){
- res = kIOReturnNoMemory; goto finish;
- }
- memset(_swapEnableCounts, 0, newECSize);
-
- // success
- res = kIOReturnSuccess;
+ IOReturn res = kIOReturnError;
+ int newNElements;
+ size_t newElementsSize, newECSize;
+
+ // analyzer appeasement
+ newElementsSize = newECSize = 0;
+
+ //IORLOG("IOReporter::handleSwapPrepare");
+
+ IOREPORTER_CHECK_CONFIG_LOCK();
+
+ if (newNChannels < _nChannels) {
+ panic("%s doesn't support shrinking", __func__);
+ }
+ if (newNChannels <= 0 || _channelDimension <= 0) {
+ res = kIOReturnUnderrun;
+ goto finish;
+ }
+ if (_swapElements || _swapEnableCounts) {
+ panic("IOReporter::_swap* already in use");
+ }
+
+ // calculate the number of elements given #ch & the dimension of each
+ if (newNChannels < 0 || newNChannels > INT_MAX / _channelDimension) {
+ res = kIOReturnOverrun;
+ goto finish;
+ }
+ newNElements = newNChannels * _channelDimension;
+
+ // Allocate memory for the new array of report elements
+ PREFL_MEMOP_FAIL(newNElements, IOReportElement);
+ newElementsSize = (size_t)newNElements * sizeof(IOReportElement);
+ _swapElements = (IOReportElement *)IOMalloc(newElementsSize);
+ if (_swapElements == NULL) {
+ res = kIOReturnNoMemory; goto finish;
+ }
+ memset(_swapElements, 0, newElementsSize);
+
+ // Allocate memory for the new array of channel watch counts
+ PREFL_MEMOP_FAIL(newNChannels, int);
+ newECSize = (size_t)newNChannels * sizeof(int);
+ _swapEnableCounts = (int *)IOMalloc(newECSize);
+ if (_swapEnableCounts == NULL) {
+ res = kIOReturnNoMemory; goto finish;
+ }
+ memset(_swapEnableCounts, 0, newECSize);
+
+ // success
+ res = kIOReturnSuccess;
- IOReturn res = kIOReturnError;
- int cnt;
- int *tmpWatchCounts = NULL;
- IOReportElement *tmpElements = NULL;
- bool swapComplete = false;
-
- //IORLOG("IOReporter::handleSwap");
-
- IOREPORTER_CHECK_CONFIG_LOCK();
- IOREPORTER_CHECK_LOCK();
-
- if (!_swapElements || !_swapEnableCounts) {
- IORLOG("IOReporter::handleSwap ERROR swap variables uninitialized!");
- goto finish;
- }
-
- // Copy any existing elements to the new location
- //IORLOG("handleSwap (base) -> copying %u elements over...", _nChannels);
- if (_elements) {
- PREFL_MEMOP_PANIC(_nElements, IOReportElement);
- memcpy(_swapElements, _elements,
- (size_t)_nElements * sizeof(IOReportElement));
-
- PREFL_MEMOP_PANIC(_nElements, int);
- memcpy(_swapEnableCounts, _enableCounts,
- (size_t)_nChannels * sizeof(int));
- }
-
- // Update principal instance variables, keep old buffers for cleanup
- tmpElements = _elements;
- _elements = _swapElements;
- _swapElements = tmpElements;
-
- tmpWatchCounts = _enableCounts;
- _enableCounts = _swapEnableCounts;
- _swapEnableCounts = tmpWatchCounts;
-
- swapComplete = true;
-
- // but _nChannels & _nElements is still the old (one smaller) size
-
- // Initialize new element metadata (existing elements copied above)
- for (cnt = 0; cnt < _channelDimension; cnt++) {
-
- _elements[_nElements + cnt].channel_id = channel_id;
- _elements[_nElements + cnt].provider_id = _driver_id;
- _elements[_nElements + cnt].channel_type = _channelType;
- _elements[_nElements + cnt].channel_type.element_idx = cnt;
-
- //IOREPORTER_DEBUG_ELEMENT(_swapNElements + cnt);
- }
-
- // Store a channel name at the end
- if (!_channelNames->setObject((unsigned)_nChannels, symChannelName)) {
- // Should never happen because we ensured capacity in addChannel()
- res = kIOReturnNoMemory;
- goto finish;
- }
-
- // And update the metadata: addChannel() always adds just one channel
- _nChannels += 1;
- _nElements += _channelDimension;
-
- // success
- res = kIOReturnSuccess;
+ IOReturn res = kIOReturnError;
+ int cnt;
+ int *tmpWatchCounts = NULL;
+ IOReportElement *tmpElements = NULL;
+ bool swapComplete = false;
+
+ //IORLOG("IOReporter::handleSwap");
+
+ IOREPORTER_CHECK_CONFIG_LOCK();
+ IOREPORTER_CHECK_LOCK();
+
+ if (!_swapElements || !_swapEnableCounts) {
+ IORLOG("IOReporter::handleSwap ERROR swap variables uninitialized!");
+ goto finish;
+ }
+
+ // Copy any existing elements to the new location
+ //IORLOG("handleSwap (base) -> copying %u elements over...", _nChannels);
+ if (_elements) {
+ PREFL_MEMOP_PANIC(_nElements, IOReportElement);
+ memcpy(_swapElements, _elements,
+ (size_t)_nElements * sizeof(IOReportElement));
+
+ PREFL_MEMOP_PANIC(_nElements, int);
+ memcpy(_swapEnableCounts, _enableCounts,
+ (size_t)_nChannels * sizeof(int));
+ }
+
+ // Update principal instance variables, keep old buffers for cleanup
+ tmpElements = _elements;
+ _elements = _swapElements;
+ _swapElements = tmpElements;
+
+ tmpWatchCounts = _enableCounts;
+ _enableCounts = _swapEnableCounts;
+ _swapEnableCounts = tmpWatchCounts;
+
+ swapComplete = true;
+
+ // but _nChannels & _nElements is still the old (one smaller) size
+
+ // Initialize new element metadata (existing elements copied above)
+ for (cnt = 0; cnt < _channelDimension; cnt++) {
+ _elements[_nElements + cnt].channel_id = channel_id;
+ _elements[_nElements + cnt].provider_id = _driver_id;
+ _elements[_nElements + cnt].channel_type = _channelType;
+ _elements[_nElements + cnt].channel_type.element_idx = cnt;
+
+ //IOREPORTER_DEBUG_ELEMENT(_swapNElements + cnt);
+ }
+
+ // Store a channel name at the end
+ if (!_channelNames->setObject((unsigned)_nChannels, symChannelName)) {
+ // Should never happen because we ensured capacity in addChannel()
+ res = kIOReturnNoMemory;
+ goto finish;
+ }
+
+ // And update the metadata: addChannel() always adds just one channel
+ _nChannels += 1;
+ _nElements += _channelDimension;
+
+ // success
+ res = kIOReturnSuccess;
- if (res && swapComplete) {
- // unswap so new buffers get cleaned up instead of old
- tmpElements = _elements;
- _elements = _swapElements;
- _swapElements = tmpElements;
-
- tmpWatchCounts = _enableCounts;
- _enableCounts = _swapEnableCounts;
- _swapEnableCounts = tmpWatchCounts;
- }
- return res;
+ if (res && swapComplete) {
+ // unswap so new buffers get cleaned up instead of old
+ tmpElements = _elements;
+ _elements = _swapElements;
+ _swapElements = tmpElements;
+
+ tmpWatchCounts = _enableCounts;
+ _enableCounts = _swapEnableCounts;
+ _swapEnableCounts = tmpWatchCounts;
+ }
+ return res;
- int swapNElements;
-
- if (!_channelDimension || swapNChannels > INT_MAX / _channelDimension) {
- panic("%s - can't free %d channels of dimension %d", __func__,
- swapNChannels, _channelDimension);
- }
- swapNElements = swapNChannels * _channelDimension;
-
- IOREPORTER_CHECK_CONFIG_LOCK();
-
- // release buffers no longer used after swapping
- if (_swapElements) {
- PREFL_MEMOP_PANIC(swapNElements, IOReportElement);
- IOFree(_swapElements, (size_t)swapNElements * sizeof(IOReportElement));
- _swapElements = NULL;
- }
- if (_swapEnableCounts) {
- PREFL_MEMOP_PANIC(swapNChannels, int);
- IOFree(_swapEnableCounts, (size_t)swapNChannels * sizeof(int));
- _swapEnableCounts = NULL;
- }
+ int swapNElements;
+
+ if (!_channelDimension || swapNChannels > INT_MAX / _channelDimension) {
+ panic("%s - can't free %d channels of dimension %d", __func__,
+ swapNChannels, _channelDimension);
+ }
+ swapNElements = swapNChannels * _channelDimension;
+
+ IOREPORTER_CHECK_CONFIG_LOCK();
+
+ // release buffers no longer used after swapping
+ if (_swapElements) {
+ PREFL_MEMOP_PANIC(swapNElements, IOReportElement);
+ IOFree(_swapElements, (size_t)swapNElements * sizeof(IOReportElement));
+ _swapElements = NULL;
+ }
+ if (_swapEnableCounts) {
+ PREFL_MEMOP_PANIC(swapNChannels, int);
+ IOFree(_swapEnableCounts, (size_t)swapNChannels * sizeof(int));
+ _swapEnableCounts = NULL;
+ }
- IOReturn res = kIOReturnError;
- int channel_index = 0;
- uint32_t chIdx;
- int *nElements, *nChannels;
-
- // Check on channelList and result because used below
- if (!channelList || !result) goto finish;
-
- //IORLOG("IOReporter::configureReport action %u for %u channels",
- // action, channelList->nchannels);
-
- // Make sure channel is present, increase matching watch count, 'result'
- for (chIdx = 0; chIdx < channelList->nchannels; chIdx++) {
-
- if (getChannelIndex(channelList->channels[chIdx].channel_id,
- &channel_index) == kIOReturnSuccess) {
- // IORLOG("reporter %p recognizes channel %lld", this, channelList->channels[chIdx].channel_id);
-
- switch (action) {
-
- case kIOReportEnable:
- nChannels = (int*)result;
- _enabled++;
- _enableCounts[channel_index]++;
- (*nChannels)++;
- break;
-
- case kIOReportDisable:
- nChannels = (int*)result;
- _enabled--;
- _enableCounts[channel_index]--;
- (*nChannels)++;
- break;
-
- case kIOReportGetDimensions:
- nElements = (int *)result;
- *nElements += _channelDimension;
- break;
-
- default:
- IORLOG("ERROR configureReport unknown action!");
- break;
- }
- }
- }
-
- // success
- res = kIOReturnSuccess;
-
+ IOReturn res = kIOReturnError;
+ int channel_index = 0;
+ uint32_t chIdx;
+ int *nElements, *nChannels;
+
+ // Check on channelList and result because used below
+ if (!channelList || !result) {
+ goto finish;
+ }
+
+ //IORLOG("IOReporter::configureReport action %u for %u channels",
+ // action, channelList->nchannels);
+
+ // Make sure channel is present, increase matching watch count, 'result'
+ for (chIdx = 0; chIdx < channelList->nchannels; chIdx++) {
+ if (getChannelIndex(channelList->channels[chIdx].channel_id,
+ &channel_index) == kIOReturnSuccess) {
+ // IORLOG("reporter %p recognizes channel %lld", this, channelList->channels[chIdx].channel_id);
+
+ switch (action) {
+ case kIOReportEnable:
+ nChannels = (int*)result;
+ _enabled++;
+ _enableCounts[channel_index]++;
+ (*nChannels)++;
+ break;
+
+ case kIOReportDisable:
+ nChannels = (int*)result;
+ _enabled--;
+ _enableCounts[channel_index]--;
+ (*nChannels)++;
+ break;
+
+ case kIOReportGetDimensions:
+ nElements = (int *)result;
+ *nElements += _channelDimension;
+ break;
+
+ default:
+ IORLOG("ERROR configureReport unknown action!");
+ break;
+ }
+ }
+ }
+
+ // success
+ res = kIOReturnSuccess;
+
- IOReturn res = kIOReturnError;
- int *nElements = (int *)result;
- int channel_index = 0;
- uint32_t chIdx;
- IOBufferMemoryDescriptor *dest;
-
- if (!channelList || !result || !destination) goto finish;
-
- dest = OSDynamicCast(IOBufferMemoryDescriptor, (OSObject *)destination);
- if (dest == NULL) {
- // Invalid destination
- res = kIOReturnBadArgument;
- goto finish;
- }
-
- if (!_enabled) {
- goto finish;
- }
-
- for (chIdx = 0; chIdx < channelList->nchannels; chIdx++) {
-
- if (getChannelIndex(channelList->channels[chIdx].channel_id,
- &channel_index) == kIOReturnSuccess) {
-
- //IORLOG("%s - found channel_id %llx @ index %d", __func__,
- // channelList->channels[chIdx].channel_id,
- // channel_index);
-
- switch(action) {
-
- case kIOReportCopyChannelData:
- res = updateChannelValues(channel_index);
- if (res) {
- IORLOG("ERROR: updateChannelValues() failed: %x", res);
- goto finish;
- }
-
- res = updateReportChannel(channel_index, nElements, dest);
- if (res) {
- IORLOG("ERROR: updateReportChannel() failed: %x", res);
- goto finish;
- }
- break;
-
- default:
- IORLOG("ERROR updateReport unknown action!");
- res = kIOReturnError;
- goto finish;
- }
- }
- }
-
- // success
- res = kIOReturnSuccess;
-
+ IOReturn res = kIOReturnError;
+ int *nElements = (int *)result;
+ int channel_index = 0;
+ uint32_t chIdx;
+ IOBufferMemoryDescriptor *dest;
+
+ if (!channelList || !result || !destination) {
+ goto finish;
+ }
+
+ dest = OSDynamicCast(IOBufferMemoryDescriptor, (OSObject *)destination);
+ if (dest == NULL) {
+ // Invalid destination
+ res = kIOReturnBadArgument;
+ goto finish;
+ }
+
+ if (!_enabled) {
+ goto finish;
+ }
+
+ for (chIdx = 0; chIdx < channelList->nchannels; chIdx++) {
+ if (getChannelIndex(channelList->channels[chIdx].channel_id,
+ &channel_index) == kIOReturnSuccess) {
+ //IORLOG("%s - found channel_id %llx @ index %d", __func__,
+ // channelList->channels[chIdx].channel_id,
+ // channel_index);
+
+ switch (action) {
+ case kIOReportCopyChannelData:
+ res = updateChannelValues(channel_index);
+ if (res) {
+ IORLOG("ERROR: updateChannelValues() failed: %x", res);
+ goto finish;
+ }
+
+ res = updateReportChannel(channel_index, nElements, dest);
+ if (res) {
+ IORLOG("ERROR: updateReportChannel() failed: %x", res);
+ goto finish;
+ }
+ break;
+
+ default:
+ IORLOG("ERROR updateReport unknown action!");
+ res = kIOReturnError;
+ goto finish;
+ }
+ }
+ }
+
+ // success
+ res = kIOReturnSuccess;
+
- IOReturn res = kIOReturnError;
-
- IOREPORTER_CHECK_LOCK();
-
- if (record_time == 0) {
- record_time = mach_absolute_time();
- }
-
- if (element_index >= _nElements || values == NULL) {
- res = kIOReturnBadArgument;
- goto finish;
- }
-
- memcpy(&_elements[element_index].values, values, sizeof(IOReportElementValues));
-
- _elements[element_index].timestamp = record_time;
-
- //IOREPORTER_DEBUG_ELEMENT(index);
-
- res = kIOReturnSuccess;
-
+ IOReturn res = kIOReturnError;
+
+ IOREPORTER_CHECK_LOCK();
+
+ if (record_time == 0) {
+ record_time = mach_absolute_time();
+ }
+
+ if (element_index >= _nElements || values == NULL) {
+ res = kIOReturnBadArgument;
+ goto finish;
+ }
+
+ memcpy(&_elements[element_index].values, values, sizeof(IOReportElementValues));
+
+ _elements[element_index].timestamp = record_time;
+
+ //IOREPORTER_DEBUG_ELEMENT(index);
+
+ res = kIOReturnSuccess;
+
- IOReturn res = kIOReturnError;
- int start_element_idx, chElems;
- size_t size2cpy;
-
- res = kIOReturnBadArgument;
- if (!nElements || !destination) {
- goto finish;
- }
- if (channel_index > _nChannels) {
- goto finish;
- }
-
- IOREPORTER_CHECK_LOCK();
-
- res = kIOReturnOverrun;
-
- start_element_idx = channel_index * _channelDimension;
- if (start_element_idx >= _nElements) goto finish;
-
- chElems = _elements[start_element_idx].channel_type.nelements;
-
- // make sure we don't go beyond the end of _elements[_nElements-1]
- if (start_element_idx + chElems > _nElements) {
- goto finish;
- }
-
- PREFL_MEMOP_FAIL(chElems, IOReportElement);
- size2cpy = (size_t)chElems * sizeof(IOReportElement);
-
- // make sure there's space in the destination
- if (size2cpy > (destination->getCapacity() - destination->getLength())) {
- IORLOG("CRITICAL ERROR: Report Buffer Overflow (buffer cap %luB, length %luB, size2cpy %luB",
- (unsigned long)destination->getCapacity(),
- (unsigned long)destination->getLength(),
- (unsigned long)size2cpy);
- goto finish;
- }
-
- destination->appendBytes(&_elements[start_element_idx], size2cpy);
- *nElements += chElems;
-
- res = kIOReturnSuccess;
-
+ IOReturn res = kIOReturnError;
+ int start_element_idx, chElems;
+ size_t size2cpy;
+
+ res = kIOReturnBadArgument;
+ if (!nElements || !destination) {
+ goto finish;
+ }
+ if (channel_index > _nChannels) {
+ goto finish;
+ }
+
+ IOREPORTER_CHECK_LOCK();
+
+ res = kIOReturnOverrun;
+
+ start_element_idx = channel_index * _channelDimension;
+ if (start_element_idx >= _nElements) {
+ goto finish;
+ }
+
+ chElems = _elements[start_element_idx].channel_type.nelements;
+
+ // make sure we don't go beyond the end of _elements[_nElements-1]
+ if (start_element_idx + chElems > _nElements) {
+ goto finish;
+ }
+
+ PREFL_MEMOP_FAIL(chElems, IOReportElement);
+ size2cpy = (size_t)chElems * sizeof(IOReportElement);
+
+ // make sure there's space in the destination
+ if (size2cpy > (destination->getCapacity() - destination->getLength())) {
+ IORLOG("CRITICAL ERROR: Report Buffer Overflow (buffer cap %luB, length %luB, size2cpy %luB",
+ (unsigned long)destination->getCapacity(),
+ (unsigned long)destination->getLength(),
+ (unsigned long)size2cpy);
+ goto finish;
+ }
+
+ destination->appendBytes(&_elements[start_element_idx], size2cpy);
+ *nElements += chElems;
+
+ res = kIOReturnSuccess;
+
- IOReturn res = kIOReturnError;
-
- if (!elementValues) goto finish;
-
- IOREPORTER_CHECK_LOCK();
-
- if (element_index >= _nElements) {
- IORLOG("ERROR getElementValues out of bounds!");
- res = kIOReturnBadArgument;
- goto finish;
- }
-
- memcpy(elementValues, &_elements[element_index].values, sizeof(IOReportElementValues));
- res = kIOReturnSuccess;
+ IOReturn res = kIOReturnError;
+
+ if (!elementValues) {
+ goto finish;
+ }
+
+ IOREPORTER_CHECK_LOCK();
+
+ if (element_index >= _nElements) {
+ IORLOG("ERROR getElementValues out of bounds!");
+ res = kIOReturnBadArgument;
+ goto finish;
+ }
+
+ memcpy(elementValues, &_elements[element_index].values, sizeof(IOReportElementValues));
+ res = kIOReturnSuccess;
- IOReturn res = kIOReturnNotFound;
- int chIdx, elemIdx;
-
- if (!channel_index || !element_index) goto finish;
-
- for (chIdx = 0; chIdx < _nChannels; chIdx++) {
-
- elemIdx = chIdx * _channelDimension;
- if (elemIdx >= _nElements) {
- IORLOG("ERROR getChannelIndices out of bounds!");
- res = kIOReturnOverrun;
- goto finish;
- }
-
- if (channel_id == _elements[elemIdx].channel_id) {
-
- // The channel index does not care about the depth of elements...
- *channel_index = chIdx;
- *element_index = elemIdx;
-
- res = kIOReturnSuccess;
- goto finish;
- }
- }
+ IOReturn res = kIOReturnNotFound;
+ int chIdx, elemIdx;
+
+ if (!channel_index || !element_index) {
+ goto finish;
+ }
+
+ for (chIdx = 0; chIdx < _nChannels; chIdx++) {
+ elemIdx = chIdx * _channelDimension;
+ if (elemIdx >= _nElements) {
+ IORLOG("ERROR getChannelIndices out of bounds!");
+ res = kIOReturnOverrun;
+ goto finish;
+ }
+
+ if (channel_id == _elements[elemIdx].channel_id) {
+ // The channel index does not care about the depth of elements...
+ *channel_index = chIdx;
+ *element_index = elemIdx;
+
+ res = kIOReturnSuccess;
+ goto finish;
+ }
+ }
- int cnt, cnt2;
- OSArray *channelIDs = NULL;
- OSNumber *tmpNum;
-
- channelIDs = OSArray::withCapacity((unsigned)_nChannels);
-
- if (!channelIDs) goto finish;
-
- for (cnt = 0; cnt < _nChannels; cnt++) {
-
- cnt2 = cnt * _channelDimension;
-
- // Encapsulate the Channel ID in OSNumber
- tmpNum = OSNumber::withNumber(_elements[cnt2].channel_id, 64);
- if (!tmpNum) {
- IORLOG("ERROR: Could not create array of channelIDs");
- channelIDs->release();
- channelIDs = NULL;
- goto finish;
- }
-
- channelIDs->setObject((unsigned)cnt, tmpNum);
- tmpNum->release();
- }
+ int cnt, cnt2;
+ OSArray *channelIDs = NULL;
+ OSNumber *tmpNum;
+
+ channelIDs = OSArray::withCapacity((unsigned)_nChannels);
+
+ if (!channelIDs) {
+ goto finish;
+ }
+
+ for (cnt = 0; cnt < _nChannels; cnt++) {
+ cnt2 = cnt * _channelDimension;
+
+ // Encapsulate the Channel ID in OSNumber
+ tmpNum = OSNumber::withNumber(_elements[cnt2].channel_id, 64);
+ if (!tmpNum) {
+ IORLOG("ERROR: Could not create array of channelIDs");
+ channelIDs->release();
+ channelIDs = NULL;
+ goto finish;
+ }
+
+ channelIDs->setObject((unsigned)cnt, tmpNum);
+ tmpNum->release();
+ }
- unsigned int cnt, chCnt;
- uint64_t type64;
- OSNumber *tmpNum;
- const OSSymbol *tmpSymbol;
- OSArray *channelLegendArray = NULL, *tmpChannelArray = NULL;
- OSDictionary *channelInfoDict = NULL;
- IOReportLegendEntry *legendEntry = NULL;
-
- // No need to check validity of channelNames because param is optional
- if (!channelIDs) goto finish;
- chCnt = channelIDs->getCount();
-
- channelLegendArray = OSArray::withCapacity(chCnt);
-
- for (cnt = 0; cnt < chCnt; cnt++) {
-
- tmpChannelArray = OSArray::withCapacity(3);
-
- // Encapsulate the Channel ID in OSNumber
- tmpChannelArray->setObject(kIOReportChannelIDIdx, channelIDs->getObject(cnt));
-
- // Encapsulate the Channel Type in OSNumber
- memcpy(&type64, &channelType, sizeof(type64));
- tmpNum = OSNumber::withNumber(type64, 64);
- if (!tmpNum) {
- goto finish;
- }
- tmpChannelArray->setObject(kIOReportChannelTypeIdx, tmpNum);
- tmpNum->release();
-
- // Encapsulate the Channel Name in OSSymbol
- // Use channelNames if provided
- if (channelNames != NULL) {
- tmpSymbol = OSDynamicCast(OSSymbol, channelNames->getObject(cnt));
- if (tmpSymbol && tmpSymbol != gIOReportNoChannelName) {
- tmpChannelArray->setObject(kIOReportChannelNameIdx, tmpSymbol);
- } // Else, skip and leave name field empty
- }
-
- channelLegendArray->setObject(cnt, tmpChannelArray);
- tmpChannelArray->release();
- tmpChannelArray = NULL;
- }
-
- // Stuff the legend entry only if we have channels...
- if (channelLegendArray->getCount() != 0) {
-
- channelInfoDict = OSDictionary::withCapacity(1);
-
- if (!channelInfoDict) {
- goto finish;
- }
-
- tmpNum = OSNumber::withNumber(unit, 64);
- if (tmpNum) {
- channelInfoDict->setObject(kIOReportLegendUnitKey, tmpNum);
- tmpNum->release();
- }
-
- legendEntry = OSDictionary::withCapacity(1);
-
- if (legendEntry) {
- legendEntry->setObject(kIOReportLegendChannelsKey, channelLegendArray);
- legendEntry->setObject(kIOReportLegendInfoKey, channelInfoDict);
- }
- }
-
+ unsigned int cnt, chCnt;
+ uint64_t type64;
+ OSNumber *tmpNum;
+ const OSSymbol *tmpSymbol;
+ OSArray *channelLegendArray = NULL, *tmpChannelArray = NULL;
+ OSDictionary *channelInfoDict = NULL;
+ IOReportLegendEntry *legendEntry = NULL;
+
+ // No need to check validity of channelNames because param is optional
+ if (!channelIDs) {
+ goto finish;
+ }
+ chCnt = channelIDs->getCount();
+
+ channelLegendArray = OSArray::withCapacity(chCnt);
+
+ for (cnt = 0; cnt < chCnt; cnt++) {
+ tmpChannelArray = OSArray::withCapacity(3);
+
+ // Encapsulate the Channel ID in OSNumber
+ tmpChannelArray->setObject(kIOReportChannelIDIdx, channelIDs->getObject(cnt));
+
+ // Encapsulate the Channel Type in OSNumber
+ memcpy(&type64, &channelType, sizeof(type64));
+ tmpNum = OSNumber::withNumber(type64, 64);
+ if (!tmpNum) {
+ goto finish;
+ }
+ tmpChannelArray->setObject(kIOReportChannelTypeIdx, tmpNum);
+ tmpNum->release();
+
+ // Encapsulate the Channel Name in OSSymbol
+ // Use channelNames if provided
+ if (channelNames != NULL) {
+ tmpSymbol = OSDynamicCast(OSSymbol, channelNames->getObject(cnt));
+ if (tmpSymbol && tmpSymbol != gIOReportNoChannelName) {
+ tmpChannelArray->setObject(kIOReportChannelNameIdx, tmpSymbol);
+ } // Else, skip and leave name field empty
+ }
+
+ channelLegendArray->setObject(cnt, tmpChannelArray);
+ tmpChannelArray->release();
+ tmpChannelArray = NULL;
+ }
+
+ // Stuff the legend entry only if we have channels...
+ if (channelLegendArray->getCount() != 0) {
+ channelInfoDict = OSDictionary::withCapacity(1);
+
+ if (!channelInfoDict) {
+ goto finish;
+ }
+
+ tmpNum = OSNumber::withNumber(unit, 64);
+ if (tmpNum) {
+ channelInfoDict->setObject(kIOReportLegendUnitKey, tmpNum);
+ tmpNum->release();
+ }
+
+ legendEntry = OSDictionary::withCapacity(1);
+
+ if (legendEntry) {
+ legendEntry->setObject(kIOReportLegendChannelsKey, channelLegendArray);
+ legendEntry->setObject(kIOReportLegendInfoKey, channelInfoDict);
+ }
+ }
+
projects / apple / xnu.git / blobdiff