blob: 67efdb97681fb52f4429656c58e6176cfbba8132 [file] [log] [blame]
Tarun Karraf8e5cd22012-01-09 14:10:09 -07001/* Copyright (c) 2008-2012, Code Aurora Forum. All rights reserved.
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002 *
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>
Jordan Croused4bc9d22011-11-17 13:39:21 -070023#include <linux/genlock.h>
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070024
25#include <linux/ashmem.h>
26#include <linux/major.h>
Jordan Crouse8eab35a2011-10-12 16:57:48 -060027#include <linux/ion.h>
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070028
29#include "kgsl.h"
30#include "kgsl_debugfs.h"
31#include "kgsl_cffdump.h"
32#include "kgsl_log.h"
33#include "kgsl_sharedmem.h"
34#include "kgsl_device.h"
Norman Geed7402ff2011-10-28 08:51:11 -060035#include "kgsl_trace.h"
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070036
37#undef MODULE_PARAM_PREFIX
38#define MODULE_PARAM_PREFIX "kgsl."
39
40static int kgsl_pagetable_count = KGSL_PAGETABLE_COUNT;
Shubhraprakash Das767fdda2011-08-15 15:49:45 -060041static char *ksgl_mmu_type;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070042module_param_named(ptcount, kgsl_pagetable_count, int, 0);
43MODULE_PARM_DESC(kgsl_pagetable_count,
44"Minimum number of pagetables for KGSL to allocate at initialization time");
Shubhraprakash Das767fdda2011-08-15 15:49:45 -060045module_param_named(mmutype, ksgl_mmu_type, charp, 0);
46MODULE_PARM_DESC(ksgl_mmu_type,
47"Type of MMU to be used for graphics. Valid values are 'iommu' or 'gpummu' or 'nommu'");
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070048
Jordan Crouse8eab35a2011-10-12 16:57:48 -060049static struct ion_client *kgsl_ion_client;
50
Jordan Croused4bc9d22011-11-17 13:39:21 -070051/**
52 * kgsl_add_event - Add a new timstamp event for the KGSL device
53 * @device - KGSL device for the new event
54 * @ts - the timestamp to trigger the event on
55 * @cb - callback function to call when the timestamp expires
56 * @priv - private data for the specific event type
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -070057 * @owner - driver instance that owns this event
Jordan Croused4bc9d22011-11-17 13:39:21 -070058 *
59 * @returns - 0 on success or error code on failure
60 */
61
62static int kgsl_add_event(struct kgsl_device *device, u32 ts,
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -070063 void (*cb)(struct kgsl_device *, void *, u32), void *priv,
64 struct kgsl_device_private *owner)
Jordan Croused4bc9d22011-11-17 13:39:21 -070065{
66 struct kgsl_event *event;
67 struct list_head *n;
68 unsigned int cur = device->ftbl->readtimestamp(device,
69 KGSL_TIMESTAMP_RETIRED);
70
71 if (cb == NULL)
72 return -EINVAL;
73
74 /* Check to see if the requested timestamp has already fired */
75
76 if (timestamp_cmp(cur, ts) >= 0) {
77 cb(device, priv, cur);
78 return 0;
79 }
80
81 event = kzalloc(sizeof(*event), GFP_KERNEL);
82 if (event == NULL)
83 return -ENOMEM;
84
85 event->timestamp = ts;
86 event->priv = priv;
87 event->func = cb;
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -070088 event->owner = owner;
Jordan Croused4bc9d22011-11-17 13:39:21 -070089
90 /* Add the event in order to the list */
91
92 for (n = device->events.next ; n != &device->events; n = n->next) {
93 struct kgsl_event *e =
94 list_entry(n, struct kgsl_event, list);
95
96 if (timestamp_cmp(e->timestamp, ts) > 0) {
97 list_add(&event->list, n->prev);
98 break;
99 }
100 }
101
102 if (n == &device->events)
103 list_add_tail(&event->list, &device->events);
104
Jeremy Gebben63904832012-02-07 16:10:55 -0700105 queue_work(device->work_queue, &device->ts_expired_ws);
Jordan Croused4bc9d22011-11-17 13:39:21 -0700106 return 0;
107}
Jordan Croused4bc9d22011-11-17 13:39:21 -0700108
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -0700109/**
110 * kgsl_cancel_events - Cancel all events for a process
111 * @device - KGSL device for the events to cancel
112 * @owner - driver instance that owns the events to cancel
113 *
114 */
115static void kgsl_cancel_events(struct kgsl_device *device,
116 struct kgsl_device_private *owner)
117{
118 struct kgsl_event *event, *event_tmp;
119 unsigned int cur = device->ftbl->readtimestamp(device,
120 KGSL_TIMESTAMP_RETIRED);
121
122 list_for_each_entry_safe(event, event_tmp, &device->events, list) {
123 if (event->owner != owner)
124 continue;
125 /*
126 * "cancel" the events by calling their callback.
127 * Currently, events are used for lock and memory
128 * management, so if the process is dying the right
129 * thing to do is release or free.
130 */
131 if (event->func)
132 event->func(device, event->priv, cur);
133
134 list_del(&event->list);
135 kfree(event);
136 }
137}
138
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700139static inline struct kgsl_mem_entry *
140kgsl_mem_entry_create(void)
141{
142 struct kgsl_mem_entry *entry = kzalloc(sizeof(*entry), GFP_KERNEL);
143
144 if (!entry)
145 KGSL_CORE_ERR("kzalloc(%d) failed\n", sizeof(*entry));
146 else
147 kref_init(&entry->refcount);
148
149 return entry;
150}
151
152void
153kgsl_mem_entry_destroy(struct kref *kref)
154{
155 struct kgsl_mem_entry *entry = container_of(kref,
156 struct kgsl_mem_entry,
157 refcount);
Jordan Crouse1b897cf2011-10-12 16:57:48 -0600158
Jordan Crouse1b897cf2011-10-12 16:57:48 -0600159 if (entry->memtype != KGSL_MEM_ENTRY_KERNEL)
160 kgsl_driver.stats.mapped -= entry->memdesc.size;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700161
Jordan Crouse8eab35a2011-10-12 16:57:48 -0600162 /*
163 * Ion takes care of freeing the sglist for us (how nice </sarcasm>) so
164 * unmap the dma before freeing the sharedmem so kgsl_sharedmem_free
165 * doesn't try to free it again
166 */
167
168 if (entry->memtype == KGSL_MEM_ENTRY_ION) {
169 ion_unmap_dma(kgsl_ion_client, entry->priv_data);
170 entry->memdesc.sg = NULL;
171 }
172
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700173 kgsl_sharedmem_free(&entry->memdesc);
174
Jordan Crouse1b897cf2011-10-12 16:57:48 -0600175 switch (entry->memtype) {
176 case KGSL_MEM_ENTRY_PMEM:
177 case KGSL_MEM_ENTRY_ASHMEM:
178 if (entry->priv_data)
179 fput(entry->priv_data);
180 break;
Jordan Crouse8eab35a2011-10-12 16:57:48 -0600181 case KGSL_MEM_ENTRY_ION:
182 ion_free(kgsl_ion_client, entry->priv_data);
183 break;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700184 }
185
186 kfree(entry);
187}
188EXPORT_SYMBOL(kgsl_mem_entry_destroy);
189
190static
191void kgsl_mem_entry_attach_process(struct kgsl_mem_entry *entry,
192 struct kgsl_process_private *process)
193{
194 spin_lock(&process->mem_lock);
195 list_add(&entry->list, &process->mem_list);
196 spin_unlock(&process->mem_lock);
197
198 entry->priv = process;
199}
200
Jordan Crouse00714012012-03-16 14:53:40 -0600201/* Detach a memory entry from a process and unmap it from the MMU */
202
203static void kgsl_mem_entry_detach_process(struct kgsl_mem_entry *entry)
204{
205 if (entry == NULL)
206 return;
207
208 entry->priv->stats[entry->memtype].cur -= entry->memdesc.size;
209 entry->priv = NULL;
210
211 kgsl_mmu_unmap(entry->memdesc.pagetable, &entry->memdesc);
212
213 kgsl_mem_entry_put(entry);
214}
215
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700216/* Allocate a new context id */
217
218static struct kgsl_context *
219kgsl_create_context(struct kgsl_device_private *dev_priv)
220{
221 struct kgsl_context *context;
222 int ret, id;
223
224 context = kzalloc(sizeof(*context), GFP_KERNEL);
225
226 if (context == NULL)
227 return NULL;
228
229 while (1) {
230 if (idr_pre_get(&dev_priv->device->context_idr,
231 GFP_KERNEL) == 0) {
232 kfree(context);
233 return NULL;
234 }
235
236 ret = idr_get_new(&dev_priv->device->context_idr,
237 context, &id);
238
239 if (ret != -EAGAIN)
240 break;
241 }
242
243 if (ret) {
244 kfree(context);
245 return NULL;
246 }
247
248 context->id = id;
249 context->dev_priv = dev_priv;
250
251 return context;
252}
253
254static void
255kgsl_destroy_context(struct kgsl_device_private *dev_priv,
256 struct kgsl_context *context)
257{
258 int id;
259
260 if (context == NULL)
261 return;
262
263 /* Fire a bug if the devctxt hasn't been freed */
264 BUG_ON(context->devctxt);
265
266 id = context->id;
267 kfree(context);
268
269 idr_remove(&dev_priv->device->context_idr, id);
270}
271
Jordan Crouse1bf80aa2011-10-12 16:57:47 -0600272static void kgsl_timestamp_expired(struct work_struct *work)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700273{
Jordan Crouse1bf80aa2011-10-12 16:57:47 -0600274 struct kgsl_device *device = container_of(work, struct kgsl_device,
275 ts_expired_ws);
Jordan Croused4bc9d22011-11-17 13:39:21 -0700276 struct kgsl_event *event, *event_tmp;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700277 uint32_t ts_processed;
278
Jordan Crouse1bf80aa2011-10-12 16:57:47 -0600279 mutex_lock(&device->mutex);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700280
281 /* get current EOP timestamp */
282 ts_processed = device->ftbl->readtimestamp(device,
283 KGSL_TIMESTAMP_RETIRED);
284
Jordan Croused4bc9d22011-11-17 13:39:21 -0700285 /* Process expired events */
286 list_for_each_entry_safe(event, event_tmp, &device->events, list) {
287 if (timestamp_cmp(ts_processed, event->timestamp) < 0)
288 break;
289
290 if (event->func)
291 event->func(device, event->priv, ts_processed);
292
293 list_del(&event->list);
294 kfree(event);
295 }
296
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700297 mutex_unlock(&device->mutex);
298}
299
300static void kgsl_check_idle_locked(struct kgsl_device *device)
301{
302 if (device->pwrctrl.nap_allowed == true &&
303 device->state == KGSL_STATE_ACTIVE &&
304 device->requested_state == KGSL_STATE_NONE) {
Jeremy Gebben388c2972011-12-16 09:05:07 -0700305 kgsl_pwrctrl_request_state(device, KGSL_STATE_NAP);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700306 if (kgsl_pwrctrl_sleep(device) != 0)
307 mod_timer(&device->idle_timer,
308 jiffies +
309 device->pwrctrl.interval_timeout);
310 }
311}
312
313static void kgsl_check_idle(struct kgsl_device *device)
314{
315 mutex_lock(&device->mutex);
316 kgsl_check_idle_locked(device);
317 mutex_unlock(&device->mutex);
318}
319
320struct kgsl_device *kgsl_get_device(int dev_idx)
321{
322 int i;
323 struct kgsl_device *ret = NULL;
324
325 mutex_lock(&kgsl_driver.devlock);
326
327 for (i = 0; i < KGSL_DEVICE_MAX; i++) {
328 if (kgsl_driver.devp[i] && kgsl_driver.devp[i]->id == dev_idx) {
329 ret = kgsl_driver.devp[i];
330 break;
331 }
332 }
333
334 mutex_unlock(&kgsl_driver.devlock);
335 return ret;
336}
337EXPORT_SYMBOL(kgsl_get_device);
338
339static struct kgsl_device *kgsl_get_minor(int minor)
340{
341 struct kgsl_device *ret = NULL;
342
343 if (minor < 0 || minor >= KGSL_DEVICE_MAX)
344 return NULL;
345
346 mutex_lock(&kgsl_driver.devlock);
347 ret = kgsl_driver.devp[minor];
348 mutex_unlock(&kgsl_driver.devlock);
349
350 return ret;
351}
352
353int kgsl_register_ts_notifier(struct kgsl_device *device,
354 struct notifier_block *nb)
355{
356 BUG_ON(device == NULL);
357 return atomic_notifier_chain_register(&device->ts_notifier_list,
358 nb);
359}
360EXPORT_SYMBOL(kgsl_register_ts_notifier);
361
362int kgsl_unregister_ts_notifier(struct kgsl_device *device,
363 struct notifier_block *nb)
364{
365 BUG_ON(device == NULL);
366 return atomic_notifier_chain_unregister(&device->ts_notifier_list,
367 nb);
368}
369EXPORT_SYMBOL(kgsl_unregister_ts_notifier);
370
371int kgsl_check_timestamp(struct kgsl_device *device, unsigned int timestamp)
372{
373 unsigned int ts_processed;
374
375 ts_processed = device->ftbl->readtimestamp(device,
376 KGSL_TIMESTAMP_RETIRED);
377
Jordan Crousee6239dd2011-11-17 13:39:21 -0700378 return (timestamp_cmp(ts_processed, timestamp) >= 0);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700379}
380EXPORT_SYMBOL(kgsl_check_timestamp);
381
382static int kgsl_suspend_device(struct kgsl_device *device, pm_message_t state)
383{
384 int status = -EINVAL;
385 unsigned int nap_allowed_saved;
386 struct kgsl_pwrscale_policy *policy_saved;
387
388 if (!device)
389 return -EINVAL;
390
391 KGSL_PWR_WARN(device, "suspend start\n");
392
393 mutex_lock(&device->mutex);
394 nap_allowed_saved = device->pwrctrl.nap_allowed;
395 device->pwrctrl.nap_allowed = false;
396 policy_saved = device->pwrscale.policy;
397 device->pwrscale.policy = NULL;
Jeremy Gebben388c2972011-12-16 09:05:07 -0700398 kgsl_pwrctrl_request_state(device, KGSL_STATE_SUSPEND);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700399 /* Make sure no user process is waiting for a timestamp *
400 * before supending */
401 if (device->active_cnt != 0) {
402 mutex_unlock(&device->mutex);
403 wait_for_completion(&device->suspend_gate);
404 mutex_lock(&device->mutex);
405 }
Suman Tatiraju4a32c652012-02-17 11:59:05 -0800406 /* Don't let the timer wake us during suspended sleep. */
407 del_timer_sync(&device->idle_timer);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700408 switch (device->state) {
409 case KGSL_STATE_INIT:
410 break;
411 case KGSL_STATE_ACTIVE:
412 /* Wait for the device to become idle */
413 device->ftbl->idle(device, KGSL_TIMEOUT_DEFAULT);
414 case KGSL_STATE_NAP:
415 case KGSL_STATE_SLEEP:
416 /* Get the completion ready to be waited upon. */
417 INIT_COMPLETION(device->hwaccess_gate);
418 device->ftbl->suspend_context(device);
419 device->ftbl->stop(device);
Jeremy Gebben388c2972011-12-16 09:05:07 -0700420 kgsl_pwrctrl_set_state(device, KGSL_STATE_SUSPEND);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700421 break;
Suman Tatiraju24569022011-10-27 11:11:12 -0700422 case KGSL_STATE_SLUMBER:
423 INIT_COMPLETION(device->hwaccess_gate);
Jeremy Gebben388c2972011-12-16 09:05:07 -0700424 kgsl_pwrctrl_set_state(device, KGSL_STATE_SUSPEND);
Suman Tatiraju24569022011-10-27 11:11:12 -0700425 break;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700426 default:
427 KGSL_PWR_ERR(device, "suspend fail, device %d\n",
428 device->id);
429 goto end;
430 }
Jeremy Gebben388c2972011-12-16 09:05:07 -0700431 kgsl_pwrctrl_request_state(device, KGSL_STATE_NONE);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700432 device->pwrctrl.nap_allowed = nap_allowed_saved;
433 device->pwrscale.policy = policy_saved;
434 status = 0;
435
436end:
437 mutex_unlock(&device->mutex);
438 KGSL_PWR_WARN(device, "suspend end\n");
439 return status;
440}
441
442static int kgsl_resume_device(struct kgsl_device *device)
443{
444 int status = -EINVAL;
445
446 if (!device)
447 return -EINVAL;
448
449 KGSL_PWR_WARN(device, "resume start\n");
450 mutex_lock(&device->mutex);
451 if (device->state == KGSL_STATE_SUSPEND) {
Jeremy Gebben388c2972011-12-16 09:05:07 -0700452 kgsl_pwrctrl_set_state(device, KGSL_STATE_SLUMBER);
Suman Tatiraju24569022011-10-27 11:11:12 -0700453 status = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700454 complete_all(&device->hwaccess_gate);
455 }
Jeremy Gebben388c2972011-12-16 09:05:07 -0700456 kgsl_pwrctrl_request_state(device, KGSL_STATE_NONE);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700457
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700458 mutex_unlock(&device->mutex);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700459 KGSL_PWR_WARN(device, "resume end\n");
460 return status;
461}
462
463static int kgsl_suspend(struct device *dev)
464{
465
466 pm_message_t arg = {0};
467 struct kgsl_device *device = dev_get_drvdata(dev);
468 return kgsl_suspend_device(device, arg);
469}
470
471static int kgsl_resume(struct device *dev)
472{
473 struct kgsl_device *device = dev_get_drvdata(dev);
474 return kgsl_resume_device(device);
475}
476
477static int kgsl_runtime_suspend(struct device *dev)
478{
479 return 0;
480}
481
482static int kgsl_runtime_resume(struct device *dev)
483{
484 return 0;
485}
486
487const struct dev_pm_ops kgsl_pm_ops = {
488 .suspend = kgsl_suspend,
489 .resume = kgsl_resume,
490 .runtime_suspend = kgsl_runtime_suspend,
491 .runtime_resume = kgsl_runtime_resume,
492};
493EXPORT_SYMBOL(kgsl_pm_ops);
494
495void kgsl_early_suspend_driver(struct early_suspend *h)
496{
497 struct kgsl_device *device = container_of(h,
498 struct kgsl_device, display_off);
Suman Tatiraju24569022011-10-27 11:11:12 -0700499 KGSL_PWR_WARN(device, "early suspend start\n");
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530500 mutex_lock(&device->mutex);
Lucille Sylvester344e4622012-01-18 15:53:21 -0700501 kgsl_pwrctrl_request_state(device, KGSL_STATE_SLUMBER);
Suman Tatiraju24569022011-10-27 11:11:12 -0700502 kgsl_pwrctrl_sleep(device);
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530503 mutex_unlock(&device->mutex);
Suman Tatiraju24569022011-10-27 11:11:12 -0700504 KGSL_PWR_WARN(device, "early suspend end\n");
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700505}
506EXPORT_SYMBOL(kgsl_early_suspend_driver);
507
508int kgsl_suspend_driver(struct platform_device *pdev,
509 pm_message_t state)
510{
511 struct kgsl_device *device = dev_get_drvdata(&pdev->dev);
512 return kgsl_suspend_device(device, state);
513}
514EXPORT_SYMBOL(kgsl_suspend_driver);
515
516int kgsl_resume_driver(struct platform_device *pdev)
517{
518 struct kgsl_device *device = dev_get_drvdata(&pdev->dev);
519 return kgsl_resume_device(device);
520}
521EXPORT_SYMBOL(kgsl_resume_driver);
522
523void kgsl_late_resume_driver(struct early_suspend *h)
524{
525 struct kgsl_device *device = container_of(h,
526 struct kgsl_device, display_off);
Suman Tatiraju24569022011-10-27 11:11:12 -0700527 KGSL_PWR_WARN(device, "late resume start\n");
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530528 mutex_lock(&device->mutex);
Suman Tatiraju24569022011-10-27 11:11:12 -0700529 kgsl_pwrctrl_wake(device);
530 device->pwrctrl.restore_slumber = 0;
Jeremy Gebben388c2972011-12-16 09:05:07 -0700531 kgsl_pwrctrl_pwrlevel_change(device, KGSL_PWRLEVEL_TURBO);
Ranjhith Kalisamy8b636952011-09-03 14:48:31 +0530532 mutex_unlock(&device->mutex);
Suman Tatiraju24569022011-10-27 11:11:12 -0700533 kgsl_check_idle(device);
534 KGSL_PWR_WARN(device, "late resume end\n");
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700535}
536EXPORT_SYMBOL(kgsl_late_resume_driver);
537
538/* file operations */
539static struct kgsl_process_private *
540kgsl_get_process_private(struct kgsl_device_private *cur_dev_priv)
541{
542 struct kgsl_process_private *private;
543
544 mutex_lock(&kgsl_driver.process_mutex);
545 list_for_each_entry(private, &kgsl_driver.process_list, list) {
546 if (private->pid == task_tgid_nr(current)) {
547 private->refcnt++;
548 goto out;
549 }
550 }
551
552 /* no existing process private found for this dev_priv, create one */
553 private = kzalloc(sizeof(struct kgsl_process_private), GFP_KERNEL);
554 if (private == NULL) {
555 KGSL_DRV_ERR(cur_dev_priv->device, "kzalloc(%d) failed\n",
556 sizeof(struct kgsl_process_private));
557 goto out;
558 }
559
560 spin_lock_init(&private->mem_lock);
561 private->refcnt = 1;
562 private->pid = task_tgid_nr(current);
563
564 INIT_LIST_HEAD(&private->mem_list);
565
Shubhraprakash Das767fdda2011-08-15 15:49:45 -0600566 if (kgsl_mmu_enabled())
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700567 {
568 unsigned long pt_name;
569
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700570 pt_name = task_tgid_nr(current);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700571 private->pagetable = kgsl_mmu_getpagetable(pt_name);
572 if (private->pagetable == NULL) {
573 kfree(private);
574 private = NULL;
575 goto out;
576 }
577 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700578
579 list_add(&private->list, &kgsl_driver.process_list);
580
581 kgsl_process_init_sysfs(private);
582
583out:
584 mutex_unlock(&kgsl_driver.process_mutex);
585 return private;
586}
587
588static void
589kgsl_put_process_private(struct kgsl_device *device,
590 struct kgsl_process_private *private)
591{
592 struct kgsl_mem_entry *entry = NULL;
593 struct kgsl_mem_entry *entry_tmp = NULL;
594
595 if (!private)
596 return;
597
598 mutex_lock(&kgsl_driver.process_mutex);
599
600 if (--private->refcnt)
601 goto unlock;
602
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700603 kgsl_process_uninit_sysfs(private);
604
605 list_del(&private->list);
606
607 list_for_each_entry_safe(entry, entry_tmp, &private->mem_list, list) {
608 list_del(&entry->list);
Jordan Crouse00714012012-03-16 14:53:40 -0600609 kgsl_mem_entry_detach_process(entry);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700610 }
611
612 kgsl_mmu_putpagetable(private->pagetable);
613 kfree(private);
614unlock:
615 mutex_unlock(&kgsl_driver.process_mutex);
616}
617
618static int kgsl_release(struct inode *inodep, struct file *filep)
619{
620 int result = 0;
Jordan Crouse2db0af92011-08-08 16:05:09 -0600621 struct kgsl_device_private *dev_priv = filep->private_data;
622 struct kgsl_process_private *private = dev_priv->process_priv;
623 struct kgsl_device *device = dev_priv->device;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700624 struct kgsl_context *context;
625 int next = 0;
626
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700627 filep->private_data = NULL;
628
629 mutex_lock(&device->mutex);
630 kgsl_check_suspended(device);
631
632 while (1) {
Jordan Crouse2db0af92011-08-08 16:05:09 -0600633 context = idr_get_next(&device->context_idr, &next);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700634 if (context == NULL)
635 break;
636
637 if (context->dev_priv == dev_priv) {
638 device->ftbl->drawctxt_destroy(device, context);
639 kgsl_destroy_context(dev_priv, context);
640 }
641
642 next = next + 1;
643 }
644
645 device->open_count--;
646 if (device->open_count == 0) {
647 result = device->ftbl->stop(device);
Jeremy Gebben388c2972011-12-16 09:05:07 -0700648 kgsl_pwrctrl_set_state(device, KGSL_STATE_INIT);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700649 }
650 /* clean up any to-be-freed entries that belong to this
651 * process and this device
652 */
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -0700653 kgsl_cancel_events(device, dev_priv);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700654
655 mutex_unlock(&device->mutex);
656 kfree(dev_priv);
657
658 kgsl_put_process_private(device, private);
659
660 pm_runtime_put(device->parentdev);
661 return result;
662}
663
664static int kgsl_open(struct inode *inodep, struct file *filep)
665{
666 int result;
667 struct kgsl_device_private *dev_priv;
668 struct kgsl_device *device;
669 unsigned int minor = iminor(inodep);
670
671 device = kgsl_get_minor(minor);
672 BUG_ON(device == NULL);
673
674 if (filep->f_flags & O_EXCL) {
675 KGSL_DRV_ERR(device, "O_EXCL not allowed\n");
676 return -EBUSY;
677 }
678
679 result = pm_runtime_get_sync(device->parentdev);
680 if (result < 0) {
681 KGSL_DRV_ERR(device,
682 "Runtime PM: Unable to wake up the device, rc = %d\n",
683 result);
684 return result;
685 }
686 result = 0;
687
688 dev_priv = kzalloc(sizeof(struct kgsl_device_private), GFP_KERNEL);
689 if (dev_priv == NULL) {
690 KGSL_DRV_ERR(device, "kzalloc failed(%d)\n",
691 sizeof(struct kgsl_device_private));
692 result = -ENOMEM;
693 goto err_pmruntime;
694 }
695
696 dev_priv->device = device;
697 filep->private_data = dev_priv;
698
699 /* Get file (per process) private struct */
700 dev_priv->process_priv = kgsl_get_process_private(dev_priv);
701 if (dev_priv->process_priv == NULL) {
702 result = -ENOMEM;
703 goto err_freedevpriv;
704 }
705
706 mutex_lock(&device->mutex);
707 kgsl_check_suspended(device);
708
709 if (device->open_count == 0) {
710 result = device->ftbl->start(device, true);
711
712 if (result) {
713 mutex_unlock(&device->mutex);
714 goto err_putprocess;
715 }
Jeremy Gebben388c2972011-12-16 09:05:07 -0700716 kgsl_pwrctrl_set_state(device, KGSL_STATE_ACTIVE);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700717 }
718 device->open_count++;
719 mutex_unlock(&device->mutex);
720
721 KGSL_DRV_INFO(device, "Initialized %s: mmu=%s pagetable_count=%d\n",
722 device->name, kgsl_mmu_enabled() ? "on" : "off",
723 kgsl_pagetable_count);
724
725 return result;
726
727err_putprocess:
728 kgsl_put_process_private(device, dev_priv->process_priv);
729err_freedevpriv:
730 filep->private_data = NULL;
731 kfree(dev_priv);
732err_pmruntime:
733 pm_runtime_put(device->parentdev);
734 return result;
735}
736
737
738/*call with private->mem_lock locked */
739static struct kgsl_mem_entry *
740kgsl_sharedmem_find(struct kgsl_process_private *private, unsigned int gpuaddr)
741{
742 struct kgsl_mem_entry *entry = NULL, *result = NULL;
743
744 BUG_ON(private == NULL);
745
746 gpuaddr &= PAGE_MASK;
747
748 list_for_each_entry(entry, &private->mem_list, list) {
749 if (entry->memdesc.gpuaddr == gpuaddr) {
750 result = entry;
751 break;
752 }
753 }
754 return result;
755}
756
757/*call with private->mem_lock locked */
758struct kgsl_mem_entry *
759kgsl_sharedmem_find_region(struct kgsl_process_private *private,
760 unsigned int gpuaddr,
761 size_t size)
762{
763 struct kgsl_mem_entry *entry = NULL, *result = NULL;
764
765 BUG_ON(private == NULL);
766
767 list_for_each_entry(entry, &private->mem_list, list) {
Jeremy Gebben16e80fa2011-11-30 15:56:29 -0700768 if (kgsl_gpuaddr_in_memdesc(&entry->memdesc, gpuaddr, size)) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700769 result = entry;
770 break;
771 }
772 }
773
774 return result;
775}
776EXPORT_SYMBOL(kgsl_sharedmem_find_region);
777
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700778/*call all ioctl sub functions with driver locked*/
779static long kgsl_ioctl_device_getproperty(struct kgsl_device_private *dev_priv,
780 unsigned int cmd, void *data)
781{
782 int result = 0;
783 struct kgsl_device_getproperty *param = data;
784
785 switch (param->type) {
786 case KGSL_PROP_VERSION:
787 {
788 struct kgsl_version version;
789 if (param->sizebytes != sizeof(version)) {
790 result = -EINVAL;
791 break;
792 }
793
794 version.drv_major = KGSL_VERSION_MAJOR;
795 version.drv_minor = KGSL_VERSION_MINOR;
796 version.dev_major = dev_priv->device->ver_major;
797 version.dev_minor = dev_priv->device->ver_minor;
798
799 if (copy_to_user(param->value, &version, sizeof(version)))
800 result = -EFAULT;
801
802 break;
803 }
Shubhraprakash Das2dfe5dd2012-02-10 13:49:53 -0700804 case KGSL_PROP_GPU_RESET_STAT:
805 {
806 /* Return reset status of given context and clear it */
807 uint32_t id;
808 struct kgsl_context *context;
809
810 if (param->sizebytes != sizeof(unsigned int)) {
811 result = -EINVAL;
812 break;
813 }
814 /* We expect the value passed in to contain the context id */
815 if (copy_from_user(&id, param->value,
816 sizeof(unsigned int))) {
817 result = -EFAULT;
818 break;
819 }
820 context = kgsl_find_context(dev_priv, id);
821 if (!context) {
822 result = -EINVAL;
823 break;
824 }
825 /*
826 * Copy the reset status to value which also serves as
827 * the out parameter
828 */
829 if (copy_to_user(param->value, &(context->reset_status),
830 sizeof(unsigned int))) {
831 result = -EFAULT;
832 break;
833 }
834 /* Clear reset status once its been queried */
835 context->reset_status = KGSL_CTX_STAT_NO_ERROR;
836 break;
837 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700838 default:
839 result = dev_priv->device->ftbl->getproperty(
840 dev_priv->device, param->type,
841 param->value, param->sizebytes);
842 }
843
844
845 return result;
846}
847
848static long kgsl_ioctl_device_waittimestamp(struct kgsl_device_private
849 *dev_priv, unsigned int cmd,
850 void *data)
851{
852 int result = 0;
853 struct kgsl_device_waittimestamp *param = data;
854
855 /* Set the active count so that suspend doesn't do the
856 wrong thing */
857
858 dev_priv->device->active_cnt++;
859
Norman Geed7402ff2011-10-28 08:51:11 -0600860 trace_kgsl_waittimestamp_entry(dev_priv->device, param);
861
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700862 result = dev_priv->device->ftbl->waittimestamp(dev_priv->device,
863 param->timestamp,
864 param->timeout);
865
Norman Geed7402ff2011-10-28 08:51:11 -0600866 trace_kgsl_waittimestamp_exit(dev_priv->device, result);
867
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700868 /* Fire off any pending suspend operations that are in flight */
869
870 INIT_COMPLETION(dev_priv->device->suspend_gate);
871 dev_priv->device->active_cnt--;
872 complete(&dev_priv->device->suspend_gate);
873
874 return result;
875}
876static bool check_ibdesc(struct kgsl_device_private *dev_priv,
877 struct kgsl_ibdesc *ibdesc, unsigned int numibs,
878 bool parse)
879{
880 bool result = true;
881 unsigned int i;
882 for (i = 0; i < numibs; i++) {
883 struct kgsl_mem_entry *entry;
884 spin_lock(&dev_priv->process_priv->mem_lock);
885 entry = kgsl_sharedmem_find_region(dev_priv->process_priv,
886 ibdesc[i].gpuaddr, ibdesc[i].sizedwords * sizeof(uint));
887 spin_unlock(&dev_priv->process_priv->mem_lock);
888 if (entry == NULL) {
889 KGSL_DRV_ERR(dev_priv->device,
890 "invalid cmd buffer gpuaddr %08x " \
891 "sizedwords %d\n", ibdesc[i].gpuaddr,
892 ibdesc[i].sizedwords);
893 result = false;
894 break;
895 }
896
897 if (parse && !kgsl_cffdump_parse_ibs(dev_priv, &entry->memdesc,
898 ibdesc[i].gpuaddr, ibdesc[i].sizedwords, true)) {
899 KGSL_DRV_ERR(dev_priv->device,
900 "invalid cmd buffer gpuaddr %08x " \
901 "sizedwords %d numibs %d/%d\n",
902 ibdesc[i].gpuaddr,
903 ibdesc[i].sizedwords, i+1, numibs);
904 result = false;
905 break;
906 }
907 }
908 return result;
909}
910
911static long kgsl_ioctl_rb_issueibcmds(struct kgsl_device_private *dev_priv,
912 unsigned int cmd, void *data)
913{
914 int result = 0;
915 struct kgsl_ringbuffer_issueibcmds *param = data;
916 struct kgsl_ibdesc *ibdesc;
917 struct kgsl_context *context;
918
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700919 context = kgsl_find_context(dev_priv, param->drawctxt_id);
920 if (context == NULL) {
921 result = -EINVAL;
922 KGSL_DRV_ERR(dev_priv->device,
923 "invalid drawctxt drawctxt_id %d\n",
924 param->drawctxt_id);
925 goto done;
926 }
927
928 if (param->flags & KGSL_CONTEXT_SUBMIT_IB_LIST) {
929 KGSL_DRV_INFO(dev_priv->device,
930 "Using IB list mode for ib submission, numibs: %d\n",
931 param->numibs);
932 if (!param->numibs) {
933 KGSL_DRV_ERR(dev_priv->device,
934 "Invalid numibs as parameter: %d\n",
935 param->numibs);
936 result = -EINVAL;
937 goto done;
938 }
939
940 ibdesc = kzalloc(sizeof(struct kgsl_ibdesc) * param->numibs,
941 GFP_KERNEL);
942 if (!ibdesc) {
943 KGSL_MEM_ERR(dev_priv->device,
944 "kzalloc(%d) failed\n",
945 sizeof(struct kgsl_ibdesc) * param->numibs);
946 result = -ENOMEM;
947 goto done;
948 }
949
950 if (copy_from_user(ibdesc, (void *)param->ibdesc_addr,
951 sizeof(struct kgsl_ibdesc) * param->numibs)) {
952 result = -EFAULT;
953 KGSL_DRV_ERR(dev_priv->device,
954 "copy_from_user failed\n");
955 goto free_ibdesc;
956 }
957 } else {
958 KGSL_DRV_INFO(dev_priv->device,
959 "Using single IB submission mode for ib submission\n");
960 /* If user space driver is still using the old mode of
961 * submitting single ib then we need to support that as well */
962 ibdesc = kzalloc(sizeof(struct kgsl_ibdesc), GFP_KERNEL);
963 if (!ibdesc) {
964 KGSL_MEM_ERR(dev_priv->device,
965 "kzalloc(%d) failed\n",
966 sizeof(struct kgsl_ibdesc));
967 result = -ENOMEM;
968 goto done;
969 }
970 ibdesc[0].gpuaddr = param->ibdesc_addr;
971 ibdesc[0].sizedwords = param->numibs;
972 param->numibs = 1;
973 }
974
975 if (!check_ibdesc(dev_priv, ibdesc, param->numibs, true)) {
976 KGSL_DRV_ERR(dev_priv->device, "bad ibdesc");
977 result = -EINVAL;
978 goto free_ibdesc;
979 }
980
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700981 result = dev_priv->device->ftbl->issueibcmds(dev_priv,
982 context,
983 ibdesc,
984 param->numibs,
985 &param->timestamp,
986 param->flags);
987
Norman Geed7402ff2011-10-28 08:51:11 -0600988 trace_kgsl_issueibcmds(dev_priv->device, param, result);
989
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700990 if (result != 0)
991 goto free_ibdesc;
992
993 /* this is a check to try to detect if a command buffer was freed
994 * during issueibcmds().
995 */
996 if (!check_ibdesc(dev_priv, ibdesc, param->numibs, false)) {
997 KGSL_DRV_ERR(dev_priv->device, "bad ibdesc AFTER issue");
998 result = -EINVAL;
999 goto free_ibdesc;
1000 }
1001
1002free_ibdesc:
1003 kfree(ibdesc);
1004done:
1005
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001006 return result;
1007}
1008
1009static long kgsl_ioctl_cmdstream_readtimestamp(struct kgsl_device_private
1010 *dev_priv, unsigned int cmd,
1011 void *data)
1012{
1013 struct kgsl_cmdstream_readtimestamp *param = data;
1014
1015 param->timestamp =
1016 dev_priv->device->ftbl->readtimestamp(dev_priv->device,
1017 param->type);
1018
Norman Geed7402ff2011-10-28 08:51:11 -06001019 trace_kgsl_readtimestamp(dev_priv->device, param);
1020
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001021 return 0;
1022}
1023
Jeremy Gebbenc81a3c62012-02-07 16:10:23 -07001024static void kgsl_freemem_event_cb(struct kgsl_device *device,
1025 void *priv, u32 timestamp)
1026{
1027 struct kgsl_mem_entry *entry = priv;
1028 spin_lock(&entry->priv->mem_lock);
1029 list_del(&entry->list);
1030 spin_unlock(&entry->priv->mem_lock);
Jeremy Gebbena5859272012-03-01 12:46:28 -07001031 trace_kgsl_mem_timestamp_free(entry, timestamp);
Jordan Crouse00714012012-03-16 14:53:40 -06001032 kgsl_mem_entry_detach_process(entry);
Jeremy Gebbenc81a3c62012-02-07 16:10:23 -07001033}
1034
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001035static long kgsl_ioctl_cmdstream_freememontimestamp(struct kgsl_device_private
1036 *dev_priv, unsigned int cmd,
1037 void *data)
1038{
1039 int result = 0;
1040 struct kgsl_cmdstream_freememontimestamp *param = data;
1041 struct kgsl_mem_entry *entry = NULL;
Jeremy Gebbena5859272012-03-01 12:46:28 -07001042 struct kgsl_device *device = dev_priv->device;
1043 unsigned int cur;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001044
1045 spin_lock(&dev_priv->process_priv->mem_lock);
1046 entry = kgsl_sharedmem_find(dev_priv->process_priv, param->gpuaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001047 spin_unlock(&dev_priv->process_priv->mem_lock);
1048
1049 if (entry) {
Jeremy Gebbena5859272012-03-01 12:46:28 -07001050 cur = device->ftbl->readtimestamp(device,
1051 KGSL_TIMESTAMP_RETIRED);
1052
1053 trace_kgsl_mem_timestamp_queue(entry, cur);
Jeremy Gebbenc81a3c62012-02-07 16:10:23 -07001054 result = kgsl_add_event(dev_priv->device, param->timestamp,
1055 kgsl_freemem_event_cb, entry, dev_priv);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001056 } else {
1057 KGSL_DRV_ERR(dev_priv->device,
1058 "invalid gpuaddr %08x\n", param->gpuaddr);
1059 result = -EINVAL;
1060 }
1061
1062 return result;
1063}
1064
1065static long kgsl_ioctl_drawctxt_create(struct kgsl_device_private *dev_priv,
1066 unsigned int cmd, void *data)
1067{
1068 int result = 0;
1069 struct kgsl_drawctxt_create *param = data;
1070 struct kgsl_context *context = NULL;
1071
1072 context = kgsl_create_context(dev_priv);
1073
1074 if (context == NULL) {
1075 result = -ENOMEM;
1076 goto done;
1077 }
1078
1079 if (dev_priv->device->ftbl->drawctxt_create)
1080 result = dev_priv->device->ftbl->drawctxt_create(
1081 dev_priv->device, dev_priv->process_priv->pagetable,
1082 context, param->flags);
1083
1084 param->drawctxt_id = context->id;
1085
1086done:
1087 if (result && context)
1088 kgsl_destroy_context(dev_priv, context);
1089
1090 return result;
1091}
1092
1093static long kgsl_ioctl_drawctxt_destroy(struct kgsl_device_private *dev_priv,
1094 unsigned int cmd, void *data)
1095{
1096 int result = 0;
1097 struct kgsl_drawctxt_destroy *param = data;
1098 struct kgsl_context *context;
1099
1100 context = kgsl_find_context(dev_priv, param->drawctxt_id);
1101
1102 if (context == NULL) {
1103 result = -EINVAL;
1104 goto done;
1105 }
1106
1107 if (dev_priv->device->ftbl->drawctxt_destroy)
1108 dev_priv->device->ftbl->drawctxt_destroy(dev_priv->device,
1109 context);
1110
1111 kgsl_destroy_context(dev_priv, context);
1112
1113done:
1114 return result;
1115}
1116
1117static long kgsl_ioctl_sharedmem_free(struct kgsl_device_private *dev_priv,
1118 unsigned int cmd, void *data)
1119{
1120 int result = 0;
1121 struct kgsl_sharedmem_free *param = data;
1122 struct kgsl_process_private *private = dev_priv->process_priv;
1123 struct kgsl_mem_entry *entry = NULL;
1124
1125 spin_lock(&private->mem_lock);
1126 entry = kgsl_sharedmem_find(private, param->gpuaddr);
1127 if (entry)
1128 list_del(&entry->list);
1129 spin_unlock(&private->mem_lock);
1130
1131 if (entry) {
Jeremy Gebbena5859272012-03-01 12:46:28 -07001132 trace_kgsl_mem_free(entry);
Jordan Crouse00714012012-03-16 14:53:40 -06001133 kgsl_mem_entry_detach_process(entry);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001134 } else {
1135 KGSL_CORE_ERR("invalid gpuaddr %08x\n", param->gpuaddr);
1136 result = -EINVAL;
1137 }
1138
1139 return result;
1140}
1141
1142static struct vm_area_struct *kgsl_get_vma_from_start_addr(unsigned int addr)
1143{
1144 struct vm_area_struct *vma;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001145
1146 down_read(&current->mm->mmap_sem);
1147 vma = find_vma(current->mm, addr);
1148 up_read(&current->mm->mmap_sem);
Jordan Crouse2c542b62011-07-26 08:30:20 -06001149 if (!vma)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001150 KGSL_CORE_ERR("find_vma(%x) failed\n", addr);
Jordan Crouse2c542b62011-07-26 08:30:20 -06001151
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001152 return vma;
1153}
1154
1155static long
1156kgsl_ioctl_sharedmem_from_vmalloc(struct kgsl_device_private *dev_priv,
1157 unsigned int cmd, void *data)
1158{
1159 int result = 0, len = 0;
1160 struct kgsl_process_private *private = dev_priv->process_priv;
1161 struct kgsl_sharedmem_from_vmalloc *param = data;
1162 struct kgsl_mem_entry *entry = NULL;
1163 struct vm_area_struct *vma;
1164
1165 if (!kgsl_mmu_enabled())
1166 return -ENODEV;
1167
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001168 if (!param->hostptr) {
1169 KGSL_CORE_ERR("invalid hostptr %x\n", param->hostptr);
1170 result = -EINVAL;
1171 goto error;
1172 }
1173
1174 vma = kgsl_get_vma_from_start_addr(param->hostptr);
1175 if (!vma) {
1176 result = -EINVAL;
1177 goto error;
1178 }
Jordan Crouse2c542b62011-07-26 08:30:20 -06001179
1180 /*
1181 * If the user specified a length, use it, otherwise try to
1182 * infer the length if the vma region
1183 */
1184 if (param->gpuaddr != 0) {
1185 len = param->gpuaddr;
1186 } else {
1187 /*
1188 * For this to work, we have to assume the VMA region is only
1189 * for this single allocation. If it isn't, then bail out
1190 */
1191 if (vma->vm_pgoff || (param->hostptr != vma->vm_start)) {
1192 KGSL_CORE_ERR("VMA region does not match hostaddr\n");
1193 result = -EINVAL;
1194 goto error;
1195 }
1196
1197 len = vma->vm_end - vma->vm_start;
1198 }
1199
1200 /* Make sure it fits */
1201 if (len == 0 || param->hostptr + len > vma->vm_end) {
1202 KGSL_CORE_ERR("Invalid memory allocation length %d\n", len);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001203 result = -EINVAL;
1204 goto error;
1205 }
1206
1207 entry = kgsl_mem_entry_create();
1208 if (entry == NULL) {
1209 result = -ENOMEM;
1210 goto error;
1211 }
1212
1213 result = kgsl_sharedmem_vmalloc_user(&entry->memdesc,
1214 private->pagetable, len,
1215 param->flags);
1216 if (result != 0)
1217 goto error_free_entry;
1218
1219 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
1220
1221 result = remap_vmalloc_range(vma, (void *) entry->memdesc.hostptr, 0);
1222 if (result) {
1223 KGSL_CORE_ERR("remap_vmalloc_range failed: %d\n", result);
1224 goto error_free_vmalloc;
1225 }
1226
1227 param->gpuaddr = entry->memdesc.gpuaddr;
1228
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001229 entry->memtype = KGSL_MEM_ENTRY_KERNEL;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001230
1231 kgsl_mem_entry_attach_process(entry, private);
1232
Jeremy Gebbena5859272012-03-01 12:46:28 -07001233 trace_kgsl_mem_alloc(entry);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001234 /* Process specific statistics */
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001235 kgsl_process_add_stats(private, entry->memtype, len);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001236
1237 kgsl_check_idle(dev_priv->device);
1238 return 0;
1239
1240error_free_vmalloc:
1241 kgsl_sharedmem_free(&entry->memdesc);
1242
1243error_free_entry:
1244 kfree(entry);
1245
1246error:
1247 kgsl_check_idle(dev_priv->device);
1248 return result;
1249}
1250
1251static inline int _check_region(unsigned long start, unsigned long size,
1252 uint64_t len)
1253{
1254 uint64_t end = ((uint64_t) start) + size;
1255 return (end > len);
1256}
1257
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001258static int kgsl_get_phys_file(int fd, unsigned long *start, unsigned long *len,
1259 unsigned long *vstart, struct file **filep)
1260{
1261 struct file *fbfile;
1262 int ret = 0;
1263 dev_t rdev;
1264 struct fb_info *info;
1265
1266 *filep = NULL;
Jordan Crousefd978432011-09-02 14:34:32 -06001267#ifdef CONFIG_ANDROID_PMEM
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001268 if (!get_pmem_file(fd, start, vstart, len, filep))
1269 return 0;
Jordan Crousefd978432011-09-02 14:34:32 -06001270#endif
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001271
1272 fbfile = fget(fd);
1273 if (fbfile == NULL) {
1274 KGSL_CORE_ERR("fget_light failed\n");
1275 return -1;
1276 }
1277
1278 rdev = fbfile->f_dentry->d_inode->i_rdev;
1279 info = MAJOR(rdev) == FB_MAJOR ? registered_fb[MINOR(rdev)] : NULL;
1280 if (info) {
1281 *start = info->fix.smem_start;
1282 *len = info->fix.smem_len;
1283 *vstart = (unsigned long)__va(info->fix.smem_start);
1284 ret = 0;
1285 } else {
1286 KGSL_CORE_ERR("framebuffer minor %d not found\n",
1287 MINOR(rdev));
1288 ret = -1;
1289 }
1290
1291 fput(fbfile);
1292
1293 return ret;
1294}
1295
1296static int kgsl_setup_phys_file(struct kgsl_mem_entry *entry,
1297 struct kgsl_pagetable *pagetable,
1298 unsigned int fd, unsigned int offset,
1299 size_t size)
1300{
1301 int ret;
1302 unsigned long phys, virt, len;
1303 struct file *filep;
1304
1305 ret = kgsl_get_phys_file(fd, &phys, &len, &virt, &filep);
1306 if (ret)
1307 return ret;
1308
Wei Zou4061c0b2011-07-08 10:24:22 -07001309 if (phys == 0) {
1310 ret = -EINVAL;
1311 goto err;
1312 }
1313
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001314 if (offset >= len) {
1315 ret = -EINVAL;
1316 goto err;
1317 }
1318
1319 if (size == 0)
1320 size = len;
1321
1322 /* Adjust the size of the region to account for the offset */
1323 size += offset & ~PAGE_MASK;
1324
1325 size = ALIGN(size, PAGE_SIZE);
1326
1327 if (_check_region(offset & PAGE_MASK, size, len)) {
1328 KGSL_CORE_ERR("Offset (%ld) + size (%d) is larger"
1329 "than pmem region length %ld\n",
1330 offset & PAGE_MASK, size, len);
1331 ret = -EINVAL;
1332 goto err;
1333
1334 }
1335
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001336 entry->priv_data = filep;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001337
1338 entry->memdesc.pagetable = pagetable;
1339 entry->memdesc.size = size;
1340 entry->memdesc.physaddr = phys + (offset & PAGE_MASK);
1341 entry->memdesc.hostptr = (void *) (virt + (offset & PAGE_MASK));
Jordan Croused17e9aa2011-10-12 16:57:48 -06001342
1343 ret = memdesc_sg_phys(&entry->memdesc,
1344 phys + (offset & PAGE_MASK), size);
1345 if (ret)
1346 goto err;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001347
1348 return 0;
1349err:
Jordan Crousefd978432011-09-02 14:34:32 -06001350#ifdef CONFIG_ANDROID_PMEM
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001351 put_pmem_file(filep);
Jordan Crousefd978432011-09-02 14:34:32 -06001352#endif
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001353 return ret;
1354}
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001355
Jordan Croused17e9aa2011-10-12 16:57:48 -06001356static int memdesc_sg_virt(struct kgsl_memdesc *memdesc,
1357 void *addr, int size)
1358{
1359 int i;
1360 int sglen = PAGE_ALIGN(size) / PAGE_SIZE;
1361 unsigned long paddr = (unsigned long) addr;
1362
Jeff Boody28afec42012-01-18 15:47:46 -07001363 memdesc->sg = vmalloc(sglen * sizeof(struct scatterlist));
Jordan Croused17e9aa2011-10-12 16:57:48 -06001364 if (memdesc->sg == NULL)
1365 return -ENOMEM;
1366
1367 memdesc->sglen = sglen;
1368 sg_init_table(memdesc->sg, sglen);
1369
1370 spin_lock(&current->mm->page_table_lock);
1371
1372 for (i = 0; i < sglen; i++, paddr += PAGE_SIZE) {
1373 struct page *page;
1374 pmd_t *ppmd;
1375 pte_t *ppte;
1376 pgd_t *ppgd = pgd_offset(current->mm, paddr);
1377
1378 if (pgd_none(*ppgd) || pgd_bad(*ppgd))
1379 goto err;
1380
1381 ppmd = pmd_offset(ppgd, paddr);
1382 if (pmd_none(*ppmd) || pmd_bad(*ppmd))
1383 goto err;
1384
1385 ppte = pte_offset_map(ppmd, paddr);
1386 if (ppte == NULL)
1387 goto err;
1388
1389 page = pfn_to_page(pte_pfn(*ppte));
1390 if (!page)
1391 goto err;
1392
1393 sg_set_page(&memdesc->sg[i], page, PAGE_SIZE, 0);
1394 pte_unmap(ppte);
1395 }
1396
1397 spin_unlock(&current->mm->page_table_lock);
1398
1399 return 0;
1400
1401err:
1402 spin_unlock(&current->mm->page_table_lock);
Jeff Boody28afec42012-01-18 15:47:46 -07001403 vfree(memdesc->sg);
Jordan Croused17e9aa2011-10-12 16:57:48 -06001404 memdesc->sg = NULL;
1405
1406 return -EINVAL;
1407}
1408
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001409static int kgsl_setup_hostptr(struct kgsl_mem_entry *entry,
1410 struct kgsl_pagetable *pagetable,
1411 void *hostptr, unsigned int offset,
1412 size_t size)
1413{
1414 struct vm_area_struct *vma;
1415 unsigned int len;
1416
1417 down_read(&current->mm->mmap_sem);
1418 vma = find_vma(current->mm, (unsigned int) hostptr);
1419 up_read(&current->mm->mmap_sem);
1420
1421 if (!vma) {
1422 KGSL_CORE_ERR("find_vma(%p) failed\n", hostptr);
1423 return -EINVAL;
1424 }
1425
1426 /* We don't necessarily start at vma->vm_start */
1427 len = vma->vm_end - (unsigned long) hostptr;
1428
1429 if (offset >= len)
1430 return -EINVAL;
1431
1432 if (!KGSL_IS_PAGE_ALIGNED((unsigned long) hostptr) ||
1433 !KGSL_IS_PAGE_ALIGNED(len)) {
1434 KGSL_CORE_ERR("user address len(%u)"
1435 "and start(%p) must be page"
1436 "aligned\n", len, hostptr);
1437 return -EINVAL;
1438 }
1439
1440 if (size == 0)
1441 size = len;
1442
1443 /* Adjust the size of the region to account for the offset */
1444 size += offset & ~PAGE_MASK;
1445
1446 size = ALIGN(size, PAGE_SIZE);
1447
1448 if (_check_region(offset & PAGE_MASK, size, len)) {
1449 KGSL_CORE_ERR("Offset (%ld) + size (%d) is larger"
1450 "than region length %d\n",
1451 offset & PAGE_MASK, size, len);
1452 return -EINVAL;
1453 }
1454
1455 entry->memdesc.pagetable = pagetable;
1456 entry->memdesc.size = size;
1457 entry->memdesc.hostptr = hostptr + (offset & PAGE_MASK);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001458
Jordan Croused17e9aa2011-10-12 16:57:48 -06001459 return memdesc_sg_virt(&entry->memdesc,
1460 hostptr + (offset & PAGE_MASK), size);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001461}
1462
1463#ifdef CONFIG_ASHMEM
1464static int kgsl_setup_ashmem(struct kgsl_mem_entry *entry,
1465 struct kgsl_pagetable *pagetable,
1466 int fd, void *hostptr, size_t size)
1467{
1468 int ret;
1469 struct vm_area_struct *vma;
1470 struct file *filep, *vmfile;
1471 unsigned long len;
Jordan Crouse2c542b62011-07-26 08:30:20 -06001472 unsigned int hostaddr = (unsigned int) hostptr;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001473
Jordan Crouse2c542b62011-07-26 08:30:20 -06001474 vma = kgsl_get_vma_from_start_addr(hostaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001475 if (vma == NULL)
1476 return -EINVAL;
1477
Jordan Crouse2c542b62011-07-26 08:30:20 -06001478 if (vma->vm_pgoff || vma->vm_start != hostaddr) {
1479 KGSL_CORE_ERR("Invalid vma region\n");
1480 return -EINVAL;
1481 }
1482
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001483 len = vma->vm_end - vma->vm_start;
1484
1485 if (size == 0)
1486 size = len;
1487
1488 if (size != len) {
1489 KGSL_CORE_ERR("Invalid size %d for vma region %p\n",
1490 size, hostptr);
1491 return -EINVAL;
1492 }
1493
1494 ret = get_ashmem_file(fd, &filep, &vmfile, &len);
1495
1496 if (ret) {
1497 KGSL_CORE_ERR("get_ashmem_file failed\n");
1498 return ret;
1499 }
1500
1501 if (vmfile != vma->vm_file) {
1502 KGSL_CORE_ERR("ashmem shmem file does not match vma\n");
1503 ret = -EINVAL;
1504 goto err;
1505 }
1506
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001507 entry->priv_data = filep;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001508 entry->memdesc.pagetable = pagetable;
1509 entry->memdesc.size = ALIGN(size, PAGE_SIZE);
1510 entry->memdesc.hostptr = hostptr;
Jordan Croused17e9aa2011-10-12 16:57:48 -06001511
1512 ret = memdesc_sg_virt(&entry->memdesc, hostptr, size);
1513 if (ret)
1514 goto err;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001515
1516 return 0;
1517
1518err:
1519 put_ashmem_file(filep);
1520 return ret;
1521}
1522#else
1523static int kgsl_setup_ashmem(struct kgsl_mem_entry *entry,
1524 struct kgsl_pagetable *pagetable,
1525 int fd, void *hostptr, size_t size)
1526{
1527 return -EINVAL;
1528}
1529#endif
1530
Jordan Crouse8eab35a2011-10-12 16:57:48 -06001531static int kgsl_setup_ion(struct kgsl_mem_entry *entry,
1532 struct kgsl_pagetable *pagetable, int fd)
1533{
1534 struct ion_handle *handle;
1535 struct scatterlist *s;
1536 unsigned long flags;
1537
1538 if (kgsl_ion_client == NULL) {
1539 kgsl_ion_client = msm_ion_client_create(UINT_MAX, KGSL_NAME);
1540 if (kgsl_ion_client == NULL)
1541 return -ENODEV;
1542 }
1543
1544 handle = ion_import_fd(kgsl_ion_client, fd);
1545 if (IS_ERR_OR_NULL(handle))
1546 return PTR_ERR(handle);
1547
1548 entry->memtype = KGSL_MEM_ENTRY_ION;
1549 entry->priv_data = handle;
1550 entry->memdesc.pagetable = pagetable;
1551 entry->memdesc.size = 0;
1552
1553 if (ion_handle_get_flags(kgsl_ion_client, handle, &flags))
1554 goto err;
1555
1556 entry->memdesc.sg = ion_map_dma(kgsl_ion_client, handle, flags);
1557
1558 if (IS_ERR_OR_NULL(entry->memdesc.sg))
1559 goto err;
1560
1561 /* Calculate the size of the memdesc from the sglist */
1562
1563 entry->memdesc.sglen = 0;
1564
1565 for (s = entry->memdesc.sg; s != NULL; s = sg_next(s)) {
1566 entry->memdesc.size += s->length;
1567 entry->memdesc.sglen++;
1568 }
1569
1570 return 0;
1571err:
1572 ion_free(kgsl_ion_client, handle);
1573 return -ENOMEM;
1574}
1575
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001576static long kgsl_ioctl_map_user_mem(struct kgsl_device_private *dev_priv,
1577 unsigned int cmd, void *data)
1578{
1579 int result = -EINVAL;
1580 struct kgsl_map_user_mem *param = data;
1581 struct kgsl_mem_entry *entry = NULL;
1582 struct kgsl_process_private *private = dev_priv->process_priv;
Jason848741a2011-07-12 10:24:25 -07001583 enum kgsl_user_mem_type memtype;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001584
1585 entry = kgsl_mem_entry_create();
1586
1587 if (entry == NULL)
1588 return -ENOMEM;
1589
Jason848741a2011-07-12 10:24:25 -07001590 if (_IOC_SIZE(cmd) == sizeof(struct kgsl_sharedmem_from_pmem))
1591 memtype = KGSL_USER_MEM_TYPE_PMEM;
1592 else
1593 memtype = param->memtype;
1594
1595 switch (memtype) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001596 case KGSL_USER_MEM_TYPE_PMEM:
1597 if (param->fd == 0 || param->len == 0)
1598 break;
1599
1600 result = kgsl_setup_phys_file(entry, private->pagetable,
1601 param->fd, param->offset,
1602 param->len);
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001603 entry->memtype = KGSL_MEM_ENTRY_PMEM;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001604 break;
1605
1606 case KGSL_USER_MEM_TYPE_ADDR:
1607 if (!kgsl_mmu_enabled()) {
1608 KGSL_DRV_ERR(dev_priv->device,
1609 "Cannot map paged memory with the "
1610 "MMU disabled\n");
1611 break;
1612 }
1613
1614 if (param->hostptr == 0)
1615 break;
1616
1617 result = kgsl_setup_hostptr(entry, private->pagetable,
1618 (void *) param->hostptr,
1619 param->offset, param->len);
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001620 entry->memtype = KGSL_MEM_ENTRY_USER;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001621 break;
1622
1623 case KGSL_USER_MEM_TYPE_ASHMEM:
1624 if (!kgsl_mmu_enabled()) {
1625 KGSL_DRV_ERR(dev_priv->device,
1626 "Cannot map paged memory with the "
1627 "MMU disabled\n");
1628 break;
1629 }
1630
1631 if (param->hostptr == 0)
1632 break;
1633
1634 result = kgsl_setup_ashmem(entry, private->pagetable,
1635 param->fd, (void *) param->hostptr,
1636 param->len);
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001637
1638 entry->memtype = KGSL_MEM_ENTRY_ASHMEM;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001639 break;
Jordan Crouse8eab35a2011-10-12 16:57:48 -06001640 case KGSL_USER_MEM_TYPE_ION:
1641 result = kgsl_setup_ion(entry, private->pagetable,
1642 param->fd);
1643 break;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001644 default:
Jason848741a2011-07-12 10:24:25 -07001645 KGSL_CORE_ERR("Invalid memory type: %x\n", memtype);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001646 break;
1647 }
1648
1649 if (result)
1650 goto error;
1651
1652 result = kgsl_mmu_map(private->pagetable,
1653 &entry->memdesc,
1654 GSL_PT_PAGE_RV | GSL_PT_PAGE_WV);
1655
1656 if (result)
1657 goto error_put_file_ptr;
1658
1659 /* Adjust the returned value for a non 4k aligned offset */
1660 param->gpuaddr = entry->memdesc.gpuaddr + (param->offset & ~PAGE_MASK);
1661
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001662 KGSL_STATS_ADD(param->len, kgsl_driver.stats.mapped,
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001663 kgsl_driver.stats.mapped_max);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001664
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001665 kgsl_process_add_stats(private, entry->memtype, param->len);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001666
1667 kgsl_mem_entry_attach_process(entry, private);
Jeremy Gebbena5859272012-03-01 12:46:28 -07001668 trace_kgsl_mem_map(entry, param->fd);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001669
1670 kgsl_check_idle(dev_priv->device);
1671 return result;
1672
1673 error_put_file_ptr:
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001674 if (entry->priv_data)
1675 fput(entry->priv_data);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001676
1677error:
1678 kfree(entry);
1679 kgsl_check_idle(dev_priv->device);
1680 return result;
1681}
1682
1683/*This function flushes a graphics memory allocation from CPU cache
1684 *when caching is enabled with MMU*/
1685static long
1686kgsl_ioctl_sharedmem_flush_cache(struct kgsl_device_private *dev_priv,
1687 unsigned int cmd, void *data)
1688{
1689 int result = 0;
1690 struct kgsl_mem_entry *entry;
1691 struct kgsl_sharedmem_free *param = data;
1692 struct kgsl_process_private *private = dev_priv->process_priv;
1693
1694 spin_lock(&private->mem_lock);
1695 entry = kgsl_sharedmem_find(private, param->gpuaddr);
1696 if (!entry) {
1697 KGSL_CORE_ERR("invalid gpuaddr %08x\n", param->gpuaddr);
1698 result = -EINVAL;
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001699 goto done;
1700 }
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001701 if (!entry->memdesc.hostptr) {
1702 KGSL_CORE_ERR("invalid hostptr with gpuaddr %08x\n",
1703 param->gpuaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001704 goto done;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001705 }
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001706
1707 kgsl_cache_range_op(&entry->memdesc, KGSL_CACHE_OP_CLEAN);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001708done:
Jeremy Gebben690f9d12011-08-08 16:33:49 -06001709 spin_unlock(&private->mem_lock);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001710 return result;
1711}
1712
1713static long
1714kgsl_ioctl_gpumem_alloc(struct kgsl_device_private *dev_priv,
1715 unsigned int cmd, void *data)
1716{
1717 struct kgsl_process_private *private = dev_priv->process_priv;
1718 struct kgsl_gpumem_alloc *param = data;
1719 struct kgsl_mem_entry *entry;
1720 int result;
1721
1722 entry = kgsl_mem_entry_create();
1723 if (entry == NULL)
1724 return -ENOMEM;
1725
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001726 result = kgsl_allocate_user(&entry->memdesc, private->pagetable,
1727 param->size, param->flags);
1728
1729 if (result == 0) {
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001730 entry->memtype = KGSL_MEM_ENTRY_KERNEL;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001731 kgsl_mem_entry_attach_process(entry, private);
1732 param->gpuaddr = entry->memdesc.gpuaddr;
1733
Jordan Crouse1b897cf2011-10-12 16:57:48 -06001734 kgsl_process_add_stats(private, entry->memtype, param->size);
Jeremy Gebbena5859272012-03-01 12:46:28 -07001735 trace_kgsl_mem_alloc(entry);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001736 } else
1737 kfree(entry);
1738
1739 kgsl_check_idle(dev_priv->device);
1740 return result;
1741}
Jeremy Gebbena7423e42011-04-18 15:11:21 -06001742static long kgsl_ioctl_cff_syncmem(struct kgsl_device_private *dev_priv,
1743 unsigned int cmd, void *data)
1744{
1745 int result = 0;
1746 struct kgsl_cff_syncmem *param = data;
1747 struct kgsl_process_private *private = dev_priv->process_priv;
1748 struct kgsl_mem_entry *entry = NULL;
1749
1750 spin_lock(&private->mem_lock);
1751 entry = kgsl_sharedmem_find_region(private, param->gpuaddr, param->len);
1752 if (entry)
1753 kgsl_cffdump_syncmem(dev_priv, &entry->memdesc, param->gpuaddr,
1754 param->len, true);
1755 else
1756 result = -EINVAL;
1757 spin_unlock(&private->mem_lock);
1758 return result;
1759}
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001760
Sushmita Susheelendra41f8fa32011-05-11 17:15:58 -06001761static long kgsl_ioctl_cff_user_event(struct kgsl_device_private *dev_priv,
1762 unsigned int cmd, void *data)
1763{
1764 int result = 0;
1765 struct kgsl_cff_user_event *param = data;
1766
1767 kgsl_cffdump_user_event(param->cff_opcode, param->op1, param->op2,
1768 param->op3, param->op4, param->op5);
1769
1770 return result;
1771}
1772
Jordan Croused4bc9d22011-11-17 13:39:21 -07001773#ifdef CONFIG_GENLOCK
1774struct kgsl_genlock_event_priv {
1775 struct genlock_handle *handle;
1776 struct genlock *lock;
1777};
1778
1779/**
1780 * kgsl_genlock_event_cb - Event callback for a genlock timestamp event
1781 * @device - The KGSL device that expired the timestamp
1782 * @priv - private data for the event
1783 * @timestamp - the timestamp that triggered the event
1784 *
1785 * Release a genlock lock following the expiration of a timestamp
1786 */
1787
1788static void kgsl_genlock_event_cb(struct kgsl_device *device,
1789 void *priv, u32 timestamp)
1790{
1791 struct kgsl_genlock_event_priv *ev = priv;
1792 int ret;
1793
1794 ret = genlock_lock(ev->handle, GENLOCK_UNLOCK, 0, 0);
1795 if (ret)
1796 KGSL_CORE_ERR("Error while unlocking genlock: %d\n", ret);
1797
1798 genlock_put_handle(ev->handle);
1799
1800 kfree(ev);
1801}
1802
1803/**
1804 * kgsl_add_genlock-event - Create a new genlock event
1805 * @device - KGSL device to create the event on
1806 * @timestamp - Timestamp to trigger the event
1807 * @data - User space buffer containing struct kgsl_genlock_event_priv
1808 * @len - length of the userspace buffer
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -07001809 * @owner - driver instance that owns this event
Jordan Croused4bc9d22011-11-17 13:39:21 -07001810 * @returns 0 on success or error code on error
1811 *
1812 * Attack to a genlock handle and register an event to release the
1813 * genlock lock when the timestamp expires
1814 */
1815
1816static int kgsl_add_genlock_event(struct kgsl_device *device,
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -07001817 u32 timestamp, void __user *data, int len,
1818 struct kgsl_device_private *owner)
Jordan Croused4bc9d22011-11-17 13:39:21 -07001819{
1820 struct kgsl_genlock_event_priv *event;
1821 struct kgsl_timestamp_event_genlock priv;
1822 int ret;
1823
1824 if (len != sizeof(priv))
1825 return -EINVAL;
1826
1827 if (copy_from_user(&priv, data, sizeof(priv)))
1828 return -EFAULT;
1829
1830 event = kzalloc(sizeof(*event), GFP_KERNEL);
1831
1832 if (event == NULL)
1833 return -ENOMEM;
1834
1835 event->handle = genlock_get_handle_fd(priv.handle);
1836
1837 if (IS_ERR(event->handle)) {
1838 int ret = PTR_ERR(event->handle);
1839 kfree(event);
1840 return ret;
1841 }
1842
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -07001843 ret = kgsl_add_event(device, timestamp, kgsl_genlock_event_cb, event,
1844 owner);
Jordan Croused4bc9d22011-11-17 13:39:21 -07001845 if (ret)
1846 kfree(event);
1847
1848 return ret;
1849}
1850#else
1851static long kgsl_add_genlock_event(struct kgsl_device *device,
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -07001852 u32 timestamp, void __user *data, int len,
1853 struct kgsl_device_private *owner)
Jordan Croused4bc9d22011-11-17 13:39:21 -07001854{
1855 return -EINVAL;
1856}
1857#endif
1858
1859/**
1860 * kgsl_ioctl_timestamp_event - Register a new timestamp event from userspace
1861 * @dev_priv - pointer to the private device structure
1862 * @cmd - the ioctl cmd passed from kgsl_ioctl
1863 * @data - the user data buffer from kgsl_ioctl
1864 * @returns 0 on success or error code on failure
1865 */
1866
1867static long kgsl_ioctl_timestamp_event(struct kgsl_device_private *dev_priv,
1868 unsigned int cmd, void *data)
1869{
1870 struct kgsl_timestamp_event *param = data;
1871 int ret;
1872
1873 switch (param->type) {
1874 case KGSL_TIMESTAMP_EVENT_GENLOCK:
1875 ret = kgsl_add_genlock_event(dev_priv->device,
Jeremy Gebbenfd87f9a2012-02-10 07:06:09 -07001876 param->timestamp, param->priv, param->len,
1877 dev_priv);
Jordan Croused4bc9d22011-11-17 13:39:21 -07001878 break;
1879 default:
1880 ret = -EINVAL;
1881 }
1882
1883 return ret;
1884}
1885
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001886typedef long (*kgsl_ioctl_func_t)(struct kgsl_device_private *,
1887 unsigned int, void *);
1888
1889#define KGSL_IOCTL_FUNC(_cmd, _func, _lock) \
1890 [_IOC_NR(_cmd)] = { .cmd = _cmd, .func = _func, .lock = _lock }
1891
1892static const struct {
1893 unsigned int cmd;
1894 kgsl_ioctl_func_t func;
1895 int lock;
1896} kgsl_ioctl_funcs[] = {
1897 KGSL_IOCTL_FUNC(IOCTL_KGSL_DEVICE_GETPROPERTY,
1898 kgsl_ioctl_device_getproperty, 1),
1899 KGSL_IOCTL_FUNC(IOCTL_KGSL_DEVICE_WAITTIMESTAMP,
1900 kgsl_ioctl_device_waittimestamp, 1),
1901 KGSL_IOCTL_FUNC(IOCTL_KGSL_RINGBUFFER_ISSUEIBCMDS,
1902 kgsl_ioctl_rb_issueibcmds, 1),
1903 KGSL_IOCTL_FUNC(IOCTL_KGSL_CMDSTREAM_READTIMESTAMP,
1904 kgsl_ioctl_cmdstream_readtimestamp, 1),
1905 KGSL_IOCTL_FUNC(IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP,
1906 kgsl_ioctl_cmdstream_freememontimestamp, 1),
1907 KGSL_IOCTL_FUNC(IOCTL_KGSL_DRAWCTXT_CREATE,
1908 kgsl_ioctl_drawctxt_create, 1),
1909 KGSL_IOCTL_FUNC(IOCTL_KGSL_DRAWCTXT_DESTROY,
1910 kgsl_ioctl_drawctxt_destroy, 1),
1911 KGSL_IOCTL_FUNC(IOCTL_KGSL_MAP_USER_MEM,
1912 kgsl_ioctl_map_user_mem, 0),
1913 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FROM_PMEM,
1914 kgsl_ioctl_map_user_mem, 0),
1915 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FREE,
1916 kgsl_ioctl_sharedmem_free, 0),
1917 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FROM_VMALLOC,
1918 kgsl_ioctl_sharedmem_from_vmalloc, 0),
1919 KGSL_IOCTL_FUNC(IOCTL_KGSL_SHAREDMEM_FLUSH_CACHE,
1920 kgsl_ioctl_sharedmem_flush_cache, 0),
1921 KGSL_IOCTL_FUNC(IOCTL_KGSL_GPUMEM_ALLOC,
1922 kgsl_ioctl_gpumem_alloc, 0),
Jeremy Gebbena7423e42011-04-18 15:11:21 -06001923 KGSL_IOCTL_FUNC(IOCTL_KGSL_CFF_SYNCMEM,
1924 kgsl_ioctl_cff_syncmem, 0),
Sushmita Susheelendra41f8fa32011-05-11 17:15:58 -06001925 KGSL_IOCTL_FUNC(IOCTL_KGSL_CFF_USER_EVENT,
1926 kgsl_ioctl_cff_user_event, 0),
Jordan Croused4bc9d22011-11-17 13:39:21 -07001927 KGSL_IOCTL_FUNC(IOCTL_KGSL_TIMESTAMP_EVENT,
Lucille Sylvester9329cf02011-12-02 14:30:41 -07001928 kgsl_ioctl_timestamp_event, 1),
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001929};
1930
1931static long kgsl_ioctl(struct file *filep, unsigned int cmd, unsigned long arg)
1932{
1933 struct kgsl_device_private *dev_priv = filep->private_data;
1934 unsigned int nr = _IOC_NR(cmd);
1935 kgsl_ioctl_func_t func;
1936 int lock, ret;
1937 char ustack[64];
1938 void *uptr = NULL;
1939
1940 BUG_ON(dev_priv == NULL);
1941
1942 /* Workaround for an previously incorrectly defined ioctl code.
1943 This helps ensure binary compatability */
1944
1945 if (cmd == IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP_OLD)
1946 cmd = IOCTL_KGSL_CMDSTREAM_FREEMEMONTIMESTAMP;
Jason Varbedian80ba33d2011-07-11 17:29:05 -07001947 else if (cmd == IOCTL_KGSL_CMDSTREAM_READTIMESTAMP_OLD)
1948 cmd = IOCTL_KGSL_CMDSTREAM_READTIMESTAMP;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001949
1950 if (cmd & (IOC_IN | IOC_OUT)) {
1951 if (_IOC_SIZE(cmd) < sizeof(ustack))
1952 uptr = ustack;
1953 else {
1954 uptr = kzalloc(_IOC_SIZE(cmd), GFP_KERNEL);
1955 if (uptr == NULL) {
1956 KGSL_MEM_ERR(dev_priv->device,
1957 "kzalloc(%d) failed\n", _IOC_SIZE(cmd));
1958 ret = -ENOMEM;
1959 goto done;
1960 }
1961 }
1962
1963 if (cmd & IOC_IN) {
1964 if (copy_from_user(uptr, (void __user *) arg,
1965 _IOC_SIZE(cmd))) {
1966 ret = -EFAULT;
1967 goto done;
1968 }
1969 } else
1970 memset(uptr, 0, _IOC_SIZE(cmd));
1971 }
1972
1973 if (nr < ARRAY_SIZE(kgsl_ioctl_funcs) &&
1974 kgsl_ioctl_funcs[nr].func != NULL) {
1975 func = kgsl_ioctl_funcs[nr].func;
1976 lock = kgsl_ioctl_funcs[nr].lock;
1977 } else {
1978 func = dev_priv->device->ftbl->ioctl;
1979 if (!func) {
1980 KGSL_DRV_INFO(dev_priv->device,
1981 "invalid ioctl code %08x\n", cmd);
Jeremy Gebbenc15b4612012-01-09 09:44:11 -07001982 ret = -ENOIOCTLCMD;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001983 goto done;
1984 }
1985 lock = 1;
1986 }
1987
1988 if (lock) {
1989 mutex_lock(&dev_priv->device->mutex);
1990 kgsl_check_suspended(dev_priv->device);
1991 }
1992
1993 ret = func(dev_priv, cmd, uptr);
1994
1995 if (lock) {
1996 kgsl_check_idle_locked(dev_priv->device);
1997 mutex_unlock(&dev_priv->device->mutex);
1998 }
1999
2000 if (ret == 0 && (cmd & IOC_OUT)) {
2001 if (copy_to_user((void __user *) arg, uptr, _IOC_SIZE(cmd)))
2002 ret = -EFAULT;
2003 }
2004
2005done:
2006 if (_IOC_SIZE(cmd) >= sizeof(ustack))
2007 kfree(uptr);
2008
2009 return ret;
2010}
2011
2012static int
2013kgsl_mmap_memstore(struct kgsl_device *device, struct vm_area_struct *vma)
2014{
2015 struct kgsl_memdesc *memdesc = &device->memstore;
2016 int result;
2017 unsigned int vma_size = vma->vm_end - vma->vm_start;
2018
2019 /* The memstore can only be mapped as read only */
2020
2021 if (vma->vm_flags & VM_WRITE)
2022 return -EPERM;
2023
2024 if (memdesc->size != vma_size) {
2025 KGSL_MEM_ERR(device, "memstore bad size: %d should be %d\n",
2026 vma_size, memdesc->size);
2027 return -EINVAL;
2028 }
2029
2030 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
2031
2032 result = remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff,
2033 vma_size, vma->vm_page_prot);
2034 if (result != 0)
2035 KGSL_MEM_ERR(device, "remap_pfn_range failed: %d\n",
2036 result);
2037
2038 return result;
2039}
2040
Jordan Crouse4283e172011-09-26 14:45:47 -06002041/*
2042 * kgsl_gpumem_vm_open is called whenever a vma region is copied or split.
2043 * Increase the refcount to make sure that the accounting stays correct
2044 */
2045
2046static void kgsl_gpumem_vm_open(struct vm_area_struct *vma)
2047{
2048 struct kgsl_mem_entry *entry = vma->vm_private_data;
2049 kgsl_mem_entry_get(entry);
2050}
2051
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002052static int
2053kgsl_gpumem_vm_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
2054{
2055 struct kgsl_mem_entry *entry = vma->vm_private_data;
2056
Jordan Croused17e9aa2011-10-12 16:57:48 -06002057 if (!entry->memdesc.ops || !entry->memdesc.ops->vmfault)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002058 return VM_FAULT_SIGBUS;
2059
2060 return entry->memdesc.ops->vmfault(&entry->memdesc, vma, vmf);
2061}
2062
2063static void
2064kgsl_gpumem_vm_close(struct vm_area_struct *vma)
2065{
2066 struct kgsl_mem_entry *entry = vma->vm_private_data;
2067 kgsl_mem_entry_put(entry);
2068}
2069
2070static struct vm_operations_struct kgsl_gpumem_vm_ops = {
Jordan Crouse4283e172011-09-26 14:45:47 -06002071 .open = kgsl_gpumem_vm_open,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002072 .fault = kgsl_gpumem_vm_fault,
2073 .close = kgsl_gpumem_vm_close,
2074};
2075
2076static int kgsl_mmap(struct file *file, struct vm_area_struct *vma)
2077{
2078 unsigned long vma_offset = vma->vm_pgoff << PAGE_SHIFT;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002079 struct kgsl_device_private *dev_priv = file->private_data;
2080 struct kgsl_process_private *private = dev_priv->process_priv;
Jordan Crouse976cf0e2011-09-12 10:41:49 -06002081 struct kgsl_mem_entry *tmp, *entry = NULL;
Jordan Crouse2db0af92011-08-08 16:05:09 -06002082 struct kgsl_device *device = dev_priv->device;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002083
2084 /* Handle leagacy behavior for memstore */
2085
2086 if (vma_offset == device->memstore.physaddr)
2087 return kgsl_mmap_memstore(device, vma);
2088
2089 /* Find a chunk of GPU memory */
2090
2091 spin_lock(&private->mem_lock);
Jordan Crouse976cf0e2011-09-12 10:41:49 -06002092 list_for_each_entry(tmp, &private->mem_list, list) {
2093 if (vma_offset == tmp->memdesc.gpuaddr) {
2094 kgsl_mem_entry_get(tmp);
2095 entry = tmp;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002096 break;
2097 }
2098 }
2099 spin_unlock(&private->mem_lock);
2100
2101 if (entry == NULL)
2102 return -EINVAL;
2103
Jordan Croused17e9aa2011-10-12 16:57:48 -06002104 if (!entry->memdesc.ops ||
2105 !entry->memdesc.ops->vmflags ||
2106 !entry->memdesc.ops->vmfault)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002107 return -EINVAL;
2108
2109 vma->vm_flags |= entry->memdesc.ops->vmflags(&entry->memdesc);
2110
2111 vma->vm_private_data = entry;
2112 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
2113 vma->vm_ops = &kgsl_gpumem_vm_ops;
2114 vma->vm_file = file;
2115
2116 return 0;
2117}
2118
2119static const struct file_operations kgsl_fops = {
2120 .owner = THIS_MODULE,
2121 .release = kgsl_release,
2122 .open = kgsl_open,
2123 .mmap = kgsl_mmap,
2124 .unlocked_ioctl = kgsl_ioctl,
2125};
2126
2127struct kgsl_driver kgsl_driver = {
2128 .process_mutex = __MUTEX_INITIALIZER(kgsl_driver.process_mutex),
2129 .ptlock = __SPIN_LOCK_UNLOCKED(kgsl_driver.ptlock),
2130 .devlock = __MUTEX_INITIALIZER(kgsl_driver.devlock),
2131};
2132EXPORT_SYMBOL(kgsl_driver);
2133
2134void kgsl_unregister_device(struct kgsl_device *device)
2135{
2136 int minor;
2137
2138 mutex_lock(&kgsl_driver.devlock);
2139 for (minor = 0; minor < KGSL_DEVICE_MAX; minor++) {
2140 if (device == kgsl_driver.devp[minor])
2141 break;
2142 }
2143
2144 mutex_unlock(&kgsl_driver.devlock);
2145
2146 if (minor == KGSL_DEVICE_MAX)
2147 return;
2148
Jordan Crouse156cfbc2012-01-24 09:32:04 -07002149 kgsl_device_snapshot_close(device);
2150
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002151 kgsl_cffdump_close(device->id);
2152 kgsl_pwrctrl_uninit_sysfs(device);
2153
Lucille Sylvester10297892012-02-27 13:54:47 -07002154 wake_lock_destroy(&device->idle_wakelock);
2155 pm_qos_remove_request(&device->pm_qos_req_dma);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002156
2157 idr_destroy(&device->context_idr);
2158
2159 if (device->memstore.hostptr)
2160 kgsl_sharedmem_free(&device->memstore);
2161
2162 kgsl_mmu_close(device);
2163
2164 if (device->work_queue) {
2165 destroy_workqueue(device->work_queue);
2166 device->work_queue = NULL;
2167 }
2168
2169 device_destroy(kgsl_driver.class,
2170 MKDEV(MAJOR(kgsl_driver.major), minor));
2171
2172 mutex_lock(&kgsl_driver.devlock);
2173 kgsl_driver.devp[minor] = NULL;
2174 mutex_unlock(&kgsl_driver.devlock);
2175}
2176EXPORT_SYMBOL(kgsl_unregister_device);
2177
2178int
2179kgsl_register_device(struct kgsl_device *device)
2180{
2181 int minor, ret;
2182 dev_t dev;
2183
2184 /* Find a minor for the device */
2185
2186 mutex_lock(&kgsl_driver.devlock);
2187 for (minor = 0; minor < KGSL_DEVICE_MAX; minor++) {
2188 if (kgsl_driver.devp[minor] == NULL) {
2189 kgsl_driver.devp[minor] = device;
2190 break;
2191 }
2192 }
2193
2194 mutex_unlock(&kgsl_driver.devlock);
2195
2196 if (minor == KGSL_DEVICE_MAX) {
2197 KGSL_CORE_ERR("minor devices exhausted\n");
2198 return -ENODEV;
2199 }
2200
2201 /* Create the device */
2202 dev = MKDEV(MAJOR(kgsl_driver.major), minor);
2203 device->dev = device_create(kgsl_driver.class,
2204 device->parentdev,
2205 dev, device,
2206 device->name);
2207
2208 if (IS_ERR(device->dev)) {
2209 ret = PTR_ERR(device->dev);
2210 KGSL_CORE_ERR("device_create(%s): %d\n", device->name, ret);
2211 goto err_devlist;
2212 }
2213
2214 dev_set_drvdata(device->parentdev, device);
2215
2216 /* Generic device initialization */
2217 init_waitqueue_head(&device->wait_queue);
2218
2219 kgsl_cffdump_open(device->id);
2220
2221 init_completion(&device->hwaccess_gate);
2222 init_completion(&device->suspend_gate);
2223
2224 ATOMIC_INIT_NOTIFIER_HEAD(&device->ts_notifier_list);
2225
2226 setup_timer(&device->idle_timer, kgsl_timer, (unsigned long) device);
2227 ret = kgsl_create_device_workqueue(device);
2228 if (ret)
2229 goto err_devlist;
2230
2231 INIT_WORK(&device->idle_check_ws, kgsl_idle_check);
Jordan Crouse1bf80aa2011-10-12 16:57:47 -06002232 INIT_WORK(&device->ts_expired_ws, kgsl_timestamp_expired);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002233
Jordan Croused4bc9d22011-11-17 13:39:21 -07002234 INIT_LIST_HEAD(&device->events);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002235
2236 ret = kgsl_mmu_init(device);
2237 if (ret != 0)
2238 goto err_dest_work_q;
2239
2240 ret = kgsl_allocate_contiguous(&device->memstore,
2241 sizeof(struct kgsl_devmemstore));
2242
2243 if (ret != 0)
2244 goto err_close_mmu;
2245
Lucille Sylvester10297892012-02-27 13:54:47 -07002246 wake_lock_init(&device->idle_wakelock, WAKE_LOCK_IDLE, device->name);
2247 pm_qos_add_request(&device->pm_qos_req_dma, PM_QOS_CPU_DMA_LATENCY,
2248 PM_QOS_DEFAULT_VALUE);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002249
2250 idr_init(&device->context_idr);
2251
Jordan Crouse156cfbc2012-01-24 09:32:04 -07002252 /* Initalize the snapshot engine */
2253 kgsl_device_snapshot_init(device);
2254
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002255 /* sysfs and debugfs initalization - failure here is non fatal */
2256
2257 /* Initialize logging */
2258 kgsl_device_debugfs_init(device);
2259
2260 /* Initialize common sysfs entries */
2261 kgsl_pwrctrl_init_sysfs(device);
2262
2263 return 0;
2264
2265err_close_mmu:
2266 kgsl_mmu_close(device);
2267err_dest_work_q:
2268 destroy_workqueue(device->work_queue);
2269 device->work_queue = NULL;
2270err_devlist:
2271 mutex_lock(&kgsl_driver.devlock);
2272 kgsl_driver.devp[minor] = NULL;
2273 mutex_unlock(&kgsl_driver.devlock);
2274
2275 return ret;
2276}
2277EXPORT_SYMBOL(kgsl_register_device);
2278
2279int kgsl_device_platform_probe(struct kgsl_device *device,
2280 irqreturn_t (*dev_isr) (int, void*))
2281{
Michael Street8bacdd02012-01-05 14:55:01 -08002282 int result;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002283 int status = -EINVAL;
2284 struct kgsl_memregion *regspace = NULL;
2285 struct resource *res;
2286 struct platform_device *pdev =
2287 container_of(device->parentdev, struct platform_device, dev);
2288
2289 pm_runtime_enable(device->parentdev);
2290
2291 status = kgsl_pwrctrl_init(device);
2292 if (status)
2293 goto error;
2294
2295 res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
2296 device->iomemname);
2297 if (res == NULL) {
2298 KGSL_DRV_ERR(device, "platform_get_resource_byname failed\n");
2299 status = -EINVAL;
2300 goto error_pwrctrl_close;
2301 }
2302 if (res->start == 0 || resource_size(res) == 0) {
2303 KGSL_DRV_ERR(device, "dev %d invalid regspace\n", device->id);
2304 status = -EINVAL;
2305 goto error_pwrctrl_close;
2306 }
2307
2308 regspace = &device->regspace;
2309 regspace->mmio_phys_base = res->start;
2310 regspace->sizebytes = resource_size(res);
2311
2312 if (!request_mem_region(regspace->mmio_phys_base,
2313 regspace->sizebytes, device->name)) {
2314 KGSL_DRV_ERR(device, "request_mem_region failed\n");
2315 status = -ENODEV;
2316 goto error_pwrctrl_close;
2317 }
2318
2319 regspace->mmio_virt_base = ioremap(regspace->mmio_phys_base,
2320 regspace->sizebytes);
2321
2322 if (regspace->mmio_virt_base == NULL) {
2323 KGSL_DRV_ERR(device, "ioremap failed\n");
2324 status = -ENODEV;
2325 goto error_release_mem;
2326 }
2327
2328 status = request_irq(device->pwrctrl.interrupt_num, dev_isr,
2329 IRQF_TRIGGER_HIGH, device->name, device);
2330 if (status) {
2331 KGSL_DRV_ERR(device, "request_irq(%d) failed: %d\n",
2332 device->pwrctrl.interrupt_num, status);
2333 goto error_iounmap;
2334 }
2335 device->pwrctrl.have_irq = 1;
2336 disable_irq(device->pwrctrl.interrupt_num);
2337
2338 KGSL_DRV_INFO(device,
2339 "dev_id %d regs phys 0x%08x size 0x%08x virt %p\n",
2340 device->id, regspace->mmio_phys_base,
2341 regspace->sizebytes, regspace->mmio_virt_base);
2342
Michael Street8bacdd02012-01-05 14:55:01 -08002343 result = kgsl_drm_init(pdev);
2344 if (result)
2345 goto error_iounmap;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002346
2347 status = kgsl_register_device(device);
2348 if (!status)
2349 return status;
2350
2351 free_irq(device->pwrctrl.interrupt_num, NULL);
2352 device->pwrctrl.have_irq = 0;
2353error_iounmap:
2354 iounmap(regspace->mmio_virt_base);
2355 regspace->mmio_virt_base = NULL;
2356error_release_mem:
2357 release_mem_region(regspace->mmio_phys_base, regspace->sizebytes);
2358error_pwrctrl_close:
2359 kgsl_pwrctrl_close(device);
2360error:
2361 return status;
2362}
2363EXPORT_SYMBOL(kgsl_device_platform_probe);
2364
2365void kgsl_device_platform_remove(struct kgsl_device *device)
2366{
2367 struct kgsl_memregion *regspace = &device->regspace;
2368
2369 kgsl_unregister_device(device);
2370
2371 if (regspace->mmio_virt_base != NULL) {
2372 iounmap(regspace->mmio_virt_base);
2373 regspace->mmio_virt_base = NULL;
2374 release_mem_region(regspace->mmio_phys_base,
2375 regspace->sizebytes);
2376 }
2377 kgsl_pwrctrl_close(device);
2378
2379 pm_runtime_disable(device->parentdev);
2380}
2381EXPORT_SYMBOL(kgsl_device_platform_remove);
2382
2383static int __devinit
2384kgsl_ptdata_init(void)
2385{
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002386 kgsl_driver.ptpool = kgsl_mmu_ptpool_init(KGSL_PAGETABLE_SIZE,
2387 kgsl_pagetable_count);
2388 if (!kgsl_driver.ptpool)
2389 return -ENOMEM;
2390 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002391}
2392
2393static void kgsl_core_exit(void)
2394{
2395 unregister_chrdev_region(kgsl_driver.major, KGSL_DEVICE_MAX);
2396
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002397 kgsl_mmu_ptpool_destroy(&kgsl_driver.ptpool);
2398 kgsl_driver.ptpool = NULL;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002399
2400 device_unregister(&kgsl_driver.virtdev);
2401
2402 if (kgsl_driver.class) {
2403 class_destroy(kgsl_driver.class);
2404 kgsl_driver.class = NULL;
2405 }
2406
2407 kgsl_drm_exit();
2408 kgsl_cffdump_destroy();
Jordan Croused8f1c6b2011-10-04 09:31:29 -06002409 kgsl_core_debugfs_close();
2410 kgsl_sharedmem_uninit_sysfs();
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002411}
2412
2413static int __init kgsl_core_init(void)
2414{
2415 int result = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002416 /* alloc major and minor device numbers */
2417 result = alloc_chrdev_region(&kgsl_driver.major, 0, KGSL_DEVICE_MAX,
2418 KGSL_NAME);
2419 if (result < 0) {
2420 KGSL_CORE_ERR("alloc_chrdev_region failed err = %d\n", result);
2421 goto err;
2422 }
2423
2424 cdev_init(&kgsl_driver.cdev, &kgsl_fops);
2425 kgsl_driver.cdev.owner = THIS_MODULE;
2426 kgsl_driver.cdev.ops = &kgsl_fops;
2427 result = cdev_add(&kgsl_driver.cdev, MKDEV(MAJOR(kgsl_driver.major), 0),
2428 KGSL_DEVICE_MAX);
2429
2430 if (result) {
2431 KGSL_CORE_ERR("kgsl: cdev_add() failed, dev_num= %d,"
2432 " result= %d\n", kgsl_driver.major, result);
2433 goto err;
2434 }
2435
2436 kgsl_driver.class = class_create(THIS_MODULE, KGSL_NAME);
2437
2438 if (IS_ERR(kgsl_driver.class)) {
2439 result = PTR_ERR(kgsl_driver.class);
2440 KGSL_CORE_ERR("failed to create class %s", KGSL_NAME);
2441 goto err;
2442 }
2443
2444 /* Make a virtual device for managing core related things
2445 in sysfs */
2446 kgsl_driver.virtdev.class = kgsl_driver.class;
2447 dev_set_name(&kgsl_driver.virtdev, "kgsl");
2448 result = device_register(&kgsl_driver.virtdev);
2449 if (result) {
2450 KGSL_CORE_ERR("driver_register failed\n");
2451 goto err;
2452 }
2453
2454 /* Make kobjects in the virtual device for storing statistics */
2455
2456 kgsl_driver.ptkobj =
2457 kobject_create_and_add("pagetables",
2458 &kgsl_driver.virtdev.kobj);
2459
2460 kgsl_driver.prockobj =
2461 kobject_create_and_add("proc",
2462 &kgsl_driver.virtdev.kobj);
2463
2464 kgsl_core_debugfs_init();
2465
2466 kgsl_sharedmem_init_sysfs();
2467 kgsl_cffdump_init();
2468
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002469 INIT_LIST_HEAD(&kgsl_driver.process_list);
2470
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06002471 INIT_LIST_HEAD(&kgsl_driver.pagetable_list);
2472
2473 kgsl_mmu_set_mmutype(ksgl_mmu_type);
2474
2475 if (KGSL_MMU_TYPE_GPU == kgsl_mmu_get_mmutype()) {
2476 result = kgsl_ptdata_init();
2477 if (result)
2478 goto err;
2479 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002480
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002481 return 0;
2482
2483err:
2484 kgsl_core_exit();
2485 return result;
2486}
2487
2488module_init(kgsl_core_init);
2489module_exit(kgsl_core_exit);
2490
2491MODULE_AUTHOR("Qualcomm Innovation Center, Inc.");
2492MODULE_DESCRIPTION("MSM GPU driver");
2493MODULE_LICENSE("GPL");