blob: 165bbbfa4b6e24090274447f820b7f60eb8f5a85 [file] [log] [blame]
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001/* Copyright (c) 2008-2011, Code Aurora Forum. All rights reserved.
2 *
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
6 *
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
11 *
12 */
13#include <linux/fb.h>
14#include <linux/file.h>
15#include <linux/fs.h>
16#include <linux/debugfs.h>
17#include <linux/uaccess.h>
18#include <linux/interrupt.h>
19#include <linux/workqueue.h>
20#include <linux/android_pmem.h>
21#include <linux/vmalloc.h>
22#include <linux/pm_runtime.h>
23
24#include <linux/ashmem.h>
25#include <linux/major.h>
26
27#include "kgsl.h"
28#include "kgsl_debugfs.h"
29#include "kgsl_cffdump.h"
30#include "kgsl_log.h"
31#include "kgsl_sharedmem.h"
32#include "kgsl_device.h"
33
34#undef MODULE_PARAM_PREFIX
35#define MODULE_PARAM_PREFIX "kgsl."
36
37static int kgsl_pagetable_count = KGSL_PAGETABLE_COUNT;
Shubhraprakash Das767fdda2011-08-15 15:49:45 -060038static char *ksgl_mmu_type;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070039module_param_named(ptcount, kgsl_pagetable_count, int, 0);
40MODULE_PARM_DESC(kgsl_pagetable_count,
41"Minimum number of pagetables for KGSL to allocate at initialization time");
Shubhraprakash Das767fdda2011-08-15 15:49:45 -060042module_param_named(mmutype, ksgl_mmu_type, charp, 0);
43MODULE_PARM_DESC(ksgl_mmu_type,
44"Type of MMU to be used for graphics. Valid values are 'iommu' or 'gpummu' or 'nommu'");
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070045
46static inline struct kgsl_mem_entry *
47kgsl_mem_entry_create(void)
48{
49 struct kgsl_mem_entry *entry = kzalloc(sizeof(*entry), GFP_KERNEL);
50
51 if (!entry)
52 KGSL_CORE_ERR("kzalloc(%d) failed\n", sizeof(*entry));
53 else
54 kref_init(&entry->refcount);
55
56 return entry;
57}
58
59void
60kgsl_mem_entry_destroy(struct kref *kref)
61{
62 struct kgsl_mem_entry *entry = container_of(kref,
63 struct kgsl_mem_entry,
64 refcount);
65 size_t size = entry->memdesc.size;
66
67 kgsl_sharedmem_free(&entry->memdesc);
68
69 if (entry->memtype == KGSL_USER_MEMORY)
70 entry->priv->stats.user -= size;
71 else if (entry->memtype == KGSL_MAPPED_MEMORY) {
72 if (entry->file_ptr)
73 fput(entry->file_ptr);
74
75 kgsl_driver.stats.mapped -= size;
76 entry->priv->stats.mapped -= size;
77 }
78
79 kfree(entry);
80}
81EXPORT_SYMBOL(kgsl_mem_entry_destroy);
82
83static
84void kgsl_mem_entry_attach_process(struct kgsl_mem_entry *entry,
85 struct kgsl_process_private *process)
86{
87 spin_lock(&process->mem_lock);
88 list_add(&entry->list, &process->mem_list);
89 spin_unlock(&process->mem_lock);
90
91 entry->priv = process;
92}
93
94/* Allocate a new context id */
95
96static struct kgsl_context *
97kgsl_create_context(struct kgsl_device_private *dev_priv)
98{
99 struct kgsl_context *context;
100 int ret, id;
101
102 context = kzalloc(sizeof(*context), GFP_KERNEL);
103
104 if (context == NULL)
105 return NULL;
106
107 while (1) {
108 if (idr_pre_get(&dev_priv->device->context_idr,
109 GFP_KERNEL) == 0) {
110 kfree(context);
111 return NULL;
112 }
113
114 ret = idr_get_new(&dev_priv->device->context_idr,
115 context, &id);
116
117 if (ret != -EAGAIN)
118 break;
119 }
120
121 if (ret) {
122 kfree(context);
123 return NULL;
124 }
125
126 context->id = id;
127 context->dev_priv = dev_priv;
128
129 return context;
130}
131
132static void
133kgsl_destroy_context(struct kgsl_device_private *dev_priv,
134 struct kgsl_context *context)
135{
136 int id;
137
138 if (context == NULL)
139 return;
140
141 /* Fire a bug if the devctxt hasn't been freed */
142 BUG_ON(context->devctxt);
143
144 id = context->id;
145 kfree(context);
146
147 idr_remove(&dev_priv->device->context_idr, id);
148}
149
150/* to be called when a process is destroyed, this walks the memqueue and
151 * frees any entryies that belong to the dying process
152 */
153static void kgsl_memqueue_cleanup(struct kgsl_device *device,
154 struct kgsl_process_private *private)
155{
156 struct kgsl_mem_entry *entry, *entry_tmp;
157
158 if (!private)
159 return;
160
161 BUG_ON(!mutex_is_locked(&device->mutex));
162
163 list_for_each_entry_safe(entry, entry_tmp, &device->memqueue, list) {
164 if (entry->priv == private) {
165 list_del(&entry->list);
166 kgsl_mem_entry_put(entry);
167 }
168 }
169}
170
171static void kgsl_memqueue_freememontimestamp(struct kgsl_device *device,
172 struct kgsl_mem_entry *entry,
173 uint32_t timestamp,
174 enum kgsl_timestamp_type type)
175{
176 BUG_ON(!mutex_is_locked(&device->mutex));
177
178 entry->free_timestamp = timestamp;
179
180 list_add_tail(&entry->list, &device->memqueue);
181}
182
Jordan Crouse1bf80aa2011-10-12 16:57:47 -0600183static void kgsl_timestamp_expired(struct work_struct *work)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700184{
Jordan Crouse1bf80aa2011-10-12 16:57:47 -0600185 struct kgsl_device *device = container_of(work, struct kgsl_device,
186 ts_expired_ws);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700187 struct kgsl_mem_entry *entry, *entry_tmp;
188 uint32_t ts_processed;
189
Jordan Crouse1bf80aa2011-10-12 16:57:47 -0600190 mutex_lock(&device->mutex);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700191
192 /* get current EOP timestamp */
193 ts_processed = device->ftbl->readtimestamp(device,
194 KGSL_TIMESTAMP_RETIRED);
195
Jordan Crouse1bf80aa2011-10-12 16:57:47 -0600196 /* Flush the freememontimestamp queue */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700197 list_for_each_entry_safe(entry, entry_tmp, &device->memqueue, list) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700198 if (!timestamp_cmp(ts_processed, entry->free_timestamp))
199 break;
200
201 list_del(&entry->list);
202 kgsl_mem_entry_put(entry);
203 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700204
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700205 mutex_unlock(&device->mutex);
206}
207
208static void kgsl_check_idle_locked(struct kgsl_device *device)
209{
210 if (device->pwrctrl.nap_allowed == true &&
211 device->state == KGSL_STATE_ACTIVE &&
212 device->requested_state == KGSL_STATE_NONE) {
213 device->requested_state = KGSL_STATE_NAP;
214 if (kgsl_pwrctrl_sleep(device) != 0)
215 mod_timer(&device->idle_timer,
216 jiffies +
217 device->pwrctrl.interval_timeout);
218 }
219}
220
221static void kgsl_check_idle(struct kgsl_device *device)
222{
223 mutex_lock(&device->mutex);
224 kgsl_check_idle_locked(device);
225 mutex_unlock(&device->mutex);
226}
227
228struct kgsl_device *kgsl_get_device(int dev_idx)
229{
230 int i;
231 struct kgsl_device *ret = NULL;
232
233 mutex_lock(&kgsl_driver.devlock);
234
235 for (i = 0; i < KGSL_DEVICE_MAX; i++) {
236 if (kgsl_driver.devp[i] && kgsl_driver.devp[i]->id == dev_idx) {
237 ret = kgsl_driver.devp[i];
238 break;
239 }
240 }
241
242 mutex_unlock(&kgsl_driver.devlock);
243 return ret;
244}
245EXPORT_SYMBOL(kgsl_get_device);
246
247static struct kgsl_device *kgsl_get_minor(int minor)
248{
249 struct kgsl_device *ret = NULL;
250
251 if (minor < 0 || minor >= KGSL_DEVICE_MAX)
252 return NULL;
253
254 mutex_lock(&kgsl_driver.devlock);
255 ret = kgsl_driver.devp[minor];
256 mutex_unlock(&kgsl_driver.devlock);
257
258 return ret;
259}
260
261int kgsl_register_ts_notifier(struct kgsl_device *device,
262 struct notifier_block *nb)
263{
264 BUG_ON(device == NULL);
265 return atomic_notifier_chain_register(&device->ts_notifier_list,
266 nb);
267}
268EXPORT_SYMBOL(kgsl_register_ts_notifier);
269
270int kgsl_unregister_ts_notifier(struct kgsl_device *device,
271 struct notifier_block *nb)
272{
273 BUG_ON(device == NULL);
274 return atomic_notifier_chain_unregister(&device->ts_notifier_list,
275 nb);
276}
277EXPORT_SYMBOL(kgsl_unregister_ts_notifier);
278
279int kgsl_check_timestamp(struct kgsl_device *device, unsigned int timestamp)
280{
281 unsigned int ts_processed;
282
283 ts_processed = device->ftbl->readtimestamp(device,
284 KGSL_TIMESTAMP_RETIRED);
285
286 return timestamp_cmp(ts_processed, timestamp);
287}
288EXPORT_SYMBOL(kgsl_check_timestamp);
289
290static int kgsl_suspend_device(struct kgsl_device *device, pm_message_t state)
291{
292 int status = -EINVAL;
293 unsigned int nap_allowed_saved;
294 struct kgsl_pwrscale_policy *policy_saved;
295
296 if (!device)
297 return -EINVAL;
298
299 KGSL_PWR_WARN(device, "suspend start\n");
300
301 mutex_lock(&device->mutex);
302 nap_allowed_saved = device->pwrctrl.nap_allowed;
303 device->pwrctrl.nap_allowed = false;
304 policy_saved = device->pwrscale.policy;
305 device->pwrscale.policy = NULL;
306 device->requested_state = KGSL_STATE_SUSPEND;
307 /* Make sure no user process is waiting for a timestamp *
308 * before supending */
309 if (device->active_cnt != 0) {
310 mutex_unlock(&device->mutex);
311 wait_for_completion(&device->suspend_gate);
312 mutex_lock(&device->mutex);
313 }
314 /* Don't let the timer wake us during suspended sleep. */
Jeremy Gebben1757a852011-07-11 16:04:38 -0600315 del_timer_sync(&device->idle_timer);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700316 switch (device->state) {
317 case KGSL_STATE_INIT:
318 break;
319 case KGSL_STATE_ACTIVE:
320 /* Wait for the device to become idle */
321 device->ftbl->idle(device, KGSL_TIMEOUT_DEFAULT);
322 case KGSL_STATE_NAP:
323 case KGSL_STATE_SLEEP:
324 /* Get the completion ready to be waited upon. */
325 INIT_COMPLETION(device->hwaccess_gate);
326 device->ftbl->suspend_context(device);
327 device->ftbl->stop(device);
328 device->state = KGSL_STATE_SUSPEND;
329 KGSL_PWR_WARN(device, "state -> SUSPEND, device %d\n",
330 device->id);
331 break;
332 default:
333 KGSL_PWR_ERR(device, "suspend fail, device %d\n",
334 device->id);
335 goto end;
336 }
337 device->requested_state = KGSL_STATE_NONE;
338 device->pwrctrl.nap_allowed = nap_allowed_saved;
339 device->pwrscale.policy = policy_saved;
340 status = 0;
341
342end:
343 mutex_unlock(&device->mutex);
344 KGSL_PWR_WARN(device, "suspend end\n");
345 return status;
346}
347
348static int kgsl_resume_device(struct kgsl_device *device)
349{
350 int status = -EINVAL;
351
352 if (!device)
353 return -EINVAL;
354
355 KGSL_PWR_WARN(device, "resume start\n");
356 mutex_lock(&device->mutex);
357 if (device->state == KGSL_STATE_SUSPEND) {
Dominic Binks417877f2011-10-20 12:55:48 -0700358 device->requested_state = KGSL_STATE_ACTIVE;
359 kgsl_pwrctrl_pwrlevel_change(device, KGSL_PWRLEVEL_NOMINAL);
360 status = device->ftbl->start(device, 0);
361 if (status == 0) {
362 device->state = KGSL_STATE_ACTIVE;
363 KGSL_PWR_WARN(device,
364 "state -> ACTIVE, device %d\n",
365 device->id);
366 } else {
367 KGSL_PWR_ERR(device,
368 "resume failed, device %d\n",
369 device->id);
370 device->state = KGSL_STATE_INIT;
371 goto end;
372 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700373 complete_all(&device->hwaccess_gate);
374 }
375 device->requested_state = KGSL_STATE_NONE;
376
Dominic Binks417877f2011-10-20 12:55:48 -0700377end:
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700378 mutex_unlock(&device->mutex);
Dominic Binks417877f2011-10-20 12:55:48 -0700379 kgsl_check_idle(device);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700380 KGSL_PWR_WARN(device, "resume end\n");
381 return status;
382}
383
384static int kgsl_suspend(struct device *dev)
385{
386
387 pm_message_t arg = {0};
388 struct kgsl_device *device = dev_get_drvdata(dev);
389 return kgsl_suspend_device(device, arg);
390}
391
392static int kgsl_resume(struct device *dev)
393{
394 struct kgsl_device *device = dev_get_drvdata(dev);
395 return kgsl_resume_device(device);
396}
397
398static int kgsl_runtime_suspend(struct device *dev)
399{
400 return 0;
401}
402
403static int kgsl_runtime_resume(struct device *dev)
404{
405 return 0;
406}
407
408const struct dev_pm_ops kgsl_pm_ops = {
409 .suspend = kgsl_suspend,
410 .resume = kgsl_resume,
411 .runtime_suspend = kgsl_runtime_suspend,
412 .runtime_resume = kgsl_runtime_resume,
413};
414EXPORT_SYMBOL(kgsl_pm_ops);
415
416void kgsl_early_suspend_driver(struct early_suspend *h)
417{
418 struct kgsl_device *device = container_of(h,
419 struct kgsl_device, display_off);
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530420 mutex_lock(&device->mutex);
Dominic Binks417877f2011-10-20 12:55:48 -0700421 kgsl_pwrctrl_pwrlevel_change(device, KGSL_PWRLEVEL_NOMINAL);
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530422 mutex_unlock(&device->mutex);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700423}
424EXPORT_SYMBOL(kgsl_early_suspend_driver);
425
426int kgsl_suspend_driver(struct platform_device *pdev,
427 pm_message_t state)
428{
429 struct kgsl_device *device = dev_get_drvdata(&pdev->dev);
430 return kgsl_suspend_device(device, state);
431}
432EXPORT_SYMBOL(kgsl_suspend_driver);
433
434int kgsl_resume_driver(struct platform_device *pdev)
435{
436 struct kgsl_device *device = dev_get_drvdata(&pdev->dev);
437 return kgsl_resume_device(device);
438}
439EXPORT_SYMBOL(kgsl_resume_driver);
440
441void kgsl_late_resume_driver(struct early_suspend *h)
442{
443 struct kgsl_device *device = container_of(h,
444 struct kgsl_device, display_off);
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530445 mutex_lock(&device->mutex);
Dominic Binks417877f2011-10-20 12:55:48 -0700446 kgsl_pwrctrl_pwrlevel_change(device, KGSL_PWRLEVEL_TURBO);
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530447 mutex_unlock(&device->mutex);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700448}
449EXPORT_SYMBOL(kgsl_late_resume_driver);
450
451/* file operations */
452static struct kgsl_process_private *
453kgsl_get_process_private(struct kgsl_device_private *cur_dev_priv)
454{
455 struct kgsl_process_private *private;
456
457 mutex_lock(&kgsl_driver.process_mutex);
458 list_for_each_entry(private, &kgsl_driver.process_list, list) {
459 if (private->pid == task_tgid_nr(current)) {
460 private->refcnt++;
461 goto out;
462 }
463 }
464
465 /* no existing process private found for this dev_priv, create one */
466 private = kzalloc(sizeof(struct kgsl_process_private), GFP_KERNEL);
467 if (private == NULL) {
468 KGSL_DRV_ERR(cur_dev_priv->device, "kzalloc(%d) failed\n",
469 sizeof(struct kgsl_process_private));
470 goto out;
471 }
472
473 spin_lock_init(&private->mem_lock);
474 private->refcnt = 1;
475 private->pid = task_tgid_nr(current);
476
477 INIT_LIST_HEAD(&private->mem_list);
478
Shubhraprakash Das767fdda2011-08-15 15:49:45 -0600479 if (kgsl_mmu_enabled())
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700480 {
481 unsigned long pt_name;
482
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700483 pt_name = task_tgid_nr(current);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700484 private->pagetable = kgsl_mmu_getpagetable(pt_name);
485 if (private->pagetable == NULL) {
486 kfree(private);
487 private = NULL;
488 goto out;
489 }
490 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700491
492 list_add(&private->list, &kgsl_driver.process_list);
493
494 kgsl_process_init_sysfs(private);
495
496out:
497 mutex_unlock(&kgsl_driver.process_mutex);
498 return private;
499}
500
501static void
502kgsl_put_process_private(struct kgsl_device *device,
503 struct kgsl_process_private *private)
504{
505 struct kgsl_mem_entry *entry = NULL;
506 struct kgsl_mem_entry *entry_tmp = NULL;
507
508 if (!private)
509 return;
510
511 mutex_lock(&kgsl_driver.process_mutex);
512
513 if (--private->refcnt)
514 goto unlock;
515
516 KGSL_MEM_INFO(device,
517 "Memory usage: user (%d/%d) mapped (%d/%d)\n",
518 private->stats.user, private->stats.user_max,
519 private->stats.mapped, private->stats.mapped_max);
520
521 kgsl_process_uninit_sysfs(private);
522
523 list_del(&private->list);
524
525 list_for_each_entry_safe(entry, entry_tmp, &private->mem_list, list) {
526 list_del(&entry->list);
527 kgsl_mem_entry_put(entry);
528 }
529
530 kgsl_mmu_putpagetable(private->pagetable);
531 kfree(private);
532unlock:
533 mutex_unlock(&kgsl_driver.process_mutex);
534}
535
536static int kgsl_release(struct inode *inodep, struct file *filep)
537{
538 int result = 0;
Jordan Crouse2db0af92011-08-08 16:05:09 -0600539 struct kgsl_device_private *dev_priv = filep->private_data;
540 struct kgsl_process_private *private = dev_priv->process_priv;
541 struct kgsl_device *device = dev_priv->device;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700542 struct kgsl_context *context;
543 int next = 0;
544
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700545 filep->private_data = NULL;
546
547 mutex_lock(&device->mutex);
548 kgsl_check_suspended(device);
549
550 while (1) {
Jordan Crouse2db0af92011-08-08 16:05:09 -0600551 context = idr_get_next(&device->context_idr, &next);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700552 if (context == NULL)
553 break;
554
555 if (context->dev_priv == dev_priv) {
556 device->ftbl->drawctxt_destroy(device, context);
557 kgsl_destroy_context(dev_priv, context);
558 }
559
560 next = next + 1;
561 }
562
563 device->open_count--;
564 if (device->open_count == 0) {
565 result = device->ftbl->stop(device);
566 device->state = KGSL_STATE_INIT;
567 KGSL_PWR_WARN(device, "state -> INIT, device %d\n", device->id);
568 }
569 /* clean up any to-be-freed entries that belong to this
570 * process and this device
571 */
572 kgsl_memqueue_cleanup(device, private);
573
574 mutex_unlock(&device->mutex);
575 kfree(dev_priv);
576
577 kgsl_put_process_private(device, private);
578
579 pm_runtime_put(device->parentdev);
580 return result;
581}
582
583static int kgsl_open(struct inode *inodep, struct file *filep)
584{
585 int result;
586 struct kgsl_device_private *dev_priv;
587 struct kgsl_device *device;
588 unsigned int minor = iminor(inodep);
589
590 device = kgsl_get_minor(minor);
591 BUG_ON(device == NULL);
592
593 if (filep->f_flags & O_EXCL) {
594 KGSL_DRV_ERR(device, "O_EXCL not allowed\n");
595 return -EBUSY;
596 }
597
598 result = pm_runtime_get_sync(device->parentdev);
599 if (result < 0) {
600 KGSL_DRV_ERR(device,
601 "Runtime PM: Unable to wake up the device, rc = %d\n",
602 result);
603 return result;
604 }
605 result = 0;
606
607 dev_priv = kzalloc(sizeof(struct kgsl_device_private), GFP_KERNEL);
608 if (dev_priv == NULL) {
609 KGSL_DRV_ERR(device, "kzalloc failed(%d)\n",
610 sizeof(struct kgsl_device_private));
611 result = -ENOMEM;
612 goto err_pmruntime;
613 }
614
615 dev_priv->device = device;
616 filep->private_data = dev_priv;
617
618 /* Get file (per process) private struct */
619 dev_priv->process_priv = kgsl_get_process_private(dev_priv);
620 if (dev_priv->process_priv == NULL) {
621 result = -ENOMEM;
622 goto err_freedevpriv;
623 }
624
625 mutex_lock(&device->mutex);
626 kgsl_check_suspended(device);
627
628 if (device->open_count == 0) {
629 result = device->ftbl->start(device, true);
630
631 if (result) {
632 mutex_unlock(&device->mutex);
633 goto err_putprocess;
634 }
635 device->state = KGSL_STATE_ACTIVE;
636 KGSL_PWR_WARN(device,
637 "state -> ACTIVE, device %d\n", minor);
638 }
639 device->open_count++;
640 mutex_unlock(&device->mutex);
641
642 KGSL_DRV_INFO(device, "Initialized %s: mmu=%s pagetable_count=%d\n",
643 device->name, kgsl_mmu_enabled() ? "on" : "off",
644 kgsl_pagetable_count);
645
646 return result;
647
648err_putprocess:
649 kgsl_put_process_private(device, dev_priv->process_priv);
650err_freedevpriv:
651 filep->private_data = NULL;
652 kfree(dev_priv);
653err_pmruntime:
654 pm_runtime_put(device->parentdev);
655 return result;
656}
657
658
659/*call with private->mem_lock locked */
660static struct kgsl_mem_entry *
661kgsl_sharedmem_find(struct kgsl_process_private *private, unsigned int gpuaddr)
662{
663 struct kgsl_mem_entry *entry = NULL, *result = NULL;
664
665 BUG_ON(private == NULL);
666
667 gpuaddr &= PAGE_MASK;
668
669 list_for_each_entry(entry, &private->mem_list, list) {
670 if (entry->memdesc.gpuaddr == gpuaddr) {
671 result = entry;
672 break;
673 }
674 }
675 return result;
676}
677
678/*call with private->mem_lock locked */
679struct kgsl_mem_entry *
680kgsl_sharedmem_find_region(struct kgsl_process_private *private,
681 unsigned int gpuaddr,
682 size_t size)
683{
684 struct kgsl_mem_entry *entry = NULL, *result = NULL;
685
686 BUG_ON(private == NULL);
687
688 list_for_each_entry(entry, &private->mem_list, list) {
689 if (gpuaddr >= entry->memdesc.gpuaddr &&
690 ((gpuaddr + size) <=
691 (entry->memdesc.gpuaddr + entry->memdesc.size))) {
692 result = entry;
693 break;
694 }
695 }
696
697 return result;
698}
699EXPORT_SYMBOL(kgsl_sharedmem_find_region);
700
701uint8_t *kgsl_gpuaddr_to_vaddr(const struct kgsl_memdesc *memdesc,
702 unsigned int gpuaddr, unsigned int *size)
703{
704 BUG_ON(memdesc->hostptr == NULL);
705
706 if (memdesc->gpuaddr == 0 || (gpuaddr < memdesc->gpuaddr ||
707 gpuaddr >= memdesc->gpuaddr + memdesc->size))
708 return NULL;
709
710 *size = memdesc->size - (gpuaddr - memdesc->gpuaddr);
711 return memdesc->hostptr + (gpuaddr - memdesc->gpuaddr);
712}
713EXPORT_SYMBOL(kgsl_gpuaddr_to_vaddr);
714
715/*call all ioctl sub functions with driver locked*/
716static long kgsl_ioctl_device_getproperty(struct kgsl_device_private *dev_priv,
717 unsigned int cmd, void *data)
718{
719 int result = 0;
720 struct kgsl_device_getproperty *param = data;
721
722 switch (param->type) {
723 case KGSL_PROP_VERSION:
724 {
725 struct kgsl_version version;
726 if (param->sizebytes != sizeof(version)) {
727 result = -EINVAL;
728 break;
729 }
730
731 version.drv_major = KGSL_VERSION_MAJOR;
732 version.drv_minor = KGSL_VERSION_MINOR;
733 version.dev_major = dev_priv->device->ver_major;
734 version.dev_minor = dev_priv->device->ver_minor;
735
736 if (copy_to_user(param->value, &version, sizeof(version)))
737 result = -EFAULT;
738
739 break;
740 }
741 default:
742 result = dev_priv->device->ftbl->getproperty(
743 dev_priv->device, param->type,
744 param->value, param->sizebytes);
745 }
746
747
748 return result;
749}
750
751static long kgsl_ioctl_device_waittimestamp(struct kgsl_device_private
752 *dev_priv, unsigned int cmd,
753 void *data)
754{
755 int result = 0;
756 struct kgsl_device_waittimestamp *param = data;
757
758 /* Set the active count so that suspend doesn't do the
759 wrong thing */
760
761 dev_priv->device->active_cnt++;
762
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700763 result = dev_priv->device->ftbl->waittimestamp(dev_priv->device,
764 param->timestamp,
765 param->timeout);
766
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700767 /* Fire off any pending suspend operations that are in flight */
768
769 INIT_COMPLETION(dev_priv->device->suspend_gate);
770 dev_priv->device->active_cnt--;
771 complete(&dev_priv->device->suspend_gate);
772
773 return result;
774}
775static bool check_ibdesc(struct kgsl_device_private *dev_priv,
776 struct kgsl_ibdesc *ibdesc, unsigned int numibs,
777 bool parse)
778{
779 bool result = true;
780 unsigned int i;
781 for (i = 0; i < numibs; i++) {
782 struct kgsl_mem_entry *entry;
783 spin_lock(&dev_priv->process_priv->mem_lock);
784 entry = kgsl_sharedmem_find_region(dev_priv->process_priv,
785 ibdesc[i].gpuaddr, ibdesc[i].sizedwords * sizeof(uint));
786 spin_unlock(&dev_priv->process_priv->mem_lock);
787 if (entry == NULL) {
788 KGSL_DRV_ERR(dev_priv->device,
789 "invalid cmd buffer gpuaddr %08x " \
790 "sizedwords %d\n", ibdesc[i].gpuaddr,
791 ibdesc[i].sizedwords);
792 result = false;
793 break;
794 }
795
796 if (parse && !kgsl_cffdump_parse_ibs(dev_priv, &entry->memdesc,
797 ibdesc[i].gpuaddr, ibdesc[i].sizedwords, true)) {
798 KGSL_DRV_ERR(dev_priv->device,
799 "invalid cmd buffer gpuaddr %08x " \
800 "sizedwords %d numibs %d/%d\n",
801 ibdesc[i].gpuaddr,
802 ibdesc[i].sizedwords, i+1, numibs);
803 result = false;
804 break;
805 }
806 }
807 return result;
808}
809
810static long kgsl_ioctl_rb_issueibcmds(struct kgsl_device_private *dev_priv,
811 unsigned int cmd, void *data)
812{
813 int result = 0;
814 struct kgsl_ringbuffer_issueibcmds *param = data;
815 struct kgsl_ibdesc *ibdesc;
816 struct kgsl_context *context;
817
818#ifdef CONFIG_MSM_KGSL_DRM
819 kgsl_gpu_mem_flush(DRM_KGSL_GEM_CACHE_OP_TO_DEV);
820#endif
821
822 context = kgsl_find_context(dev_priv, param->drawctxt_id);
823 if (context == NULL) {
824 result = -EINVAL;
825 KGSL_DRV_ERR(dev_priv->device,
826 "invalid drawctxt drawctxt_id %d\n",
827 param->drawctxt_id);
828 goto done;
829 }
830
831 if (param->flags & KGSL_CONTEXT_SUBMIT_IB_LIST) {
832 KGSL_DRV_INFO(dev_priv->device,
833 "Using IB list mode for ib submission, numibs: %d\n",
834 param->numibs);
835 if (!param->numibs) {
836 KGSL_DRV_ERR(dev_priv->device,
837 "Invalid numibs as parameter: %d\n",
838 param->numibs);
839 result = -EINVAL;
840 goto done;
841 }
842
843 ibdesc = kzalloc(sizeof(struct kgsl_ibdesc) * param->numibs,
844 GFP_KERNEL);
845 if (!ibdesc) {
846 KGSL_MEM_ERR(dev_priv->device,
847 "kzalloc(%d) failed\n",
848 sizeof(struct kgsl_ibdesc) * param->numibs);
849 result = -ENOMEM;
850 goto done;
851 }
852
853 if (copy_from_user(ibdesc, (void *)param->ibdesc_addr,
854 sizeof(struct kgsl_ibdesc) * param->numibs)) {
855 result = -EFAULT;
856 KGSL_DRV_ERR(dev_priv->device,
857 "copy_from_user failed\n");
858 goto free_ibdesc;
859 }
860 } else {
861 KGSL_DRV_INFO(dev_priv->device,
862 "Using single IB submission mode for ib submission\n");
863 /* If user space driver is still using the old mode of
864 * submitting single ib then we need to support that as well */
865 ibdesc = kzalloc(sizeof(struct kgsl_ibdesc), GFP_KERNEL);
866 if (!ibdesc) {
867 KGSL_MEM_ERR(dev_priv->device,
868 "kzalloc(%d) failed\n",
869 sizeof(struct kgsl_ibdesc));
870 result = -ENOMEM;
871 goto done;
872 }
873 ibdesc[0].gpuaddr = param->ibdesc_addr;
874 ibdesc[0].sizedwords = param->numibs;
875 param->numibs = 1;
876 }
877
878 if (!check_ibdesc(dev_priv, ibdesc, param->numibs, true)) {
879 KGSL_DRV_ERR(dev_priv->device, "bad ibdesc");
880 result = -EINVAL;
881 goto free_ibdesc;
882 }
883
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700884 result = dev_priv->device->ftbl->issueibcmds(dev_priv,
885 context,
886 ibdesc,
887 param->numibs,
888 &param->timestamp,
889 param->flags);
890
891 if (result != 0)
892 goto free_ibdesc;
893
894 /* this is a check to try to detect if a command buffer was freed
895 * during issueibcmds().
896 */
897 if (!check_ibdesc(dev_priv, ibdesc, param->numibs, false)) {
898 KGSL_DRV_ERR(dev_priv->device, "bad ibdesc AFTER issue");
899 result = -EINVAL;
900 goto free_ibdesc;
901 }
902
903free_ibdesc:
904 kfree(ibdesc);
905done:
906
907#ifdef CONFIG_MSM_KGSL_DRM
908 kgsl_gpu_mem_flush(DRM_KGSL_GEM_CACHE_OP_FROM_DEV);
909#endif
910
911 return result;
912}
913
914static long kgsl_ioctl_cmdstream_readtimestamp(struct kgsl_device_private
915 *dev_priv, unsigned int cmd,
916 void *data)
917{
918 struct kgsl_cmdstream_readtimestamp *param = data;
919
920 param->timestamp =
921 dev_priv->device->ftbl->readtimestamp(dev_priv->device,
922 param->type);
923
924 return 0;
925}
926
927static long kgsl_ioctl_cmdstream_freememontimestamp(struct kgsl_device_private
928 *dev_priv, unsigned int cmd,
929 void *data)
930{
931 int result = 0;
932 struct kgsl_cmdstream_freememontimestamp *param = data;
933 struct kgsl_mem_entry *entry = NULL;
934
935 spin_lock(&dev_priv->process_priv->mem_lock);
936 entry = kgsl_sharedmem_find(dev_priv->process_priv, param->gpuaddr);
937 if (entry)
938 list_del(&entry->list);
939 spin_unlock(&dev_priv->process_priv->mem_lock);
940
941 if (entry) {
942 kgsl_memqueue_freememontimestamp(dev_priv->device, entry,
943 param->timestamp, param->type);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700944 } else {
945 KGSL_DRV_ERR(dev_priv->device,
946 "invalid gpuaddr %08x\n", param->gpuaddr);
947 result = -EINVAL;
948 }
949
950 return result;
951}
952
953static long kgsl_ioctl_drawctxt_create(struct kgsl_device_private *dev_priv,
954 unsigned int cmd, void *data)
955{
956 int result = 0;
957 struct kgsl_drawctxt_create *param = data;
958 struct kgsl_context *context = NULL;
959
960 context = kgsl_create_context(dev_priv);
961
962 if (context == NULL) {
963 result = -ENOMEM;
964 goto done;
965 }
966
967 if (dev_priv->device->ftbl->drawctxt_create)
968 result = dev_priv->device->ftbl->drawctxt_create(
969 dev_priv->device, dev_priv->process_priv->pagetable,
970 context, param->flags);
971
972 param->drawctxt_id = context->id;
973
974done:
975 if (result && context)
976 kgsl_destroy_context(dev_priv, context);
977
978 return result;
979}
980
981static long kgsl_ioctl_drawctxt_destroy(struct kgsl_device_private *dev_priv,
982 unsigned int cmd, void *data)
983{
984 int result = 0;
985 struct kgsl_drawctxt_destroy *param = data;
986 struct kgsl_context *context;
987
988 context = kgsl_find_context(dev_priv, param->drawctxt_id);
989
990 if (context == NULL) {
991 result = -EINVAL;
992 goto done;
993 }
994
995 if (dev_priv->device->ftbl->drawctxt_destroy)
996 dev_priv->device->ftbl->drawctxt_destroy(dev_priv->device,
997 context);
998
999 kgsl_destroy_context(dev_priv, context);
1000
1001done:
1002 return result;
1003}
1004
1005static long kgsl_ioctl_sharedmem_free(struct kgsl_device_private *dev_priv,
1006 unsigned int cmd, void *data)
1007{
1008 int result = 0;
1009 struct kgsl_sharedmem_free *param = data;
1010 struct kgsl_process_private *private = dev_priv->process_priv;
1011 struct kgsl_mem_entry *entry = NULL;
1012
1013 spin_lock(&private->mem_lock);
1014 entry = kgsl_sharedmem_find(private, param->gpuaddr);
1015 if (entry)
1016 list_del(&entry->list);
1017 spin_unlock(&private->mem_lock);
1018
1019 if (entry) {
1020 kgsl_mem_entry_put(entry);
1021 } else {
1022 KGSL_CORE_ERR("invalid gpuaddr %08x\n", param->gpuaddr);
1023 result = -EINVAL;
1024 }
1025
1026 return result;
1027}
1028
1029static struct vm_area_struct *kgsl_get_vma_from_start_addr(unsigned int addr)
1030{
1031 struct vm_area_struct *vma;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001032
1033 down_read(&current->mm->mmap_sem);
1034 vma = find_vma(current->mm, addr);
1035 up_read(&current->mm->mmap_sem);
Jordan Crouse2c542b62011-07-26 08:30:20 -06001036 if (!vma)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001037 KGSL_CORE_ERR("find_vma(%x) failed\n", addr);
Jordan Crouse2c542b62011-07-26 08:30:20 -06001038
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001039 return vma;
1040}
1041
1042static long
1043kgsl_ioctl_sharedmem_from_vmalloc(struct kgsl_device_private *dev_priv,
1044 unsigned int cmd, void *data)
1045{
1046 int result = 0, len = 0;
1047 struct kgsl_process_private *private = dev_priv->process_priv;
1048 struct kgsl_sharedmem_from_vmalloc *param = data;
1049 struct kgsl_mem_entry *entry = NULL;
1050 struct vm_area_struct *vma;
1051
1052 if (!kgsl_mmu_enabled())
1053 return -ENODEV;
1054
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001055 if (!param->hostptr) {
1056 KGSL_CORE_ERR("invalid hostptr %x\n", param->hostptr);
1057 result = -EINVAL;
1058 goto error;
1059 }
1060
1061 vma = kgsl_get_vma_from_start_addr(param->hostptr);
1062 if (!vma) {
1063 result = -EINVAL;
1064 goto error;
1065 }
Jordan Crouse2c542b62011-07-26 08:30:20 -06001066
1067 /*
1068 * If the user specified a length, use it, otherwise try to
1069 * infer the length if the vma region
1070 */
1071 if (param->gpuaddr != 0) {
1072 len = param->gpuaddr;
1073 } else {
1074 /*
1075 * For this to work, we have to assume the VMA region is only
1076 * for this single allocation. If it isn't, then bail out
1077 */
1078 if (vma->vm_pgoff || (param->hostptr != vma->vm_start)) {
1079 KGSL_CORE_ERR("VMA region does not match hostaddr\n");
1080 result = -EINVAL;
1081 goto error;
1082 }
1083
1084 len = vma->vm_end - vma->vm_start;
1085 }
1086
1087 /* Make sure it fits */
1088 if (len == 0 || param->hostptr + len > vma->vm_end) {
1089 KGSL_CORE_ERR("Invalid memory allocation length %d\n", len);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001090 result = -EINVAL;
1091 goto error;
1092 }
1093
1094 entry = kgsl_mem_entry_create();
1095 if (entry == NULL) {
1096 result = -ENOMEM;
1097 goto error;
1098 }
1099
1100 result = kgsl_sharedmem_vmalloc_user(&entry->memdesc,
1101 private->pagetable, len,
1102 param->flags);
1103 if (result != 0)
1104 goto error_free_entry;
1105
1106 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
1107
1108 result = remap_vmalloc_range(vma, (void *) entry->memdesc.hostptr, 0);
1109 if (result) {
1110 KGSL_CORE_ERR("remap_vmalloc_range failed: %d\n", result);
1111 goto error_free_vmalloc;
1112 }
1113
1114 param->gpuaddr = entry->memdesc.gpuaddr;
1115
1116 entry->memtype = KGSL_USER_MEMORY;
1117
1118 kgsl_mem_entry_attach_process(entry, private);
1119
1120 /* Process specific statistics */
1121 KGSL_STATS_ADD(len, private->stats.user,
1122 private->stats.user_max);
1123
1124 kgsl_check_idle(dev_priv->device);
1125 return 0;
1126
1127error_free_vmalloc:
1128 kgsl_sharedmem_free(&entry->memdesc);
1129
1130error_free_entry:
1131 kfree(entry);
1132
1133error:
1134 kgsl_check_idle(dev_priv->device);
1135 return result;
1136}
1137
1138static inline int _check_region(unsigned long start, unsigned long size,
1139 uint64_t len)
1140{
1141 uint64_t end = ((uint64_t) start) + size;
1142 return (end > len);
1143}
1144
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001145static int kgsl_get_phys_file(int fd, unsigned long *start, unsigned long *len,
1146 unsigned long *vstart, struct file **filep)
1147{
1148 struct file *fbfile;
1149 int ret = 0;
1150 dev_t rdev;
1151 struct fb_info *info;
1152
1153 *filep = NULL;
Jordan Crousefd978432011-09-02 14:34:32 -06001154#ifdef CONFIG_ANDROID_PMEM
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001155 if (!get_pmem_file(fd, start, vstart, len, filep))
1156 return 0;
Jordan Crousefd978432011-09-02 14:34:32 -06001157#endif
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001158
1159 fbfile = fget(fd);
1160 if (fbfile == NULL) {
1161 KGSL_CORE_ERR("fget_light failed\n");
1162 return -1;
1163 }
1164
1165 rdev = fbfile->f_dentry->d_inode->i_rdev;
1166 info = MAJOR(rdev) == FB_MAJOR ? registered_fb[MINOR(rdev)] : NULL;
1167 if (info) {
1168 *start = info->fix.smem_start;
1169 *len = info->fix.smem_len;
1170 *vstart = (unsigned long)__va(info->fix.smem_start);
1171 ret = 0;
1172 } else {
1173 KGSL_CORE_ERR("framebuffer minor %d not found\n",
1174 MINOR(rdev));
1175 ret = -1;
1176 }
1177
1178 fput(fbfile);
1179
1180 return ret;
1181}
1182
1183static int kgsl_setup_phys_file(struct kgsl_mem_entry *entry,
1184 struct kgsl_pagetable *pagetable,
1185 unsigned int fd, unsigned int offset,
1186 size_t size)
1187{
1188 int ret;
1189 unsigned long phys, virt, len;
1190 struct file *filep;
1191
1192 ret = kgsl_get_phys_file(fd, &phys, &len, &virt, &filep);
1193 if (ret)
1194 return ret;
1195
Wei Zou4061c0b2011-07-08 10:24:22 -07001196 if (phys == 0) {
1197 ret = -EINVAL;
1198 goto err;
1199 }
1200
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001201 if (offset >= len) {
1202 ret = -EINVAL;
1203 goto err;
1204 }
1205
1206 if (size == 0)
1207 size = len;
1208
1209 /* Adjust the size of the region to account for the offset */
1210 size += offset & ~PAGE_MASK;
1211
1212 size = ALIGN(size, PAGE_SIZE);
1213
1214 if (_check_region(offset & PAGE_MASK, size, len)) {
1215 KGSL_CORE_ERR("Offset (%ld) + size (%d) is larger"
1216 "than pmem region length %ld\n",
1217 offset & PAGE_MASK, size, len);
1218 ret = -EINVAL;
1219 goto err;
1220
1221 }
1222
1223 entry->file_ptr = filep;
1224
1225 entry->memdesc.pagetable = pagetable;
1226 entry->memdesc.size = size;
1227 entry->memdesc.physaddr = phys + (offset & PAGE_MASK);
1228 entry->memdesc.hostptr = (void *) (virt + (offset & PAGE_MASK));
1229 entry->memdesc.ops = &kgsl_contiguous_ops;
1230
1231 return 0;
1232err:
Jordan Crousefd978432011-09-02 14:34:32 -06001233#ifdef CONFIG_ANDROID_PMEM
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001234 put_pmem_file(filep);
Jordan Crousefd978432011-09-02 14:34:32 -06001235#endif
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001236 return ret;
1237}
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001238
1239static int kgsl_setup_hostptr(struct kgsl_mem_entry *entry,
1240 struct kgsl_pagetable *pagetable,
1241 void *hostptr, unsigned int offset,
1242 size_t size)
1243{
1244 struct vm_area_struct *vma;
1245 unsigned int len;
1246
1247 down_read(&current->mm->mmap_sem);
1248 vma = find_vma(current->mm, (unsigned int) hostptr);
1249 up_read(&current->mm->mmap_sem);
1250
1251 if (!vma) {
1252 KGSL_CORE_ERR("find_vma(%p) failed\n", hostptr);
1253 return -EINVAL;
1254 }
1255
1256 /* We don't necessarily start at vma->vm_start */
1257 len = vma->vm_end - (unsigned long) hostptr;
1258
1259 if (offset >= len)
1260 return -EINVAL;
1261
1262 if (!KGSL_IS_PAGE_ALIGNED((unsigned long) hostptr) ||
1263 !KGSL_IS_PAGE_ALIGNED(len)) {
1264 KGSL_CORE_ERR("user address len(%u)"
1265 "and start(%p) must be page"
1266 "aligned\n", len, hostptr);
1267 return -EINVAL;
1268 }
1269
1270 if (size == 0)
1271 size = len;
1272
1273 /* Adjust the size of the region to account for the offset */
1274 size += offset & ~PAGE_MASK;
1275
1276 size = ALIGN(size, PAGE_SIZE);
1277
1278 if (_check_region(offset & PAGE_MASK, size, len)) {
1279 KGSL_CORE_ERR("Offset (%ld) + size (%d) is larger"
1280 "than region length %d\n",
1281 offset & PAGE_MASK, size, len);
1282 return -EINVAL;
1283 }
1284
1285 entry->memdesc.pagetable = pagetable;
1286 entry->memdesc.size = size;
1287 entry->memdesc.hostptr = hostptr + (offset & PAGE_MASK);
1288 entry->memdesc.ops = &kgsl_userptr_ops;
1289
1290 return 0;
1291}
1292
1293#ifdef CONFIG_ASHMEM
1294static int kgsl_setup_ashmem(struct kgsl_mem_entry *entry,
1295 struct kgsl_pagetable *pagetable,
1296 int fd, void *hostptr, size_t size)
1297{
1298 int ret;
1299 struct vm_area_struct *vma;
1300 struct file *filep, *vmfile;
1301 unsigned long len;
Jordan Crouse2c542b62011-07-26 08:30:20 -06001302 unsigned int hostaddr = (unsigned int) hostptr;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001303
Jordan Crouse2c542b62011-07-26 08:30:20 -06001304 vma = kgsl_get_vma_from_start_addr(hostaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001305 if (vma == NULL)
1306 return -EINVAL;
1307
Jordan Crouse2c542b62011-07-26 08:30:20 -06001308 if (vma->vm_pgoff || vma->vm_start != hostaddr) {
1309 KGSL_CORE_ERR("Invalid vma region\n");
1310 return -EINVAL;
1311 }
1312
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001313 len = vma->vm_end - vma->vm_start;
1314
1315 if (size == 0)
1316 size = len;
1317
1318 if (size != len) {
1319 KGSL_CORE_ERR("Invalid size %d for vma region %p\n",
1320 size, hostptr);
1321 return -EINVAL;
1322 }
1323
1324 ret = get_ashmem_file(fd, &filep, &vmfile, &len);
1325
1326 if (ret) {
1327 KGSL_CORE_ERR("get_ashmem_file failed\n");
1328 return ret;
1329 }
1330
1331 if (vmfile != vma->vm_file) {
1332 KGSL_CORE_ERR("ashmem shmem file does not match vma\n");
1333 ret = -EINVAL;
1334 goto err;
1335 }
1336
1337 entry->file_ptr = filep;
1338
1339 entry->memdesc.pagetable = pagetable;
1340 entry->memdesc.size = ALIGN(size, PAGE_SIZE);
1341 entry->memdesc.hostptr = hostptr;
1342 entry->memdesc.ops = &kgsl_userptr_ops;
1343
1344 return 0;
1345
1346err:
1347 put_ashmem_file(filep);
1348 return ret;
1349}
1350#else
1351static int kgsl_setup_ashmem(struct kgsl_mem_entry *entry,
1352 struct kgsl_pagetable *pagetable,
1353 int fd, void *hostptr, size_t size)
1354{
1355 return -EINVAL;
1356}
1357#endif
1358
1359static long kgsl_ioctl_map_user_mem(struct kgsl_device_private *dev_priv,
1360 unsigned int cmd, void *data)
1361{
1362 int result = -EINVAL;
1363 struct kgsl_map_user_mem *param = data;
1364 struct kgsl_mem_entry *entry = NULL;
1365 struct kgsl_process_private *private = dev_priv->process_priv;
Jason848741a2011-07-12 10:24:25 -07001366 enum kgsl_user_mem_type memtype;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001367
1368 entry = kgsl_mem_entry_create();
1369
1370 if (entry == NULL)
1371 return -ENOMEM;
1372
Jason848741a2011-07-12 10:24:25 -07001373 if (_IOC_SIZE(cmd) == sizeof(struct kgsl_sharedmem_from_pmem))
1374 memtype = KGSL_USER_MEM_TYPE_PMEM;
1375 else
1376 memtype = param->memtype;
1377
1378 switch (memtype) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001379 case KGSL_USER_MEM_TYPE_PMEM:
1380 if (param->fd == 0 || param->len == 0)
1381 break;
1382
1383 result = kgsl_setup_phys_file(entry, private->pagetable,
1384 param->fd, param->offset,
1385 param->len);
1386 break;
1387
1388 case KGSL_USER_MEM_TYPE_ADDR:
1389 if (!kgsl_mmu_enabled()) {
1390 KGSL_DRV_ERR(dev_priv->device,
1391 "Cannot map paged memory with the "
1392 "MMU disabled\n");
1393 break;
1394 }
1395
1396 if (param->hostptr == 0)
1397 break;
1398
1399 result = kgsl_setup_hostptr(entry, private->pagetable,
1400 (void *) param->hostptr,
1401 param->offset, param->len);
1402 break;
1403
1404 case KGSL_USER_MEM_TYPE_ASHMEM:
1405 if (!kgsl_mmu_enabled()) {
1406 KGSL_DRV_ERR(dev_priv->device,
1407 "Cannot map paged memory with the "
1408 "MMU disabled\n");
1409 break;
1410 }
1411
1412 if (param->hostptr == 0)
1413 break;
1414
1415 result = kgsl_setup_ashmem(entry, private->pagetable,
1416 param->fd, (void *) param->hostptr,
1417 param->len);
1418 break;
1419 default:
Jason848741a2011-07-12 10:24:25 -07001420 KGSL_CORE_ERR("Invalid memory type: %x\n", memtype);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001421 break;
1422 }
1423
1424 if (result)
1425 goto error;
1426
1427 result = kgsl_mmu_map(private->pagetable,
1428 &entry->memdesc,
1429 GSL_PT_PAGE_RV | GSL_PT_PAGE_WV);
1430
1431 if (result)
1432 goto error_put_file_ptr;
1433
1434 /* Adjust the returned value for a non 4k aligned offset */
1435 param->gpuaddr = entry->memdesc.gpuaddr + (param->offset & ~PAGE_MASK);
1436
1437 entry->memtype = KGSL_MAPPED_MEMORY;
1438
1439 KGSL_STATS_ADD(param->len, kgsl_driver.stats.mapped,
1440 kgsl_driver.stats.mapped_max);
1441
1442 /* Statistics */
1443 KGSL_STATS_ADD(param->len, private->stats.mapped,
1444 private->stats.mapped_max);
1445
1446 kgsl_mem_entry_attach_process(entry, private);
1447
1448 kgsl_check_idle(dev_priv->device);
1449 return result;
1450
1451 error_put_file_ptr:
1452 if (entry->file_ptr)
1453 fput(entry->file_ptr);
1454
1455error:
1456 kfree(entry);
1457 kgsl_check_idle(dev_priv->device);
1458 return result;
1459}
1460
1461/*This function flushes a graphics memory allocation from CPU cache
1462 *when caching is enabled with MMU*/
1463static long
1464kgsl_ioctl_sharedmem_flush_cache(struct kgsl_device_private *dev_priv,
1465 unsigned int cmd, void *data)
1466{
1467 int result = 0;
1468 struct kgsl_mem_entry *entry;
1469 struct kgsl_sharedmem_free *param = data;
1470 struct kgsl_process_private *private = dev_priv->process_priv;
1471
1472 spin_lock(&private->mem_lock);
1473 entry = kgsl_sharedmem_find(private, param->gpuaddr);
1474 if (!entry) {
1475 KGSL_CORE_ERR("invalid gpuaddr %08x\n", param->gpuaddr);
1476 result = -EINVAL;
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001477 goto done;
1478 }
1479 if (!entry->memdesc.hostptr)
1480 entry->memdesc.hostptr =
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001481 kgsl_gpuaddr_to_vaddr(&entry->memdesc,
1482 param->gpuaddr, &entry->memdesc.size);
1483
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001484 if (!entry->memdesc.hostptr) {
1485 KGSL_CORE_ERR("invalid hostptr with gpuaddr %08x\n",
1486 param->gpuaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001487 goto done;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001488 }
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001489
1490 kgsl_cache_range_op(&entry->memdesc, KGSL_CACHE_OP_CLEAN);
1491
1492 /* Statistics - keep track of how many flushes each process does */
1493 private->stats.flushes++;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001494done:
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001495 spin_unlock(&private->mem_lock);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001496 return result;
1497}
1498
1499static long
1500kgsl_ioctl_gpumem_alloc(struct kgsl_device_private *dev_priv,
1501 unsigned int cmd, void *data)
1502{
1503 struct kgsl_process_private *private = dev_priv->process_priv;
1504 struct kgsl_gpumem_alloc *param = data;
1505 struct kgsl_mem_entry *entry;
1506 int result;
1507
1508 entry = kgsl_mem_entry_create();
1509 if (entry == NULL)
1510 return -ENOMEM;
1511
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001512 result = kgsl_allocate_user(&entry->memdesc, private->pagetable,
1513 param->size, param->flags);
1514
1515 if (result == 0) {
1516 entry->memtype = KGSL_USER_MEMORY;
1517 kgsl_mem_entry_attach_process(entry, private);
1518 param->gpuaddr = entry->memdesc.gpuaddr;
1519
1520 KGSL_STATS_ADD(entry->memdesc.size, private->stats.user,
1521 private->stats.user_max);
1522 } else
1523 kfree(entry);
1524
1525 kgsl_check_idle(dev_priv->device);
1526 return result;
1527}
Jeremy Gebbena7423e42011-04-18 15:11:21 -06001528static long kgsl_ioctl_cff_syncmem(struct kgsl_device_private *dev_priv,
1529 unsigned int cmd, void *data)
1530{
1531 int result = 0;
1532 struct kgsl_cff_syncmem *param = data;
1533 struct kgsl_process_private *private = dev_priv->process_priv;
1534 struct kgsl_mem_entry *entry = NULL;
1535
1536 spin_lock(&private->mem_lock);
1537 entry = kgsl_sharedmem_find_region(private, param->gpuaddr, param->len);
1538 if (entry)
1539 kgsl_cffdump_syncmem(dev_priv, &entry->memdesc, param->gpuaddr,
1540 param->len, true);
1541 else
1542 result = -EINVAL;
1543 spin_unlock(&private->mem_lock);
1544 return result;
1545}
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001546
Sushmita Susheelendra41f8fa32011-05-11 17:15:58 -06001547static long kgsl_ioctl_cff_user_event(struct kgsl_device_private *dev_priv,
1548 unsigned int cmd, void *data)
1549{
1550 int result = 0;
1551 struct kgsl_cff_user_event *param = data;
1552
1553 kgsl_cffdump_user_event(param->cff_opcode, param->op1, param->op2,
1554 param->op3, param->op4, param->op5);
1555
1556 return result;
1557}
1558
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001559typedef long (*kgsl_ioctl_func_t)(struct kgsl_device_private *,
1560 unsigned int, void *);
1561
1562#define KGSL_IOCTL_FUNC(_cmd, _func, _lock) \
1563 [_IOC_NR(_cmd)] = { .cmd = _cmd, .func = _func, .lock = _lock }
1564
1565static const struct {
1566 unsigned int cmd;
1567 kgsl_ioctl_func_t func;
1568 int lock;
1569} kgsl_ioctl_funcs[] = {
1570 KGSL_IOCTL_FUNC(IOCTL_KGSL_DEVICE_GETPROPERTY,
1571 kgsl_ioctl_device_getproperty, 1),
1572 KGSL_IOCTL_FUNC(IOCTL_KGSL_DEVICE_WAITTIMESTAMP,
1573 kgsl_ioctl_device_waittimestamp, 1),
1574 KGSL_IOCTL_FUNC(IOCTL_KGSL_RINGBUFFER_ISSUEIBCMDS,
1575 kgsl_ioctl_rb_issueibcmds, 1),
1576 KGSL_IOCTL_FUNC(IOCTL_KGSL_CMDSTREAM_READTIMESTAMP,
1577 kgsl_ioctl_cmdstream_readtimestamp, 1),
1578 KGSL_IOCTL_FUNC(IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP,
1579 kgsl_ioctl_cmdstream_freememontimestamp, 1),
1580 KGSL_IOCTL_FUNC(IOCTL_KGSL_DRAWCTXT_CREATE,
1581 kgsl_ioctl_drawctxt_create, 1),
1582 KGSL_IOCTL_FUNC(IOCTL_KGSL_DRAWCTXT_DESTROY,
1583 kgsl_ioctl_drawctxt_destroy, 1),
1584 KGSL_IOCTL_FUNC(IOCTL_KGSL_MAP_USER_MEM,
1585 kgsl_ioctl_map_user_mem, 0),
1586 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FROM_PMEM,
1587 kgsl_ioctl_map_user_mem, 0),
1588 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FREE,
1589 kgsl_ioctl_sharedmem_free, 0),
1590 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FROM_VMALLOC,
1591 kgsl_ioctl_sharedmem_from_vmalloc, 0),
1592 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FLUSH_CACHE,
1593 kgsl_ioctl_sharedmem_flush_cache, 0),
1594 KGSL_IOCTL_FUNC(IOCTL_KGSL_GPUMEM_ALLOC,
1595 kgsl_ioctl_gpumem_alloc, 0),
Jeremy Gebbena7423e42011-04-18 15:11:21 -06001596 KGSL_IOCTL_FUNC(IOCTL_KGSL_CFF_SYNCMEM,
1597 kgsl_ioctl_cff_syncmem, 0),
Sushmita Susheelendra41f8fa32011-05-11 17:15:58 -06001598 KGSL_IOCTL_FUNC(IOCTL_KGSL_CFF_USER_EVENT,
1599 kgsl_ioctl_cff_user_event, 0),
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001600};
1601
1602static long kgsl_ioctl(struct file *filep, unsigned int cmd, unsigned long arg)
1603{
1604 struct kgsl_device_private *dev_priv = filep->private_data;
1605 unsigned int nr = _IOC_NR(cmd);
1606 kgsl_ioctl_func_t func;
1607 int lock, ret;
1608 char ustack[64];
1609 void *uptr = NULL;
1610
1611 BUG_ON(dev_priv == NULL);
1612
1613 /* Workaround for an previously incorrectly defined ioctl code.
1614 This helps ensure binary compatability */
1615
1616 if (cmd == IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP_OLD)
1617 cmd = IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP;
Jason Varbedian80ba33d2011-07-11 17:29:05 -07001618 else if (cmd == IOCTL_KGSL_CMDSTREAM_READTIMESTAMP_OLD)
1619 cmd = IOCTL_KGSL_CMDSTREAM_READTIMESTAMP;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001620
1621 if (cmd & (IOC_IN | IOC_OUT)) {
1622 if (_IOC_SIZE(cmd) < sizeof(ustack))
1623 uptr = ustack;
1624 else {
1625 uptr = kzalloc(_IOC_SIZE(cmd), GFP_KERNEL);
1626 if (uptr == NULL) {
1627 KGSL_MEM_ERR(dev_priv->device,
1628 "kzalloc(%d) failed\n", _IOC_SIZE(cmd));
1629 ret = -ENOMEM;
1630 goto done;
1631 }
1632 }
1633
1634 if (cmd & IOC_IN) {
1635 if (copy_from_user(uptr, (void __user *) arg,
1636 _IOC_SIZE(cmd))) {
1637 ret = -EFAULT;
1638 goto done;
1639 }
1640 } else
1641 memset(uptr, 0, _IOC_SIZE(cmd));
1642 }
1643
1644 if (nr < ARRAY_SIZE(kgsl_ioctl_funcs) &&
1645 kgsl_ioctl_funcs[nr].func != NULL) {
1646 func = kgsl_ioctl_funcs[nr].func;
1647 lock = kgsl_ioctl_funcs[nr].lock;
1648 } else {
1649 func = dev_priv->device->ftbl->ioctl;
1650 if (!func) {
1651 KGSL_DRV_INFO(dev_priv->device,
1652 "invalid ioctl code %08x\n", cmd);
1653 ret = -EINVAL;
1654 goto done;
1655 }
1656 lock = 1;
1657 }
1658
1659 if (lock) {
1660 mutex_lock(&dev_priv->device->mutex);
1661 kgsl_check_suspended(dev_priv->device);
1662 }
1663
1664 ret = func(dev_priv, cmd, uptr);
1665
1666 if (lock) {
1667 kgsl_check_idle_locked(dev_priv->device);
1668 mutex_unlock(&dev_priv->device->mutex);
1669 }
1670
1671 if (ret == 0 && (cmd & IOC_OUT)) {
1672 if (copy_to_user((void __user *) arg, uptr, _IOC_SIZE(cmd)))
1673 ret = -EFAULT;
1674 }
1675
1676done:
1677 if (_IOC_SIZE(cmd) >= sizeof(ustack))
1678 kfree(uptr);
1679
1680 return ret;
1681}
1682
1683static int
1684kgsl_mmap_memstore(struct kgsl_device *device, struct vm_area_struct *vma)
1685{
1686 struct kgsl_memdesc *memdesc = &device->memstore;
1687 int result;
1688 unsigned int vma_size = vma->vm_end - vma->vm_start;
1689
1690 /* The memstore can only be mapped as read only */
1691
1692 if (vma->vm_flags & VM_WRITE)
1693 return -EPERM;
1694
1695 if (memdesc->size != vma_size) {
1696 KGSL_MEM_ERR(device, "memstore bad size: %d should be %d\n",
1697 vma_size, memdesc->size);
1698 return -EINVAL;
1699 }
1700
1701 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
1702
1703 result = remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff,
1704 vma_size, vma->vm_page_prot);
1705 if (result != 0)
1706 KGSL_MEM_ERR(device, "remap_pfn_range failed: %d\n",
1707 result);
1708
1709 return result;
1710}
1711
Jordan Crouse4283e172011-09-26 14:45:47 -06001712/*
1713 * kgsl_gpumem_vm_open is called whenever a vma region is copied or split.
1714 * Increase the refcount to make sure that the accounting stays correct
1715 */
1716
1717static void kgsl_gpumem_vm_open(struct vm_area_struct *vma)
1718{
1719 struct kgsl_mem_entry *entry = vma->vm_private_data;
1720 kgsl_mem_entry_get(entry);
1721}
1722
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001723static int
1724kgsl_gpumem_vm_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
1725{
1726 struct kgsl_mem_entry *entry = vma->vm_private_data;
1727
1728 if (!entry->memdesc.ops->vmfault)
1729 return VM_FAULT_SIGBUS;
1730
1731 return entry->memdesc.ops->vmfault(&entry->memdesc, vma, vmf);
1732}
1733
1734static void
1735kgsl_gpumem_vm_close(struct vm_area_struct *vma)
1736{
1737 struct kgsl_mem_entry *entry = vma->vm_private_data;
1738 kgsl_mem_entry_put(entry);
1739}
1740
1741static struct vm_operations_struct kgsl_gpumem_vm_ops = {
Jordan Crouse4283e172011-09-26 14:45:47 -06001742 .open = kgsl_gpumem_vm_open,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001743 .fault = kgsl_gpumem_vm_fault,
1744 .close = kgsl_gpumem_vm_close,
1745};
1746
1747static int kgsl_mmap(struct file *file, struct vm_area_struct *vma)
1748{
1749 unsigned long vma_offset = vma->vm_pgoff << PAGE_SHIFT;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001750 struct kgsl_device_private *dev_priv = file->private_data;
1751 struct kgsl_process_private *private = dev_priv->process_priv;
Jordan Crouse976cf0e2011-09-12 10:41:49 -06001752 struct kgsl_mem_entry *tmp, *entry = NULL;
Jordan Crouse2db0af92011-08-08 16:05:09 -06001753 struct kgsl_device *device = dev_priv->device;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001754
1755 /* Handle leagacy behavior for memstore */
1756
1757 if (vma_offset == device->memstore.physaddr)
1758 return kgsl_mmap_memstore(device, vma);
1759
1760 /* Find a chunk of GPU memory */
1761
1762 spin_lock(&private->mem_lock);
Jordan Crouse976cf0e2011-09-12 10:41:49 -06001763 list_for_each_entry(tmp, &private->mem_list, list) {
1764 if (vma_offset == tmp->memdesc.gpuaddr) {
1765 kgsl_mem_entry_get(tmp);
1766 entry = tmp;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001767 break;
1768 }
1769 }
1770 spin_unlock(&private->mem_lock);
1771
1772 if (entry == NULL)
1773 return -EINVAL;
1774
1775 if (!entry->memdesc.ops->vmflags || !entry->memdesc.ops->vmfault)
1776 return -EINVAL;
1777
1778 vma->vm_flags |= entry->memdesc.ops->vmflags(&entry->memdesc);
1779
1780 vma->vm_private_data = entry;
1781 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
1782 vma->vm_ops = &kgsl_gpumem_vm_ops;
1783 vma->vm_file = file;
1784
1785 return 0;
1786}
1787
1788static const struct file_operations kgsl_fops = {
1789 .owner = THIS_MODULE,
1790 .release = kgsl_release,
1791 .open = kgsl_open,
1792 .mmap = kgsl_mmap,
1793 .unlocked_ioctl = kgsl_ioctl,
1794};
1795
1796struct kgsl_driver kgsl_driver = {
1797 .process_mutex = __MUTEX_INITIALIZER(kgsl_driver.process_mutex),
1798 .ptlock = __SPIN_LOCK_UNLOCKED(kgsl_driver.ptlock),
1799 .devlock = __MUTEX_INITIALIZER(kgsl_driver.devlock),
1800};
1801EXPORT_SYMBOL(kgsl_driver);
1802
1803void kgsl_unregister_device(struct kgsl_device *device)
1804{
1805 int minor;
1806
1807 mutex_lock(&kgsl_driver.devlock);
1808 for (minor = 0; minor < KGSL_DEVICE_MAX; minor++) {
1809 if (device == kgsl_driver.devp[minor])
1810 break;
1811 }
1812
1813 mutex_unlock(&kgsl_driver.devlock);
1814
1815 if (minor == KGSL_DEVICE_MAX)
1816 return;
1817
1818 kgsl_cffdump_close(device->id);
1819 kgsl_pwrctrl_uninit_sysfs(device);
1820
1821 wake_lock_destroy(&device->idle_wakelock);
1822 pm_qos_remove_request(&device->pm_qos_req_dma);
1823
1824 idr_destroy(&device->context_idr);
1825
1826 if (device->memstore.hostptr)
1827 kgsl_sharedmem_free(&device->memstore);
1828
1829 kgsl_mmu_close(device);
1830
1831 if (device->work_queue) {
1832 destroy_workqueue(device->work_queue);
1833 device->work_queue = NULL;
1834 }
1835
1836 device_destroy(kgsl_driver.class,
1837 MKDEV(MAJOR(kgsl_driver.major), minor));
1838
1839 mutex_lock(&kgsl_driver.devlock);
1840 kgsl_driver.devp[minor] = NULL;
1841 mutex_unlock(&kgsl_driver.devlock);
1842}
1843EXPORT_SYMBOL(kgsl_unregister_device);
1844
1845int
1846kgsl_register_device(struct kgsl_device *device)
1847{
1848 int minor, ret;
1849 dev_t dev;
1850
1851 /* Find a minor for the device */
1852
1853 mutex_lock(&kgsl_driver.devlock);
1854 for (minor = 0; minor < KGSL_DEVICE_MAX; minor++) {
1855 if (kgsl_driver.devp[minor] == NULL) {
1856 kgsl_driver.devp[minor] = device;
1857 break;
1858 }
1859 }
1860
1861 mutex_unlock(&kgsl_driver.devlock);
1862
1863 if (minor == KGSL_DEVICE_MAX) {
1864 KGSL_CORE_ERR("minor devices exhausted\n");
1865 return -ENODEV;
1866 }
1867
1868 /* Create the device */
1869 dev = MKDEV(MAJOR(kgsl_driver.major), minor);
1870 device->dev = device_create(kgsl_driver.class,
1871 device->parentdev,
1872 dev, device,
1873 device->name);
1874
1875 if (IS_ERR(device->dev)) {
1876 ret = PTR_ERR(device->dev);
1877 KGSL_CORE_ERR("device_create(%s): %d\n", device->name, ret);
1878 goto err_devlist;
1879 }
1880
1881 dev_set_drvdata(device->parentdev, device);
1882
1883 /* Generic device initialization */
1884 init_waitqueue_head(&device->wait_queue);
1885
1886 kgsl_cffdump_open(device->id);
1887
1888 init_completion(&device->hwaccess_gate);
1889 init_completion(&device->suspend_gate);
1890
1891 ATOMIC_INIT_NOTIFIER_HEAD(&device->ts_notifier_list);
1892
1893 setup_timer(&device->idle_timer, kgsl_timer, (unsigned long) device);
1894 ret = kgsl_create_device_workqueue(device);
1895 if (ret)
1896 goto err_devlist;
1897
1898 INIT_WORK(&device->idle_check_ws, kgsl_idle_check);
Jordan Crouse1bf80aa2011-10-12 16:57:47 -06001899 INIT_WORK(&device->ts_expired_ws, kgsl_timestamp_expired);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001900
1901 INIT_LIST_HEAD(&device->memqueue);
1902
1903 ret = kgsl_mmu_init(device);
1904 if (ret != 0)
1905 goto err_dest_work_q;
1906
1907 ret = kgsl_allocate_contiguous(&device->memstore,
1908 sizeof(struct kgsl_devmemstore));
1909
1910 if (ret != 0)
1911 goto err_close_mmu;
1912
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001913 wake_lock_init(&device->idle_wakelock, WAKE_LOCK_IDLE, device->name);
1914 pm_qos_add_request(&device->pm_qos_req_dma, PM_QOS_CPU_DMA_LATENCY,
1915 PM_QOS_DEFAULT_VALUE);
1916
1917 idr_init(&device->context_idr);
1918
1919 /* sysfs and debugfs initalization - failure here is non fatal */
1920
1921 /* Initialize logging */
1922 kgsl_device_debugfs_init(device);
1923
1924 /* Initialize common sysfs entries */
1925 kgsl_pwrctrl_init_sysfs(device);
1926
1927 return 0;
1928
1929err_close_mmu:
1930 kgsl_mmu_close(device);
1931err_dest_work_q:
1932 destroy_workqueue(device->work_queue);
1933 device->work_queue = NULL;
1934err_devlist:
1935 mutex_lock(&kgsl_driver.devlock);
1936 kgsl_driver.devp[minor] = NULL;
1937 mutex_unlock(&kgsl_driver.devlock);
1938
1939 return ret;
1940}
1941EXPORT_SYMBOL(kgsl_register_device);
1942
1943int kgsl_device_platform_probe(struct kgsl_device *device,
1944 irqreturn_t (*dev_isr) (int, void*))
1945{
1946 int status = -EINVAL;
1947 struct kgsl_memregion *regspace = NULL;
1948 struct resource *res;
1949 struct platform_device *pdev =
1950 container_of(device->parentdev, struct platform_device, dev);
1951
1952 pm_runtime_enable(device->parentdev);
1953
1954 status = kgsl_pwrctrl_init(device);
1955 if (status)
1956 goto error;
1957
1958 res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
1959 device->iomemname);
1960 if (res == NULL) {
1961 KGSL_DRV_ERR(device, "platform_get_resource_byname failed\n");
1962 status = -EINVAL;
1963 goto error_pwrctrl_close;
1964 }
1965 if (res->start == 0 || resource_size(res) == 0) {
1966 KGSL_DRV_ERR(device, "dev %d invalid regspace\n", device->id);
1967 status = -EINVAL;
1968 goto error_pwrctrl_close;
1969 }
1970
1971 regspace = &device->regspace;
1972 regspace->mmio_phys_base = res->start;
1973 regspace->sizebytes = resource_size(res);
1974
1975 if (!request_mem_region(regspace->mmio_phys_base,
1976 regspace->sizebytes, device->name)) {
1977 KGSL_DRV_ERR(device, "request_mem_region failed\n");
1978 status = -ENODEV;
1979 goto error_pwrctrl_close;
1980 }
1981
1982 regspace->mmio_virt_base = ioremap(regspace->mmio_phys_base,
1983 regspace->sizebytes);
1984
1985 if (regspace->mmio_virt_base == NULL) {
1986 KGSL_DRV_ERR(device, "ioremap failed\n");
1987 status = -ENODEV;
1988 goto error_release_mem;
1989 }
1990
1991 status = request_irq(device->pwrctrl.interrupt_num, dev_isr,
1992 IRQF_TRIGGER_HIGH, device->name, device);
1993 if (status) {
1994 KGSL_DRV_ERR(device, "request_irq(%d) failed: %d\n",
1995 device->pwrctrl.interrupt_num, status);
1996 goto error_iounmap;
1997 }
1998 device->pwrctrl.have_irq = 1;
1999 disable_irq(device->pwrctrl.interrupt_num);
2000
2001 KGSL_DRV_INFO(device,
2002 "dev_id %d regs phys 0x%08x size 0x%08x virt %p\n",
2003 device->id, regspace->mmio_phys_base,
2004 regspace->sizebytes, regspace->mmio_virt_base);
2005
2006
2007 status = kgsl_register_device(device);
2008 if (!status)
2009 return status;
2010
2011 free_irq(device->pwrctrl.interrupt_num, NULL);
2012 device->pwrctrl.have_irq = 0;
2013error_iounmap:
2014 iounmap(regspace->mmio_virt_base);
2015 regspace->mmio_virt_base = NULL;
2016error_release_mem:
2017 release_mem_region(regspace->mmio_phys_base, regspace->sizebytes);
2018error_pwrctrl_close:
2019 kgsl_pwrctrl_close(device);
2020error:
2021 return status;
2022}
2023EXPORT_SYMBOL(kgsl_device_platform_probe);
2024
2025void kgsl_device_platform_remove(struct kgsl_device *device)
2026{
2027 struct kgsl_memregion *regspace = &device->regspace;
2028
2029 kgsl_unregister_device(device);
2030
2031 if (regspace->mmio_virt_base != NULL) {
2032 iounmap(regspace->mmio_virt_base);
2033 regspace->mmio_virt_base = NULL;
2034 release_mem_region(regspace->mmio_phys_base,
2035 regspace->sizebytes);
2036 }
2037 kgsl_pwrctrl_close(device);
2038
2039 pm_runtime_disable(device->parentdev);
2040}
2041EXPORT_SYMBOL(kgsl_device_platform_remove);
2042
2043static int __devinit
2044kgsl_ptdata_init(void)
2045{
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002046 kgsl_driver.ptpool = kgsl_mmu_ptpool_init(KGSL_PAGETABLE_SIZE,
2047 kgsl_pagetable_count);
2048 if (!kgsl_driver.ptpool)
2049 return -ENOMEM;
2050 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002051}
2052
2053static void kgsl_core_exit(void)
2054{
2055 unregister_chrdev_region(kgsl_driver.major, KGSL_DEVICE_MAX);
2056
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002057 kgsl_mmu_ptpool_destroy(&kgsl_driver.ptpool);
2058 kgsl_driver.ptpool = NULL;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002059
2060 device_unregister(&kgsl_driver.virtdev);
2061
2062 if (kgsl_driver.class) {
2063 class_destroy(kgsl_driver.class);
2064 kgsl_driver.class = NULL;
2065 }
2066
2067 kgsl_drm_exit();
2068 kgsl_cffdump_destroy();
Jordan Croused8f1c6b2011-10-04 09:31:29 -06002069 kgsl_core_debugfs_close();
2070 kgsl_sharedmem_uninit_sysfs();
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002071}
2072
2073static int __init kgsl_core_init(void)
2074{
2075 int result = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002076 /* alloc major and minor device numbers */
2077 result = alloc_chrdev_region(&kgsl_driver.major, 0, KGSL_DEVICE_MAX,
2078 KGSL_NAME);
2079 if (result < 0) {
2080 KGSL_CORE_ERR("alloc_chrdev_region failed err = %d\n", result);
2081 goto err;
2082 }
2083
2084 cdev_init(&kgsl_driver.cdev, &kgsl_fops);
2085 kgsl_driver.cdev.owner = THIS_MODULE;
2086 kgsl_driver.cdev.ops = &kgsl_fops;
2087 result = cdev_add(&kgsl_driver.cdev, MKDEV(MAJOR(kgsl_driver.major), 0),
2088 KGSL_DEVICE_MAX);
2089
2090 if (result) {
2091 KGSL_CORE_ERR("kgsl: cdev_add() failed, dev_num= %d,"
2092 " result= %d\n", kgsl_driver.major, result);
2093 goto err;
2094 }
2095
2096 kgsl_driver.class = class_create(THIS_MODULE, KGSL_NAME);
2097
2098 if (IS_ERR(kgsl_driver.class)) {
2099 result = PTR_ERR(kgsl_driver.class);
2100 KGSL_CORE_ERR("failed to create class %s", KGSL_NAME);
2101 goto err;
2102 }
2103
2104 /* Make a virtual device for managing core related things
2105 in sysfs */
2106 kgsl_driver.virtdev.class = kgsl_driver.class;
2107 dev_set_name(&kgsl_driver.virtdev, "kgsl");
2108 result = device_register(&kgsl_driver.virtdev);
2109 if (result) {
2110 KGSL_CORE_ERR("driver_register failed\n");
2111 goto err;
2112 }
2113
2114 /* Make kobjects in the virtual device for storing statistics */
2115
2116 kgsl_driver.ptkobj =
2117 kobject_create_and_add("pagetables",
2118 &kgsl_driver.virtdev.kobj);
2119
2120 kgsl_driver.prockobj =
2121 kobject_create_and_add("proc",
2122 &kgsl_driver.virtdev.kobj);
2123
2124 kgsl_core_debugfs_init();
2125
2126 kgsl_sharedmem_init_sysfs();
2127 kgsl_cffdump_init();
2128
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002129 INIT_LIST_HEAD(&kgsl_driver.process_list);
2130
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002131 INIT_LIST_HEAD(&kgsl_driver.pagetable_list);
2132
2133 kgsl_mmu_set_mmutype(ksgl_mmu_type);
2134
2135 if (KGSL_MMU_TYPE_GPU == kgsl_mmu_get_mmutype()) {
2136 result = kgsl_ptdata_init();
2137 if (result)
2138 goto err;
2139 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002140
2141 result = kgsl_drm_init(NULL);
2142
2143 if (result)
2144 goto err;
2145
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002146 kgsl_mmu_set_mmutype(ksgl_mmu_type);
2147
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002148 return 0;
2149
2150err:
2151 kgsl_core_exit();
2152 return result;
2153}
2154
2155module_init(kgsl_core_init);
2156module_exit(kgsl_core_exit);
2157
2158MODULE_AUTHOR("Qualcomm Innovation Center, Inc.");
2159MODULE_DESCRIPTION("MSM GPU driver");
2160MODULE_LICENSE("GPL");