blob: 7e61a32faa97974fc04ec1fe3801744dc1583bc6 [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));
Jordan Croused17e9aa2011-10-12 16:57:48 -06001229
1230 ret = memdesc_sg_phys(&entry->memdesc,
1231 phys + (offset & PAGE_MASK), size);
1232 if (ret)
1233 goto err;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001234
1235 return 0;
1236err:
Jordan Crousefd978432011-09-02 14:34:32 -06001237#ifdef CONFIG_ANDROID_PMEM
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001238 put_pmem_file(filep);
Jordan Crousefd978432011-09-02 14:34:32 -06001239#endif
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001240 return ret;
1241}
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001242
Jordan Croused17e9aa2011-10-12 16:57:48 -06001243static int memdesc_sg_virt(struct kgsl_memdesc *memdesc,
1244 void *addr, int size)
1245{
1246 int i;
1247 int sglen = PAGE_ALIGN(size) / PAGE_SIZE;
1248 unsigned long paddr = (unsigned long) addr;
1249
1250 memdesc->sg = kmalloc(sglen * sizeof(struct scatterlist),
1251 GFP_KERNEL);
1252 if (memdesc->sg == NULL)
1253 return -ENOMEM;
1254
1255 memdesc->sglen = sglen;
1256 sg_init_table(memdesc->sg, sglen);
1257
1258 spin_lock(&current->mm->page_table_lock);
1259
1260 for (i = 0; i < sglen; i++, paddr += PAGE_SIZE) {
1261 struct page *page;
1262 pmd_t *ppmd;
1263 pte_t *ppte;
1264 pgd_t *ppgd = pgd_offset(current->mm, paddr);
1265
1266 if (pgd_none(*ppgd) || pgd_bad(*ppgd))
1267 goto err;
1268
1269 ppmd = pmd_offset(ppgd, paddr);
1270 if (pmd_none(*ppmd) || pmd_bad(*ppmd))
1271 goto err;
1272
1273 ppte = pte_offset_map(ppmd, paddr);
1274 if (ppte == NULL)
1275 goto err;
1276
1277 page = pfn_to_page(pte_pfn(*ppte));
1278 if (!page)
1279 goto err;
1280
1281 sg_set_page(&memdesc->sg[i], page, PAGE_SIZE, 0);
1282 pte_unmap(ppte);
1283 }
1284
1285 spin_unlock(&current->mm->page_table_lock);
1286
1287 return 0;
1288
1289err:
1290 spin_unlock(&current->mm->page_table_lock);
1291 kfree(memdesc->sg);
1292 memdesc->sg = NULL;
1293
1294 return -EINVAL;
1295}
1296
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001297static int kgsl_setup_hostptr(struct kgsl_mem_entry *entry,
1298 struct kgsl_pagetable *pagetable,
1299 void *hostptr, unsigned int offset,
1300 size_t size)
1301{
1302 struct vm_area_struct *vma;
1303 unsigned int len;
1304
1305 down_read(&current->mm->mmap_sem);
1306 vma = find_vma(current->mm, (unsigned int) hostptr);
1307 up_read(&current->mm->mmap_sem);
1308
1309 if (!vma) {
1310 KGSL_CORE_ERR("find_vma(%p) failed\n", hostptr);
1311 return -EINVAL;
1312 }
1313
1314 /* We don't necessarily start at vma->vm_start */
1315 len = vma->vm_end - (unsigned long) hostptr;
1316
1317 if (offset >= len)
1318 return -EINVAL;
1319
1320 if (!KGSL_IS_PAGE_ALIGNED((unsigned long) hostptr) ||
1321 !KGSL_IS_PAGE_ALIGNED(len)) {
1322 KGSL_CORE_ERR("user address len(%u)"
1323 "and start(%p) must be page"
1324 "aligned\n", len, hostptr);
1325 return -EINVAL;
1326 }
1327
1328 if (size == 0)
1329 size = len;
1330
1331 /* Adjust the size of the region to account for the offset */
1332 size += offset & ~PAGE_MASK;
1333
1334 size = ALIGN(size, PAGE_SIZE);
1335
1336 if (_check_region(offset & PAGE_MASK, size, len)) {
1337 KGSL_CORE_ERR("Offset (%ld) + size (%d) is larger"
1338 "than region length %d\n",
1339 offset & PAGE_MASK, size, len);
1340 return -EINVAL;
1341 }
1342
1343 entry->memdesc.pagetable = pagetable;
1344 entry->memdesc.size = size;
1345 entry->memdesc.hostptr = hostptr + (offset & PAGE_MASK);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001346
Jordan Croused17e9aa2011-10-12 16:57:48 -06001347 return memdesc_sg_virt(&entry->memdesc,
1348 hostptr + (offset & PAGE_MASK), size);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001349}
1350
1351#ifdef CONFIG_ASHMEM
1352static int kgsl_setup_ashmem(struct kgsl_mem_entry *entry,
1353 struct kgsl_pagetable *pagetable,
1354 int fd, void *hostptr, size_t size)
1355{
1356 int ret;
1357 struct vm_area_struct *vma;
1358 struct file *filep, *vmfile;
1359 unsigned long len;
Jordan Crouse2c542b62011-07-26 08:30:20 -06001360 unsigned int hostaddr = (unsigned int) hostptr;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001361
Jordan Crouse2c542b62011-07-26 08:30:20 -06001362 vma = kgsl_get_vma_from_start_addr(hostaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001363 if (vma == NULL)
1364 return -EINVAL;
1365
Jordan Crouse2c542b62011-07-26 08:30:20 -06001366 if (vma->vm_pgoff || vma->vm_start != hostaddr) {
1367 KGSL_CORE_ERR("Invalid vma region\n");
1368 return -EINVAL;
1369 }
1370
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001371 len = vma->vm_end - vma->vm_start;
1372
1373 if (size == 0)
1374 size = len;
1375
1376 if (size != len) {
1377 KGSL_CORE_ERR("Invalid size %d for vma region %p\n",
1378 size, hostptr);
1379 return -EINVAL;
1380 }
1381
1382 ret = get_ashmem_file(fd, &filep, &vmfile, &len);
1383
1384 if (ret) {
1385 KGSL_CORE_ERR("get_ashmem_file failed\n");
1386 return ret;
1387 }
1388
1389 if (vmfile != vma->vm_file) {
1390 KGSL_CORE_ERR("ashmem shmem file does not match vma\n");
1391 ret = -EINVAL;
1392 goto err;
1393 }
1394
1395 entry->file_ptr = filep;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001396 entry->memdesc.pagetable = pagetable;
1397 entry->memdesc.size = ALIGN(size, PAGE_SIZE);
1398 entry->memdesc.hostptr = hostptr;
Jordan Croused17e9aa2011-10-12 16:57:48 -06001399
1400 ret = memdesc_sg_virt(&entry->memdesc, hostptr, size);
1401 if (ret)
1402 goto err;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001403
1404 return 0;
1405
1406err:
1407 put_ashmem_file(filep);
1408 return ret;
1409}
1410#else
1411static int kgsl_setup_ashmem(struct kgsl_mem_entry *entry,
1412 struct kgsl_pagetable *pagetable,
1413 int fd, void *hostptr, size_t size)
1414{
1415 return -EINVAL;
1416}
1417#endif
1418
1419static long kgsl_ioctl_map_user_mem(struct kgsl_device_private *dev_priv,
1420 unsigned int cmd, void *data)
1421{
1422 int result = -EINVAL;
1423 struct kgsl_map_user_mem *param = data;
1424 struct kgsl_mem_entry *entry = NULL;
1425 struct kgsl_process_private *private = dev_priv->process_priv;
Jason848741a2011-07-12 10:24:25 -07001426 enum kgsl_user_mem_type memtype;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001427
1428 entry = kgsl_mem_entry_create();
1429
1430 if (entry == NULL)
1431 return -ENOMEM;
1432
Jason848741a2011-07-12 10:24:25 -07001433 if (_IOC_SIZE(cmd) == sizeof(struct kgsl_sharedmem_from_pmem))
1434 memtype = KGSL_USER_MEM_TYPE_PMEM;
1435 else
1436 memtype = param->memtype;
1437
1438 switch (memtype) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001439 case KGSL_USER_MEM_TYPE_PMEM:
1440 if (param->fd == 0 || param->len == 0)
1441 break;
1442
1443 result = kgsl_setup_phys_file(entry, private->pagetable,
1444 param->fd, param->offset,
1445 param->len);
1446 break;
1447
1448 case KGSL_USER_MEM_TYPE_ADDR:
1449 if (!kgsl_mmu_enabled()) {
1450 KGSL_DRV_ERR(dev_priv->device,
1451 "Cannot map paged memory with the "
1452 "MMU disabled\n");
1453 break;
1454 }
1455
1456 if (param->hostptr == 0)
1457 break;
1458
1459 result = kgsl_setup_hostptr(entry, private->pagetable,
1460 (void *) param->hostptr,
1461 param->offset, param->len);
1462 break;
1463
1464 case KGSL_USER_MEM_TYPE_ASHMEM:
1465 if (!kgsl_mmu_enabled()) {
1466 KGSL_DRV_ERR(dev_priv->device,
1467 "Cannot map paged memory with the "
1468 "MMU disabled\n");
1469 break;
1470 }
1471
1472 if (param->hostptr == 0)
1473 break;
1474
1475 result = kgsl_setup_ashmem(entry, private->pagetable,
1476 param->fd, (void *) param->hostptr,
1477 param->len);
1478 break;
1479 default:
Jason848741a2011-07-12 10:24:25 -07001480 KGSL_CORE_ERR("Invalid memory type: %x\n", memtype);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001481 break;
1482 }
1483
1484 if (result)
1485 goto error;
1486
1487 result = kgsl_mmu_map(private->pagetable,
1488 &entry->memdesc,
1489 GSL_PT_PAGE_RV | GSL_PT_PAGE_WV);
1490
1491 if (result)
1492 goto error_put_file_ptr;
1493
1494 /* Adjust the returned value for a non 4k aligned offset */
1495 param->gpuaddr = entry->memdesc.gpuaddr + (param->offset & ~PAGE_MASK);
1496
1497 entry->memtype = KGSL_MAPPED_MEMORY;
1498
1499 KGSL_STATS_ADD(param->len, kgsl_driver.stats.mapped,
1500 kgsl_driver.stats.mapped_max);
1501
1502 /* Statistics */
1503 KGSL_STATS_ADD(param->len, private->stats.mapped,
1504 private->stats.mapped_max);
1505
1506 kgsl_mem_entry_attach_process(entry, private);
1507
1508 kgsl_check_idle(dev_priv->device);
1509 return result;
1510
1511 error_put_file_ptr:
1512 if (entry->file_ptr)
1513 fput(entry->file_ptr);
1514
1515error:
1516 kfree(entry);
1517 kgsl_check_idle(dev_priv->device);
1518 return result;
1519}
1520
1521/*This function flushes a graphics memory allocation from CPU cache
1522 *when caching is enabled with MMU*/
1523static long
1524kgsl_ioctl_sharedmem_flush_cache(struct kgsl_device_private *dev_priv,
1525 unsigned int cmd, void *data)
1526{
1527 int result = 0;
1528 struct kgsl_mem_entry *entry;
1529 struct kgsl_sharedmem_free *param = data;
1530 struct kgsl_process_private *private = dev_priv->process_priv;
1531
1532 spin_lock(&private->mem_lock);
1533 entry = kgsl_sharedmem_find(private, param->gpuaddr);
1534 if (!entry) {
1535 KGSL_CORE_ERR("invalid gpuaddr %08x\n", param->gpuaddr);
1536 result = -EINVAL;
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001537 goto done;
1538 }
1539 if (!entry->memdesc.hostptr)
1540 entry->memdesc.hostptr =
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001541 kgsl_gpuaddr_to_vaddr(&entry->memdesc,
1542 param->gpuaddr, &entry->memdesc.size);
1543
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001544 if (!entry->memdesc.hostptr) {
1545 KGSL_CORE_ERR("invalid hostptr with gpuaddr %08x\n",
1546 param->gpuaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001547 goto done;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001548 }
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001549
1550 kgsl_cache_range_op(&entry->memdesc, KGSL_CACHE_OP_CLEAN);
1551
1552 /* Statistics - keep track of how many flushes each process does */
1553 private->stats.flushes++;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001554done:
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001555 spin_unlock(&private->mem_lock);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001556 return result;
1557}
1558
1559static long
1560kgsl_ioctl_gpumem_alloc(struct kgsl_device_private *dev_priv,
1561 unsigned int cmd, void *data)
1562{
1563 struct kgsl_process_private *private = dev_priv->process_priv;
1564 struct kgsl_gpumem_alloc *param = data;
1565 struct kgsl_mem_entry *entry;
1566 int result;
1567
1568 entry = kgsl_mem_entry_create();
1569 if (entry == NULL)
1570 return -ENOMEM;
1571
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001572 result = kgsl_allocate_user(&entry->memdesc, private->pagetable,
1573 param->size, param->flags);
1574
1575 if (result == 0) {
1576 entry->memtype = KGSL_USER_MEMORY;
1577 kgsl_mem_entry_attach_process(entry, private);
1578 param->gpuaddr = entry->memdesc.gpuaddr;
1579
1580 KGSL_STATS_ADD(entry->memdesc.size, private->stats.user,
1581 private->stats.user_max);
1582 } else
1583 kfree(entry);
1584
1585 kgsl_check_idle(dev_priv->device);
1586 return result;
1587}
Jeremy Gebbena7423e42011-04-18 15:11:21 -06001588static long kgsl_ioctl_cff_syncmem(struct kgsl_device_private *dev_priv,
1589 unsigned int cmd, void *data)
1590{
1591 int result = 0;
1592 struct kgsl_cff_syncmem *param = data;
1593 struct kgsl_process_private *private = dev_priv->process_priv;
1594 struct kgsl_mem_entry *entry = NULL;
1595
1596 spin_lock(&private->mem_lock);
1597 entry = kgsl_sharedmem_find_region(private, param->gpuaddr, param->len);
1598 if (entry)
1599 kgsl_cffdump_syncmem(dev_priv, &entry->memdesc, param->gpuaddr,
1600 param->len, true);
1601 else
1602 result = -EINVAL;
1603 spin_unlock(&private->mem_lock);
1604 return result;
1605}
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001606
Sushmita Susheelendra41f8fa32011-05-11 17:15:58 -06001607static long kgsl_ioctl_cff_user_event(struct kgsl_device_private *dev_priv,
1608 unsigned int cmd, void *data)
1609{
1610 int result = 0;
1611 struct kgsl_cff_user_event *param = data;
1612
1613 kgsl_cffdump_user_event(param->cff_opcode, param->op1, param->op2,
1614 param->op3, param->op4, param->op5);
1615
1616 return result;
1617}
1618
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001619typedef long (*kgsl_ioctl_func_t)(struct kgsl_device_private *,
1620 unsigned int, void *);
1621
1622#define KGSL_IOCTL_FUNC(_cmd, _func, _lock) \
1623 [_IOC_NR(_cmd)] = { .cmd = _cmd, .func = _func, .lock = _lock }
1624
1625static const struct {
1626 unsigned int cmd;
1627 kgsl_ioctl_func_t func;
1628 int lock;
1629} kgsl_ioctl_funcs[] = {
1630 KGSL_IOCTL_FUNC(IOCTL_KGSL_DEVICE_GETPROPERTY,
1631 kgsl_ioctl_device_getproperty, 1),
1632 KGSL_IOCTL_FUNC(IOCTL_KGSL_DEVICE_WAITTIMESTAMP,
1633 kgsl_ioctl_device_waittimestamp, 1),
1634 KGSL_IOCTL_FUNC(IOCTL_KGSL_RINGBUFFER_ISSUEIBCMDS,
1635 kgsl_ioctl_rb_issueibcmds, 1),
1636 KGSL_IOCTL_FUNC(IOCTL_KGSL_CMDSTREAM_READTIMESTAMP,
1637 kgsl_ioctl_cmdstream_readtimestamp, 1),
1638 KGSL_IOCTL_FUNC(IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP,
1639 kgsl_ioctl_cmdstream_freememontimestamp, 1),
1640 KGSL_IOCTL_FUNC(IOCTL_KGSL_DRAWCTXT_CREATE,
1641 kgsl_ioctl_drawctxt_create, 1),
1642 KGSL_IOCTL_FUNC(IOCTL_KGSL_DRAWCTXT_DESTROY,
1643 kgsl_ioctl_drawctxt_destroy, 1),
1644 KGSL_IOCTL_FUNC(IOCTL_KGSL_MAP_USER_MEM,
1645 kgsl_ioctl_map_user_mem, 0),
1646 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FROM_PMEM,
1647 kgsl_ioctl_map_user_mem, 0),
1648 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FREE,
1649 kgsl_ioctl_sharedmem_free, 0),
1650 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FROM_VMALLOC,
1651 kgsl_ioctl_sharedmem_from_vmalloc, 0),
1652 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FLUSH_CACHE,
1653 kgsl_ioctl_sharedmem_flush_cache, 0),
1654 KGSL_IOCTL_FUNC(IOCTL_KGSL_GPUMEM_ALLOC,
1655 kgsl_ioctl_gpumem_alloc, 0),
Jeremy Gebbena7423e42011-04-18 15:11:21 -06001656 KGSL_IOCTL_FUNC(IOCTL_KGSL_CFF_SYNCMEM,
1657 kgsl_ioctl_cff_syncmem, 0),
Sushmita Susheelendra41f8fa32011-05-11 17:15:58 -06001658 KGSL_IOCTL_FUNC(IOCTL_KGSL_CFF_USER_EVENT,
1659 kgsl_ioctl_cff_user_event, 0),
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001660};
1661
1662static long kgsl_ioctl(struct file *filep, unsigned int cmd, unsigned long arg)
1663{
1664 struct kgsl_device_private *dev_priv = filep->private_data;
1665 unsigned int nr = _IOC_NR(cmd);
1666 kgsl_ioctl_func_t func;
1667 int lock, ret;
1668 char ustack[64];
1669 void *uptr = NULL;
1670
1671 BUG_ON(dev_priv == NULL);
1672
1673 /* Workaround for an previously incorrectly defined ioctl code.
1674 This helps ensure binary compatability */
1675
1676 if (cmd == IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP_OLD)
1677 cmd = IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP;
Jason Varbedian80ba33d2011-07-11 17:29:05 -07001678 else if (cmd == IOCTL_KGSL_CMDSTREAM_READTIMESTAMP_OLD)
1679 cmd = IOCTL_KGSL_CMDSTREAM_READTIMESTAMP;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001680
1681 if (cmd & (IOC_IN | IOC_OUT)) {
1682 if (_IOC_SIZE(cmd) < sizeof(ustack))
1683 uptr = ustack;
1684 else {
1685 uptr = kzalloc(_IOC_SIZE(cmd), GFP_KERNEL);
1686 if (uptr == NULL) {
1687 KGSL_MEM_ERR(dev_priv->device,
1688 "kzalloc(%d) failed\n", _IOC_SIZE(cmd));
1689 ret = -ENOMEM;
1690 goto done;
1691 }
1692 }
1693
1694 if (cmd & IOC_IN) {
1695 if (copy_from_user(uptr, (void __user *) arg,
1696 _IOC_SIZE(cmd))) {
1697 ret = -EFAULT;
1698 goto done;
1699 }
1700 } else
1701 memset(uptr, 0, _IOC_SIZE(cmd));
1702 }
1703
1704 if (nr < ARRAY_SIZE(kgsl_ioctl_funcs) &&
1705 kgsl_ioctl_funcs[nr].func != NULL) {
1706 func = kgsl_ioctl_funcs[nr].func;
1707 lock = kgsl_ioctl_funcs[nr].lock;
1708 } else {
1709 func = dev_priv->device->ftbl->ioctl;
1710 if (!func) {
1711 KGSL_DRV_INFO(dev_priv->device,
1712 "invalid ioctl code %08x\n", cmd);
1713 ret = -EINVAL;
1714 goto done;
1715 }
1716 lock = 1;
1717 }
1718
1719 if (lock) {
1720 mutex_lock(&dev_priv->device->mutex);
1721 kgsl_check_suspended(dev_priv->device);
1722 }
1723
1724 ret = func(dev_priv, cmd, uptr);
1725
1726 if (lock) {
1727 kgsl_check_idle_locked(dev_priv->device);
1728 mutex_unlock(&dev_priv->device->mutex);
1729 }
1730
1731 if (ret == 0 && (cmd & IOC_OUT)) {
1732 if (copy_to_user((void __user *) arg, uptr, _IOC_SIZE(cmd)))
1733 ret = -EFAULT;
1734 }
1735
1736done:
1737 if (_IOC_SIZE(cmd) >= sizeof(ustack))
1738 kfree(uptr);
1739
1740 return ret;
1741}
1742
1743static int
1744kgsl_mmap_memstore(struct kgsl_device *device, struct vm_area_struct *vma)
1745{
1746 struct kgsl_memdesc *memdesc = &device->memstore;
1747 int result;
1748 unsigned int vma_size = vma->vm_end - vma->vm_start;
1749
1750 /* The memstore can only be mapped as read only */
1751
1752 if (vma->vm_flags & VM_WRITE)
1753 return -EPERM;
1754
1755 if (memdesc->size != vma_size) {
1756 KGSL_MEM_ERR(device, "memstore bad size: %d should be %d\n",
1757 vma_size, memdesc->size);
1758 return -EINVAL;
1759 }
1760
1761 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
1762
1763 result = remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff,
1764 vma_size, vma->vm_page_prot);
1765 if (result != 0)
1766 KGSL_MEM_ERR(device, "remap_pfn_range failed: %d\n",
1767 result);
1768
1769 return result;
1770}
1771
Jordan Crouse4283e172011-09-26 14:45:47 -06001772/*
1773 * kgsl_gpumem_vm_open is called whenever a vma region is copied or split.
1774 * Increase the refcount to make sure that the accounting stays correct
1775 */
1776
1777static void kgsl_gpumem_vm_open(struct vm_area_struct *vma)
1778{
1779 struct kgsl_mem_entry *entry = vma->vm_private_data;
1780 kgsl_mem_entry_get(entry);
1781}
1782
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001783static int
1784kgsl_gpumem_vm_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
1785{
1786 struct kgsl_mem_entry *entry = vma->vm_private_data;
1787
Jordan Croused17e9aa2011-10-12 16:57:48 -06001788 if (!entry->memdesc.ops || !entry->memdesc.ops->vmfault)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001789 return VM_FAULT_SIGBUS;
1790
1791 return entry->memdesc.ops->vmfault(&entry->memdesc, vma, vmf);
1792}
1793
1794static void
1795kgsl_gpumem_vm_close(struct vm_area_struct *vma)
1796{
1797 struct kgsl_mem_entry *entry = vma->vm_private_data;
1798 kgsl_mem_entry_put(entry);
1799}
1800
1801static struct vm_operations_struct kgsl_gpumem_vm_ops = {
Jordan Crouse4283e172011-09-26 14:45:47 -06001802 .open = kgsl_gpumem_vm_open,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001803 .fault = kgsl_gpumem_vm_fault,
1804 .close = kgsl_gpumem_vm_close,
1805};
1806
1807static int kgsl_mmap(struct file *file, struct vm_area_struct *vma)
1808{
1809 unsigned long vma_offset = vma->vm_pgoff << PAGE_SHIFT;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001810 struct kgsl_device_private *dev_priv = file->private_data;
1811 struct kgsl_process_private *private = dev_priv->process_priv;
Jordan Crouse976cf0e2011-09-12 10:41:49 -06001812 struct kgsl_mem_entry *tmp, *entry = NULL;
Jordan Crouse2db0af92011-08-08 16:05:09 -06001813 struct kgsl_device *device = dev_priv->device;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001814
1815 /* Handle leagacy behavior for memstore */
1816
1817 if (vma_offset == device->memstore.physaddr)
1818 return kgsl_mmap_memstore(device, vma);
1819
1820 /* Find a chunk of GPU memory */
1821
1822 spin_lock(&private->mem_lock);
Jordan Crouse976cf0e2011-09-12 10:41:49 -06001823 list_for_each_entry(tmp, &private->mem_list, list) {
1824 if (vma_offset == tmp->memdesc.gpuaddr) {
1825 kgsl_mem_entry_get(tmp);
1826 entry = tmp;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001827 break;
1828 }
1829 }
1830 spin_unlock(&private->mem_lock);
1831
1832 if (entry == NULL)
1833 return -EINVAL;
1834
Jordan Croused17e9aa2011-10-12 16:57:48 -06001835 if (!entry->memdesc.ops ||
1836 !entry->memdesc.ops->vmflags ||
1837 !entry->memdesc.ops->vmfault)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001838 return -EINVAL;
1839
1840 vma->vm_flags |= entry->memdesc.ops->vmflags(&entry->memdesc);
1841
1842 vma->vm_private_data = entry;
1843 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
1844 vma->vm_ops = &kgsl_gpumem_vm_ops;
1845 vma->vm_file = file;
1846
1847 return 0;
1848}
1849
1850static const struct file_operations kgsl_fops = {
1851 .owner = THIS_MODULE,
1852 .release = kgsl_release,
1853 .open = kgsl_open,
1854 .mmap = kgsl_mmap,
1855 .unlocked_ioctl = kgsl_ioctl,
1856};
1857
1858struct kgsl_driver kgsl_driver = {
1859 .process_mutex = __MUTEX_INITIALIZER(kgsl_driver.process_mutex),
1860 .ptlock = __SPIN_LOCK_UNLOCKED(kgsl_driver.ptlock),
1861 .devlock = __MUTEX_INITIALIZER(kgsl_driver.devlock),
1862};
1863EXPORT_SYMBOL(kgsl_driver);
1864
1865void kgsl_unregister_device(struct kgsl_device *device)
1866{
1867 int minor;
1868
1869 mutex_lock(&kgsl_driver.devlock);
1870 for (minor = 0; minor < KGSL_DEVICE_MAX; minor++) {
1871 if (device == kgsl_driver.devp[minor])
1872 break;
1873 }
1874
1875 mutex_unlock(&kgsl_driver.devlock);
1876
1877 if (minor == KGSL_DEVICE_MAX)
1878 return;
1879
1880 kgsl_cffdump_close(device->id);
1881 kgsl_pwrctrl_uninit_sysfs(device);
1882
1883 wake_lock_destroy(&device->idle_wakelock);
1884 pm_qos_remove_request(&device->pm_qos_req_dma);
1885
1886 idr_destroy(&device->context_idr);
1887
1888 if (device->memstore.hostptr)
1889 kgsl_sharedmem_free(&device->memstore);
1890
1891 kgsl_mmu_close(device);
1892
1893 if (device->work_queue) {
1894 destroy_workqueue(device->work_queue);
1895 device->work_queue = NULL;
1896 }
1897
1898 device_destroy(kgsl_driver.class,
1899 MKDEV(MAJOR(kgsl_driver.major), minor));
1900
1901 mutex_lock(&kgsl_driver.devlock);
1902 kgsl_driver.devp[minor] = NULL;
1903 mutex_unlock(&kgsl_driver.devlock);
1904}
1905EXPORT_SYMBOL(kgsl_unregister_device);
1906
1907int
1908kgsl_register_device(struct kgsl_device *device)
1909{
1910 int minor, ret;
1911 dev_t dev;
1912
1913 /* Find a minor for the device */
1914
1915 mutex_lock(&kgsl_driver.devlock);
1916 for (minor = 0; minor < KGSL_DEVICE_MAX; minor++) {
1917 if (kgsl_driver.devp[minor] == NULL) {
1918 kgsl_driver.devp[minor] = device;
1919 break;
1920 }
1921 }
1922
1923 mutex_unlock(&kgsl_driver.devlock);
1924
1925 if (minor == KGSL_DEVICE_MAX) {
1926 KGSL_CORE_ERR("minor devices exhausted\n");
1927 return -ENODEV;
1928 }
1929
1930 /* Create the device */
1931 dev = MKDEV(MAJOR(kgsl_driver.major), minor);
1932 device->dev = device_create(kgsl_driver.class,
1933 device->parentdev,
1934 dev, device,
1935 device->name);
1936
1937 if (IS_ERR(device->dev)) {
1938 ret = PTR_ERR(device->dev);
1939 KGSL_CORE_ERR("device_create(%s): %d\n", device->name, ret);
1940 goto err_devlist;
1941 }
1942
1943 dev_set_drvdata(device->parentdev, device);
1944
1945 /* Generic device initialization */
1946 init_waitqueue_head(&device->wait_queue);
1947
1948 kgsl_cffdump_open(device->id);
1949
1950 init_completion(&device->hwaccess_gate);
1951 init_completion(&device->suspend_gate);
1952
1953 ATOMIC_INIT_NOTIFIER_HEAD(&device->ts_notifier_list);
1954
1955 setup_timer(&device->idle_timer, kgsl_timer, (unsigned long) device);
1956 ret = kgsl_create_device_workqueue(device);
1957 if (ret)
1958 goto err_devlist;
1959
1960 INIT_WORK(&device->idle_check_ws, kgsl_idle_check);
Jordan Crouse1bf80aa2011-10-12 16:57:47 -06001961 INIT_WORK(&device->ts_expired_ws, kgsl_timestamp_expired);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001962
1963 INIT_LIST_HEAD(&device->memqueue);
1964
1965 ret = kgsl_mmu_init(device);
1966 if (ret != 0)
1967 goto err_dest_work_q;
1968
1969 ret = kgsl_allocate_contiguous(&device->memstore,
1970 sizeof(struct kgsl_devmemstore));
1971
1972 if (ret != 0)
1973 goto err_close_mmu;
1974
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001975 wake_lock_init(&device->idle_wakelock, WAKE_LOCK_IDLE, device->name);
1976 pm_qos_add_request(&device->pm_qos_req_dma, PM_QOS_CPU_DMA_LATENCY,
1977 PM_QOS_DEFAULT_VALUE);
1978
1979 idr_init(&device->context_idr);
1980
1981 /* sysfs and debugfs initalization - failure here is non fatal */
1982
1983 /* Initialize logging */
1984 kgsl_device_debugfs_init(device);
1985
1986 /* Initialize common sysfs entries */
1987 kgsl_pwrctrl_init_sysfs(device);
1988
1989 return 0;
1990
1991err_close_mmu:
1992 kgsl_mmu_close(device);
1993err_dest_work_q:
1994 destroy_workqueue(device->work_queue);
1995 device->work_queue = NULL;
1996err_devlist:
1997 mutex_lock(&kgsl_driver.devlock);
1998 kgsl_driver.devp[minor] = NULL;
1999 mutex_unlock(&kgsl_driver.devlock);
2000
2001 return ret;
2002}
2003EXPORT_SYMBOL(kgsl_register_device);
2004
2005int kgsl_device_platform_probe(struct kgsl_device *device,
2006 irqreturn_t (*dev_isr) (int, void*))
2007{
2008 int status = -EINVAL;
2009 struct kgsl_memregion *regspace = NULL;
2010 struct resource *res;
2011 struct platform_device *pdev =
2012 container_of(device->parentdev, struct platform_device, dev);
2013
2014 pm_runtime_enable(device->parentdev);
2015
2016 status = kgsl_pwrctrl_init(device);
2017 if (status)
2018 goto error;
2019
2020 res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
2021 device->iomemname);
2022 if (res == NULL) {
2023 KGSL_DRV_ERR(device, "platform_get_resource_byname failed\n");
2024 status = -EINVAL;
2025 goto error_pwrctrl_close;
2026 }
2027 if (res->start == 0 || resource_size(res) == 0) {
2028 KGSL_DRV_ERR(device, "dev %d invalid regspace\n", device->id);
2029 status = -EINVAL;
2030 goto error_pwrctrl_close;
2031 }
2032
2033 regspace = &device->regspace;
2034 regspace->mmio_phys_base = res->start;
2035 regspace->sizebytes = resource_size(res);
2036
2037 if (!request_mem_region(regspace->mmio_phys_base,
2038 regspace->sizebytes, device->name)) {
2039 KGSL_DRV_ERR(device, "request_mem_region failed\n");
2040 status = -ENODEV;
2041 goto error_pwrctrl_close;
2042 }
2043
2044 regspace->mmio_virt_base = ioremap(regspace->mmio_phys_base,
2045 regspace->sizebytes);
2046
2047 if (regspace->mmio_virt_base == NULL) {
2048 KGSL_DRV_ERR(device, "ioremap failed\n");
2049 status = -ENODEV;
2050 goto error_release_mem;
2051 }
2052
2053 status = request_irq(device->pwrctrl.interrupt_num, dev_isr,
2054 IRQF_TRIGGER_HIGH, device->name, device);
2055 if (status) {
2056 KGSL_DRV_ERR(device, "request_irq(%d) failed: %d\n",
2057 device->pwrctrl.interrupt_num, status);
2058 goto error_iounmap;
2059 }
2060 device->pwrctrl.have_irq = 1;
2061 disable_irq(device->pwrctrl.interrupt_num);
2062
2063 KGSL_DRV_INFO(device,
2064 "dev_id %d regs phys 0x%08x size 0x%08x virt %p\n",
2065 device->id, regspace->mmio_phys_base,
2066 regspace->sizebytes, regspace->mmio_virt_base);
2067
2068
2069 status = kgsl_register_device(device);
2070 if (!status)
2071 return status;
2072
2073 free_irq(device->pwrctrl.interrupt_num, NULL);
2074 device->pwrctrl.have_irq = 0;
2075error_iounmap:
2076 iounmap(regspace->mmio_virt_base);
2077 regspace->mmio_virt_base = NULL;
2078error_release_mem:
2079 release_mem_region(regspace->mmio_phys_base, regspace->sizebytes);
2080error_pwrctrl_close:
2081 kgsl_pwrctrl_close(device);
2082error:
2083 return status;
2084}
2085EXPORT_SYMBOL(kgsl_device_platform_probe);
2086
2087void kgsl_device_platform_remove(struct kgsl_device *device)
2088{
2089 struct kgsl_memregion *regspace = &device->regspace;
2090
2091 kgsl_unregister_device(device);
2092
2093 if (regspace->mmio_virt_base != NULL) {
2094 iounmap(regspace->mmio_virt_base);
2095 regspace->mmio_virt_base = NULL;
2096 release_mem_region(regspace->mmio_phys_base,
2097 regspace->sizebytes);
2098 }
2099 kgsl_pwrctrl_close(device);
2100
2101 pm_runtime_disable(device->parentdev);
2102}
2103EXPORT_SYMBOL(kgsl_device_platform_remove);
2104
2105static int __devinit
2106kgsl_ptdata_init(void)
2107{
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002108 kgsl_driver.ptpool = kgsl_mmu_ptpool_init(KGSL_PAGETABLE_SIZE,
2109 kgsl_pagetable_count);
2110 if (!kgsl_driver.ptpool)
2111 return -ENOMEM;
2112 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002113}
2114
2115static void kgsl_core_exit(void)
2116{
2117 unregister_chrdev_region(kgsl_driver.major, KGSL_DEVICE_MAX);
2118
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002119 kgsl_mmu_ptpool_destroy(&kgsl_driver.ptpool);
2120 kgsl_driver.ptpool = NULL;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002121
2122 device_unregister(&kgsl_driver.virtdev);
2123
2124 if (kgsl_driver.class) {
2125 class_destroy(kgsl_driver.class);
2126 kgsl_driver.class = NULL;
2127 }
2128
2129 kgsl_drm_exit();
2130 kgsl_cffdump_destroy();
Jordan Croused8f1c6b2011-10-04 09:31:29 -06002131 kgsl_core_debugfs_close();
2132 kgsl_sharedmem_uninit_sysfs();
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002133}
2134
2135static int __init kgsl_core_init(void)
2136{
2137 int result = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002138 /* alloc major and minor device numbers */
2139 result = alloc_chrdev_region(&kgsl_driver.major, 0, KGSL_DEVICE_MAX,
2140 KGSL_NAME);
2141 if (result < 0) {
2142 KGSL_CORE_ERR("alloc_chrdev_region failed err = %d\n", result);
2143 goto err;
2144 }
2145
2146 cdev_init(&kgsl_driver.cdev, &kgsl_fops);
2147 kgsl_driver.cdev.owner = THIS_MODULE;
2148 kgsl_driver.cdev.ops = &kgsl_fops;
2149 result = cdev_add(&kgsl_driver.cdev, MKDEV(MAJOR(kgsl_driver.major), 0),
2150 KGSL_DEVICE_MAX);
2151
2152 if (result) {
2153 KGSL_CORE_ERR("kgsl: cdev_add() failed, dev_num= %d,"
2154 " result= %d\n", kgsl_driver.major, result);
2155 goto err;
2156 }
2157
2158 kgsl_driver.class = class_create(THIS_MODULE, KGSL_NAME);
2159
2160 if (IS_ERR(kgsl_driver.class)) {
2161 result = PTR_ERR(kgsl_driver.class);
2162 KGSL_CORE_ERR("failed to create class %s", KGSL_NAME);
2163 goto err;
2164 }
2165
2166 /* Make a virtual device for managing core related things
2167 in sysfs */
2168 kgsl_driver.virtdev.class = kgsl_driver.class;
2169 dev_set_name(&kgsl_driver.virtdev, "kgsl");
2170 result = device_register(&kgsl_driver.virtdev);
2171 if (result) {
2172 KGSL_CORE_ERR("driver_register failed\n");
2173 goto err;
2174 }
2175
2176 /* Make kobjects in the virtual device for storing statistics */
2177
2178 kgsl_driver.ptkobj =
2179 kobject_create_and_add("pagetables",
2180 &kgsl_driver.virtdev.kobj);
2181
2182 kgsl_driver.prockobj =
2183 kobject_create_and_add("proc",
2184 &kgsl_driver.virtdev.kobj);
2185
2186 kgsl_core_debugfs_init();
2187
2188 kgsl_sharedmem_init_sysfs();
2189 kgsl_cffdump_init();
2190
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002191 INIT_LIST_HEAD(&kgsl_driver.process_list);
2192
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002193 INIT_LIST_HEAD(&kgsl_driver.pagetable_list);
2194
2195 kgsl_mmu_set_mmutype(ksgl_mmu_type);
2196
2197 if (KGSL_MMU_TYPE_GPU == kgsl_mmu_get_mmutype()) {
2198 result = kgsl_ptdata_init();
2199 if (result)
2200 goto err;
2201 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002202
2203 result = kgsl_drm_init(NULL);
2204
2205 if (result)
2206 goto err;
2207
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002208 kgsl_mmu_set_mmutype(ksgl_mmu_type);
2209
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002210 return 0;
2211
2212err:
2213 kgsl_core_exit();
2214 return result;
2215}
2216
2217module_init(kgsl_core_init);
2218module_exit(kgsl_core_exit);
2219
2220MODULE_AUTHOR("Qualcomm Innovation Center, Inc.");
2221MODULE_DESCRIPTION("MSM GPU driver");
2222MODULE_LICENSE("GPL");