]>
Commit | Line | Data |
---|---|---|
6a9ee8af DA |
1 | /* |
2 | * Copyright (c) 2010 Red Hat Inc. | |
3 | * Author : Dave Airlie <airlied@redhat.com> | |
4 | * | |
5 | * | |
6 | * Licensed under GPLv2 | |
7 | * | |
8 | * vga_switcheroo.c - Support for laptop with dual GPU using one set of outputs | |
9 | ||
10 | Switcher interface - methods require for ATPX and DCM | |
11 | - switchto - this throws the output MUX switch | |
12 | - discrete_set_power - sets the power state for the discrete card | |
13 | ||
14 | GPU driver interface | |
15 | - set_gpu_state - this should do the equiv of s/r for the card | |
16 | - this should *not* set the discrete power state | |
17 | - switch_check - check if the device is in a position to switch now | |
18 | */ | |
19 | ||
20 | #include <linux/module.h> | |
6a9ee8af DA |
21 | #include <linux/seq_file.h> |
22 | #include <linux/uaccess.h> | |
23 | #include <linux/fs.h> | |
24 | #include <linux/debugfs.h> | |
25 | #include <linux/fb.h> | |
26 | ||
6a9ee8af | 27 | #include <linux/pci.h> |
054430e7 | 28 | #include <linux/console.h> |
6a9ee8af | 29 | #include <linux/vga_switcheroo.h> |
0d69704a | 30 | #include <linux/pm_runtime.h> |
6a9ee8af | 31 | |
2fbe8c7c MG |
32 | #include <linux/vgaarb.h> |
33 | ||
6a9ee8af DA |
34 | struct vga_switcheroo_client { |
35 | struct pci_dev *pdev; | |
36 | struct fb_info *fb_info; | |
37 | int pwr_state; | |
26ec685f | 38 | const struct vga_switcheroo_client_ops *ops; |
6a9ee8af DA |
39 | int id; |
40 | bool active; | |
0d69704a | 41 | bool driver_power_control; |
79721e0a | 42 | struct list_head list; |
6a9ee8af DA |
43 | }; |
44 | ||
45 | static DEFINE_MUTEX(vgasr_mutex); | |
46 | ||
47 | struct vgasr_priv { | |
48 | ||
49 | bool active; | |
50 | bool delayed_switch_active; | |
51 | enum vga_switcheroo_client_id delayed_client_id; | |
52 | ||
53 | struct dentry *debugfs_root; | |
54 | struct dentry *switch_file; | |
55 | ||
56 | int registered_clients; | |
79721e0a | 57 | struct list_head clients; |
6a9ee8af DA |
58 | |
59 | struct vga_switcheroo_handler *handler; | |
60 | }; | |
61 | ||
3e9e63db TI |
62 | #define ID_BIT_AUDIO 0x100 |
63 | #define client_is_audio(c) ((c)->id & ID_BIT_AUDIO) | |
64 | #define client_is_vga(c) ((c)->id == -1 || !client_is_audio(c)) | |
65 | #define client_id(c) ((c)->id & ~ID_BIT_AUDIO) | |
66 | ||
6a9ee8af DA |
67 | static int vga_switcheroo_debugfs_init(struct vgasr_priv *priv); |
68 | static void vga_switcheroo_debugfs_fini(struct vgasr_priv *priv); | |
69 | ||
70 | /* only one switcheroo per system */ | |
79721e0a TI |
71 | static struct vgasr_priv vgasr_priv = { |
72 | .clients = LIST_HEAD_INIT(vgasr_priv.clients), | |
73 | }; | |
6a9ee8af | 74 | |
36704c0c | 75 | static bool vga_switcheroo_ready(void) |
6a9ee8af | 76 | { |
36704c0c SF |
77 | /* we're ready if we get two clients + handler */ |
78 | return !vgasr_priv.active && | |
79 | vgasr_priv.registered_clients == 2 && vgasr_priv.handler; | |
6a9ee8af | 80 | } |
6a9ee8af DA |
81 | |
82 | static void vga_switcheroo_enable(void) | |
83 | { | |
6a9ee8af | 84 | int ret; |
79721e0a TI |
85 | struct vga_switcheroo_client *client; |
86 | ||
6a9ee8af | 87 | /* call the handler to init */ |
e99eac5e SF |
88 | if (vgasr_priv.handler->init) |
89 | vgasr_priv.handler->init(); | |
6a9ee8af | 90 | |
79721e0a | 91 | list_for_each_entry(client, &vgasr_priv.clients, list) { |
3e9e63db TI |
92 | if (client->id != -1) |
93 | continue; | |
79721e0a | 94 | ret = vgasr_priv.handler->get_client_id(client->pdev); |
6a9ee8af DA |
95 | if (ret < 0) |
96 | return; | |
97 | ||
79721e0a | 98 | client->id = ret; |
6a9ee8af DA |
99 | } |
100 | vga_switcheroo_debugfs_init(&vgasr_priv); | |
101 | vgasr_priv.active = true; | |
102 | } | |
103 | ||
36704c0c SF |
104 | int vga_switcheroo_register_handler(struct vga_switcheroo_handler *handler) |
105 | { | |
106 | mutex_lock(&vgasr_mutex); | |
107 | if (vgasr_priv.handler) { | |
108 | mutex_unlock(&vgasr_mutex); | |
109 | return -EINVAL; | |
110 | } | |
111 | ||
112 | vgasr_priv.handler = handler; | |
113 | if (vga_switcheroo_ready()) { | |
114 | printk(KERN_INFO "vga_switcheroo: enabled\n"); | |
115 | vga_switcheroo_enable(); | |
116 | } | |
117 | mutex_unlock(&vgasr_mutex); | |
118 | return 0; | |
119 | } | |
120 | EXPORT_SYMBOL(vga_switcheroo_register_handler); | |
121 | ||
122 | void vga_switcheroo_unregister_handler(void) | |
123 | { | |
124 | mutex_lock(&vgasr_mutex); | |
125 | vgasr_priv.handler = NULL; | |
126 | if (vgasr_priv.active) { | |
127 | pr_info("vga_switcheroo: disabled\n"); | |
128 | vga_switcheroo_debugfs_fini(&vgasr_priv); | |
129 | vgasr_priv.active = false; | |
130 | } | |
131 | mutex_unlock(&vgasr_mutex); | |
132 | } | |
133 | EXPORT_SYMBOL(vga_switcheroo_unregister_handler); | |
134 | ||
3e9e63db TI |
135 | static int register_client(struct pci_dev *pdev, |
136 | const struct vga_switcheroo_client_ops *ops, | |
0d69704a | 137 | int id, bool active, bool driver_power_control) |
6a9ee8af | 138 | { |
79721e0a | 139 | struct vga_switcheroo_client *client; |
6a9ee8af | 140 | |
79721e0a TI |
141 | client = kzalloc(sizeof(*client), GFP_KERNEL); |
142 | if (!client) | |
143 | return -ENOMEM; | |
144 | ||
145 | client->pwr_state = VGA_SWITCHEROO_ON; | |
146 | client->pdev = pdev; | |
26ec685f | 147 | client->ops = ops; |
3e9e63db TI |
148 | client->id = id; |
149 | client->active = active; | |
0d69704a | 150 | client->driver_power_control = driver_power_control; |
6a9ee8af | 151 | |
79721e0a TI |
152 | mutex_lock(&vgasr_mutex); |
153 | list_add_tail(&client->list, &vgasr_priv.clients); | |
3e9e63db TI |
154 | if (client_is_vga(client)) |
155 | vgasr_priv.registered_clients++; | |
6a9ee8af | 156 | |
36704c0c | 157 | if (vga_switcheroo_ready()) { |
6a9ee8af DA |
158 | printk(KERN_INFO "vga_switcheroo: enabled\n"); |
159 | vga_switcheroo_enable(); | |
160 | } | |
161 | mutex_unlock(&vgasr_mutex); | |
162 | return 0; | |
163 | } | |
3e9e63db TI |
164 | |
165 | int vga_switcheroo_register_client(struct pci_dev *pdev, | |
0d69704a DA |
166 | const struct vga_switcheroo_client_ops *ops, |
167 | bool driver_power_control) | |
3e9e63db TI |
168 | { |
169 | return register_client(pdev, ops, -1, | |
0d69704a | 170 | pdev == vga_default_device(), driver_power_control); |
3e9e63db | 171 | } |
6a9ee8af DA |
172 | EXPORT_SYMBOL(vga_switcheroo_register_client); |
173 | ||
3e9e63db TI |
174 | int vga_switcheroo_register_audio_client(struct pci_dev *pdev, |
175 | const struct vga_switcheroo_client_ops *ops, | |
176 | int id, bool active) | |
177 | { | |
0d69704a | 178 | return register_client(pdev, ops, id | ID_BIT_AUDIO, active, false); |
3e9e63db TI |
179 | } |
180 | EXPORT_SYMBOL(vga_switcheroo_register_audio_client); | |
181 | ||
79721e0a TI |
182 | static struct vga_switcheroo_client * |
183 | find_client_from_pci(struct list_head *head, struct pci_dev *pdev) | |
184 | { | |
185 | struct vga_switcheroo_client *client; | |
186 | list_for_each_entry(client, head, list) | |
187 | if (client->pdev == pdev) | |
188 | return client; | |
189 | return NULL; | |
190 | } | |
191 | ||
192 | static struct vga_switcheroo_client * | |
193 | find_client_from_id(struct list_head *head, int client_id) | |
194 | { | |
195 | struct vga_switcheroo_client *client; | |
196 | list_for_each_entry(client, head, list) | |
197 | if (client->id == client_id) | |
198 | return client; | |
199 | return NULL; | |
200 | } | |
201 | ||
202 | static struct vga_switcheroo_client * | |
203 | find_active_client(struct list_head *head) | |
204 | { | |
205 | struct vga_switcheroo_client *client; | |
206 | list_for_each_entry(client, head, list) | |
3e9e63db | 207 | if (client->active && client_is_vga(client)) |
79721e0a TI |
208 | return client; |
209 | return NULL; | |
210 | } | |
211 | ||
c8e9cf7b TI |
212 | int vga_switcheroo_get_client_state(struct pci_dev *pdev) |
213 | { | |
214 | struct vga_switcheroo_client *client; | |
215 | ||
216 | client = find_client_from_pci(&vgasr_priv.clients, pdev); | |
217 | if (!client) | |
218 | return VGA_SWITCHEROO_NOT_FOUND; | |
219 | if (!vgasr_priv.active) | |
220 | return VGA_SWITCHEROO_INIT; | |
221 | return client->pwr_state; | |
222 | } | |
223 | EXPORT_SYMBOL(vga_switcheroo_get_client_state); | |
224 | ||
6a9ee8af DA |
225 | void vga_switcheroo_unregister_client(struct pci_dev *pdev) |
226 | { | |
79721e0a | 227 | struct vga_switcheroo_client *client; |
6a9ee8af DA |
228 | |
229 | mutex_lock(&vgasr_mutex); | |
79721e0a TI |
230 | client = find_client_from_pci(&vgasr_priv.clients, pdev); |
231 | if (client) { | |
3e9e63db TI |
232 | if (client_is_vga(client)) |
233 | vgasr_priv.registered_clients--; | |
79721e0a TI |
234 | list_del(&client->list); |
235 | kfree(client); | |
6a9ee8af | 236 | } |
3e9e63db TI |
237 | if (vgasr_priv.active && vgasr_priv.registered_clients < 2) { |
238 | printk(KERN_INFO "vga_switcheroo: disabled\n"); | |
239 | vga_switcheroo_debugfs_fini(&vgasr_priv); | |
240 | vgasr_priv.active = false; | |
241 | } | |
6a9ee8af DA |
242 | mutex_unlock(&vgasr_mutex); |
243 | } | |
244 | EXPORT_SYMBOL(vga_switcheroo_unregister_client); | |
245 | ||
246 | void vga_switcheroo_client_fb_set(struct pci_dev *pdev, | |
247 | struct fb_info *info) | |
248 | { | |
79721e0a | 249 | struct vga_switcheroo_client *client; |
6a9ee8af DA |
250 | |
251 | mutex_lock(&vgasr_mutex); | |
79721e0a TI |
252 | client = find_client_from_pci(&vgasr_priv.clients, pdev); |
253 | if (client) | |
254 | client->fb_info = info; | |
6a9ee8af DA |
255 | mutex_unlock(&vgasr_mutex); |
256 | } | |
257 | EXPORT_SYMBOL(vga_switcheroo_client_fb_set); | |
258 | ||
259 | static int vga_switcheroo_show(struct seq_file *m, void *v) | |
260 | { | |
79721e0a TI |
261 | struct vga_switcheroo_client *client; |
262 | int i = 0; | |
6a9ee8af | 263 | mutex_lock(&vgasr_mutex); |
79721e0a | 264 | list_for_each_entry(client, &vgasr_priv.clients, list) { |
0d69704a | 265 | seq_printf(m, "%d:%s%s:%c:%s%s:%s\n", i, |
3e9e63db TI |
266 | client_id(client) == VGA_SWITCHEROO_DIS ? "DIS" : "IGD", |
267 | client_is_vga(client) ? "" : "-Audio", | |
79721e0a | 268 | client->active ? '+' : ' ', |
0d69704a | 269 | client->driver_power_control ? "Dyn" : "", |
79721e0a TI |
270 | client->pwr_state ? "Pwr" : "Off", |
271 | pci_name(client->pdev)); | |
272 | i++; | |
6a9ee8af DA |
273 | } |
274 | mutex_unlock(&vgasr_mutex); | |
275 | return 0; | |
276 | } | |
277 | ||
278 | static int vga_switcheroo_debugfs_open(struct inode *inode, struct file *file) | |
279 | { | |
280 | return single_open(file, vga_switcheroo_show, NULL); | |
281 | } | |
282 | ||
283 | static int vga_switchon(struct vga_switcheroo_client *client) | |
284 | { | |
0d69704a DA |
285 | if (client->driver_power_control) |
286 | return 0; | |
5cfb3c3a DA |
287 | if (vgasr_priv.handler->power_state) |
288 | vgasr_priv.handler->power_state(client->id, VGA_SWITCHEROO_ON); | |
6a9ee8af | 289 | /* call the driver callback to turn on device */ |
26ec685f | 290 | client->ops->set_gpu_state(client->pdev, VGA_SWITCHEROO_ON); |
6a9ee8af DA |
291 | client->pwr_state = VGA_SWITCHEROO_ON; |
292 | return 0; | |
293 | } | |
294 | ||
295 | static int vga_switchoff(struct vga_switcheroo_client *client) | |
296 | { | |
0d69704a DA |
297 | if (client->driver_power_control) |
298 | return 0; | |
6a9ee8af | 299 | /* call the driver callback to turn off device */ |
26ec685f | 300 | client->ops->set_gpu_state(client->pdev, VGA_SWITCHEROO_OFF); |
5cfb3c3a DA |
301 | if (vgasr_priv.handler->power_state) |
302 | vgasr_priv.handler->power_state(client->id, VGA_SWITCHEROO_OFF); | |
6a9ee8af DA |
303 | client->pwr_state = VGA_SWITCHEROO_OFF; |
304 | return 0; | |
305 | } | |
306 | ||
3e9e63db TI |
307 | static void set_audio_state(int id, int state) |
308 | { | |
309 | struct vga_switcheroo_client *client; | |
310 | ||
311 | client = find_client_from_id(&vgasr_priv.clients, id | ID_BIT_AUDIO); | |
312 | if (client && client->pwr_state != state) { | |
313 | client->ops->set_gpu_state(client->pdev, state); | |
314 | client->pwr_state = state; | |
315 | } | |
316 | } | |
317 | ||
66b37c67 DA |
318 | /* stage one happens before delay */ |
319 | static int vga_switchto_stage1(struct vga_switcheroo_client *new_client) | |
6a9ee8af | 320 | { |
79721e0a | 321 | struct vga_switcheroo_client *active; |
6a9ee8af | 322 | |
79721e0a | 323 | active = find_active_client(&vgasr_priv.clients); |
6a9ee8af DA |
324 | if (!active) |
325 | return 0; | |
326 | ||
6a9ee8af DA |
327 | if (new_client->pwr_state == VGA_SWITCHEROO_OFF) |
328 | vga_switchon(new_client); | |
329 | ||
2fbe8c7c | 330 | vga_set_default_device(new_client->pdev); |
66b37c67 DA |
331 | return 0; |
332 | } | |
333 | ||
334 | /* post delay */ | |
335 | static int vga_switchto_stage2(struct vga_switcheroo_client *new_client) | |
336 | { | |
337 | int ret; | |
79721e0a | 338 | struct vga_switcheroo_client *active; |
66b37c67 | 339 | |
79721e0a | 340 | active = find_active_client(&vgasr_priv.clients); |
66b37c67 DA |
341 | if (!active) |
342 | return 0; | |
343 | ||
344 | active->active = false; | |
6a9ee8af | 345 | |
c91c3fae TI |
346 | set_audio_state(active->id, VGA_SWITCHEROO_OFF); |
347 | ||
6a9ee8af DA |
348 | if (new_client->fb_info) { |
349 | struct fb_event event; | |
054430e7 | 350 | console_lock(); |
6a9ee8af DA |
351 | event.info = new_client->fb_info; |
352 | fb_notifier_call_chain(FB_EVENT_REMAP_ALL_CONSOLE, &event); | |
054430e7 | 353 | console_unlock(); |
6a9ee8af DA |
354 | } |
355 | ||
356 | ret = vgasr_priv.handler->switchto(new_client->id); | |
357 | if (ret) | |
358 | return ret; | |
359 | ||
26ec685f TI |
360 | if (new_client->ops->reprobe) |
361 | new_client->ops->reprobe(new_client->pdev); | |
8d608aa6 | 362 | |
6a9ee8af DA |
363 | if (active->pwr_state == VGA_SWITCHEROO_ON) |
364 | vga_switchoff(active); | |
365 | ||
c91c3fae TI |
366 | set_audio_state(new_client->id, VGA_SWITCHEROO_ON); |
367 | ||
6a9ee8af DA |
368 | new_client->active = true; |
369 | return 0; | |
370 | } | |
371 | ||
79721e0a TI |
372 | static bool check_can_switch(void) |
373 | { | |
374 | struct vga_switcheroo_client *client; | |
375 | ||
376 | list_for_each_entry(client, &vgasr_priv.clients, list) { | |
26ec685f | 377 | if (!client->ops->can_switch(client->pdev)) { |
79721e0a TI |
378 | printk(KERN_ERR "vga_switcheroo: client %x refused switch\n", client->id); |
379 | return false; | |
380 | } | |
381 | } | |
382 | return true; | |
383 | } | |
384 | ||
6a9ee8af DA |
385 | static ssize_t |
386 | vga_switcheroo_debugfs_write(struct file *filp, const char __user *ubuf, | |
387 | size_t cnt, loff_t *ppos) | |
388 | { | |
389 | char usercmd[64]; | |
79721e0a | 390 | int ret; |
6a9ee8af | 391 | bool delay = false, can_switch; |
851ab954 | 392 | bool just_mux = false; |
6a9ee8af DA |
393 | int client_id = -1; |
394 | struct vga_switcheroo_client *client = NULL; | |
395 | ||
396 | if (cnt > 63) | |
397 | cnt = 63; | |
398 | ||
399 | if (copy_from_user(usercmd, ubuf, cnt)) | |
400 | return -EFAULT; | |
401 | ||
402 | mutex_lock(&vgasr_mutex); | |
403 | ||
8c88e50b JS |
404 | if (!vgasr_priv.active) { |
405 | cnt = -EINVAL; | |
406 | goto out; | |
407 | } | |
6a9ee8af DA |
408 | |
409 | /* pwr off the device not in use */ | |
410 | if (strncmp(usercmd, "OFF", 3) == 0) { | |
79721e0a | 411 | list_for_each_entry(client, &vgasr_priv.clients, list) { |
c91c3fae | 412 | if (client->active || client_is_audio(client)) |
6a9ee8af | 413 | continue; |
0d69704a DA |
414 | if (client->driver_power_control) |
415 | continue; | |
c91c3fae | 416 | set_audio_state(client->id, VGA_SWITCHEROO_OFF); |
79721e0a TI |
417 | if (client->pwr_state == VGA_SWITCHEROO_ON) |
418 | vga_switchoff(client); | |
6a9ee8af DA |
419 | } |
420 | goto out; | |
421 | } | |
422 | /* pwr on the device not in use */ | |
423 | if (strncmp(usercmd, "ON", 2) == 0) { | |
79721e0a | 424 | list_for_each_entry(client, &vgasr_priv.clients, list) { |
c91c3fae | 425 | if (client->active || client_is_audio(client)) |
6a9ee8af | 426 | continue; |
0d69704a DA |
427 | if (client->driver_power_control) |
428 | continue; | |
79721e0a TI |
429 | if (client->pwr_state == VGA_SWITCHEROO_OFF) |
430 | vga_switchon(client); | |
c91c3fae | 431 | set_audio_state(client->id, VGA_SWITCHEROO_ON); |
6a9ee8af DA |
432 | } |
433 | goto out; | |
434 | } | |
435 | ||
436 | /* request a delayed switch - test can we switch now */ | |
437 | if (strncmp(usercmd, "DIGD", 4) == 0) { | |
438 | client_id = VGA_SWITCHEROO_IGD; | |
439 | delay = true; | |
440 | } | |
441 | ||
442 | if (strncmp(usercmd, "DDIS", 4) == 0) { | |
443 | client_id = VGA_SWITCHEROO_DIS; | |
444 | delay = true; | |
445 | } | |
446 | ||
447 | if (strncmp(usercmd, "IGD", 3) == 0) | |
448 | client_id = VGA_SWITCHEROO_IGD; | |
449 | ||
450 | if (strncmp(usercmd, "DIS", 3) == 0) | |
451 | client_id = VGA_SWITCHEROO_DIS; | |
452 | ||
fea6f330 | 453 | if (strncmp(usercmd, "MIGD", 4) == 0) { |
851ab954 DA |
454 | just_mux = true; |
455 | client_id = VGA_SWITCHEROO_IGD; | |
456 | } | |
fea6f330 | 457 | if (strncmp(usercmd, "MDIS", 4) == 0) { |
851ab954 DA |
458 | just_mux = true; |
459 | client_id = VGA_SWITCHEROO_DIS; | |
460 | } | |
461 | ||
6a9ee8af DA |
462 | if (client_id == -1) |
463 | goto out; | |
79721e0a TI |
464 | client = find_client_from_id(&vgasr_priv.clients, client_id); |
465 | if (!client) | |
466 | goto out; | |
6a9ee8af DA |
467 | |
468 | vgasr_priv.delayed_switch_active = false; | |
851ab954 DA |
469 | |
470 | if (just_mux) { | |
471 | ret = vgasr_priv.handler->switchto(client_id); | |
472 | goto out; | |
473 | } | |
474 | ||
79721e0a | 475 | if (client->active) |
a67b8887 FM |
476 | goto out; |
477 | ||
6a9ee8af | 478 | /* okay we want a switch - test if devices are willing to switch */ |
79721e0a | 479 | can_switch = check_can_switch(); |
6a9ee8af DA |
480 | |
481 | if (can_switch == false && delay == false) | |
482 | goto out; | |
483 | ||
79721e0a | 484 | if (can_switch) { |
66b37c67 DA |
485 | ret = vga_switchto_stage1(client); |
486 | if (ret) | |
487 | printk(KERN_ERR "vga_switcheroo: switching failed stage 1 %d\n", ret); | |
488 | ||
489 | ret = vga_switchto_stage2(client); | |
6a9ee8af | 490 | if (ret) |
66b37c67 DA |
491 | printk(KERN_ERR "vga_switcheroo: switching failed stage 2 %d\n", ret); |
492 | ||
6a9ee8af DA |
493 | } else { |
494 | printk(KERN_INFO "vga_switcheroo: setting delayed switch to client %d\n", client->id); | |
495 | vgasr_priv.delayed_switch_active = true; | |
496 | vgasr_priv.delayed_client_id = client_id; | |
497 | ||
66b37c67 DA |
498 | ret = vga_switchto_stage1(client); |
499 | if (ret) | |
500 | printk(KERN_ERR "vga_switcheroo: delayed switching stage 1 failed %d\n", ret); | |
6a9ee8af DA |
501 | } |
502 | ||
503 | out: | |
504 | mutex_unlock(&vgasr_mutex); | |
505 | return cnt; | |
506 | } | |
507 | ||
508 | static const struct file_operations vga_switcheroo_debugfs_fops = { | |
509 | .owner = THIS_MODULE, | |
510 | .open = vga_switcheroo_debugfs_open, | |
511 | .write = vga_switcheroo_debugfs_write, | |
512 | .read = seq_read, | |
513 | .llseek = seq_lseek, | |
514 | .release = single_release, | |
515 | }; | |
516 | ||
517 | static void vga_switcheroo_debugfs_fini(struct vgasr_priv *priv) | |
518 | { | |
519 | if (priv->switch_file) { | |
520 | debugfs_remove(priv->switch_file); | |
521 | priv->switch_file = NULL; | |
522 | } | |
523 | if (priv->debugfs_root) { | |
524 | debugfs_remove(priv->debugfs_root); | |
525 | priv->debugfs_root = NULL; | |
526 | } | |
527 | } | |
528 | ||
529 | static int vga_switcheroo_debugfs_init(struct vgasr_priv *priv) | |
530 | { | |
531 | /* already initialised */ | |
532 | if (priv->debugfs_root) | |
533 | return 0; | |
534 | priv->debugfs_root = debugfs_create_dir("vgaswitcheroo", NULL); | |
535 | ||
536 | if (!priv->debugfs_root) { | |
537 | printk(KERN_ERR "vga_switcheroo: Cannot create /sys/kernel/debug/vgaswitcheroo\n"); | |
538 | goto fail; | |
539 | } | |
540 | ||
541 | priv->switch_file = debugfs_create_file("switch", 0644, | |
542 | priv->debugfs_root, NULL, &vga_switcheroo_debugfs_fops); | |
543 | if (!priv->switch_file) { | |
544 | printk(KERN_ERR "vga_switcheroo: cannot create /sys/kernel/debug/vgaswitcheroo/switch\n"); | |
545 | goto fail; | |
546 | } | |
547 | return 0; | |
548 | fail: | |
549 | vga_switcheroo_debugfs_fini(priv); | |
550 | return -1; | |
551 | } | |
552 | ||
553 | int vga_switcheroo_process_delayed_switch(void) | |
554 | { | |
79721e0a | 555 | struct vga_switcheroo_client *client; |
6a9ee8af DA |
556 | int ret; |
557 | int err = -EINVAL; | |
558 | ||
559 | mutex_lock(&vgasr_mutex); | |
560 | if (!vgasr_priv.delayed_switch_active) | |
561 | goto err; | |
562 | ||
563 | printk(KERN_INFO "vga_switcheroo: processing delayed switch to %d\n", vgasr_priv.delayed_client_id); | |
564 | ||
79721e0a TI |
565 | client = find_client_from_id(&vgasr_priv.clients, |
566 | vgasr_priv.delayed_client_id); | |
567 | if (!client || !check_can_switch()) | |
6a9ee8af DA |
568 | goto err; |
569 | ||
66b37c67 | 570 | ret = vga_switchto_stage2(client); |
6a9ee8af | 571 | if (ret) |
66b37c67 | 572 | printk(KERN_ERR "vga_switcheroo: delayed switching failed stage 2 %d\n", ret); |
6a9ee8af DA |
573 | |
574 | vgasr_priv.delayed_switch_active = false; | |
575 | err = 0; | |
576 | err: | |
577 | mutex_unlock(&vgasr_mutex); | |
578 | return err; | |
579 | } | |
580 | EXPORT_SYMBOL(vga_switcheroo_process_delayed_switch); | |
0d69704a DA |
581 | |
582 | static void vga_switcheroo_power_switch(struct pci_dev *pdev, enum vga_switcheroo_state state) | |
583 | { | |
584 | struct vga_switcheroo_client *client; | |
585 | ||
586 | if (!vgasr_priv.handler->power_state) | |
587 | return; | |
588 | ||
589 | client = find_client_from_pci(&vgasr_priv.clients, pdev); | |
590 | if (!client) | |
591 | return; | |
592 | ||
593 | if (!client->driver_power_control) | |
594 | return; | |
595 | ||
596 | vgasr_priv.handler->power_state(client->id, state); | |
597 | } | |
598 | ||
599 | /* force a PCI device to a certain state - mainly to turn off audio clients */ | |
600 | ||
601 | void vga_switcheroo_set_dynamic_switch(struct pci_dev *pdev, enum vga_switcheroo_state dynamic) | |
602 | { | |
603 | struct vga_switcheroo_client *client; | |
604 | ||
605 | client = find_client_from_pci(&vgasr_priv.clients, pdev); | |
606 | if (!client) | |
607 | return; | |
608 | ||
609 | if (!client->driver_power_control) | |
610 | return; | |
611 | ||
612 | client->pwr_state = dynamic; | |
613 | set_audio_state(client->id, dynamic); | |
614 | } | |
615 | EXPORT_SYMBOL(vga_switcheroo_set_dynamic_switch); | |
616 | ||
617 | /* switcheroo power domain */ | |
618 | static int vga_switcheroo_runtime_suspend(struct device *dev) | |
619 | { | |
620 | struct pci_dev *pdev = to_pci_dev(dev); | |
621 | int ret; | |
622 | ||
623 | ret = dev->bus->pm->runtime_suspend(dev); | |
624 | if (ret) | |
625 | return ret; | |
f2bc5616 AD |
626 | if (vgasr_priv.handler->switchto) |
627 | vgasr_priv.handler->switchto(VGA_SWITCHEROO_IGD); | |
0d69704a DA |
628 | vga_switcheroo_power_switch(pdev, VGA_SWITCHEROO_OFF); |
629 | return 0; | |
630 | } | |
631 | ||
632 | static int vga_switcheroo_runtime_resume(struct device *dev) | |
633 | { | |
634 | struct pci_dev *pdev = to_pci_dev(dev); | |
635 | int ret; | |
636 | ||
637 | vga_switcheroo_power_switch(pdev, VGA_SWITCHEROO_ON); | |
638 | ret = dev->bus->pm->runtime_resume(dev); | |
639 | if (ret) | |
640 | return ret; | |
641 | ||
642 | return 0; | |
643 | } | |
644 | ||
645 | /* this version is for the case where the power switch is separate | |
646 | to the device being powered down. */ | |
647 | int vga_switcheroo_init_domain_pm_ops(struct device *dev, struct dev_pm_domain *domain) | |
648 | { | |
649 | /* copy over all the bus versions */ | |
650 | if (dev->bus && dev->bus->pm) { | |
651 | domain->ops = *dev->bus->pm; | |
652 | domain->ops.runtime_suspend = vga_switcheroo_runtime_suspend; | |
653 | domain->ops.runtime_resume = vga_switcheroo_runtime_resume; | |
654 | ||
655 | dev->pm_domain = domain; | |
656 | return 0; | |
657 | } | |
658 | dev->pm_domain = NULL; | |
659 | return -EINVAL; | |
660 | } | |
661 | EXPORT_SYMBOL(vga_switcheroo_init_domain_pm_ops); | |
662 | ||
663 | static int vga_switcheroo_runtime_resume_hdmi_audio(struct device *dev) | |
664 | { | |
665 | struct pci_dev *pdev = to_pci_dev(dev); | |
666 | int ret; | |
667 | struct vga_switcheroo_client *client, *found = NULL; | |
668 | ||
669 | /* we need to check if we have to switch back on the video | |
670 | device so the audio device can come back */ | |
671 | list_for_each_entry(client, &vgasr_priv.clients, list) { | |
672 | if (PCI_SLOT(client->pdev->devfn) == PCI_SLOT(pdev->devfn) && client_is_vga(client)) { | |
673 | found = client; | |
674 | ret = pm_runtime_get_sync(&client->pdev->dev); | |
675 | if (ret) { | |
676 | if (ret != 1) | |
677 | return ret; | |
678 | } | |
679 | break; | |
680 | } | |
681 | } | |
682 | ret = dev->bus->pm->runtime_resume(dev); | |
683 | ||
684 | /* put the reference for the gpu */ | |
685 | if (found) { | |
686 | pm_runtime_mark_last_busy(&found->pdev->dev); | |
687 | pm_runtime_put_autosuspend(&found->pdev->dev); | |
688 | } | |
689 | return ret; | |
690 | } | |
691 | ||
692 | int vga_switcheroo_init_domain_pm_optimus_hdmi_audio(struct device *dev, struct dev_pm_domain *domain) | |
693 | { | |
694 | /* copy over all the bus versions */ | |
695 | if (dev->bus && dev->bus->pm) { | |
696 | domain->ops = *dev->bus->pm; | |
697 | domain->ops.runtime_resume = vga_switcheroo_runtime_resume_hdmi_audio; | |
698 | ||
699 | dev->pm_domain = domain; | |
700 | return 0; | |
701 | } | |
702 | dev->pm_domain = NULL; | |
703 | return -EINVAL; | |
704 | } | |
705 | EXPORT_SYMBOL(vga_switcheroo_init_domain_pm_optimus_hdmi_audio); |