1*e3723e1fSApple OSS Distributions /*
2*e3723e1fSApple OSS Distributions * Copyright (c) 2017 Apple Inc. All rights reserved.
3*e3723e1fSApple OSS Distributions */
4*e3723e1fSApple OSS Distributions
5*e3723e1fSApple OSS Distributions #include <IOKit/perfcontrol/IOPerfControl.h>
6*e3723e1fSApple OSS Distributions
7*e3723e1fSApple OSS Distributions #include <stdatomic.h>
8*e3723e1fSApple OSS Distributions
9*e3723e1fSApple OSS Distributions #include <kern/thread_group.h>
10*e3723e1fSApple OSS Distributions #include <kern/task.h>
11*e3723e1fSApple OSS Distributions #include <sys/coalition.h>
12*e3723e1fSApple OSS Distributions #include <kern/coalition.h>
13*e3723e1fSApple OSS Distributions
14*e3723e1fSApple OSS Distributions #undef super
15*e3723e1fSApple OSS Distributions #define super OSObject
16*e3723e1fSApple OSS Distributions OSDefineMetaClassAndStructors(IOPerfControlClient, OSObject);
17*e3723e1fSApple OSS Distributions
18*e3723e1fSApple OSS Distributions static IOPerfControlClient::IOPerfControlClientShared *_Atomic gIOPerfControlClientShared;
19*e3723e1fSApple OSS Distributions
20*e3723e1fSApple OSS Distributions bool
init(IOService * driver,uint64_t maxWorkCapacity)21*e3723e1fSApple OSS Distributions IOPerfControlClient::init(IOService *driver, uint64_t maxWorkCapacity)
22*e3723e1fSApple OSS Distributions {
23*e3723e1fSApple OSS Distributions // TODO: Remove this limit and implement dynamic table growth if workloads are found that exceed this
24*e3723e1fSApple OSS Distributions if (maxWorkCapacity > kMaxWorkTableNumEntries) {
25*e3723e1fSApple OSS Distributions maxWorkCapacity = kMaxWorkTableNumEntries;
26*e3723e1fSApple OSS Distributions }
27*e3723e1fSApple OSS Distributions
28*e3723e1fSApple OSS Distributions if (!super::init()) {
29*e3723e1fSApple OSS Distributions return false;
30*e3723e1fSApple OSS Distributions }
31*e3723e1fSApple OSS Distributions
32*e3723e1fSApple OSS Distributions shared = atomic_load_explicit(&gIOPerfControlClientShared, memory_order_acquire);
33*e3723e1fSApple OSS Distributions if (shared == nullptr) {
34*e3723e1fSApple OSS Distributions IOPerfControlClient::IOPerfControlClientShared *expected = shared;
35*e3723e1fSApple OSS Distributions shared = kalloc_type(IOPerfControlClientShared, Z_WAITOK);
36*e3723e1fSApple OSS Distributions if (!shared) {
37*e3723e1fSApple OSS Distributions return false;
38*e3723e1fSApple OSS Distributions }
39*e3723e1fSApple OSS Distributions
40*e3723e1fSApple OSS Distributions atomic_init(&shared->maxDriverIndex, 0);
41*e3723e1fSApple OSS Distributions
42*e3723e1fSApple OSS Distributions shared->interface = PerfControllerInterface{
43*e3723e1fSApple OSS Distributions .version = PERFCONTROL_INTERFACE_VERSION_NONE,
44*e3723e1fSApple OSS Distributions .registerDevice =
45*e3723e1fSApple OSS Distributions [](IOService *device) {
46*e3723e1fSApple OSS Distributions return kIOReturnSuccess;
47*e3723e1fSApple OSS Distributions },
48*e3723e1fSApple OSS Distributions .unregisterDevice =
49*e3723e1fSApple OSS Distributions [](IOService *device) {
50*e3723e1fSApple OSS Distributions return kIOReturnSuccess;
51*e3723e1fSApple OSS Distributions },
52*e3723e1fSApple OSS Distributions .workCanSubmit =
53*e3723e1fSApple OSS Distributions [](IOService *device, PerfControllerInterface::WorkState *state, WorkSubmitArgs *args) {
54*e3723e1fSApple OSS Distributions return false;
55*e3723e1fSApple OSS Distributions },
56*e3723e1fSApple OSS Distributions .workSubmit =
57*e3723e1fSApple OSS Distributions [](IOService *device, uint64_t token, PerfControllerInterface::WorkState *state, WorkSubmitArgs *args) {
58*e3723e1fSApple OSS Distributions },
59*e3723e1fSApple OSS Distributions .workBegin =
60*e3723e1fSApple OSS Distributions [](IOService *device, uint64_t token, PerfControllerInterface::WorkState *state, WorkBeginArgs *args) {
61*e3723e1fSApple OSS Distributions },
62*e3723e1fSApple OSS Distributions .workEnd =
63*e3723e1fSApple OSS Distributions [](IOService *device, uint64_t token, PerfControllerInterface::WorkState *state, WorkEndArgs *args, bool done) {
64*e3723e1fSApple OSS Distributions },
65*e3723e1fSApple OSS Distributions .workUpdate =
66*e3723e1fSApple OSS Distributions [](IOService *device, uint64_t token, PerfControllerInterface::WorkState *state, WorkUpdateArgs *args) {
67*e3723e1fSApple OSS Distributions },
68*e3723e1fSApple OSS Distributions };
69*e3723e1fSApple OSS Distributions
70*e3723e1fSApple OSS Distributions shared->interfaceLock = IOLockAlloc();
71*e3723e1fSApple OSS Distributions if (!shared->interfaceLock) {
72*e3723e1fSApple OSS Distributions goto shared_init_error;
73*e3723e1fSApple OSS Distributions }
74*e3723e1fSApple OSS Distributions
75*e3723e1fSApple OSS Distributions shared->deviceRegistrationList = OSSet::withCapacity(4);
76*e3723e1fSApple OSS Distributions if (!shared->deviceRegistrationList) {
77*e3723e1fSApple OSS Distributions goto shared_init_error;
78*e3723e1fSApple OSS Distributions }
79*e3723e1fSApple OSS Distributions
80*e3723e1fSApple OSS Distributions if (!atomic_compare_exchange_strong_explicit(&gIOPerfControlClientShared, &expected, shared, memory_order_acq_rel,
81*e3723e1fSApple OSS Distributions memory_order_acquire)) {
82*e3723e1fSApple OSS Distributions IOLockFree(shared->interfaceLock);
83*e3723e1fSApple OSS Distributions shared->deviceRegistrationList->release();
84*e3723e1fSApple OSS Distributions kfree_type(IOPerfControlClientShared, shared);
85*e3723e1fSApple OSS Distributions shared = expected;
86*e3723e1fSApple OSS Distributions }
87*e3723e1fSApple OSS Distributions }
88*e3723e1fSApple OSS Distributions workTable = NULL;
89*e3723e1fSApple OSS Distributions workTableLock = NULL;
90*e3723e1fSApple OSS Distributions
91*e3723e1fSApple OSS Distributions // Note: driverIndex is not guaranteed to be unique if maxDriverIndex wraps around. It is intended for debugging only.
92*e3723e1fSApple OSS Distributions driverIndex = atomic_fetch_add_explicit(&shared->maxDriverIndex, 1, memory_order_relaxed) + 1;
93*e3723e1fSApple OSS Distributions
94*e3723e1fSApple OSS Distributions // + 1 since index 0 is unused for kIOPerfControlClientWorkUntracked
95*e3723e1fSApple OSS Distributions workTableLength = maxWorkCapacity + 1;
96*e3723e1fSApple OSS Distributions assertf(workTableLength <= kWorkTableMaxSize, "%zu exceeds max allowed capacity of %zu", workTableLength, kWorkTableMaxSize);
97*e3723e1fSApple OSS Distributions if (maxWorkCapacity > 0) {
98*e3723e1fSApple OSS Distributions workTable = kalloc_type(WorkTableEntry, workTableLength, Z_WAITOK_ZERO);
99*e3723e1fSApple OSS Distributions if (!workTable) {
100*e3723e1fSApple OSS Distributions goto error;
101*e3723e1fSApple OSS Distributions }
102*e3723e1fSApple OSS Distributions workTableNextIndex = 1;
103*e3723e1fSApple OSS Distributions
104*e3723e1fSApple OSS Distributions workTableLock = IOSimpleLockAlloc();
105*e3723e1fSApple OSS Distributions if (!workTableLock) {
106*e3723e1fSApple OSS Distributions goto error;
107*e3723e1fSApple OSS Distributions }
108*e3723e1fSApple OSS Distributions }
109*e3723e1fSApple OSS Distributions
110*e3723e1fSApple OSS Distributions bzero(&clientData, sizeof(clientData));
111*e3723e1fSApple OSS Distributions
112*e3723e1fSApple OSS Distributions return true;
113*e3723e1fSApple OSS Distributions
114*e3723e1fSApple OSS Distributions error:
115*e3723e1fSApple OSS Distributions if (workTable) {
116*e3723e1fSApple OSS Distributions kfree_type(WorkTableEntry, workTableLength, workTable);
117*e3723e1fSApple OSS Distributions workTable = NULL;
118*e3723e1fSApple OSS Distributions }
119*e3723e1fSApple OSS Distributions if (workTableLock) {
120*e3723e1fSApple OSS Distributions IOSimpleLockFree(workTableLock);
121*e3723e1fSApple OSS Distributions workTableLock = NULL;
122*e3723e1fSApple OSS Distributions }
123*e3723e1fSApple OSS Distributions return false;
124*e3723e1fSApple OSS Distributions shared_init_error:
125*e3723e1fSApple OSS Distributions if (shared) {
126*e3723e1fSApple OSS Distributions if (shared->interfaceLock) {
127*e3723e1fSApple OSS Distributions IOLockFree(shared->interfaceLock);
128*e3723e1fSApple OSS Distributions }
129*e3723e1fSApple OSS Distributions if (shared->deviceRegistrationList) {
130*e3723e1fSApple OSS Distributions shared->deviceRegistrationList->release();
131*e3723e1fSApple OSS Distributions }
132*e3723e1fSApple OSS Distributions kfree_type(IOPerfControlClientShared, shared);
133*e3723e1fSApple OSS Distributions shared = nullptr;
134*e3723e1fSApple OSS Distributions }
135*e3723e1fSApple OSS Distributions return false;
136*e3723e1fSApple OSS Distributions }
137*e3723e1fSApple OSS Distributions
138*e3723e1fSApple OSS Distributions void
free()139*e3723e1fSApple OSS Distributions IOPerfControlClient::free()
140*e3723e1fSApple OSS Distributions {
141*e3723e1fSApple OSS Distributions if (workTable) {
142*e3723e1fSApple OSS Distributions kfree_type(WorkTableEntry, workTableLength, workTable);
143*e3723e1fSApple OSS Distributions }
144*e3723e1fSApple OSS Distributions if (workTableLock) {
145*e3723e1fSApple OSS Distributions IOSimpleLockFree(workTableLock);
146*e3723e1fSApple OSS Distributions }
147*e3723e1fSApple OSS Distributions super::free();
148*e3723e1fSApple OSS Distributions }
149*e3723e1fSApple OSS Distributions
150*e3723e1fSApple OSS Distributions IOPerfControlClient *
copyClient(IOService * driver,uint64_t maxWorkCapacity)151*e3723e1fSApple OSS Distributions IOPerfControlClient::copyClient(IOService *driver, uint64_t maxWorkCapacity)
152*e3723e1fSApple OSS Distributions {
153*e3723e1fSApple OSS Distributions IOPerfControlClient *client = new IOPerfControlClient;
154*e3723e1fSApple OSS Distributions if (!client || !client->init(driver, maxWorkCapacity)) {
155*e3723e1fSApple OSS Distributions panic("could not create IOPerfControlClient");
156*e3723e1fSApple OSS Distributions }
157*e3723e1fSApple OSS Distributions return client;
158*e3723e1fSApple OSS Distributions }
159*e3723e1fSApple OSS Distributions
160*e3723e1fSApple OSS Distributions /* Convert the per driver token into a globally unique token for the performance
161*e3723e1fSApple OSS Distributions * controller's consumption. This is achieved by setting the driver's unique
162*e3723e1fSApple OSS Distributions * index onto the high order bits. The performance controller is shared between
163*e3723e1fSApple OSS Distributions * all drivers and must track all instances separately, while each driver has
164*e3723e1fSApple OSS Distributions * its own token table, so this step is needed to avoid token collisions between
165*e3723e1fSApple OSS Distributions * drivers.
166*e3723e1fSApple OSS Distributions */
167*e3723e1fSApple OSS Distributions inline uint64_t
tokenToGlobalUniqueToken(uint64_t token)168*e3723e1fSApple OSS Distributions IOPerfControlClient::tokenToGlobalUniqueToken(uint64_t token)
169*e3723e1fSApple OSS Distributions {
170*e3723e1fSApple OSS Distributions return token | (static_cast<uint64_t>(driverIndex) << kWorkTableIndexBits);
171*e3723e1fSApple OSS Distributions }
172*e3723e1fSApple OSS Distributions
173*e3723e1fSApple OSS Distributions /* Accounting resources used in a work item to the containing coalition.
174*e3723e1fSApple OSS Distributions * Contigent upon the PerfController signaling that it wants resource accounting
175*e3723e1fSApple OSS Distributions * in the registerDevice()/registerDriverDevice calls. More device types can
176*e3723e1fSApple OSS Distributions * be added here in the future.
177*e3723e1fSApple OSS Distributions */
178*e3723e1fSApple OSS Distributions void
accountResources(coalition_t coal,PerfControllerInterface::PerfDeviceID device_type,PerfControllerInterface::ResourceAccounting * resources)179*e3723e1fSApple OSS Distributions IOPerfControlClient::accountResources(coalition_t coal, PerfControllerInterface::PerfDeviceID device_type, PerfControllerInterface::ResourceAccounting *resources)
180*e3723e1fSApple OSS Distributions {
181*e3723e1fSApple OSS Distributions switch (device_type) {
182*e3723e1fSApple OSS Distributions case PerfControllerInterface::PerfDeviceID::kANE:
183*e3723e1fSApple OSS Distributions if (coal != nullptr) {
184*e3723e1fSApple OSS Distributions coalition_update_ane_stats(coal, resources->mach_time_delta, resources->energy_nj_delta);
185*e3723e1fSApple OSS Distributions }
186*e3723e1fSApple OSS Distributions break;
187*e3723e1fSApple OSS Distributions
188*e3723e1fSApple OSS Distributions default:
189*e3723e1fSApple OSS Distributions assertf(false, "Unexpected device type for IOPerfControlClient::accountResources: %llu", static_cast<uint64_t>(device_type));
190*e3723e1fSApple OSS Distributions }
191*e3723e1fSApple OSS Distributions }
192*e3723e1fSApple OSS Distributions
193*e3723e1fSApple OSS Distributions /* With this implementation, tokens returned to the driver differ from tokens
194*e3723e1fSApple OSS Distributions * passed to the performance controller. This implementation has the nice
195*e3723e1fSApple OSS Distributions * property that tokens returns to the driver will aways be between 1 and
196*e3723e1fSApple OSS Distributions * the value of maxWorkCapacity passed by the driver to copyClient. The tokens
197*e3723e1fSApple OSS Distributions * the performance controller sees will match on the lower order bits and have
198*e3723e1fSApple OSS Distributions * the driver index set on the high order bits.
199*e3723e1fSApple OSS Distributions */
200*e3723e1fSApple OSS Distributions uint64_t
allocateToken(thread_group * thread_group)201*e3723e1fSApple OSS Distributions IOPerfControlClient::allocateToken(thread_group *thread_group)
202*e3723e1fSApple OSS Distributions {
203*e3723e1fSApple OSS Distributions uint64_t token = kIOPerfControlClientWorkUntracked;
204*e3723e1fSApple OSS Distributions
205*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
206*e3723e1fSApple OSS Distributions auto s = IOSimpleLockLockDisableInterrupt(workTableLock);
207*e3723e1fSApple OSS Distributions
208*e3723e1fSApple OSS Distributions uint64_t num_tries = 0;
209*e3723e1fSApple OSS Distributions size_t index = workTableNextIndex;
210*e3723e1fSApple OSS Distributions // - 1 since entry 0 is for kIOPerfControlClientWorkUntracked
211*e3723e1fSApple OSS Distributions while (num_tries < workTableLength - 1) {
212*e3723e1fSApple OSS Distributions if (workTable[index].thread_group == nullptr) {
213*e3723e1fSApple OSS Distributions thread_group_retain(thread_group);
214*e3723e1fSApple OSS Distributions workTable[index].thread_group = thread_group;
215*e3723e1fSApple OSS Distributions if (clientData.driverState.resource_accounting) {
216*e3723e1fSApple OSS Distributions auto *coalition = task_get_coalition(current_task(), COALITION_TYPE_RESOURCE);
217*e3723e1fSApple OSS Distributions assert(coalition != nullptr);
218*e3723e1fSApple OSS Distributions coalition_retain(coalition);
219*e3723e1fSApple OSS Distributions workTable[index].coal = coalition;
220*e3723e1fSApple OSS Distributions }
221*e3723e1fSApple OSS Distributions token = index;
222*e3723e1fSApple OSS Distributions // next integer between 1 and workTableLength - 1
223*e3723e1fSApple OSS Distributions workTableNextIndex = (index % (workTableLength - 1)) + 1;
224*e3723e1fSApple OSS Distributions break;
225*e3723e1fSApple OSS Distributions }
226*e3723e1fSApple OSS Distributions // next integer between 1 and workTableLength - 1
227*e3723e1fSApple OSS Distributions index = (index % (workTableLength - 1)) + 1;
228*e3723e1fSApple OSS Distributions num_tries += 1;
229*e3723e1fSApple OSS Distributions }
230*e3723e1fSApple OSS Distributions #if (DEVELOPMENT || DEBUG)
231*e3723e1fSApple OSS Distributions if (token == kIOPerfControlClientWorkUntracked) {
232*e3723e1fSApple OSS Distributions /* When investigating a panic here, first check that the driver is not leaking tokens.
233*e3723e1fSApple OSS Distributions * If the driver is not leaking tokens and maximum is less than kMaxWorkTableNumEntries,
234*e3723e1fSApple OSS Distributions * the driver should be modified to pass a larger value to copyClient.
235*e3723e1fSApple OSS Distributions * If the driver is not leaking tokens and maximum is equal to kMaxWorkTableNumEntries,
236*e3723e1fSApple OSS Distributions * this code will have to be modified to support dynamic table growth to support larger
237*e3723e1fSApple OSS Distributions * numbers of tokens.
238*e3723e1fSApple OSS Distributions */
239*e3723e1fSApple OSS Distributions panic("Tokens allocated for this device exceeded maximum of %zu.",
240*e3723e1fSApple OSS Distributions workTableLength - 1); // - 1 since entry 0 is for kIOPerfControlClientWorkUntracked
241*e3723e1fSApple OSS Distributions }
242*e3723e1fSApple OSS Distributions #endif
243*e3723e1fSApple OSS Distributions
244*e3723e1fSApple OSS Distributions IOSimpleLockUnlockEnableInterrupt(workTableLock, s);
245*e3723e1fSApple OSS Distributions #endif
246*e3723e1fSApple OSS Distributions
247*e3723e1fSApple OSS Distributions return token;
248*e3723e1fSApple OSS Distributions }
249*e3723e1fSApple OSS Distributions
250*e3723e1fSApple OSS Distributions void
deallocateToken(uint64_t token)251*e3723e1fSApple OSS Distributions IOPerfControlClient::deallocateToken(uint64_t token)
252*e3723e1fSApple OSS Distributions {
253*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
254*e3723e1fSApple OSS Distributions assertf(token != kIOPerfControlClientWorkUntracked, "Attempt to deallocate token kIOPerfControlClientWorkUntracked\n");
255*e3723e1fSApple OSS Distributions assertf(token <= workTableLength, "Attempt to deallocate token %llu which is greater than the table size of %zu\n", token, workTableLength);
256*e3723e1fSApple OSS Distributions auto s = IOSimpleLockLockDisableInterrupt(workTableLock);
257*e3723e1fSApple OSS Distributions
258*e3723e1fSApple OSS Distributions auto &entry = workTable[token];
259*e3723e1fSApple OSS Distributions auto *thread_group = entry.thread_group;
260*e3723e1fSApple OSS Distributions auto *coal = entry.coal;
261*e3723e1fSApple OSS Distributions bzero(&entry, sizeof(entry));
262*e3723e1fSApple OSS Distributions workTableNextIndex = token;
263*e3723e1fSApple OSS Distributions
264*e3723e1fSApple OSS Distributions IOSimpleLockUnlockEnableInterrupt(workTableLock, s);
265*e3723e1fSApple OSS Distributions
266*e3723e1fSApple OSS Distributions // This can call into the performance controller if the last reference is dropped here. Are we sure
267*e3723e1fSApple OSS Distributions // the driver isn't holding any locks? If not, we may want to async this to another context.
268*e3723e1fSApple OSS Distributions thread_group_release(thread_group);
269*e3723e1fSApple OSS Distributions if (coal != nullptr) {
270*e3723e1fSApple OSS Distributions coalition_release(coal);
271*e3723e1fSApple OSS Distributions }
272*e3723e1fSApple OSS Distributions #endif
273*e3723e1fSApple OSS Distributions }
274*e3723e1fSApple OSS Distributions
275*e3723e1fSApple OSS Distributions IOPerfControlClient::WorkTableEntry *
getEntryForToken(uint64_t token)276*e3723e1fSApple OSS Distributions IOPerfControlClient::getEntryForToken(uint64_t token)
277*e3723e1fSApple OSS Distributions {
278*e3723e1fSApple OSS Distributions if (token == kIOPerfControlClientWorkUntracked) {
279*e3723e1fSApple OSS Distributions return nullptr;
280*e3723e1fSApple OSS Distributions }
281*e3723e1fSApple OSS Distributions
282*e3723e1fSApple OSS Distributions if (token >= workTableLength) {
283*e3723e1fSApple OSS Distributions panic("Invalid work token (%llu): index out of bounds.", token);
284*e3723e1fSApple OSS Distributions }
285*e3723e1fSApple OSS Distributions
286*e3723e1fSApple OSS Distributions WorkTableEntry *entry = &workTable[token];
287*e3723e1fSApple OSS Distributions assertf(entry->thread_group, "Invalid work token: %llu", token);
288*e3723e1fSApple OSS Distributions return entry;
289*e3723e1fSApple OSS Distributions }
290*e3723e1fSApple OSS Distributions
291*e3723e1fSApple OSS Distributions void
markEntryStarted(uint64_t token,bool started)292*e3723e1fSApple OSS Distributions IOPerfControlClient::markEntryStarted(uint64_t token, bool started)
293*e3723e1fSApple OSS Distributions {
294*e3723e1fSApple OSS Distributions if (token == kIOPerfControlClientWorkUntracked) {
295*e3723e1fSApple OSS Distributions return;
296*e3723e1fSApple OSS Distributions }
297*e3723e1fSApple OSS Distributions
298*e3723e1fSApple OSS Distributions if (token >= workTableLength) {
299*e3723e1fSApple OSS Distributions panic("Invalid work token (%llu): index out of bounds.", token);
300*e3723e1fSApple OSS Distributions }
301*e3723e1fSApple OSS Distributions
302*e3723e1fSApple OSS Distributions workTable[token].started = started;
303*e3723e1fSApple OSS Distributions }
304*e3723e1fSApple OSS Distributions
305*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
306*e3723e1fSApple OSS Distributions
307*e3723e1fSApple OSS Distributions static struct thread_group *
threadGroupForDextService(IOService * device)308*e3723e1fSApple OSS Distributions threadGroupForDextService(IOService *device)
309*e3723e1fSApple OSS Distributions {
310*e3723e1fSApple OSS Distributions assert(device);
311*e3723e1fSApple OSS Distributions
312*e3723e1fSApple OSS Distributions if (!device->hasUserServer()) {
313*e3723e1fSApple OSS Distributions return NULL;
314*e3723e1fSApple OSS Distributions }
315*e3723e1fSApple OSS Distributions
316*e3723e1fSApple OSS Distributions // Devices associated with a dext driver, must be called from dext
317*e3723e1fSApple OSS Distributions // context to ensure that thread_group reference is valid.
318*e3723e1fSApple OSS Distributions thread_t thread = current_thread();
319*e3723e1fSApple OSS Distributions assert(get_threadtask(thread) != kernel_task);
320*e3723e1fSApple OSS Distributions struct thread_group * thread_group = thread_group_get(thread);
321*e3723e1fSApple OSS Distributions assert(thread_group != nullptr);
322*e3723e1fSApple OSS Distributions return thread_group;
323*e3723e1fSApple OSS Distributions }
324*e3723e1fSApple OSS Distributions
325*e3723e1fSApple OSS Distributions #endif /* CONFIG_THREAD_GROUPS */
326*e3723e1fSApple OSS Distributions
327*e3723e1fSApple OSS Distributions IOReturn
registerDevice(IOService * driver,IOService * device)328*e3723e1fSApple OSS Distributions IOPerfControlClient::registerDevice(IOService *driver, IOService *device)
329*e3723e1fSApple OSS Distributions {
330*e3723e1fSApple OSS Distributions IOReturn ret = kIOReturnSuccess;
331*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
332*e3723e1fSApple OSS Distributions IOLockLock(shared->interfaceLock);
333*e3723e1fSApple OSS Distributions
334*e3723e1fSApple OSS Distributions clientData.device = device;
335*e3723e1fSApple OSS Distributions
336*e3723e1fSApple OSS Distributions if (device) {
337*e3723e1fSApple OSS Distributions struct thread_group *dext_thread_group = threadGroupForDextService(device);
338*e3723e1fSApple OSS Distributions if (dext_thread_group) {
339*e3723e1fSApple OSS Distributions if (clientData.driverState.has_target_thread_group) {
340*e3723e1fSApple OSS Distributions panic("driverState has already been initialized");
341*e3723e1fSApple OSS Distributions }
342*e3723e1fSApple OSS Distributions clientData.driverState.has_target_thread_group = true;
343*e3723e1fSApple OSS Distributions clientData.driverState.target_thread_group_id = thread_group_get_id(dext_thread_group);
344*e3723e1fSApple OSS Distributions clientData.driverState.target_thread_group_data = thread_group_get_machine_data(dext_thread_group);
345*e3723e1fSApple OSS Distributions
346*e3723e1fSApple OSS Distributions clientData.target_thread_group = dext_thread_group;
347*e3723e1fSApple OSS Distributions thread_group_retain(dext_thread_group);
348*e3723e1fSApple OSS Distributions }
349*e3723e1fSApple OSS Distributions }
350*e3723e1fSApple OSS Distributions
351*e3723e1fSApple OSS Distributions if (shared->interface.version >= PERFCONTROL_INTERFACE_VERSION_3) {
352*e3723e1fSApple OSS Distributions ret = shared->interface.registerDriverDevice(driver, device, &clientData.driverState);
353*e3723e1fSApple OSS Distributions } else if (shared->interface.version >= PERFCONTROL_INTERFACE_VERSION_1) {
354*e3723e1fSApple OSS Distributions ret = shared->interface.registerDevice(device);
355*e3723e1fSApple OSS Distributions } else {
356*e3723e1fSApple OSS Distributions shared->deviceRegistrationList->setObject(this);
357*e3723e1fSApple OSS Distributions }
358*e3723e1fSApple OSS Distributions
359*e3723e1fSApple OSS Distributions IOLockUnlock(shared->interfaceLock);
360*e3723e1fSApple OSS Distributions #endif
361*e3723e1fSApple OSS Distributions return ret;
362*e3723e1fSApple OSS Distributions }
363*e3723e1fSApple OSS Distributions
364*e3723e1fSApple OSS Distributions void
unregisterDevice(IOService * driver,IOService * device)365*e3723e1fSApple OSS Distributions IOPerfControlClient::unregisterDevice(IOService *driver, IOService *device)
366*e3723e1fSApple OSS Distributions {
367*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
368*e3723e1fSApple OSS Distributions IOLockLock(shared->interfaceLock);
369*e3723e1fSApple OSS Distributions
370*e3723e1fSApple OSS Distributions if (shared->interface.version >= PERFCONTROL_INTERFACE_VERSION_3) {
371*e3723e1fSApple OSS Distributions shared->interface.unregisterDriverDevice(driver, device, &clientData.driverState);
372*e3723e1fSApple OSS Distributions } else if (shared->interface.version >= PERFCONTROL_INTERFACE_VERSION_1) {
373*e3723e1fSApple OSS Distributions shared->interface.unregisterDevice(device);
374*e3723e1fSApple OSS Distributions } else {
375*e3723e1fSApple OSS Distributions shared->deviceRegistrationList->removeObject(this);
376*e3723e1fSApple OSS Distributions }
377*e3723e1fSApple OSS Distributions
378*e3723e1fSApple OSS Distributions if (clientData.driverState.has_target_thread_group) {
379*e3723e1fSApple OSS Distributions thread_group_release(clientData.target_thread_group);
380*e3723e1fSApple OSS Distributions clientData.target_thread_group = nullptr;
381*e3723e1fSApple OSS Distributions
382*e3723e1fSApple OSS Distributions clientData.driverState.has_target_thread_group = false;
383*e3723e1fSApple OSS Distributions clientData.driverState.target_thread_group_id = ~0ull;
384*e3723e1fSApple OSS Distributions clientData.driverState.target_thread_group_data = nullptr;
385*e3723e1fSApple OSS Distributions }
386*e3723e1fSApple OSS Distributions
387*e3723e1fSApple OSS Distributions clientData.device = nullptr;
388*e3723e1fSApple OSS Distributions
389*e3723e1fSApple OSS Distributions IOLockUnlock(shared->interfaceLock);
390*e3723e1fSApple OSS Distributions #endif
391*e3723e1fSApple OSS Distributions }
392*e3723e1fSApple OSS Distributions
393*e3723e1fSApple OSS Distributions uint64_t
workSubmit(IOService * device,WorkSubmitArgs * args)394*e3723e1fSApple OSS Distributions IOPerfControlClient::workSubmit(IOService *device, WorkSubmitArgs *args)
395*e3723e1fSApple OSS Distributions {
396*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
397*e3723e1fSApple OSS Distributions auto *thread_group = thread_group_get(current_thread());
398*e3723e1fSApple OSS Distributions if (!thread_group) {
399*e3723e1fSApple OSS Distributions return kIOPerfControlClientWorkUntracked;
400*e3723e1fSApple OSS Distributions }
401*e3723e1fSApple OSS Distributions
402*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
403*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(thread_group),
404*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(thread_group),
405*e3723e1fSApple OSS Distributions .work_data = nullptr,
406*e3723e1fSApple OSS Distributions .work_data_size = 0,
407*e3723e1fSApple OSS Distributions .started = false,
408*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
409*e3723e1fSApple OSS Distributions };
410*e3723e1fSApple OSS Distributions if (!shared->interface.workCanSubmit(device, &state, args)) {
411*e3723e1fSApple OSS Distributions return kIOPerfControlClientWorkUntracked;
412*e3723e1fSApple OSS Distributions }
413*e3723e1fSApple OSS Distributions
414*e3723e1fSApple OSS Distributions uint64_t token = allocateToken(thread_group);
415*e3723e1fSApple OSS Distributions if (token != kIOPerfControlClientWorkUntracked) {
416*e3723e1fSApple OSS Distributions state.work_data = &workTable[token].perfcontrol_data;
417*e3723e1fSApple OSS Distributions state.work_data_size = sizeof(workTable[token].perfcontrol_data);
418*e3723e1fSApple OSS Distributions shared->interface.workSubmit(device, tokenToGlobalUniqueToken(token), &state, args);
419*e3723e1fSApple OSS Distributions }
420*e3723e1fSApple OSS Distributions return token;
421*e3723e1fSApple OSS Distributions #else
422*e3723e1fSApple OSS Distributions return kIOPerfControlClientWorkUntracked;
423*e3723e1fSApple OSS Distributions #endif
424*e3723e1fSApple OSS Distributions }
425*e3723e1fSApple OSS Distributions
426*e3723e1fSApple OSS Distributions uint64_t
workSubmitAndBegin(IOService * device,WorkSubmitArgs * submitArgs,WorkBeginArgs * beginArgs)427*e3723e1fSApple OSS Distributions IOPerfControlClient::workSubmitAndBegin(IOService *device, WorkSubmitArgs *submitArgs, WorkBeginArgs *beginArgs)
428*e3723e1fSApple OSS Distributions {
429*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
430*e3723e1fSApple OSS Distributions auto *thread_group = thread_group_get(current_thread());
431*e3723e1fSApple OSS Distributions if (!thread_group) {
432*e3723e1fSApple OSS Distributions return kIOPerfControlClientWorkUntracked;
433*e3723e1fSApple OSS Distributions }
434*e3723e1fSApple OSS Distributions
435*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
436*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(thread_group),
437*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(thread_group),
438*e3723e1fSApple OSS Distributions .work_data = nullptr,
439*e3723e1fSApple OSS Distributions .work_data_size = 0,
440*e3723e1fSApple OSS Distributions .started = false,
441*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
442*e3723e1fSApple OSS Distributions };
443*e3723e1fSApple OSS Distributions if (!shared->interface.workCanSubmit(device, &state, submitArgs)) {
444*e3723e1fSApple OSS Distributions return kIOPerfControlClientWorkUntracked;
445*e3723e1fSApple OSS Distributions }
446*e3723e1fSApple OSS Distributions
447*e3723e1fSApple OSS Distributions uint64_t token = allocateToken(thread_group);
448*e3723e1fSApple OSS Distributions if (token != kIOPerfControlClientWorkUntracked) {
449*e3723e1fSApple OSS Distributions auto &entry = workTable[token];
450*e3723e1fSApple OSS Distributions state.work_data = &entry.perfcontrol_data;
451*e3723e1fSApple OSS Distributions state.work_data_size = sizeof(workTable[token].perfcontrol_data);
452*e3723e1fSApple OSS Distributions shared->interface.workSubmit(device, tokenToGlobalUniqueToken(token), &state, submitArgs);
453*e3723e1fSApple OSS Distributions state.started = true;
454*e3723e1fSApple OSS Distributions shared->interface.workBegin(device, tokenToGlobalUniqueToken(token), &state, beginArgs);
455*e3723e1fSApple OSS Distributions markEntryStarted(token, true);
456*e3723e1fSApple OSS Distributions }
457*e3723e1fSApple OSS Distributions return token;
458*e3723e1fSApple OSS Distributions #else
459*e3723e1fSApple OSS Distributions return kIOPerfControlClientWorkUntracked;
460*e3723e1fSApple OSS Distributions #endif
461*e3723e1fSApple OSS Distributions }
462*e3723e1fSApple OSS Distributions
463*e3723e1fSApple OSS Distributions void
workBegin(IOService * device,uint64_t token,WorkBeginArgs * args)464*e3723e1fSApple OSS Distributions IOPerfControlClient::workBegin(IOService *device, uint64_t token, WorkBeginArgs *args)
465*e3723e1fSApple OSS Distributions {
466*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
467*e3723e1fSApple OSS Distributions WorkTableEntry *entry = getEntryForToken(token);
468*e3723e1fSApple OSS Distributions if (entry == nullptr) {
469*e3723e1fSApple OSS Distributions return;
470*e3723e1fSApple OSS Distributions }
471*e3723e1fSApple OSS Distributions
472*e3723e1fSApple OSS Distributions assertf(!entry->started, "Work for token %llu was already started", token);
473*e3723e1fSApple OSS Distributions
474*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
475*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(entry->thread_group),
476*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(entry->thread_group),
477*e3723e1fSApple OSS Distributions .work_data = &entry->perfcontrol_data,
478*e3723e1fSApple OSS Distributions .work_data_size = sizeof(entry->perfcontrol_data),
479*e3723e1fSApple OSS Distributions .started = true,
480*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
481*e3723e1fSApple OSS Distributions };
482*e3723e1fSApple OSS Distributions shared->interface.workBegin(device, tokenToGlobalUniqueToken(token), &state, args);
483*e3723e1fSApple OSS Distributions markEntryStarted(token, true);
484*e3723e1fSApple OSS Distributions #endif
485*e3723e1fSApple OSS Distributions }
486*e3723e1fSApple OSS Distributions
487*e3723e1fSApple OSS Distributions void
workEnd(IOService * device,uint64_t token,WorkEndArgs * args,bool done)488*e3723e1fSApple OSS Distributions IOPerfControlClient::workEnd(IOService *device, uint64_t token, WorkEndArgs *args, bool done)
489*e3723e1fSApple OSS Distributions {
490*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
491*e3723e1fSApple OSS Distributions WorkTableEntry *entry = getEntryForToken(token);
492*e3723e1fSApple OSS Distributions if (entry == nullptr) {
493*e3723e1fSApple OSS Distributions return;
494*e3723e1fSApple OSS Distributions }
495*e3723e1fSApple OSS Distributions
496*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
497*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(entry->thread_group),
498*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(entry->thread_group),
499*e3723e1fSApple OSS Distributions .work_data = &entry->perfcontrol_data,
500*e3723e1fSApple OSS Distributions .work_data_size = sizeof(entry->perfcontrol_data),
501*e3723e1fSApple OSS Distributions .started = entry->started,
502*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
503*e3723e1fSApple OSS Distributions };
504*e3723e1fSApple OSS Distributions
505*e3723e1fSApple OSS Distributions if (shared->interface.version >= PERFCONTROL_INTERFACE_VERSION_4) {
506*e3723e1fSApple OSS Distributions PerfControllerInterface::ResourceAccounting resources;
507*e3723e1fSApple OSS Distributions shared->interface.workEndWithResources(device, tokenToGlobalUniqueToken(token), &state, args, &resources, done);
508*e3723e1fSApple OSS Distributions if (clientData.driverState.resource_accounting) {
509*e3723e1fSApple OSS Distributions accountResources(workTable[token].coal, clientData.driverState.device_type, &resources);
510*e3723e1fSApple OSS Distributions }
511*e3723e1fSApple OSS Distributions } else {
512*e3723e1fSApple OSS Distributions shared->interface.workEnd(device, tokenToGlobalUniqueToken(token), &state, args, done);
513*e3723e1fSApple OSS Distributions }
514*e3723e1fSApple OSS Distributions
515*e3723e1fSApple OSS Distributions if (done) {
516*e3723e1fSApple OSS Distributions deallocateToken(token);
517*e3723e1fSApple OSS Distributions } else {
518*e3723e1fSApple OSS Distributions markEntryStarted(token, false);
519*e3723e1fSApple OSS Distributions }
520*e3723e1fSApple OSS Distributions #endif
521*e3723e1fSApple OSS Distributions }
522*e3723e1fSApple OSS Distributions
523*e3723e1fSApple OSS Distributions static _Atomic uint64_t unique_work_context_id = 1ull;
524*e3723e1fSApple OSS Distributions
525*e3723e1fSApple OSS Distributions class IOPerfControlWorkContext : public OSObject
526*e3723e1fSApple OSS Distributions {
527*e3723e1fSApple OSS Distributions OSDeclareDefaultStructors(IOPerfControlWorkContext);
528*e3723e1fSApple OSS Distributions
529*e3723e1fSApple OSS Distributions public:
530*e3723e1fSApple OSS Distributions uint64_t id;
531*e3723e1fSApple OSS Distributions struct thread_group *thread_group;
532*e3723e1fSApple OSS Distributions coalition_t coal;
533*e3723e1fSApple OSS Distributions bool started;
534*e3723e1fSApple OSS Distributions uint8_t perfcontrol_data[32];
535*e3723e1fSApple OSS Distributions
536*e3723e1fSApple OSS Distributions bool init() override;
537*e3723e1fSApple OSS Distributions void reset();
538*e3723e1fSApple OSS Distributions void free() override;
539*e3723e1fSApple OSS Distributions };
540*e3723e1fSApple OSS Distributions
541*e3723e1fSApple OSS Distributions OSDefineMetaClassAndStructors(IOPerfControlWorkContext, OSObject);
542*e3723e1fSApple OSS Distributions
543*e3723e1fSApple OSS Distributions bool
init()544*e3723e1fSApple OSS Distributions IOPerfControlWorkContext::init()
545*e3723e1fSApple OSS Distributions {
546*e3723e1fSApple OSS Distributions if (!super::init()) {
547*e3723e1fSApple OSS Distributions return false;
548*e3723e1fSApple OSS Distributions }
549*e3723e1fSApple OSS Distributions id = atomic_fetch_add_explicit(&unique_work_context_id, 1, memory_order_relaxed) + 1;
550*e3723e1fSApple OSS Distributions reset();
551*e3723e1fSApple OSS Distributions return true;
552*e3723e1fSApple OSS Distributions }
553*e3723e1fSApple OSS Distributions
554*e3723e1fSApple OSS Distributions void
reset()555*e3723e1fSApple OSS Distributions IOPerfControlWorkContext::reset()
556*e3723e1fSApple OSS Distributions {
557*e3723e1fSApple OSS Distributions thread_group = nullptr;
558*e3723e1fSApple OSS Distributions coal = nullptr;
559*e3723e1fSApple OSS Distributions started = false;
560*e3723e1fSApple OSS Distributions bzero(perfcontrol_data, sizeof(perfcontrol_data));
561*e3723e1fSApple OSS Distributions }
562*e3723e1fSApple OSS Distributions
563*e3723e1fSApple OSS Distributions void
free()564*e3723e1fSApple OSS Distributions IOPerfControlWorkContext::free()
565*e3723e1fSApple OSS Distributions {
566*e3723e1fSApple OSS Distributions assertf(thread_group == nullptr, "IOPerfControlWorkContext ID %llu being released without calling workEnd!\n", id);
567*e3723e1fSApple OSS Distributions assertf(coal == nullptr, "IOPerfControlWorkContext ID %llu being released without calling workEnd!\n", id);
568*e3723e1fSApple OSS Distributions super::free();
569*e3723e1fSApple OSS Distributions }
570*e3723e1fSApple OSS Distributions
571*e3723e1fSApple OSS Distributions OSObject *
copyWorkContext()572*e3723e1fSApple OSS Distributions IOPerfControlClient::copyWorkContext()
573*e3723e1fSApple OSS Distributions {
574*e3723e1fSApple OSS Distributions IOPerfControlWorkContext *context = new IOPerfControlWorkContext;
575*e3723e1fSApple OSS Distributions
576*e3723e1fSApple OSS Distributions if (context == nullptr) {
577*e3723e1fSApple OSS Distributions return nullptr;
578*e3723e1fSApple OSS Distributions }
579*e3723e1fSApple OSS Distributions
580*e3723e1fSApple OSS Distributions if (!context->init()) {
581*e3723e1fSApple OSS Distributions context->free();
582*e3723e1fSApple OSS Distributions return nullptr;
583*e3723e1fSApple OSS Distributions }
584*e3723e1fSApple OSS Distributions
585*e3723e1fSApple OSS Distributions return context;
586*e3723e1fSApple OSS Distributions }
587*e3723e1fSApple OSS Distributions
588*e3723e1fSApple OSS Distributions bool
workSubmitAndBeginWithContext(IOService * device,OSObject * context,WorkSubmitArgs * submitArgs,WorkBeginArgs * beginArgs)589*e3723e1fSApple OSS Distributions IOPerfControlClient::workSubmitAndBeginWithContext(IOService *device, OSObject *context, WorkSubmitArgs *submitArgs, WorkBeginArgs *beginArgs)
590*e3723e1fSApple OSS Distributions {
591*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
592*e3723e1fSApple OSS Distributions
593*e3723e1fSApple OSS Distributions if (workSubmitWithContext(device, context, submitArgs) == false) {
594*e3723e1fSApple OSS Distributions return false;
595*e3723e1fSApple OSS Distributions }
596*e3723e1fSApple OSS Distributions
597*e3723e1fSApple OSS Distributions IOPerfControlWorkContext *work_context = OSDynamicCast(IOPerfControlWorkContext, context);
598*e3723e1fSApple OSS Distributions
599*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
600*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(work_context->thread_group),
601*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(work_context->thread_group),
602*e3723e1fSApple OSS Distributions .work_data = &work_context->perfcontrol_data,
603*e3723e1fSApple OSS Distributions .work_data_size = sizeof(work_context->perfcontrol_data),
604*e3723e1fSApple OSS Distributions .started = true,
605*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
606*e3723e1fSApple OSS Distributions };
607*e3723e1fSApple OSS Distributions
608*e3723e1fSApple OSS Distributions shared->interface.workBegin(device, work_context->id, &state, beginArgs);
609*e3723e1fSApple OSS Distributions
610*e3723e1fSApple OSS Distributions work_context->started = true;
611*e3723e1fSApple OSS Distributions
612*e3723e1fSApple OSS Distributions return true;
613*e3723e1fSApple OSS Distributions #else
614*e3723e1fSApple OSS Distributions return false;
615*e3723e1fSApple OSS Distributions #endif
616*e3723e1fSApple OSS Distributions }
617*e3723e1fSApple OSS Distributions
618*e3723e1fSApple OSS Distributions bool
workSubmitWithContext(IOService * device,OSObject * context,WorkSubmitArgs * args)619*e3723e1fSApple OSS Distributions IOPerfControlClient::workSubmitWithContext(IOService *device, OSObject *context, WorkSubmitArgs *args)
620*e3723e1fSApple OSS Distributions {
621*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
622*e3723e1fSApple OSS Distributions IOPerfControlWorkContext *work_context = OSDynamicCast(IOPerfControlWorkContext, context);
623*e3723e1fSApple OSS Distributions
624*e3723e1fSApple OSS Distributions if (work_context == nullptr) {
625*e3723e1fSApple OSS Distributions return false;
626*e3723e1fSApple OSS Distributions }
627*e3723e1fSApple OSS Distributions
628*e3723e1fSApple OSS Distributions auto *thread_group = thread_group_get(current_thread());
629*e3723e1fSApple OSS Distributions assert(thread_group != nullptr);
630*e3723e1fSApple OSS Distributions
631*e3723e1fSApple OSS Distributions assertf(!work_context->started, "IOPerfControlWorkContext ID %llu was already started", work_context->id);
632*e3723e1fSApple OSS Distributions assertf(work_context->thread_group == nullptr, "IOPerfControlWorkContext ID %llu has already taken a refcount on TG 0x%p \n", work_context->id, (void *)(work_context->thread_group));
633*e3723e1fSApple OSS Distributions
634*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
635*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(thread_group),
636*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(thread_group),
637*e3723e1fSApple OSS Distributions .work_data = nullptr,
638*e3723e1fSApple OSS Distributions .work_data_size = 0,
639*e3723e1fSApple OSS Distributions .started = false,
640*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
641*e3723e1fSApple OSS Distributions };
642*e3723e1fSApple OSS Distributions if (!shared->interface.workCanSubmit(device, &state, args)) {
643*e3723e1fSApple OSS Distributions return false;
644*e3723e1fSApple OSS Distributions }
645*e3723e1fSApple OSS Distributions
646*e3723e1fSApple OSS Distributions work_context->thread_group = thread_group_retain(thread_group);
647*e3723e1fSApple OSS Distributions if (clientData.driverState.resource_accounting) {
648*e3723e1fSApple OSS Distributions auto *coalition = task_get_coalition(current_task(), COALITION_TYPE_RESOURCE);
649*e3723e1fSApple OSS Distributions assert(coalition != nullptr);
650*e3723e1fSApple OSS Distributions work_context->coal = coalition;
651*e3723e1fSApple OSS Distributions coalition_retain(coalition);
652*e3723e1fSApple OSS Distributions }
653*e3723e1fSApple OSS Distributions
654*e3723e1fSApple OSS Distributions state.work_data = &work_context->perfcontrol_data;
655*e3723e1fSApple OSS Distributions state.work_data_size = sizeof(work_context->perfcontrol_data);
656*e3723e1fSApple OSS Distributions
657*e3723e1fSApple OSS Distributions shared->interface.workSubmit(device, work_context->id, &state, args);
658*e3723e1fSApple OSS Distributions
659*e3723e1fSApple OSS Distributions return true;
660*e3723e1fSApple OSS Distributions #else
661*e3723e1fSApple OSS Distributions return false;
662*e3723e1fSApple OSS Distributions #endif
663*e3723e1fSApple OSS Distributions }
664*e3723e1fSApple OSS Distributions
665*e3723e1fSApple OSS Distributions void
workUpdateWithContext(IOService * device,OSObject * context,WorkUpdateArgs * args)666*e3723e1fSApple OSS Distributions IOPerfControlClient::workUpdateWithContext(IOService *device, OSObject *context, WorkUpdateArgs *args)
667*e3723e1fSApple OSS Distributions {
668*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
669*e3723e1fSApple OSS Distributions IOPerfControlWorkContext *work_context = OSDynamicCast(IOPerfControlWorkContext, context);
670*e3723e1fSApple OSS Distributions
671*e3723e1fSApple OSS Distributions if (work_context == nullptr) {
672*e3723e1fSApple OSS Distributions return;
673*e3723e1fSApple OSS Distributions }
674*e3723e1fSApple OSS Distributions
675*e3723e1fSApple OSS Distributions if (work_context->thread_group == nullptr) {
676*e3723e1fSApple OSS Distributions // This Work Context has not taken a refcount on a TG
677*e3723e1fSApple OSS Distributions return;
678*e3723e1fSApple OSS Distributions }
679*e3723e1fSApple OSS Distributions
680*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
681*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(work_context->thread_group),
682*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(work_context->thread_group),
683*e3723e1fSApple OSS Distributions .work_data = &work_context->perfcontrol_data,
684*e3723e1fSApple OSS Distributions .work_data_size = sizeof(work_context->perfcontrol_data),
685*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
686*e3723e1fSApple OSS Distributions };
687*e3723e1fSApple OSS Distributions shared->interface.workUpdate(device, work_context->id, &state, args);
688*e3723e1fSApple OSS Distributions #endif
689*e3723e1fSApple OSS Distributions }
690*e3723e1fSApple OSS Distributions
691*e3723e1fSApple OSS Distributions void
workBeginWithContext(IOService * device,OSObject * context,WorkBeginArgs * args)692*e3723e1fSApple OSS Distributions IOPerfControlClient::workBeginWithContext(IOService *device, OSObject *context, WorkBeginArgs *args)
693*e3723e1fSApple OSS Distributions {
694*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
695*e3723e1fSApple OSS Distributions IOPerfControlWorkContext *work_context = OSDynamicCast(IOPerfControlWorkContext, context);
696*e3723e1fSApple OSS Distributions
697*e3723e1fSApple OSS Distributions if (work_context == nullptr) {
698*e3723e1fSApple OSS Distributions return;
699*e3723e1fSApple OSS Distributions }
700*e3723e1fSApple OSS Distributions
701*e3723e1fSApple OSS Distributions if (work_context->thread_group == nullptr) {
702*e3723e1fSApple OSS Distributions // This Work Context has not taken a refcount on a TG
703*e3723e1fSApple OSS Distributions return;
704*e3723e1fSApple OSS Distributions }
705*e3723e1fSApple OSS Distributions
706*e3723e1fSApple OSS Distributions assertf(!work_context->started, "IOPerfControlWorkContext %llu was already started", work_context->id);
707*e3723e1fSApple OSS Distributions
708*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
709*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(work_context->thread_group),
710*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(work_context->thread_group),
711*e3723e1fSApple OSS Distributions .work_data = &work_context->perfcontrol_data,
712*e3723e1fSApple OSS Distributions .work_data_size = sizeof(work_context->perfcontrol_data),
713*e3723e1fSApple OSS Distributions .started = true,
714*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
715*e3723e1fSApple OSS Distributions };
716*e3723e1fSApple OSS Distributions shared->interface.workBegin(device, work_context->id, &state, args);
717*e3723e1fSApple OSS Distributions
718*e3723e1fSApple OSS Distributions work_context->started = true;
719*e3723e1fSApple OSS Distributions #endif
720*e3723e1fSApple OSS Distributions }
721*e3723e1fSApple OSS Distributions
722*e3723e1fSApple OSS Distributions void
workEndWithContext(IOService * device,OSObject * context,WorkEndArgs * args,bool done)723*e3723e1fSApple OSS Distributions IOPerfControlClient::workEndWithContext(IOService *device, OSObject *context, WorkEndArgs *args, bool done)
724*e3723e1fSApple OSS Distributions {
725*e3723e1fSApple OSS Distributions #if CONFIG_THREAD_GROUPS
726*e3723e1fSApple OSS Distributions IOPerfControlWorkContext *work_context = OSDynamicCast(IOPerfControlWorkContext, context);
727*e3723e1fSApple OSS Distributions
728*e3723e1fSApple OSS Distributions if (work_context == nullptr) {
729*e3723e1fSApple OSS Distributions return;
730*e3723e1fSApple OSS Distributions }
731*e3723e1fSApple OSS Distributions
732*e3723e1fSApple OSS Distributions if (work_context->thread_group == nullptr) {
733*e3723e1fSApple OSS Distributions return;
734*e3723e1fSApple OSS Distributions }
735*e3723e1fSApple OSS Distributions
736*e3723e1fSApple OSS Distributions PerfControllerInterface::WorkState state{
737*e3723e1fSApple OSS Distributions .thread_group_id = thread_group_get_id(work_context->thread_group),
738*e3723e1fSApple OSS Distributions .thread_group_data = thread_group_get_machine_data(work_context->thread_group),
739*e3723e1fSApple OSS Distributions .work_data = &work_context->perfcontrol_data,
740*e3723e1fSApple OSS Distributions .work_data_size = sizeof(work_context->perfcontrol_data),
741*e3723e1fSApple OSS Distributions .started = work_context->started,
742*e3723e1fSApple OSS Distributions .driver_state = &clientData.driverState
743*e3723e1fSApple OSS Distributions };
744*e3723e1fSApple OSS Distributions
745*e3723e1fSApple OSS Distributions if (shared->interface.version >= PERFCONTROL_INTERFACE_VERSION_4) {
746*e3723e1fSApple OSS Distributions PerfControllerInterface::ResourceAccounting resources;
747*e3723e1fSApple OSS Distributions shared->interface.workEndWithResources(device, work_context->id, &state, args, &resources, done);
748*e3723e1fSApple OSS Distributions if (clientData.driverState.resource_accounting) {
749*e3723e1fSApple OSS Distributions accountResources(work_context->coal, clientData.driverState.device_type, &resources);
750*e3723e1fSApple OSS Distributions }
751*e3723e1fSApple OSS Distributions } else {
752*e3723e1fSApple OSS Distributions shared->interface.workEnd(device, work_context->id, &state, args, done);
753*e3723e1fSApple OSS Distributions }
754*e3723e1fSApple OSS Distributions
755*e3723e1fSApple OSS Distributions if (done) {
756*e3723e1fSApple OSS Distributions thread_group_release(work_context->thread_group);
757*e3723e1fSApple OSS Distributions if (work_context->coal != nullptr) {
758*e3723e1fSApple OSS Distributions coalition_release(work_context->coal);
759*e3723e1fSApple OSS Distributions }
760*e3723e1fSApple OSS Distributions work_context->reset();
761*e3723e1fSApple OSS Distributions } else {
762*e3723e1fSApple OSS Distributions work_context->started = false;
763*e3723e1fSApple OSS Distributions }
764*e3723e1fSApple OSS Distributions
765*e3723e1fSApple OSS Distributions return;
766*e3723e1fSApple OSS Distributions #else
767*e3723e1fSApple OSS Distributions return;
768*e3723e1fSApple OSS Distributions #endif
769*e3723e1fSApple OSS Distributions }
770*e3723e1fSApple OSS Distributions
771*e3723e1fSApple OSS Distributions IOReturn
registerPerformanceController(PerfControllerInterface * pci)772*e3723e1fSApple OSS Distributions IOPerfControlClient::registerPerformanceController(PerfControllerInterface *pci)
773*e3723e1fSApple OSS Distributions {
774*e3723e1fSApple OSS Distributions IOReturn result = kIOReturnError;
775*e3723e1fSApple OSS Distributions
776*e3723e1fSApple OSS Distributions IOLockLock(shared->interfaceLock);
777*e3723e1fSApple OSS Distributions
778*e3723e1fSApple OSS Distributions if (shared->interface.version == PERFCONTROL_INTERFACE_VERSION_NONE) {
779*e3723e1fSApple OSS Distributions shared->interface.version = pci->version;
780*e3723e1fSApple OSS Distributions
781*e3723e1fSApple OSS Distributions if (pci->version >= PERFCONTROL_INTERFACE_VERSION_1) {
782*e3723e1fSApple OSS Distributions assert(pci->registerDevice && pci->unregisterDevice && pci->workCanSubmit && pci->workSubmit && pci->workBegin && pci->workEnd);
783*e3723e1fSApple OSS Distributions shared->interface.registerDevice = pci->registerDevice;
784*e3723e1fSApple OSS Distributions shared->interface.unregisterDevice = pci->unregisterDevice;
785*e3723e1fSApple OSS Distributions shared->interface.workCanSubmit = pci->workCanSubmit;
786*e3723e1fSApple OSS Distributions shared->interface.workSubmit = pci->workSubmit;
787*e3723e1fSApple OSS Distributions shared->interface.workBegin = pci->workBegin;
788*e3723e1fSApple OSS Distributions shared->interface.workEnd = pci->workEnd;
789*e3723e1fSApple OSS Distributions }
790*e3723e1fSApple OSS Distributions
791*e3723e1fSApple OSS Distributions if (pci->version >= PERFCONTROL_INTERFACE_VERSION_2) {
792*e3723e1fSApple OSS Distributions if (pci->workUpdate != nullptr) {
793*e3723e1fSApple OSS Distributions shared->interface.workUpdate = pci->workUpdate;
794*e3723e1fSApple OSS Distributions }
795*e3723e1fSApple OSS Distributions }
796*e3723e1fSApple OSS Distributions
797*e3723e1fSApple OSS Distributions if (pci->version >= PERFCONTROL_INTERFACE_VERSION_3) {
798*e3723e1fSApple OSS Distributions assert(pci->registerDriverDevice && pci->unregisterDriverDevice);
799*e3723e1fSApple OSS Distributions shared->interface.registerDriverDevice = pci->registerDriverDevice;
800*e3723e1fSApple OSS Distributions shared->interface.unregisterDriverDevice = pci->unregisterDriverDevice;
801*e3723e1fSApple OSS Distributions }
802*e3723e1fSApple OSS Distributions
803*e3723e1fSApple OSS Distributions if (pci->version >= PERFCONTROL_INTERFACE_VERSION_4) {
804*e3723e1fSApple OSS Distributions assert(pci->workEndWithResources);
805*e3723e1fSApple OSS Distributions shared->interface.workEndWithResources = pci->workEndWithResources;
806*e3723e1fSApple OSS Distributions }
807*e3723e1fSApple OSS Distributions
808*e3723e1fSApple OSS Distributions result = kIOReturnSuccess;
809*e3723e1fSApple OSS Distributions
810*e3723e1fSApple OSS Distributions OSObject *obj;
811*e3723e1fSApple OSS Distributions while ((obj = shared->deviceRegistrationList->getAnyObject())) {
812*e3723e1fSApple OSS Distributions IOPerfControlClient *client = OSDynamicCast(IOPerfControlClient, obj);
813*e3723e1fSApple OSS Distributions IOPerfControlClientData *clientData = client->getClientData();
814*e3723e1fSApple OSS Distributions if (clientData && clientData->device) {
815*e3723e1fSApple OSS Distributions if (pci->version >= PERFCONTROL_INTERFACE_VERSION_3) {
816*e3723e1fSApple OSS Distributions pci->registerDriverDevice(clientData->device->getProvider(), clientData->device, &(clientData->driverState));
817*e3723e1fSApple OSS Distributions } else if (pci->version >= PERFCONTROL_INTERFACE_VERSION_1) {
818*e3723e1fSApple OSS Distributions pci->registerDevice(clientData->device);
819*e3723e1fSApple OSS Distributions }
820*e3723e1fSApple OSS Distributions }
821*e3723e1fSApple OSS Distributions shared->deviceRegistrationList->removeObject(obj);
822*e3723e1fSApple OSS Distributions }
823*e3723e1fSApple OSS Distributions }
824*e3723e1fSApple OSS Distributions
825*e3723e1fSApple OSS Distributions IOLockUnlock(shared->interfaceLock);
826*e3723e1fSApple OSS Distributions
827*e3723e1fSApple OSS Distributions return result;
828*e3723e1fSApple OSS Distributions }
829