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