xref: /xnu-11215.81.4/iokit/Kernel/IOStateReporter.cpp (revision d4514f0bc1d3f944c22d92e68b646ac3fb40d452)
1*d4514f0bSApple OSS Distributions /*
2*d4514f0bSApple OSS Distributions  * Copyright (c) 2012-2013 Apple Computer, Inc.  All Rights Reserved.
3*d4514f0bSApple OSS Distributions  *
4*d4514f0bSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*d4514f0bSApple OSS Distributions  *
6*d4514f0bSApple OSS Distributions  * This file contains Original Code and/or Modifications of Original Code
7*d4514f0bSApple OSS Distributions  * as defined in and that are subject to the Apple Public Source License
8*d4514f0bSApple OSS Distributions  * Version 2.0 (the 'License'). You may not use this file except in
9*d4514f0bSApple OSS Distributions  * compliance with the License. The rights granted to you under the License
10*d4514f0bSApple OSS Distributions  * may not be used to create, or enable the creation or redistribution of,
11*d4514f0bSApple OSS Distributions  * unlawful or unlicensed copies of an Apple operating system, or to
12*d4514f0bSApple OSS Distributions  * circumvent, violate, or enable the circumvention or violation of, any
13*d4514f0bSApple OSS Distributions  * terms of an Apple operating system software license agreement.
14*d4514f0bSApple OSS Distributions  *
15*d4514f0bSApple OSS Distributions  * Please obtain a copy of the License at
16*d4514f0bSApple OSS Distributions  * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*d4514f0bSApple OSS Distributions  *
18*d4514f0bSApple OSS Distributions  * The Original Code and all software distributed under the License are
19*d4514f0bSApple OSS Distributions  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*d4514f0bSApple OSS Distributions  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*d4514f0bSApple OSS Distributions  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*d4514f0bSApple OSS Distributions  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*d4514f0bSApple OSS Distributions  * Please see the License for the specific language governing rights and
24*d4514f0bSApple OSS Distributions  * limitations under the License.
25*d4514f0bSApple OSS Distributions  *
26*d4514f0bSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*d4514f0bSApple OSS Distributions  */
28*d4514f0bSApple OSS Distributions 
29*d4514f0bSApple OSS Distributions #define IOKIT_ENABLE_SHARED_PTR
30*d4514f0bSApple OSS Distributions 
31*d4514f0bSApple OSS Distributions #include <libkern/c++/OSSharedPtr.h>
32*d4514f0bSApple OSS Distributions #include <IOKit/IOKernelReportStructs.h>
33*d4514f0bSApple OSS Distributions #include <IOKit/IOKernelReporters.h>
34*d4514f0bSApple OSS Distributions #include "IOReporterDefs.h"
35*d4514f0bSApple OSS Distributions 
36*d4514f0bSApple OSS Distributions 
37*d4514f0bSApple OSS Distributions #define super IOReporter
38*d4514f0bSApple OSS Distributions OSDefineMetaClassAndStructors(IOStateReporter, IOReporter);
39*d4514f0bSApple OSS Distributions 
40*d4514f0bSApple OSS Distributions 
41*d4514f0bSApple OSS Distributions /* static */
42*d4514f0bSApple OSS Distributions OSSharedPtr<IOStateReporter>
with(IOService * reportingService,IOReportCategories categories,int nstates,IOReportUnit unit)43*d4514f0bSApple OSS Distributions IOStateReporter::with(IOService *reportingService,
44*d4514f0bSApple OSS Distributions     IOReportCategories categories,
45*d4514f0bSApple OSS Distributions     int nstates,
46*d4514f0bSApple OSS Distributions     IOReportUnit unit /* = kIOReportUnitHWTicks*/)
47*d4514f0bSApple OSS Distributions {
48*d4514f0bSApple OSS Distributions 	OSSharedPtr<IOStateReporter> reporter;
49*d4514f0bSApple OSS Distributions 
50*d4514f0bSApple OSS Distributions 	if (nstates > INT16_MAX) {
51*d4514f0bSApple OSS Distributions 		return nullptr;
52*d4514f0bSApple OSS Distributions 	}
53*d4514f0bSApple OSS Distributions 
54*d4514f0bSApple OSS Distributions 	reporter = OSMakeShared<IOStateReporter>();
55*d4514f0bSApple OSS Distributions 	if (!reporter) {
56*d4514f0bSApple OSS Distributions 		return nullptr;
57*d4514f0bSApple OSS Distributions 	}
58*d4514f0bSApple OSS Distributions 
59*d4514f0bSApple OSS Distributions 	if (!reporter->initWith(reportingService, categories, (int16_t) nstates, unit)) {
60*d4514f0bSApple OSS Distributions 		return nullptr;
61*d4514f0bSApple OSS Distributions 	}
62*d4514f0bSApple OSS Distributions 
63*d4514f0bSApple OSS Distributions 	return reporter;
64*d4514f0bSApple OSS Distributions }
65*d4514f0bSApple OSS Distributions 
66*d4514f0bSApple OSS Distributions bool
initWith(IOService * reportingService,IOReportCategories categories,int16_t nstates,IOReportUnit unit)67*d4514f0bSApple OSS Distributions IOStateReporter::initWith(IOService *reportingService,
68*d4514f0bSApple OSS Distributions     IOReportCategories categories,
69*d4514f0bSApple OSS Distributions     int16_t nstates,
70*d4514f0bSApple OSS Distributions     IOReportUnit unit)
71*d4514f0bSApple OSS Distributions {
72*d4514f0bSApple OSS Distributions 	bool success = false;
73*d4514f0bSApple OSS Distributions 
74*d4514f0bSApple OSS Distributions 	IOReportChannelType channelType = {
75*d4514f0bSApple OSS Distributions 		.categories = categories,
76*d4514f0bSApple OSS Distributions 		.report_format = kIOReportFormatState,
77*d4514f0bSApple OSS Distributions 		.nelements = static_cast<uint16_t>(nstates),
78*d4514f0bSApple OSS Distributions 		.element_idx = 0
79*d4514f0bSApple OSS Distributions 	};
80*d4514f0bSApple OSS Distributions 
81*d4514f0bSApple OSS Distributions 	if (super::init(reportingService, channelType, unit) != true) {
82*d4514f0bSApple OSS Distributions 		IORLOG("ERROR super::initWith failed");
83*d4514f0bSApple OSS Distributions 		success = false;
84*d4514f0bSApple OSS Distributions 		goto finish;
85*d4514f0bSApple OSS Distributions 	}
86*d4514f0bSApple OSS Distributions 
87*d4514f0bSApple OSS Distributions 	_currentStates = NULL;
88*d4514f0bSApple OSS Distributions 	_lastUpdateTimes = NULL;
89*d4514f0bSApple OSS Distributions 
90*d4514f0bSApple OSS Distributions 	success = true;
91*d4514f0bSApple OSS Distributions 
92*d4514f0bSApple OSS Distributions finish:
93*d4514f0bSApple OSS Distributions 	return success;
94*d4514f0bSApple OSS Distributions }
95*d4514f0bSApple OSS Distributions 
96*d4514f0bSApple OSS Distributions 
97*d4514f0bSApple OSS Distributions void
free(void)98*d4514f0bSApple OSS Distributions IOStateReporter::free(void)
99*d4514f0bSApple OSS Distributions {
100*d4514f0bSApple OSS Distributions 	if (_currentStates) {
101*d4514f0bSApple OSS Distributions 		PREFL_MEMOP_PANIC(_nChannels, int);
102*d4514f0bSApple OSS Distributions 		IOFreeData(_currentStates, (size_t)_nChannels * sizeof(int));
103*d4514f0bSApple OSS Distributions 	}
104*d4514f0bSApple OSS Distributions 	if (_lastUpdateTimes) {
105*d4514f0bSApple OSS Distributions 		PREFL_MEMOP_PANIC(_nChannels, uint64_t);
106*d4514f0bSApple OSS Distributions 		IOFreeData(_lastUpdateTimes, (size_t)_nChannels * sizeof(uint64_t));
107*d4514f0bSApple OSS Distributions 	}
108*d4514f0bSApple OSS Distributions 
109*d4514f0bSApple OSS Distributions 	super::free();
110*d4514f0bSApple OSS Distributions }
111*d4514f0bSApple OSS Distributions 
112*d4514f0bSApple OSS Distributions 
113*d4514f0bSApple OSS Distributions IOReturn
handleSwapPrepare(int newNChannels)114*d4514f0bSApple OSS Distributions IOStateReporter::handleSwapPrepare(int newNChannels)
115*d4514f0bSApple OSS Distributions {
116*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
117*d4514f0bSApple OSS Distributions 	size_t newCurStatesSize, newTSSize;
118*d4514f0bSApple OSS Distributions 
119*d4514f0bSApple OSS Distributions 	//IORLOG("handleSwapPrepare (state) _nChannels before = %u", _nChannels);
120*d4514f0bSApple OSS Distributions 
121*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_CONFIG_LOCK();
122*d4514f0bSApple OSS Distributions 
123*d4514f0bSApple OSS Distributions 	if (_swapCurrentStates || _swapLastUpdateTimes) {
124*d4514f0bSApple OSS Distributions 		panic("IOStateReporter::_swap* already in use");
125*d4514f0bSApple OSS Distributions 	}
126*d4514f0bSApple OSS Distributions 
127*d4514f0bSApple OSS Distributions 	// new currentStates buffer
128*d4514f0bSApple OSS Distributions 	PREFL_MEMOP_FAIL(newNChannels, int);
129*d4514f0bSApple OSS Distributions 	newCurStatesSize = (size_t)newNChannels * sizeof(int);
130*d4514f0bSApple OSS Distributions 	_swapCurrentStates = (int*)IOMallocData(newCurStatesSize);
131*d4514f0bSApple OSS Distributions 	if (_swapCurrentStates == NULL) {
132*d4514f0bSApple OSS Distributions 		res = kIOReturnNoMemory; goto finish;
133*d4514f0bSApple OSS Distributions 	}
134*d4514f0bSApple OSS Distributions 	memset(_swapCurrentStates, -1, newCurStatesSize); // init w/"no state"
135*d4514f0bSApple OSS Distributions 
136*d4514f0bSApple OSS Distributions 	// new timestamps buffer
137*d4514f0bSApple OSS Distributions 	PREFL_MEMOP_FAIL(newNChannels, uint64_t);
138*d4514f0bSApple OSS Distributions 	newTSSize = (size_t)newNChannels * sizeof(uint64_t);
139*d4514f0bSApple OSS Distributions 	_swapLastUpdateTimes = (uint64_t *)IOMallocZeroData(newTSSize);
140*d4514f0bSApple OSS Distributions 	if (_swapLastUpdateTimes == NULL) {
141*d4514f0bSApple OSS Distributions 		res = kIOReturnNoMemory; goto finish;
142*d4514f0bSApple OSS Distributions 	}
143*d4514f0bSApple OSS Distributions 
144*d4514f0bSApple OSS Distributions 	res = super::handleSwapPrepare(newNChannels);
145*d4514f0bSApple OSS Distributions 
146*d4514f0bSApple OSS Distributions finish:
147*d4514f0bSApple OSS Distributions 	if (res) {
148*d4514f0bSApple OSS Distributions 		if (_swapCurrentStates) {
149*d4514f0bSApple OSS Distributions 			IOFreeData(_swapCurrentStates, newCurStatesSize);
150*d4514f0bSApple OSS Distributions 			_swapCurrentStates = NULL;
151*d4514f0bSApple OSS Distributions 		}
152*d4514f0bSApple OSS Distributions 		if (_swapLastUpdateTimes) {
153*d4514f0bSApple OSS Distributions 			IOFreeData(_swapLastUpdateTimes, newTSSize);
154*d4514f0bSApple OSS Distributions 			_swapLastUpdateTimes = NULL;
155*d4514f0bSApple OSS Distributions 		}
156*d4514f0bSApple OSS Distributions 	}
157*d4514f0bSApple OSS Distributions 
158*d4514f0bSApple OSS Distributions 	return res;
159*d4514f0bSApple OSS Distributions }
160*d4514f0bSApple OSS Distributions 
161*d4514f0bSApple OSS Distributions IOReturn
handleAddChannelSwap(uint64_t channelID,const OSSymbol * symChannelName)162*d4514f0bSApple OSS Distributions IOStateReporter::handleAddChannelSwap(uint64_t channelID,
163*d4514f0bSApple OSS Distributions     const OSSymbol *symChannelName)
164*d4514f0bSApple OSS Distributions {
165*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
166*d4514f0bSApple OSS Distributions 	int cnt;
167*d4514f0bSApple OSS Distributions 	int *tmpCurStates;
168*d4514f0bSApple OSS Distributions 	uint64_t *tmpTimestamps;
169*d4514f0bSApple OSS Distributions 	bool swapComplete = false;
170*d4514f0bSApple OSS Distributions 
171*d4514f0bSApple OSS Distributions 	//IORLOG("IOStateReporter::handleSwap");
172*d4514f0bSApple OSS Distributions 
173*d4514f0bSApple OSS Distributions 	if (!_swapCurrentStates || !_swapLastUpdateTimes) {
174*d4514f0bSApple OSS Distributions 		IORLOG("IOReporter::handleSwap ERROR swap variables uninitialized!");
175*d4514f0bSApple OSS Distributions 		goto finish;
176*d4514f0bSApple OSS Distributions 	}
177*d4514f0bSApple OSS Distributions 
178*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_CONFIG_LOCK();
179*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_LOCK();
180*d4514f0bSApple OSS Distributions 
181*d4514f0bSApple OSS Distributions 	// Copy any existing buffers
182*d4514f0bSApple OSS Distributions 	if (_currentStates) {
183*d4514f0bSApple OSS Distributions 		PREFL_MEMOP_FAIL(_nChannels, int);
184*d4514f0bSApple OSS Distributions 		memcpy(_swapCurrentStates, _currentStates,
185*d4514f0bSApple OSS Distributions 		    (size_t)_nChannels * sizeof(int));
186*d4514f0bSApple OSS Distributions 
187*d4514f0bSApple OSS Distributions 		if (!_lastUpdateTimes) {
188*d4514f0bSApple OSS Distributions 			panic("IOStateReporter::handleAddChannelSwap _lastUpdateTimes unset despite non-NULL _currentStates");
189*d4514f0bSApple OSS Distributions 		}
190*d4514f0bSApple OSS Distributions 		PREFL_MEMOP_FAIL(_nChannels, uint64_t);
191*d4514f0bSApple OSS Distributions 		memcpy(_swapLastUpdateTimes, _lastUpdateTimes,
192*d4514f0bSApple OSS Distributions 		    (size_t)_nChannels * sizeof(uint64_t));
193*d4514f0bSApple OSS Distributions 	}
194*d4514f0bSApple OSS Distributions 
195*d4514f0bSApple OSS Distributions 	// Update principal instance variables, keep old values in _swap* for cleanup
196*d4514f0bSApple OSS Distributions 	tmpCurStates = _currentStates;
197*d4514f0bSApple OSS Distributions 	_currentStates = _swapCurrentStates;
198*d4514f0bSApple OSS Distributions 	_swapCurrentStates = tmpCurStates;
199*d4514f0bSApple OSS Distributions 
200*d4514f0bSApple OSS Distributions 	tmpTimestamps = _lastUpdateTimes;
201*d4514f0bSApple OSS Distributions 	_lastUpdateTimes = _swapLastUpdateTimes;
202*d4514f0bSApple OSS Distributions 	_swapLastUpdateTimes = tmpTimestamps;
203*d4514f0bSApple OSS Distributions 
204*d4514f0bSApple OSS Distributions 	swapComplete = true;
205*d4514f0bSApple OSS Distributions 
206*d4514f0bSApple OSS Distributions 	// subclass success
207*d4514f0bSApple OSS Distributions 
208*d4514f0bSApple OSS Distributions 	// invoke superclass(es): base class updates _nChannels & _nElements
209*d4514f0bSApple OSS Distributions 	res = super::handleAddChannelSwap(channelID, symChannelName);
210*d4514f0bSApple OSS Distributions 	if (res) {
211*d4514f0bSApple OSS Distributions 		IORLOG("handleSwap(state) ERROR super::handleSwap failed!");
212*d4514f0bSApple OSS Distributions 		goto finish;
213*d4514f0bSApple OSS Distributions 	}
214*d4514f0bSApple OSS Distributions 
215*d4514f0bSApple OSS Distributions 	// Channel added successfully, initialize the new channel's state_ids to 0..nStates-1
216*d4514f0bSApple OSS Distributions 	for (cnt = 0; cnt < _channelDimension; cnt++) {
217*d4514f0bSApple OSS Distributions 		handleSetStateID(channelID, cnt, (uint64_t)cnt);
218*d4514f0bSApple OSS Distributions 	}
219*d4514f0bSApple OSS Distributions 
220*d4514f0bSApple OSS Distributions finish:
221*d4514f0bSApple OSS Distributions 	if (res && swapComplete) {
222*d4514f0bSApple OSS Distributions 		// unswap so the unused buffers get cleaned up
223*d4514f0bSApple OSS Distributions 		tmpCurStates = _currentStates;
224*d4514f0bSApple OSS Distributions 		_currentStates = _swapCurrentStates;
225*d4514f0bSApple OSS Distributions 		_swapCurrentStates = tmpCurStates;
226*d4514f0bSApple OSS Distributions 
227*d4514f0bSApple OSS Distributions 		tmpTimestamps = _lastUpdateTimes;
228*d4514f0bSApple OSS Distributions 		_lastUpdateTimes = _swapLastUpdateTimes;
229*d4514f0bSApple OSS Distributions 		_swapLastUpdateTimes = tmpTimestamps;
230*d4514f0bSApple OSS Distributions 	}
231*d4514f0bSApple OSS Distributions 
232*d4514f0bSApple OSS Distributions 	return res;
233*d4514f0bSApple OSS Distributions }
234*d4514f0bSApple OSS Distributions 
235*d4514f0bSApple OSS Distributions 
236*d4514f0bSApple OSS Distributions void
handleSwapCleanup(int swapNChannels)237*d4514f0bSApple OSS Distributions IOStateReporter::handleSwapCleanup(int swapNChannels)
238*d4514f0bSApple OSS Distributions {
239*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_CONFIG_LOCK();
240*d4514f0bSApple OSS Distributions 
241*d4514f0bSApple OSS Distributions 	super::handleSwapCleanup(swapNChannels);
242*d4514f0bSApple OSS Distributions 
243*d4514f0bSApple OSS Distributions 	if (_swapCurrentStates) {
244*d4514f0bSApple OSS Distributions 		PREFL_MEMOP_PANIC(swapNChannels, int);
245*d4514f0bSApple OSS Distributions 		IOFreeData(_swapCurrentStates, (size_t)swapNChannels * sizeof(int));
246*d4514f0bSApple OSS Distributions 		_swapCurrentStates = NULL;
247*d4514f0bSApple OSS Distributions 	}
248*d4514f0bSApple OSS Distributions 	if (_swapLastUpdateTimes) {
249*d4514f0bSApple OSS Distributions 		PREFL_MEMOP_PANIC(swapNChannels, uint64_t);
250*d4514f0bSApple OSS Distributions 		IOFreeData(_swapLastUpdateTimes, (size_t)swapNChannels * sizeof(uint64_t));
251*d4514f0bSApple OSS Distributions 		_swapLastUpdateTimes = NULL;
252*d4514f0bSApple OSS Distributions 	}
253*d4514f0bSApple OSS Distributions }
254*d4514f0bSApple OSS Distributions 
255*d4514f0bSApple OSS Distributions 
256*d4514f0bSApple OSS Distributions IOReturn
_getStateIndices(uint64_t channel_id,uint64_t state_id,int * channel_index,int * state_index)257*d4514f0bSApple OSS Distributions IOStateReporter::_getStateIndices(uint64_t channel_id,
258*d4514f0bSApple OSS Distributions     uint64_t state_id,
259*d4514f0bSApple OSS Distributions     int *channel_index,
260*d4514f0bSApple OSS Distributions     int *state_index)
261*d4514f0bSApple OSS Distributions {
262*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
263*d4514f0bSApple OSS Distributions 	int cnt;
264*d4514f0bSApple OSS Distributions 	IOStateReportValues *values;
265*d4514f0bSApple OSS Distributions 	int element_index = 0;
266*d4514f0bSApple OSS Distributions 
267*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_LOCK();
268*d4514f0bSApple OSS Distributions 
269*d4514f0bSApple OSS Distributions 	if (getChannelIndices(channel_id,
270*d4514f0bSApple OSS Distributions 	    channel_index,
271*d4514f0bSApple OSS Distributions 	    &element_index) != kIOReturnSuccess) {
272*d4514f0bSApple OSS Distributions 		res = kIOReturnBadArgument;
273*d4514f0bSApple OSS Distributions 
274*d4514f0bSApple OSS Distributions 		goto finish;
275*d4514f0bSApple OSS Distributions 	}
276*d4514f0bSApple OSS Distributions 
277*d4514f0bSApple OSS Distributions 	for (cnt = 0; cnt < _channelDimension; cnt++) {
278*d4514f0bSApple OSS Distributions 		values = (IOStateReportValues *)getElementValues(element_index + cnt);
279*d4514f0bSApple OSS Distributions 
280*d4514f0bSApple OSS Distributions 		if (values == NULL) {
281*d4514f0bSApple OSS Distributions 			res = kIOReturnError;
282*d4514f0bSApple OSS Distributions 			goto finish;
283*d4514f0bSApple OSS Distributions 		}
284*d4514f0bSApple OSS Distributions 
285*d4514f0bSApple OSS Distributions 		if (values->state_id == state_id) {
286*d4514f0bSApple OSS Distributions 			*state_index = cnt;
287*d4514f0bSApple OSS Distributions 			res = kIOReturnSuccess;
288*d4514f0bSApple OSS Distributions 			goto finish;
289*d4514f0bSApple OSS Distributions 		}
290*d4514f0bSApple OSS Distributions 	}
291*d4514f0bSApple OSS Distributions 
292*d4514f0bSApple OSS Distributions 	res = kIOReturnBadArgument;
293*d4514f0bSApple OSS Distributions 
294*d4514f0bSApple OSS Distributions finish:
295*d4514f0bSApple OSS Distributions 	return res;
296*d4514f0bSApple OSS Distributions }
297*d4514f0bSApple OSS Distributions 
298*d4514f0bSApple OSS Distributions 
299*d4514f0bSApple OSS Distributions IOReturn
setChannelState(uint64_t channel_id,uint64_t new_state_id)300*d4514f0bSApple OSS Distributions IOStateReporter::setChannelState(uint64_t channel_id,
301*d4514f0bSApple OSS Distributions     uint64_t new_state_id)
302*d4514f0bSApple OSS Distributions {
303*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
304*d4514f0bSApple OSS Distributions 	int channel_index, new_state_index;
305*d4514f0bSApple OSS Distributions 	uint64_t last_intransition = 0;
306*d4514f0bSApple OSS Distributions 	uint64_t prev_state_residency = 0;
307*d4514f0bSApple OSS Distributions 
308*d4514f0bSApple OSS Distributions 	lockReporter();
309*d4514f0bSApple OSS Distributions 
310*d4514f0bSApple OSS Distributions 	if (_getStateIndices(channel_id, new_state_id, &channel_index, &new_state_index) == kIOReturnSuccess) {
311*d4514f0bSApple OSS Distributions 		res = handleSetStateByIndices(channel_index, new_state_index,
312*d4514f0bSApple OSS Distributions 		    last_intransition,
313*d4514f0bSApple OSS Distributions 		    prev_state_residency);
314*d4514f0bSApple OSS Distributions 		goto finish;
315*d4514f0bSApple OSS Distributions 	}
316*d4514f0bSApple OSS Distributions 
317*d4514f0bSApple OSS Distributions 	res = kIOReturnBadArgument;
318*d4514f0bSApple OSS Distributions 
319*d4514f0bSApple OSS Distributions finish:
320*d4514f0bSApple OSS Distributions 	unlockReporter();
321*d4514f0bSApple OSS Distributions 	return res;
322*d4514f0bSApple OSS Distributions }
323*d4514f0bSApple OSS Distributions 
324*d4514f0bSApple OSS Distributions IOReturn
setChannelState(uint64_t channel_id,uint64_t new_state_id,uint64_t last_intransition,uint64_t prev_state_residency)325*d4514f0bSApple OSS Distributions IOStateReporter::setChannelState(uint64_t channel_id,
326*d4514f0bSApple OSS Distributions     uint64_t new_state_id,
327*d4514f0bSApple OSS Distributions     uint64_t last_intransition,
328*d4514f0bSApple OSS Distributions     uint64_t prev_state_residency)
329*d4514f0bSApple OSS Distributions {
330*d4514f0bSApple OSS Distributions 	return setChannelState(channel_id, new_state_id);
331*d4514f0bSApple OSS Distributions }
332*d4514f0bSApple OSS Distributions 
333*d4514f0bSApple OSS Distributions IOReturn
overrideChannelState(uint64_t channel_id,uint64_t state_id,uint64_t time_in_state,uint64_t intransitions,uint64_t last_intransition)334*d4514f0bSApple OSS Distributions IOStateReporter::overrideChannelState(uint64_t channel_id,
335*d4514f0bSApple OSS Distributions     uint64_t state_id,
336*d4514f0bSApple OSS Distributions     uint64_t time_in_state,
337*d4514f0bSApple OSS Distributions     uint64_t intransitions,
338*d4514f0bSApple OSS Distributions     uint64_t last_intransition /*=0*/)
339*d4514f0bSApple OSS Distributions {
340*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
341*d4514f0bSApple OSS Distributions 	int channel_index, state_index;
342*d4514f0bSApple OSS Distributions 
343*d4514f0bSApple OSS Distributions 	lockReporter();
344*d4514f0bSApple OSS Distributions 
345*d4514f0bSApple OSS Distributions 	if (_getStateIndices(channel_id, state_id, &channel_index, &state_index) == kIOReturnSuccess) {
346*d4514f0bSApple OSS Distributions 		if (_lastUpdateTimes[channel_index]) {
347*d4514f0bSApple OSS Distributions 			panic("overrideChannelState() cannot be used after setChannelState()!");
348*d4514f0bSApple OSS Distributions 		}
349*d4514f0bSApple OSS Distributions 
350*d4514f0bSApple OSS Distributions 		res = handleOverrideChannelStateByIndices(channel_index, state_index,
351*d4514f0bSApple OSS Distributions 		    time_in_state, intransitions,
352*d4514f0bSApple OSS Distributions 		    last_intransition);
353*d4514f0bSApple OSS Distributions 		goto finish;
354*d4514f0bSApple OSS Distributions 	}
355*d4514f0bSApple OSS Distributions 
356*d4514f0bSApple OSS Distributions 	res = kIOReturnBadArgument;
357*d4514f0bSApple OSS Distributions 
358*d4514f0bSApple OSS Distributions finish:
359*d4514f0bSApple OSS Distributions 	unlockReporter();
360*d4514f0bSApple OSS Distributions 	return res;
361*d4514f0bSApple OSS Distributions }
362*d4514f0bSApple OSS Distributions 
363*d4514f0bSApple OSS Distributions 
364*d4514f0bSApple OSS Distributions IOReturn
handleOverrideChannelStateByIndices(int channel_index,int state_index,uint64_t time_in_state,uint64_t intransitions,uint64_t last_intransition)365*d4514f0bSApple OSS Distributions IOStateReporter::handleOverrideChannelStateByIndices(int channel_index,
366*d4514f0bSApple OSS Distributions     int state_index,
367*d4514f0bSApple OSS Distributions     uint64_t time_in_state,
368*d4514f0bSApple OSS Distributions     uint64_t intransitions,
369*d4514f0bSApple OSS Distributions     uint64_t last_intransition /*=0*/)
370*d4514f0bSApple OSS Distributions {
371*d4514f0bSApple OSS Distributions 	IOReturn kerr, result = kIOReturnError;
372*d4514f0bSApple OSS Distributions 	IOStateReportValues state_values;
373*d4514f0bSApple OSS Distributions 	int element_index;
374*d4514f0bSApple OSS Distributions 
375*d4514f0bSApple OSS Distributions 	if (channel_index < 0 || channel_index >= _nChannels) {
376*d4514f0bSApple OSS Distributions 		result = kIOReturnBadArgument; goto finish;
377*d4514f0bSApple OSS Distributions 	}
378*d4514f0bSApple OSS Distributions 
379*d4514f0bSApple OSS Distributions 	if (channel_index < 0 || channel_index > (_nElements - state_index)
380*d4514f0bSApple OSS Distributions 	    / _channelDimension) {
381*d4514f0bSApple OSS Distributions 		result = kIOReturnOverrun; goto finish;
382*d4514f0bSApple OSS Distributions 	}
383*d4514f0bSApple OSS Distributions 	element_index = channel_index * _channelDimension + state_index;
384*d4514f0bSApple OSS Distributions 
385*d4514f0bSApple OSS Distributions 	kerr = copyElementValues(element_index, (IOReportElementValues*)&state_values);
386*d4514f0bSApple OSS Distributions 	if (kerr) {
387*d4514f0bSApple OSS Distributions 		result = kerr; goto finish;
388*d4514f0bSApple OSS Distributions 	}
389*d4514f0bSApple OSS Distributions 
390*d4514f0bSApple OSS Distributions 	// last_intransition = 0 -> no current state ("residency summary only")
391*d4514f0bSApple OSS Distributions 	state_values.last_intransition = last_intransition;
392*d4514f0bSApple OSS Distributions 	state_values.intransitions = intransitions;
393*d4514f0bSApple OSS Distributions 	state_values.upticks = time_in_state;
394*d4514f0bSApple OSS Distributions 
395*d4514f0bSApple OSS Distributions 	// determines current time for metadata
396*d4514f0bSApple OSS Distributions 	kerr = setElementValues(element_index, (IOReportElementValues *)&state_values);
397*d4514f0bSApple OSS Distributions 	if (kerr) {
398*d4514f0bSApple OSS Distributions 		result = kerr; goto finish;
399*d4514f0bSApple OSS Distributions 	}
400*d4514f0bSApple OSS Distributions 
401*d4514f0bSApple OSS Distributions 	// success
402*d4514f0bSApple OSS Distributions 	result = kIOReturnSuccess;
403*d4514f0bSApple OSS Distributions 
404*d4514f0bSApple OSS Distributions finish:
405*d4514f0bSApple OSS Distributions 	return result;
406*d4514f0bSApple OSS Distributions }
407*d4514f0bSApple OSS Distributions 
408*d4514f0bSApple OSS Distributions 
409*d4514f0bSApple OSS Distributions IOReturn
incrementChannelState(uint64_t channel_id,uint64_t state_id,uint64_t time_in_state,uint64_t intransitions,uint64_t last_intransition)410*d4514f0bSApple OSS Distributions IOStateReporter::incrementChannelState(uint64_t channel_id,
411*d4514f0bSApple OSS Distributions     uint64_t state_id,
412*d4514f0bSApple OSS Distributions     uint64_t time_in_state,
413*d4514f0bSApple OSS Distributions     uint64_t intransitions,
414*d4514f0bSApple OSS Distributions     uint64_t last_intransition /*=0*/)
415*d4514f0bSApple OSS Distributions {
416*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
417*d4514f0bSApple OSS Distributions 	int channel_index, state_index;
418*d4514f0bSApple OSS Distributions 
419*d4514f0bSApple OSS Distributions 	lockReporter();
420*d4514f0bSApple OSS Distributions 
421*d4514f0bSApple OSS Distributions 	if (_getStateIndices(channel_id, state_id, &channel_index, &state_index) == kIOReturnSuccess) {
422*d4514f0bSApple OSS Distributions 		if (_lastUpdateTimes[channel_index]) {
423*d4514f0bSApple OSS Distributions 			panic("incrementChannelState() cannot be used after setChannelState()!");
424*d4514f0bSApple OSS Distributions 		}
425*d4514f0bSApple OSS Distributions 
426*d4514f0bSApple OSS Distributions 		res = handleIncrementChannelStateByIndices(channel_index, state_index,
427*d4514f0bSApple OSS Distributions 		    time_in_state, intransitions,
428*d4514f0bSApple OSS Distributions 		    last_intransition);
429*d4514f0bSApple OSS Distributions 		goto finish;
430*d4514f0bSApple OSS Distributions 	}
431*d4514f0bSApple OSS Distributions 
432*d4514f0bSApple OSS Distributions 	res = kIOReturnBadArgument;
433*d4514f0bSApple OSS Distributions 
434*d4514f0bSApple OSS Distributions finish:
435*d4514f0bSApple OSS Distributions 	unlockReporter();
436*d4514f0bSApple OSS Distributions 	return res;
437*d4514f0bSApple OSS Distributions }
438*d4514f0bSApple OSS Distributions 
439*d4514f0bSApple OSS Distributions 
440*d4514f0bSApple OSS Distributions IOReturn
handleIncrementChannelStateByIndices(int channel_index,int state_index,uint64_t time_in_state,uint64_t intransitions,uint64_t last_intransition)441*d4514f0bSApple OSS Distributions IOStateReporter::handleIncrementChannelStateByIndices(int channel_index,
442*d4514f0bSApple OSS Distributions     int state_index,
443*d4514f0bSApple OSS Distributions     uint64_t time_in_state,
444*d4514f0bSApple OSS Distributions     uint64_t intransitions,
445*d4514f0bSApple OSS Distributions     uint64_t last_intransition /*=0*/)
446*d4514f0bSApple OSS Distributions {
447*d4514f0bSApple OSS Distributions 	IOReturn kerr, result = kIOReturnError;
448*d4514f0bSApple OSS Distributions 	IOStateReportValues state_values;
449*d4514f0bSApple OSS Distributions 	int element_index;
450*d4514f0bSApple OSS Distributions 
451*d4514f0bSApple OSS Distributions 	if (channel_index < 0 || channel_index >= _nChannels) {
452*d4514f0bSApple OSS Distributions 		result = kIOReturnBadArgument; goto finish;
453*d4514f0bSApple OSS Distributions 	}
454*d4514f0bSApple OSS Distributions 
455*d4514f0bSApple OSS Distributions 	if (channel_index < 0 || channel_index > (_nElements - state_index)
456*d4514f0bSApple OSS Distributions 	    / _channelDimension) {
457*d4514f0bSApple OSS Distributions 		result = kIOReturnOverrun; goto finish;
458*d4514f0bSApple OSS Distributions 	}
459*d4514f0bSApple OSS Distributions 	element_index = channel_index * _channelDimension + state_index;
460*d4514f0bSApple OSS Distributions 
461*d4514f0bSApple OSS Distributions 	kerr = copyElementValues(element_index, (IOReportElementValues*)&state_values);
462*d4514f0bSApple OSS Distributions 	if (kerr) {
463*d4514f0bSApple OSS Distributions 		result = kerr;
464*d4514f0bSApple OSS Distributions 		goto finish;
465*d4514f0bSApple OSS Distributions 	}
466*d4514f0bSApple OSS Distributions 
467*d4514f0bSApple OSS Distributions 	state_values.last_intransition = last_intransition;
468*d4514f0bSApple OSS Distributions 	state_values.intransitions += intransitions;
469*d4514f0bSApple OSS Distributions 	state_values.upticks += time_in_state;
470*d4514f0bSApple OSS Distributions 
471*d4514f0bSApple OSS Distributions 	// determines current time for metadata
472*d4514f0bSApple OSS Distributions 	kerr = setElementValues(element_index, (IOReportElementValues *)&state_values);
473*d4514f0bSApple OSS Distributions 	if (kerr) {
474*d4514f0bSApple OSS Distributions 		result = kerr;
475*d4514f0bSApple OSS Distributions 		goto finish;
476*d4514f0bSApple OSS Distributions 	}
477*d4514f0bSApple OSS Distributions 
478*d4514f0bSApple OSS Distributions 	// success
479*d4514f0bSApple OSS Distributions 	result = kIOReturnSuccess;
480*d4514f0bSApple OSS Distributions 
481*d4514f0bSApple OSS Distributions finish:
482*d4514f0bSApple OSS Distributions 	return result;
483*d4514f0bSApple OSS Distributions }
484*d4514f0bSApple OSS Distributions 
485*d4514f0bSApple OSS Distributions 
486*d4514f0bSApple OSS Distributions IOReturn
setState(uint64_t new_state_id)487*d4514f0bSApple OSS Distributions IOStateReporter::setState(uint64_t new_state_id)
488*d4514f0bSApple OSS Distributions {
489*d4514f0bSApple OSS Distributions 	uint64_t last_intransition = 0;
490*d4514f0bSApple OSS Distributions 	uint64_t prev_state_residency = 0;
491*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
492*d4514f0bSApple OSS Distributions 	IOStateReportValues *values;
493*d4514f0bSApple OSS Distributions 	int channel_index = 0, element_index = 0, new_state_index = 0;
494*d4514f0bSApple OSS Distributions 	int cnt;
495*d4514f0bSApple OSS Distributions 
496*d4514f0bSApple OSS Distributions 	lockReporter();
497*d4514f0bSApple OSS Distributions 
498*d4514f0bSApple OSS Distributions 	if (_nChannels == 1) {
499*d4514f0bSApple OSS Distributions 		for (cnt = 0; cnt < _channelDimension; cnt++) {
500*d4514f0bSApple OSS Distributions 			new_state_index = element_index + cnt;
501*d4514f0bSApple OSS Distributions 
502*d4514f0bSApple OSS Distributions 			values = (IOStateReportValues *)getElementValues(new_state_index);
503*d4514f0bSApple OSS Distributions 
504*d4514f0bSApple OSS Distributions 			if (values == NULL) {
505*d4514f0bSApple OSS Distributions 				res = kIOReturnError;
506*d4514f0bSApple OSS Distributions 				goto finish;
507*d4514f0bSApple OSS Distributions 			}
508*d4514f0bSApple OSS Distributions 
509*d4514f0bSApple OSS Distributions 			if (values->state_id == new_state_id) {
510*d4514f0bSApple OSS Distributions 				res = handleSetStateByIndices(channel_index, new_state_index,
511*d4514f0bSApple OSS Distributions 				    last_intransition,
512*d4514f0bSApple OSS Distributions 				    prev_state_residency);
513*d4514f0bSApple OSS Distributions 				goto finish;
514*d4514f0bSApple OSS Distributions 			}
515*d4514f0bSApple OSS Distributions 		}
516*d4514f0bSApple OSS Distributions 	}
517*d4514f0bSApple OSS Distributions 
518*d4514f0bSApple OSS Distributions 	res = kIOReturnBadArgument;
519*d4514f0bSApple OSS Distributions 
520*d4514f0bSApple OSS Distributions finish:
521*d4514f0bSApple OSS Distributions 	unlockReporter();
522*d4514f0bSApple OSS Distributions 	return res;
523*d4514f0bSApple OSS Distributions }
524*d4514f0bSApple OSS Distributions 
525*d4514f0bSApple OSS Distributions IOReturn
setState(uint64_t new_state_id,uint64_t last_intransition,uint64_t prev_state_residency)526*d4514f0bSApple OSS Distributions IOStateReporter::setState(uint64_t new_state_id,
527*d4514f0bSApple OSS Distributions     uint64_t last_intransition,
528*d4514f0bSApple OSS Distributions     uint64_t prev_state_residency)
529*d4514f0bSApple OSS Distributions {
530*d4514f0bSApple OSS Distributions 	return setState(new_state_id);
531*d4514f0bSApple OSS Distributions }
532*d4514f0bSApple OSS Distributions 
533*d4514f0bSApple OSS Distributions IOReturn
setStateID(uint64_t channel_id,int state_index,uint64_t state_id)534*d4514f0bSApple OSS Distributions IOStateReporter::setStateID(uint64_t channel_id,
535*d4514f0bSApple OSS Distributions     int state_index,
536*d4514f0bSApple OSS Distributions     uint64_t state_id)
537*d4514f0bSApple OSS Distributions {
538*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
539*d4514f0bSApple OSS Distributions 
540*d4514f0bSApple OSS Distributions 	lockReporter();
541*d4514f0bSApple OSS Distributions 
542*d4514f0bSApple OSS Distributions 	res = handleSetStateID(channel_id, state_index, state_id);
543*d4514f0bSApple OSS Distributions 
544*d4514f0bSApple OSS Distributions 	unlockReporter();
545*d4514f0bSApple OSS Distributions 
546*d4514f0bSApple OSS Distributions 	return res;
547*d4514f0bSApple OSS Distributions }
548*d4514f0bSApple OSS Distributions 
549*d4514f0bSApple OSS Distributions 
550*d4514f0bSApple OSS Distributions IOReturn
handleSetStateID(uint64_t channel_id,int state_index,uint64_t state_id)551*d4514f0bSApple OSS Distributions IOStateReporter::handleSetStateID(uint64_t channel_id,
552*d4514f0bSApple OSS Distributions     int state_index,
553*d4514f0bSApple OSS Distributions     uint64_t state_id)
554*d4514f0bSApple OSS Distributions {
555*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
556*d4514f0bSApple OSS Distributions 	IOStateReportValues state_values;
557*d4514f0bSApple OSS Distributions 	int element_index = 0;
558*d4514f0bSApple OSS Distributions 
559*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_LOCK();
560*d4514f0bSApple OSS Distributions 
561*d4514f0bSApple OSS Distributions 	if (getFirstElementIndex(channel_id, &element_index) == kIOReturnSuccess) {
562*d4514f0bSApple OSS Distributions 		if (state_index >= _channelDimension) {
563*d4514f0bSApple OSS Distributions 			res = kIOReturnBadArgument; goto finish;
564*d4514f0bSApple OSS Distributions 		}
565*d4514f0bSApple OSS Distributions 		if (_nElements - state_index <= element_index) {
566*d4514f0bSApple OSS Distributions 			res = kIOReturnOverrun; goto finish;
567*d4514f0bSApple OSS Distributions 		}
568*d4514f0bSApple OSS Distributions 		element_index += state_index;
569*d4514f0bSApple OSS Distributions 
570*d4514f0bSApple OSS Distributions 		if (copyElementValues(element_index, (IOReportElementValues *)&state_values) != kIOReturnSuccess) {
571*d4514f0bSApple OSS Distributions 			res = kIOReturnBadArgument;
572*d4514f0bSApple OSS Distributions 			goto finish;
573*d4514f0bSApple OSS Distributions 		}
574*d4514f0bSApple OSS Distributions 
575*d4514f0bSApple OSS Distributions 		state_values.state_id = state_id;
576*d4514f0bSApple OSS Distributions 
577*d4514f0bSApple OSS Distributions 		res = setElementValues(element_index, (IOReportElementValues *)&state_values);
578*d4514f0bSApple OSS Distributions 	}
579*d4514f0bSApple OSS Distributions 
580*d4514f0bSApple OSS Distributions 	// FIXME: set a bit somewhere (reporter-wide?) that state_ids can no longer be
581*d4514f0bSApple OSS Distributions 	// assumed to be contiguous
582*d4514f0bSApple OSS Distributions finish:
583*d4514f0bSApple OSS Distributions 	return res;
584*d4514f0bSApple OSS Distributions }
585*d4514f0bSApple OSS Distributions 
586*d4514f0bSApple OSS Distributions IOReturn
setStateByIndices(int channel_index,int new_state_index)587*d4514f0bSApple OSS Distributions IOStateReporter::setStateByIndices(int channel_index,
588*d4514f0bSApple OSS Distributions     int new_state_index)
589*d4514f0bSApple OSS Distributions {
590*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
591*d4514f0bSApple OSS Distributions 	uint64_t last_intransition = 0;
592*d4514f0bSApple OSS Distributions 	uint64_t prev_state_residency = 0;
593*d4514f0bSApple OSS Distributions 
594*d4514f0bSApple OSS Distributions 	lockReporter();
595*d4514f0bSApple OSS Distributions 
596*d4514f0bSApple OSS Distributions 	res = handleSetStateByIndices(channel_index, new_state_index,
597*d4514f0bSApple OSS Distributions 	    last_intransition, prev_state_residency);
598*d4514f0bSApple OSS Distributions 
599*d4514f0bSApple OSS Distributions 	unlockReporter();
600*d4514f0bSApple OSS Distributions 
601*d4514f0bSApple OSS Distributions 	return res;
602*d4514f0bSApple OSS Distributions }
603*d4514f0bSApple OSS Distributions 
604*d4514f0bSApple OSS Distributions IOReturn
setStateByIndices(int channel_index,int new_state_index,uint64_t last_intransition,uint64_t prev_state_residency)605*d4514f0bSApple OSS Distributions IOStateReporter::setStateByIndices(int channel_index,
606*d4514f0bSApple OSS Distributions     int new_state_index,
607*d4514f0bSApple OSS Distributions     uint64_t last_intransition,
608*d4514f0bSApple OSS Distributions     uint64_t prev_state_residency)
609*d4514f0bSApple OSS Distributions {
610*d4514f0bSApple OSS Distributions 	return setStateByIndices(channel_index, new_state_index);
611*d4514f0bSApple OSS Distributions }
612*d4514f0bSApple OSS Distributions 
613*d4514f0bSApple OSS Distributions IOReturn
handleSetStateByIndices(int channel_index,int new_state_index,uint64_t last_intransition,uint64_t prev_state_residency)614*d4514f0bSApple OSS Distributions IOStateReporter::handleSetStateByIndices(int channel_index,
615*d4514f0bSApple OSS Distributions     int new_state_index,
616*d4514f0bSApple OSS Distributions     uint64_t last_intransition,
617*d4514f0bSApple OSS Distributions     uint64_t prev_state_residency)
618*d4514f0bSApple OSS Distributions {
619*d4514f0bSApple OSS Distributions 	IOReturn res = kIOReturnError;
620*d4514f0bSApple OSS Distributions 
621*d4514f0bSApple OSS Distributions 	IOStateReportValues curr_state_values, new_state_values;
622*d4514f0bSApple OSS Distributions 	int curr_state_index = 0;
623*d4514f0bSApple OSS Distributions 	int curr_element_index, new_element_index;
624*d4514f0bSApple OSS Distributions 	uint64_t last_ch_update_time = 0;
625*d4514f0bSApple OSS Distributions 	uint64_t recordTime = mach_absolute_time();
626*d4514f0bSApple OSS Distributions 
627*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_LOCK();
628*d4514f0bSApple OSS Distributions 
629*d4514f0bSApple OSS Distributions 	if (channel_index < 0 || channel_index >= _nChannels) {
630*d4514f0bSApple OSS Distributions 		res = kIOReturnBadArgument; goto finish;
631*d4514f0bSApple OSS Distributions 	}
632*d4514f0bSApple OSS Distributions 
633*d4514f0bSApple OSS Distributions 	// if no timestamp provided, last_intransition = time of recording (now)
634*d4514f0bSApple OSS Distributions 	if (last_intransition == 0) {
635*d4514f0bSApple OSS Distributions 		last_intransition = recordTime;
636*d4514f0bSApple OSS Distributions 	}
637*d4514f0bSApple OSS Distributions 
638*d4514f0bSApple OSS Distributions 	// First update target state if different than the current state
639*d4514f0bSApple OSS Distributions 	// _currentStates[] initialized to -1 to detect first state transition
640*d4514f0bSApple OSS Distributions 	curr_state_index = _currentStates[channel_index];
641*d4514f0bSApple OSS Distributions 	if (new_state_index != curr_state_index) {
642*d4514f0bSApple OSS Distributions 		// fetch element data
643*d4514f0bSApple OSS Distributions 		if (channel_index < 0 || channel_index > (_nElements - new_state_index)
644*d4514f0bSApple OSS Distributions 		    / _channelDimension) {
645*d4514f0bSApple OSS Distributions 			res = kIOReturnOverrun; goto finish;
646*d4514f0bSApple OSS Distributions 		}
647*d4514f0bSApple OSS Distributions 		new_element_index = channel_index * _channelDimension + new_state_index;
648*d4514f0bSApple OSS Distributions 		if (copyElementValues(new_element_index,
649*d4514f0bSApple OSS Distributions 		    (IOReportElementValues *)&new_state_values)) {
650*d4514f0bSApple OSS Distributions 			res = kIOReturnBadArgument;
651*d4514f0bSApple OSS Distributions 			goto finish;
652*d4514f0bSApple OSS Distributions 		}
653*d4514f0bSApple OSS Distributions 
654*d4514f0bSApple OSS Distributions 		// Update new state's transition info
655*d4514f0bSApple OSS Distributions 		new_state_values.intransitions += 1;
656*d4514f0bSApple OSS Distributions 		new_state_values.last_intransition = last_intransition;
657*d4514f0bSApple OSS Distributions 
658*d4514f0bSApple OSS Distributions 		// and store the values
659*d4514f0bSApple OSS Distributions 		res = setElementValues(new_element_index,
660*d4514f0bSApple OSS Distributions 		    (IOReportElementValues *)&new_state_values,
661*d4514f0bSApple OSS Distributions 		    recordTime);
662*d4514f0bSApple OSS Distributions 
663*d4514f0bSApple OSS Distributions 		if (res != kIOReturnSuccess) {
664*d4514f0bSApple OSS Distributions 			goto finish;
665*d4514f0bSApple OSS Distributions 		}
666*d4514f0bSApple OSS Distributions 
667*d4514f0bSApple OSS Distributions 		_currentStates[channel_index] = new_state_index;
668*d4514f0bSApple OSS Distributions 	}
669*d4514f0bSApple OSS Distributions 
670*d4514f0bSApple OSS Distributions 	/* Now update time spent in any previous state
671*d4514f0bSApple OSS Distributions 	 *  If new_state_index = curr_state_index, this updates time in the
672*d4514f0bSApple OSS Distributions 	 *  current state.  If this is the channel's first state transition,
673*d4514f0bSApple OSS Distributions 	 *  the last update time will be zero.
674*d4514f0bSApple OSS Distributions 	 *
675*d4514f0bSApple OSS Distributions 	 *  Note: While setState() should never be called on a channel being
676*d4514f0bSApple OSS Distributions 	 *  updated with increment/overrideChannelState(), that's another way
677*d4514f0bSApple OSS Distributions 	 *  that the last update time might not exist.  Regardless, if there
678*d4514f0bSApple OSS Distributions 	 *  is no basis for determining time spent in previous state, there's
679*d4514f0bSApple OSS Distributions 	 *  nothing to update!
680*d4514f0bSApple OSS Distributions 	 */
681*d4514f0bSApple OSS Distributions 	last_ch_update_time = _lastUpdateTimes[channel_index];
682*d4514f0bSApple OSS Distributions 	if (last_ch_update_time != 0) {
683*d4514f0bSApple OSS Distributions 		if (channel_index < 0 || channel_index > (_nElements - curr_state_index)
684*d4514f0bSApple OSS Distributions 		    / _channelDimension) {
685*d4514f0bSApple OSS Distributions 			res = kIOReturnOverrun; goto finish;
686*d4514f0bSApple OSS Distributions 		}
687*d4514f0bSApple OSS Distributions 		curr_element_index = channel_index * _channelDimension + curr_state_index;
688*d4514f0bSApple OSS Distributions 		if (copyElementValues(curr_element_index,
689*d4514f0bSApple OSS Distributions 		    (IOReportElementValues *)&curr_state_values)) {
690*d4514f0bSApple OSS Distributions 			res = kIOReturnBadArgument;
691*d4514f0bSApple OSS Distributions 			goto finish;
692*d4514f0bSApple OSS Distributions 		}
693*d4514f0bSApple OSS Distributions 		// compute the time spent in previous state, unless provided
694*d4514f0bSApple OSS Distributions 		if (prev_state_residency == 0) {
695*d4514f0bSApple OSS Distributions 			prev_state_residency = last_intransition - last_ch_update_time;
696*d4514f0bSApple OSS Distributions 		}
697*d4514f0bSApple OSS Distributions 
698*d4514f0bSApple OSS Distributions 		curr_state_values.upticks += prev_state_residency;
699*d4514f0bSApple OSS Distributions 
700*d4514f0bSApple OSS Distributions 		res = setElementValues(curr_element_index,
701*d4514f0bSApple OSS Distributions 		    (IOReportElementValues*)&curr_state_values,
702*d4514f0bSApple OSS Distributions 		    recordTime);
703*d4514f0bSApple OSS Distributions 
704*d4514f0bSApple OSS Distributions 		if (res != kIOReturnSuccess) {
705*d4514f0bSApple OSS Distributions 			goto finish;
706*d4514f0bSApple OSS Distributions 		}
707*d4514f0bSApple OSS Distributions 	}
708*d4514f0bSApple OSS Distributions 
709*d4514f0bSApple OSS Distributions 	// record basis for next "time in prior state" calculation
710*d4514f0bSApple OSS Distributions 	// (also arms a panic in override/incrementChannelState())
711*d4514f0bSApple OSS Distributions 	_lastUpdateTimes[channel_index] = last_intransition;
712*d4514f0bSApple OSS Distributions 
713*d4514f0bSApple OSS Distributions finish:
714*d4514f0bSApple OSS Distributions 	return res;
715*d4514f0bSApple OSS Distributions }
716*d4514f0bSApple OSS Distributions 
717*d4514f0bSApple OSS Distributions 
718*d4514f0bSApple OSS Distributions // blocks might make this slightly easier?
719*d4514f0bSApple OSS Distributions uint64_t
getStateInTransitions(uint64_t channel_id,uint64_t state_id)720*d4514f0bSApple OSS Distributions IOStateReporter::getStateInTransitions(uint64_t channel_id,
721*d4514f0bSApple OSS Distributions     uint64_t state_id)
722*d4514f0bSApple OSS Distributions {
723*d4514f0bSApple OSS Distributions 	return _getStateValue(channel_id, state_id, kInTransitions);
724*d4514f0bSApple OSS Distributions }
725*d4514f0bSApple OSS Distributions 
726*d4514f0bSApple OSS Distributions uint64_t
getStateResidencyTime(uint64_t channel_id,uint64_t state_id)727*d4514f0bSApple OSS Distributions IOStateReporter::getStateResidencyTime(uint64_t channel_id,
728*d4514f0bSApple OSS Distributions     uint64_t state_id)
729*d4514f0bSApple OSS Distributions {
730*d4514f0bSApple OSS Distributions 	return _getStateValue(channel_id, state_id, kResidencyTime);
731*d4514f0bSApple OSS Distributions }
732*d4514f0bSApple OSS Distributions 
733*d4514f0bSApple OSS Distributions uint64_t
getStateLastTransitionTime(uint64_t channel_id,uint64_t state_id)734*d4514f0bSApple OSS Distributions IOStateReporter::getStateLastTransitionTime(uint64_t channel_id,
735*d4514f0bSApple OSS Distributions     uint64_t state_id)
736*d4514f0bSApple OSS Distributions {
737*d4514f0bSApple OSS Distributions 	return _getStateValue(channel_id, state_id, kLastTransitionTime);
738*d4514f0bSApple OSS Distributions }
739*d4514f0bSApple OSS Distributions 
740*d4514f0bSApple OSS Distributions uint64_t
_getStateValue(uint64_t channel_id,uint64_t state_id,enum valueSelector value)741*d4514f0bSApple OSS Distributions IOStateReporter::_getStateValue(uint64_t channel_id,
742*d4514f0bSApple OSS Distributions     uint64_t state_id,
743*d4514f0bSApple OSS Distributions     enum valueSelector value)
744*d4514f0bSApple OSS Distributions {
745*d4514f0bSApple OSS Distributions 	int channel_index = 0, element_index = 0, cnt;
746*d4514f0bSApple OSS Distributions 	IOStateReportValues *values = NULL;
747*d4514f0bSApple OSS Distributions 	uint64_t result = kIOReportInvalidValue;
748*d4514f0bSApple OSS Distributions 
749*d4514f0bSApple OSS Distributions 	lockReporter();
750*d4514f0bSApple OSS Distributions 
751*d4514f0bSApple OSS Distributions 	if (getChannelIndices(channel_id, &channel_index, &element_index) == kIOReturnSuccess) {
752*d4514f0bSApple OSS Distributions 		if (updateChannelValues(channel_index) == kIOReturnSuccess) {
753*d4514f0bSApple OSS Distributions 			for (cnt = 0; cnt < _channelDimension; cnt++) {
754*d4514f0bSApple OSS Distributions 				values = (IOStateReportValues *)getElementValues(element_index);
755*d4514f0bSApple OSS Distributions 
756*d4514f0bSApple OSS Distributions 				if (state_id == values->state_id) {
757*d4514f0bSApple OSS Distributions 					switch (value) {
758*d4514f0bSApple OSS Distributions 					case kInTransitions:
759*d4514f0bSApple OSS Distributions 						result = values->intransitions;
760*d4514f0bSApple OSS Distributions 						break;
761*d4514f0bSApple OSS Distributions 					case kResidencyTime:
762*d4514f0bSApple OSS Distributions 						result = values->upticks;
763*d4514f0bSApple OSS Distributions 						break;
764*d4514f0bSApple OSS Distributions 					case kLastTransitionTime:
765*d4514f0bSApple OSS Distributions 						result = values->last_intransition;
766*d4514f0bSApple OSS Distributions 						break;
767*d4514f0bSApple OSS Distributions 					default:
768*d4514f0bSApple OSS Distributions 						break;
769*d4514f0bSApple OSS Distributions 					}
770*d4514f0bSApple OSS Distributions 
771*d4514f0bSApple OSS Distributions 					break;
772*d4514f0bSApple OSS Distributions 				}
773*d4514f0bSApple OSS Distributions 
774*d4514f0bSApple OSS Distributions 				element_index++;
775*d4514f0bSApple OSS Distributions 			}
776*d4514f0bSApple OSS Distributions 		}
777*d4514f0bSApple OSS Distributions 	}
778*d4514f0bSApple OSS Distributions 
779*d4514f0bSApple OSS Distributions 	unlockReporter();
780*d4514f0bSApple OSS Distributions 	return result;
781*d4514f0bSApple OSS Distributions }
782*d4514f0bSApple OSS Distributions 
783*d4514f0bSApple OSS Distributions 
784*d4514f0bSApple OSS Distributions uint64_t
getStateLastChannelUpdateTime(uint64_t channel_id)785*d4514f0bSApple OSS Distributions IOStateReporter::getStateLastChannelUpdateTime(uint64_t channel_id)
786*d4514f0bSApple OSS Distributions {
787*d4514f0bSApple OSS Distributions 	int channel_index;
788*d4514f0bSApple OSS Distributions 	uint64_t result = kIOReportInvalidValue;
789*d4514f0bSApple OSS Distributions 
790*d4514f0bSApple OSS Distributions 	lockReporter();
791*d4514f0bSApple OSS Distributions 
792*d4514f0bSApple OSS Distributions 	if (getChannelIndex(channel_id, &channel_index) == kIOReturnSuccess) {
793*d4514f0bSApple OSS Distributions 		result = _lastUpdateTimes[channel_index];
794*d4514f0bSApple OSS Distributions 	}
795*d4514f0bSApple OSS Distributions 
796*d4514f0bSApple OSS Distributions 	unlockReporter();
797*d4514f0bSApple OSS Distributions 
798*d4514f0bSApple OSS Distributions 	return result;
799*d4514f0bSApple OSS Distributions }
800*d4514f0bSApple OSS Distributions 
801*d4514f0bSApple OSS Distributions 
802*d4514f0bSApple OSS Distributions /* updateChannelValues() is called to refresh state before being
803*d4514f0bSApple OSS Distributions  *  reported outside the reporter.  In the case of IOStateReporter,
804*d4514f0bSApple OSS Distributions  *  this is primarily an update to the "time in state" data.
805*d4514f0bSApple OSS Distributions  */
806*d4514f0bSApple OSS Distributions IOReturn
updateChannelValues(int channel_index)807*d4514f0bSApple OSS Distributions IOStateReporter::updateChannelValues(int channel_index)
808*d4514f0bSApple OSS Distributions {
809*d4514f0bSApple OSS Distributions 	IOReturn kerr, result = kIOReturnError;
810*d4514f0bSApple OSS Distributions 
811*d4514f0bSApple OSS Distributions 	int state_index, element_idx;
812*d4514f0bSApple OSS Distributions 	uint64_t currentTime;
813*d4514f0bSApple OSS Distributions 	uint64_t last_ch_update_time;
814*d4514f0bSApple OSS Distributions 	uint64_t time_in_state;
815*d4514f0bSApple OSS Distributions 	IOStateReportValues state_values;
816*d4514f0bSApple OSS Distributions 
817*d4514f0bSApple OSS Distributions 	IOREPORTER_CHECK_LOCK();
818*d4514f0bSApple OSS Distributions 
819*d4514f0bSApple OSS Distributions 	if (channel_index < 0 || channel_index >= _nChannels) {
820*d4514f0bSApple OSS Distributions 		result = kIOReturnBadArgument; goto finish;
821*d4514f0bSApple OSS Distributions 	}
822*d4514f0bSApple OSS Distributions 
823*d4514f0bSApple OSS Distributions 	/* First check to see whether this channel has begun self-
824*d4514f0bSApple OSS Distributions 	 *  calculation of time in state.  It's possible this channel
825*d4514f0bSApple OSS Distributions 	 *  has yet to be initialized or that the driver is updating
826*d4514f0bSApple OSS Distributions 	 *  the channel with override/incrementChannelState() which
827*d4514f0bSApple OSS Distributions 	 *  never enable automatic time-in-state updates.  In that case,
828*d4514f0bSApple OSS Distributions 	 *  there is nothing to update and we return success.
829*d4514f0bSApple OSS Distributions 	 */
830*d4514f0bSApple OSS Distributions 	last_ch_update_time = _lastUpdateTimes[channel_index];
831*d4514f0bSApple OSS Distributions 	if (last_ch_update_time == 0) {
832*d4514f0bSApple OSS Distributions 		result = kIOReturnSuccess; goto finish;
833*d4514f0bSApple OSS Distributions 	}
834*d4514f0bSApple OSS Distributions 
835*d4514f0bSApple OSS Distributions 	// figure out the current state (if any)
836*d4514f0bSApple OSS Distributions 	state_index = _currentStates[channel_index];
837*d4514f0bSApple OSS Distributions 
838*d4514f0bSApple OSS Distributions 	// e.g. given 4 4-state channels, the boundary is ch[3].st[3] <- _elems[15]
839*d4514f0bSApple OSS Distributions 	if (channel_index < 0 || channel_index > (_nElements - state_index)
840*d4514f0bSApple OSS Distributions 	    / _channelDimension) {
841*d4514f0bSApple OSS Distributions 		result = kIOReturnOverrun; goto finish;
842*d4514f0bSApple OSS Distributions 	}
843*d4514f0bSApple OSS Distributions 	element_idx = channel_index * _channelDimension + state_index;
844*d4514f0bSApple OSS Distributions 
845*d4514f0bSApple OSS Distributions 	// get the current values
846*d4514f0bSApple OSS Distributions 	kerr = copyElementValues(element_idx, (IOReportElementValues*)&state_values);
847*d4514f0bSApple OSS Distributions 	if (kerr) {
848*d4514f0bSApple OSS Distributions 		result = kerr; goto finish;
849*d4514f0bSApple OSS Distributions 	}
850*d4514f0bSApple OSS Distributions 
851*d4514f0bSApple OSS Distributions 	// calculate time in state
852*d4514f0bSApple OSS Distributions 	currentTime = mach_absolute_time();
853*d4514f0bSApple OSS Distributions 	time_in_state = currentTime - last_ch_update_time;
854*d4514f0bSApple OSS Distributions 	state_values.upticks += time_in_state;
855*d4514f0bSApple OSS Distributions 
856*d4514f0bSApple OSS Distributions 	// and store the values
857*d4514f0bSApple OSS Distributions 	kerr = setElementValues(element_idx,
858*d4514f0bSApple OSS Distributions 	    (IOReportElementValues *)&state_values,
859*d4514f0bSApple OSS Distributions 	    currentTime);
860*d4514f0bSApple OSS Distributions 	if (kerr) {
861*d4514f0bSApple OSS Distributions 		result = kerr; goto finish;
862*d4514f0bSApple OSS Distributions 	}
863*d4514f0bSApple OSS Distributions 
864*d4514f0bSApple OSS Distributions 	// Record basis for next "prior time" calculation
865*d4514f0bSApple OSS Distributions 	_lastUpdateTimes[channel_index] = currentTime;
866*d4514f0bSApple OSS Distributions 
867*d4514f0bSApple OSS Distributions 
868*d4514f0bSApple OSS Distributions 	// success
869*d4514f0bSApple OSS Distributions 	result = kIOReturnSuccess;
870*d4514f0bSApple OSS Distributions 
871*d4514f0bSApple OSS Distributions finish:
872*d4514f0bSApple OSS Distributions 	return result;
873*d4514f0bSApple OSS Distributions }
874*d4514f0bSApple OSS Distributions 
875*d4514f0bSApple OSS Distributions /* static */ OSPtr<IOReportLegendEntry>
createLegend(const uint64_t * channelIDs,const char ** channelNames,int channelCount,int nstates,IOReportCategories categories,IOReportUnit unit)876*d4514f0bSApple OSS Distributions IOStateReporter::createLegend(const uint64_t *channelIDs,
877*d4514f0bSApple OSS Distributions     const char **channelNames,
878*d4514f0bSApple OSS Distributions     int channelCount,
879*d4514f0bSApple OSS Distributions     int nstates,
880*d4514f0bSApple OSS Distributions     IOReportCategories categories,
881*d4514f0bSApple OSS Distributions     IOReportUnit unit)
882*d4514f0bSApple OSS Distributions {
883*d4514f0bSApple OSS Distributions 	IOReportChannelType channelType = {
884*d4514f0bSApple OSS Distributions 		.categories = categories,
885*d4514f0bSApple OSS Distributions 		.report_format = kIOReportFormatState,
886*d4514f0bSApple OSS Distributions 		.nelements = static_cast<uint16_t>(nstates),
887*d4514f0bSApple OSS Distributions 		.element_idx = 0
888*d4514f0bSApple OSS Distributions 	};
889*d4514f0bSApple OSS Distributions 
890*d4514f0bSApple OSS Distributions 	return IOReporter::legendWith(channelIDs, channelNames, channelCount, channelType, unit);
891*d4514f0bSApple OSS Distributions }
892