drivers/gpu/msm/kgsl_events.c - kernel/msm - Gitiles

 /* Copyright (c) 2011-2013, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
  * only version 2 as published by the Free Software Foundation.
  *
  * This program is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  * GNU General Public License for more details.
  *
  */

 #include <linux/slab.h>
 #include <linux/list.h>
 #include <linux/module.h>
 #include <kgsl_device.h>

 static void _add_event_to_list(struct list_head *head, struct kgsl_event *event)
 {
 	struct list_head *n;

 	for (n = head->next; n != head; n = n->next) {
 		struct kgsl_event *e =
 			list_entry(n, struct kgsl_event, list);

 		if (timestamp_cmp(e->timestamp, event->timestamp) > 0) {
 			list_add(&event->list, n->prev);
 			break;
 		}
 	}

 	if (n == head)
 		list_add_tail(&event->list, head);
 }

 /**
  * kgsl_add_event - Add a new timstamp event for the KGSL device
  * @device - KGSL device for the new event
  * @id - the context ID that the event should be added to
  * @ts - the timestamp to trigger the event on
  * @cb - callback function to call when the timestamp expires
  * @priv - private data for the specific event type
  * @owner - driver instance that owns this event
  *
  * @returns - 0 on success or error code on failure
  */
 int kgsl_add_event(struct kgsl_device *device, u32 id, u32 ts,
 	void (*cb)(struct kgsl_device *, void *, u32, u32), void *priv,
 	void *owner)
 {
 	struct kgsl_event *event;
 	unsigned int cur_ts;
 	struct kgsl_context *context = NULL;

 	if (cb == NULL)
 		return -EINVAL;

 	if (id != KGSL_MEMSTORE_GLOBAL) {
 		context = idr_find(&device->context_idr, id);
 		if (context == NULL)
 			return -EINVAL;
 	}
 	cur_ts = kgsl_readtimestamp(device, context, KGSL_TIMESTAMP_RETIRED);

 	/*
 	 * Check to see if the requested timestamp has already fired.  If it
 	 * did do the callback right away.  Make sure to send the timestamp that
 	 * the event expected instead of the current timestamp because sometimes
 	 * the event handlers can get confused.
 	 */

 	if (timestamp_cmp(cur_ts, ts) >= 0) {
 		cb(device, priv, id, ts);
 		return 0;
 	}

 	event = kzalloc(sizeof(*event), GFP_KERNEL);
 	if (event == NULL)
 		return -ENOMEM;

 	event->context = context;
 	event->timestamp = ts;
 	event->priv = priv;
 	event->func = cb;
 	event->owner = owner;

 	/* inc refcount to avoid race conditions in cleanup */
 	if (context)
 		kgsl_context_get(context);

 	/* Add the event to either the owning context or the global list */

 	if (context) {
 		_add_event_to_list(&context->events, event);

 		/*
 		 * Add it to the master list of contexts with pending events if
 		 * it isn't already there
 		 */

 		if (list_empty(&context->events_list))
 			list_add_tail(&context->events_list,
 				&device->events_pending_list);

 	} else
 		_add_event_to_list(&device->events, event);

 	queue_work(device->work_queue, &device->ts_expired_ws);
 	return 0;
 }
 EXPORT_SYMBOL(kgsl_add_event);

 /**
  * kgsl_cancel_events_ctxt - Cancel all events for a context
  * @device - KGSL device for the events to cancel
  * @context - context whose events we want to cancel
  *
  */
 void kgsl_cancel_events_ctxt(struct kgsl_device *device,
 	struct kgsl_context *context)
 {
 	struct kgsl_event *event, *event_tmp;
 	unsigned int id, cur;

 	cur = kgsl_readtimestamp(device, context, KGSL_TIMESTAMP_RETIRED);
 	id = context->id;

 	list_for_each_entry_safe(event, event_tmp, &context->events, list) {
 		/*
 		 * "cancel" the events by calling their callback.
 		 * Currently, events are used for lock and memory
 		 * management, so if the process is dying the right
 		 * thing to do is release or free.
 		 *
 		 * Send the current timestamp so the event knows how far the
 		 * system got before the event was canceled
 		 */

 		if (event->func)
 			event->func(device, event->priv, id, cur);

 		kgsl_context_put(context);
 		list_del(&event->list);
 		kfree(event);
 	}

 	/* Remove ourselves from the master pending list */
 	list_del_init(&context->events_list);
 }

 /**
  * kgsl_cancel_events - Cancel all generic events for a process
  * @device - KGSL device for the events to cancel
  * @owner - driver instance that owns the events to cancel
  *
  */
 void kgsl_cancel_events(struct kgsl_device *device,
 	void *owner)
 {
 	struct kgsl_event *event, *event_tmp;
 	unsigned int cur;

 	cur = kgsl_readtimestamp(device, NULL, KGSL_TIMESTAMP_RETIRED);

 	list_for_each_entry_safe(event, event_tmp, &device->events, list) {
 		if (event->owner != owner)
 			continue;

 		/*
 		 * "cancel" the events by calling their callback.
 		 * Currently, events are used for lock and memory
 		 * management, so if the process is dying the right
 		 * thing to do is release or free. Send the current timestamp so
 		 * the callback knows how far the GPU made it before things went
 		 * explosion
 		 */
 		if (event->func)
 			event->func(device, event->priv, KGSL_MEMSTORE_GLOBAL,
 				cur);

 		if (event->context)
 			kgsl_context_put(event->context);

 		list_del(&event->list);
 		kfree(event);
 	}
 }
 EXPORT_SYMBOL(kgsl_cancel_events);

 static void _process_event_list(struct kgsl_device *device,
 		struct list_head *head, unsigned int timestamp)
 {
 	struct kgsl_event *event, *tmp;
 	unsigned int id;

 	list_for_each_entry_safe(event, tmp, head, list) {
 		if (timestamp_cmp(timestamp, event->timestamp) < 0)
 			break;

 		id = event->context ? event->context->id : KGSL_MEMSTORE_GLOBAL;

 		/*
 		 * Send the timestamp of the expired event, not the current
 		 * timestamp.  This prevents the event handlers from getting
 		 * confused if they don't bother comparing the current timetamp
 		 * to the timestamp they wanted
 		 */

 		if (event->func)
 			event->func(device, event->priv, id, event->timestamp);

 		if (event->context)
 			kgsl_context_put(event->context);

 		list_del(&event->list);
 		kfree(event);
 	}
 }

 static inline int _mark_next_event(struct kgsl_device *device,
 		struct list_head *head)
 {
 	struct kgsl_event *event;

 	if (!list_empty(head)) {
 		event = list_first_entry(head, struct kgsl_event, list);

 		/*
 		 * Next event will return 0 if the event was marked or 1 if the
 		 * timestamp on the event has passed - return that up a layer
 		 */

 		return device->ftbl->next_event(device, event);
 	}

 	return 0;
 }

 static int kgsl_process_context_events(struct kgsl_device *device,
 		struct kgsl_context *context)
 {
 	while (1) {
 		unsigned int timestamp = kgsl_readtimestamp(device, context,
 			KGSL_TIMESTAMP_RETIRED);

 		_process_event_list(device, &context->events, timestamp);

 		/*
 		 * _mark_next event will return 1 as long as the next event
 		 * timestamp has expired - this is to cope with an unavoidable
 		 * race condition with the GPU that is still processing events.
 		 */

 		if (!_mark_next_event(device, &context->events))
 			break;
 	}

 	/*
 	 * Return 0 if the list is empty so the calling function can remove the
 	 * context from the pending list
 	 */

 	return list_empty(&context->events) ? 0 : 1;
 }

 void kgsl_process_events(struct work_struct *work)
 {
 	struct kgsl_device *device = container_of(work, struct kgsl_device,
 		ts_expired_ws);
 	struct kgsl_context *context, *tmp;
 	uint32_t timestamp;

 	mutex_lock(&device->mutex);

 	/* Process expired global events */
 	timestamp = kgsl_readtimestamp(device, NULL, KGSL_TIMESTAMP_RETIRED);
 	_process_event_list(device, &device->events, timestamp);
 	_mark_next_event(device, &device->events);

 	/* Now process all of the pending contexts */
 	list_for_each_entry_safe(context, tmp, &device->events_pending_list,
 		events_list) {

 		/*
 		 * If kgsl_timestamp_expired_context returns 0 then it no longer
 		 * has any pending events and can be removed from the list
 		 */

 		if (kgsl_process_context_events(device, context) == 0)
 			list_del_init(&context->events_list);
 	}

 	mutex_unlock(&device->mutex);
 }
 EXPORT_SYMBOL(kgsl_process_events);
	/* Copyright (c) 2011-2013, The Linux Foundation. All rights reserved.
	*
	* This program is free software; you can redistribute it and/or modify
	* it under the terms of the GNU General Public License version 2 and
	* only version 2 as published by the Free Software Foundation.
	*
	* This program is distributed in the hope that it will be useful,
	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	* GNU General Public License for more details.
	*
	*/

	#include <linux/slab.h>
	#include <linux/list.h>
	#include <linux/module.h>
	#include <kgsl_device.h>

	static void _add_event_to_list(struct list_head head, struct kgsl_event event)
	{
	struct list_head *n;

	for (n = head->next; n != head; n = n->next) {
	struct kgsl_event *e =
	list_entry(n, struct kgsl_event, list);

	if (timestamp_cmp(e->timestamp, event->timestamp) > 0) {
	list_add(&event->list, n->prev);
	break;
	}
	}

	if (n == head)
	list_add_tail(&event->list, head);
	}

	/**
	* kgsl_add_event - Add a new timstamp event for the KGSL device
	* @device - KGSL device for the new event
	* @id - the context ID that the event should be added to
	* @ts - the timestamp to trigger the event on
	* @cb - callback function to call when the timestamp expires
	* @priv - private data for the specific event type
	* @owner - driver instance that owns this event
	*
	* @returns - 0 on success or error code on failure
	*/
	int kgsl_add_event(struct kgsl_device *device, u32 id, u32 ts,
	void (cb)(struct kgsl_device , void , u32, u32), void priv,
	void *owner)
	{
	struct kgsl_event *event;
	unsigned int cur_ts;
	struct kgsl_context *context = NULL;

	if (cb == NULL)
	return -EINVAL;

	if (id != KGSL_MEMSTORE_GLOBAL) {
	context = idr_find(&device->context_idr, id);
	if (context == NULL)
	return -EINVAL;
	}
	cur_ts = kgsl_readtimestamp(device, context, KGSL_TIMESTAMP_RETIRED);

	/*
	* Check to see if the requested timestamp has already fired. If it
	* did do the callback right away. Make sure to send the timestamp that
	* the event expected instead of the current timestamp because sometimes
	* the event handlers can get confused.
	*/

	if (timestamp_cmp(cur_ts, ts) >= 0) {
	cb(device, priv, id, ts);
	return 0;
	}

	event = kzalloc(sizeof(*event), GFP_KERNEL);
	if (event == NULL)
	return -ENOMEM;

	event->context = context;
	event->timestamp = ts;
	event->priv = priv;
	event->func = cb;
	event->owner = owner;

	/* inc refcount to avoid race conditions in cleanup */
	if (context)
	kgsl_context_get(context);

	/* Add the event to either the owning context or the global list */

	if (context) {
	_add_event_to_list(&context->events, event);

	/*
	* Add it to the master list of contexts with pending events if
	* it isn't already there
	*/

	if (list_empty(&context->events_list))
	list_add_tail(&context->events_list,
	&device->events_pending_list);

	} else
	_add_event_to_list(&device->events, event);

	queue_work(device->work_queue, &device->ts_expired_ws);
	return 0;
	}
	EXPORT_SYMBOL(kgsl_add_event);

	/**
	* kgsl_cancel_events_ctxt - Cancel all events for a context
	* @device - KGSL device for the events to cancel
	* @context - context whose events we want to cancel
	*
	*/
	void kgsl_cancel_events_ctxt(struct kgsl_device *device,
	struct kgsl_context *context)
	{
	struct kgsl_event event, event_tmp;
	unsigned int id, cur;

	cur = kgsl_readtimestamp(device, context, KGSL_TIMESTAMP_RETIRED);
	id = context->id;

	list_for_each_entry_safe(event, event_tmp, &context->events, list) {
	/*
	* "cancel" the events by calling their callback.
	* Currently, events are used for lock and memory
	* management, so if the process is dying the right
	* thing to do is release or free.
	*
	* Send the current timestamp so the event knows how far the
	* system got before the event was canceled
	*/

	if (event->func)
	event->func(device, event->priv, id, cur);

	kgsl_context_put(context);
	list_del(&event->list);
	kfree(event);
	}

	/* Remove ourselves from the master pending list */
	list_del_init(&context->events_list);
	}

	/**
	* kgsl_cancel_events - Cancel all generic events for a process
	* @device - KGSL device for the events to cancel
	* @owner - driver instance that owns the events to cancel
	*
	*/
	void kgsl_cancel_events(struct kgsl_device *device,
	void *owner)
	{
	struct kgsl_event event, event_tmp;
	unsigned int cur;

	cur = kgsl_readtimestamp(device, NULL, KGSL_TIMESTAMP_RETIRED);

	list_for_each_entry_safe(event, event_tmp, &device->events, list) {
	if (event->owner != owner)
	continue;

	/*
	* "cancel" the events by calling their callback.
	* Currently, events are used for lock and memory
	* management, so if the process is dying the right
	* thing to do is release or free. Send the current timestamp so
	* the callback knows how far the GPU made it before things went
	* explosion
	*/
	if (event->func)
	event->func(device, event->priv, KGSL_MEMSTORE_GLOBAL,
	cur);

	if (event->context)
	kgsl_context_put(event->context);

	list_del(&event->list);
	kfree(event);
	}
	}
	EXPORT_SYMBOL(kgsl_cancel_events);

	static void _process_event_list(struct kgsl_device *device,
	struct list_head *head, unsigned int timestamp)
	{
	struct kgsl_event event, tmp;
	unsigned int id;

	list_for_each_entry_safe(event, tmp, head, list) {
	if (timestamp_cmp(timestamp, event->timestamp) < 0)
	break;

	id = event->context ? event->context->id : KGSL_MEMSTORE_GLOBAL;

	/*
	* Send the timestamp of the expired event, not the current
	* timestamp. This prevents the event handlers from getting
	* confused if they don't bother comparing the current timetamp
	* to the timestamp they wanted
	*/

	if (event->func)
	event->func(device, event->priv, id, event->timestamp);

	if (event->context)
	kgsl_context_put(event->context);

	list_del(&event->list);
	kfree(event);
	}
	}

	static inline int _mark_next_event(struct kgsl_device *device,
	struct list_head *head)
	{
	struct kgsl_event *event;

	if (!list_empty(head)) {
	event = list_first_entry(head, struct kgsl_event, list);

	/*
	* Next event will return 0 if the event was marked or 1 if the
	* timestamp on the event has passed - return that up a layer
	*/

	return device->ftbl->next_event(device, event);
	}

	return 0;
	}

	static int kgsl_process_context_events(struct kgsl_device *device,
	struct kgsl_context *context)
	{
	while (1) {
	unsigned int timestamp = kgsl_readtimestamp(device, context,
	KGSL_TIMESTAMP_RETIRED);

	_process_event_list(device, &context->events, timestamp);

	/*
	* _mark_next event will return 1 as long as the next event
	* timestamp has expired - this is to cope with an unavoidable
	* race condition with the GPU that is still processing events.
	*/

	if (!_mark_next_event(device, &context->events))
	break;
	}

	/*
	* Return 0 if the list is empty so the calling function can remove the
	* context from the pending list
	*/

	return list_empty(&context->events) ? 0 : 1;
	}

	void kgsl_process_events(struct work_struct *work)
	{
	struct kgsl_device *device = container_of(work, struct kgsl_device,
	ts_expired_ws);
	struct kgsl_context context, tmp;
	uint32_t timestamp;

	mutex_lock(&device->mutex);

	/* Process expired global events */
	timestamp = kgsl_readtimestamp(device, NULL, KGSL_TIMESTAMP_RETIRED);
	_process_event_list(device, &device->events, timestamp);
	_mark_next_event(device, &device->events);

	/* Now process all of the pending contexts */
	list_for_each_entry_safe(context, tmp, &device->events_pending_list,
	events_list) {

	/*
	* If kgsl_timestamp_expired_context returns 0 then it no longer
	* has any pending events and can be removed from the list
	*/

	if (kgsl_process_context_events(device, context) == 0)
	list_del_init(&context->events_list);
	}

	mutex_unlock(&device->mutex);
	}
	EXPORT_SYMBOL(kgsl_process_events);