- 根目录:
- drivers
- video
- adf
- adf.c
/*
* Copyright (C) 2013 Google, Inc.
* adf_modeinfo_{set_name,set_vrefresh} modified from
* drivers/gpu/drm/drm_modes.c
* adf_format_validate_yuv modified from framebuffer_check in
* drivers/gpu/drm/drm_crtc.c
*
* This software is licensed under the terms of the GNU General Public
* License version 2, as published by the Free Software Foundation, and
* may be copied, distributed, and modified under those terms.
*
* 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/device.h>
#include <linux/idr.h>
#include <linux/highmem.h>
#include <linux/memblock.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <video/adf_format.h>
#include "sw_sync.h"
#include "sync.h"
#include "adf.h"
#include "adf_fops.h"
#include "adf_sysfs.h"
#define CREATE_TRACE_POINTS
#include "adf_trace.h"
#define ADF_SHORT_FENCE_TIMEOUT (1 * MSEC_PER_SEC)
#define ADF_LONG_FENCE_TIMEOUT (10 * MSEC_PER_SEC)
static DEFINE_IDR(adf_devices);
static void adf_fence_wait(struct adf_device *dev, struct sync_fence *fence)
{
/* sync_fence_wait() dumps debug information on timeout. Experience
has shown that if the pipeline gets stuck, a short timeout followed
by a longer one provides useful information for debugging. */
int err = sync_fence_wait(fence, ADF_SHORT_FENCE_TIMEOUT);
if (err >= 0)
return;
if (err == -ETIME)
err = sync_fence_wait(fence, ADF_LONG_FENCE_TIMEOUT);
if (err < 0)
dev_warn(&dev->base.dev, "error waiting on fence: %d\n", err);
}
void adf_buffer_cleanup(struct adf_buffer *buf)
{
size_t i;
for (i = 0; i < ARRAY_SIZE(buf->dma_bufs); i++)
if (buf->dma_bufs[i])
dma_buf_put(buf->dma_bufs[i]);
if (buf->acquire_fence)
sync_fence_put(buf->acquire_fence);
}
void adf_buffer_mapping_cleanup(struct adf_buffer_mapping *mapping,
struct adf_buffer *buf)
{
/* calling adf_buffer_mapping_cleanup() is safe even if mapping is
uninitialized or partially-initialized, as long as it was
zeroed on allocation */
size_t i;
for (i = 0; i < ARRAY_SIZE(mapping->sg_tables); i++) {
if (mapping->sg_tables[i])
dma_buf_unmap_attachment(mapping->attachments[i],
mapping->sg_tables[i], DMA_TO_DEVICE);
if (mapping->attachments[i])
dma_buf_detach(buf->dma_bufs[i],
mapping->attachments[i]);
}
}
void adf_post_cleanup(struct adf_device *dev, struct adf_pending_post *post)
{
size_t i;
if (post->state)
dev->ops->state_free(dev, post->state);
for (i = 0; i < post->config.n_bufs; i++) {
adf_buffer_mapping_cleanup(&post->config.mappings[i],
&post->config.bufs[i]);
adf_buffer_cleanup(&post->config.bufs[i]);
}
kfree(post->config.custom_data);
kfree(post->config.mappings);
kfree(post->config.bufs);
kfree(post);
}
static void adf_sw_advance_timeline(struct adf_device *dev)
{
#ifdef CONFIG_SW_SYNC
sw_sync_timeline_inc(dev->timeline, 1);
#else
BUG();
#endif
}
static void adf_post_work_func(struct kthread_work *work)
{
struct adf_device *dev =
container_of(work, struct adf_device, post_work);
struct adf_pending_post *post, *next;
struct list_head saved_list;
mutex_lock(&dev->post_lock);
memcpy(&saved_list, &dev->post_list, sizeof(saved_list));
list_replace_init(&dev->post_list, &saved_list);
mutex_unlock(&dev->post_lock);
list_for_each_entry_safe(post, next, &saved_list, head) {
int i;
for (i = 0; i < post->config.n_bufs; i++) {
struct sync_fence *fence =
post->config.bufs[i].acquire_fence;
if (fence)
adf_fence_wait(dev, fence);
}
dev->ops->post(dev, &post->config, post->state);
if (dev->ops->advance_timeline)
dev->ops->advance_timeline(dev, &post->config,
post->state);
else
adf_sw_advance_timeline(dev);
list_del(&post->head);
if (dev->onscreen)
adf_post_cleanup(dev, dev->onscreen);
dev->onscreen = post;
}
}
void adf_attachment_free(struct adf_attachment_list *attachment)
{
list_del(&attachment->head);
kfree(attachment);
}
struct adf_event_refcount *adf_obj_find_event_refcount(struct adf_obj *obj,
enum adf_event_type type)
{
struct rb_root *root = &obj->event_refcount;
struct rb_node **new = &(root->rb_node);
struct rb_node *parent = NULL;
struct adf_event_refcount *refcount;
while (*new) {
refcount = container_of(*new, struct adf_event_refcount, node);
parent = *new;
if (refcount->type > type)
new = &(*new)->rb_left;
else if (refcount->type < type)
new = &(*new)->rb_right;
else
return refcount;
}
refcount = kzalloc(sizeof(*refcount), GFP_KERNEL);
if (!refcount)
return NULL;
refcount->type = type;
rb_link_node(&refcount->node, parent, new);
rb_insert_color(&refcount->node, root);
return refcount;
}
/**
* adf_event_get - increase the refcount for an event
*
* @obj: the object that produces the event
* @type: the event type
*
* ADF will call the object's set_event() op if needed. ops are allowed
* to sleep, so adf_event_get() must NOT be called from an atomic context.
*
* Returns 0 if successful, or -%EINVAL if the object does not support the
* requested event type.
*/
int adf_event_get(struct adf_obj *obj, enum adf_event_type type)
{
struct adf_event_refcount *refcount;
int old_refcount;
int ret;
ret = adf_obj_check_supports_event(obj, type);
if (ret < 0)
return ret;
mutex_lock(&obj->event_lock);
refcount = adf_obj_find_event_refcount(obj, type);
if (!refcount) {
ret = -ENOMEM;
goto done;
}
old_refcount = refcount->refcount++;
if (old_refcount == 0) {
obj->ops->set_event(obj, type, true);
trace_adf_event_enable(obj, type);
}
done:
mutex_unlock(&obj->event_lock);
return ret;
}
EXPORT_SYMBOL(adf_event_get);
/**
* adf_event_put - decrease the refcount for an event
*
* @obj: the object that produces the event
* @type: the event type
*
* ADF will call the object's set_event() op if needed. ops are allowed
* to sleep, so adf_event_put() must NOT be called from an atomic context.
*
* Returns 0 if successful, -%EINVAL if the object does not support the
* requested event type, or -%EALREADY if the refcount is already 0.
*/
int adf_event_put(struct adf_obj *obj, enum adf_event_type type)
{
struct adf_event_refcount *refcount;
int old_refcount;
int ret;
ret = adf_obj_check_supports_event(obj, type);
if (ret < 0)
return ret;
mutex_lock(&obj->event_lock);
refcount = adf_obj_find_event_refcount(obj, type);
if (!refcount) {
ret = -ENOMEM;
goto done;
}
old_refcount = refcount->refcount--;
if (WARN_ON(old_refcount == 0)) {
refcount->refcount++;
ret = -EALREADY;
} else if (old_refcount == 1) {
obj->ops->set_event(obj, type, false);
trace_adf_event_disable(obj, type);
}
done:
mutex_unlock(&obj->event_lock);
return ret;
}
EXPORT_SYMBOL(adf_event_put);
/**
* adf_vsync_wait - wait for a vsync event on a display interface
*
* @intf: the display interface
* @timeout: timeout in jiffies (0 = wait indefinitely)
*
* adf_vsync_wait() may sleep, so it must NOT be called from an atomic context.
*
* This function returns -%ERESTARTSYS if it is interrupted by a signal.
* If @timeout == 0 then this function returns 0 on vsync. If @timeout > 0 then
* this function returns the number of remaining jiffies or -%ETIMEDOUT on
* timeout.
*/
int adf_vsync_wait(struct adf_interface *intf, long timeout)
{
ktime_t timestamp;
int ret;
unsigned long flags;
read_lock_irqsave(&intf->vsync_lock, flags);
timestamp = intf->vsync_timestamp;
read_unlock_irqrestore(&intf->vsync_lock, flags);
adf_vsync_get(intf);
if (timeout) {
ret = wait_event_interruptible_timeout(intf->vsync_wait,
!ktime_equal(timestamp,
intf->vsync_timestamp),
msecs_to_jiffies(timeout));
if (ret == 0 && ktime_equal(timestamp, intf->vsync_timestamp))
ret = -ETIMEDOUT;
} else {
ret = wait_event_interruptible(intf->vsync_wait,
!ktime_equal(timestamp,
intf->vsync_timestamp));
}
adf_vsync_put(intf);
return ret;
}
EXPORT_SYMBOL(adf_vsync_wait);
static void adf_event_queue(struct adf_obj *obj, struct adf_event *event)
{
struct adf_file *file;
unsigned long flags;
trace_adf_event(obj, event->type);
spin_lock_irqsave(&obj->file_lock, flags);
list_for_each_entry(file, &obj->file_list, head)
if (test_bit(event->type, file->event_subscriptions))
adf_file_queue_event(file, event);
spin_unlock_irqrestore(&obj->file_lock, flags);
}
/**
* adf_event_notify - notify userspace of a driver-private event
*
* @obj: the ADF object that produced the event
* @event: the event
*
* adf_event_notify() may be called safely from an atomic context. It will
* copy @event if needed, so @event may point to a variable on the stack.
*
* Drivers must NOT call adf_event_notify() for vsync and hotplug events.
* ADF provides adf_vsync_notify() and
* adf_hotplug_notify_{connected,disconnected}() for these events.
*/
int adf_event_notify(struct adf_obj *obj, struct adf_event *event)
{
if (WARN_ON(event->type == ADF_EVENT_VSYNC ||
event->type == ADF_EVENT_HOTPLUG))
return -EINVAL;
adf_event_queue(obj, event);
return 0;
}
EXPORT_SYMBOL(adf_event_notify);
/**
* adf_vsync_notify - notify ADF of a display interface's vsync event
*
* @intf: the display interface
* @timestamp: the time the vsync occurred
*
* adf_vsync_notify() may be called safely from an atomic context.
*/
void adf_vsync_notify(struct adf_interface *intf, ktime_t timestamp)
{
unsigned long flags;
struct adf_vsync_event event;
write_lock_irqsave(&intf->vsync_lock, flags);
intf->vsync_timestamp = timestamp;
write_unlock_irqrestore(&intf->vsync_lock, flags);
wake_up_interruptible_all(&intf->vsync_wait);
event.base.type = ADF_EVENT_VSYNC;
event.base.length = sizeof(event);
event.timestamp = ktime_to_ns(timestamp);
adf_event_queue(&intf->base, &event.base);
}
EXPORT_SYMBOL(adf_vsync_notify);
void adf_hotplug_notify(struct adf_interface *intf, bool connected,
struct drm_mode_modeinfo *modelist, size_t n_modes)
{
unsigned long flags;
struct adf_hotplug_event event;
struct drm_mode_modeinfo *old_modelist;
write_lock_irqsave(&intf->hotplug_modelist_lock, flags);
old_modelist = intf->modelist;
intf->hotplug_detect = connected;
intf->modelist = modelist;
intf->n_modes = n_modes;
write_unlock_irqrestore(&intf->hotplug_modelist_lock, flags);
kfree(old_modelist);
event.base.length = sizeof(event);
event.base.type = ADF_EVENT_HOTPLUG;
event.connected = connected;
adf_event_queue(&intf->base, &event.base);
}
/**
* adf_hotplug_notify_connected - notify ADF of a display interface being
* connected to a display
*
* @intf: the display interface
* @modelist: hardware modes supported by display
* @n_modes: length of modelist
*
* @modelist is copied as needed, so it may point to a variable on the stack.
*
* adf_hotplug_notify_connected() may NOT be called safely from an atomic
* context.
*
* Returns 0 on success or error code (<0) on error.
*/
int adf_hotplug_notify_connected(struct adf_interface *intf,
struct drm_mode_modeinfo *modelist, size_t n_modes)
{
struct drm_mode_modeinfo *modelist_copy;
if (n_modes > ADF_MAX_MODES)
return -ENOMEM;
modelist_copy = kzalloc(sizeof(modelist_copy[0]) * n_modes,
GFP_KERNEL);
if (!modelist_copy)
return -ENOMEM;
memcpy(modelist_copy, modelist, sizeof(modelist_copy[0]) * n_modes);
adf_hotplug_notify(intf, true, modelist_copy, n_modes);
return 0;
}
EXPORT_SYMBOL(adf_hotplug_notify_connected);
/**
* adf_hotplug_notify_disconnected - notify ADF of a display interface being
* disconnected from a display
*
* @intf: the display interface
*
* adf_hotplug_notify_disconnected() may be called safely from an atomic
* context.
*/
void adf_hotplug_notify_disconnected(struct adf_interface *intf)
{
adf_hotplug_notify(intf, false, NULL, 0);
}
EXPORT_SYMBOL(adf_hotplug_notify_disconnected);
static int adf_obj_init(struct adf_obj *obj, enum adf_obj_type type,
struct idr *idr, struct adf_device *parent,
const struct adf_obj_ops *ops, const char *fmt, va_list args)
{
int ret;
if (ops && ops->supports_event && !ops->set_event) {
pr_err("%s: %s implements supports_event but not set_event\n",
__func__, adf_obj_type_str(type));
return -EINVAL;
}
ret = idr_alloc(idr, obj, 0, 0, GFP_KERNEL);
if (ret < 0) {
pr_err("%s: allocating object id failed: %d\n", __func__, ret);
return ret;
}
obj->id = ret;
vscnprintf(obj->name, sizeof(obj->name), fmt, args);
obj->type = type;
obj->ops = ops;
obj->parent = parent;
mutex_init(&obj->event_lock);
obj->event_refcount = RB_ROOT;
spin_lock_init(&obj->file_lock);
INIT_LIST_HEAD(&obj->file_list);
return 0;
}
static void adf_obj_destroy(struct adf_obj *obj, struct idr *idr)
{
struct rb_node *node = rb_first(&obj->event_refcount);
while (node) {
struct adf_event_refcount *refcount =
container_of(node, struct adf_event_refcount,
node);
rb_erase(&refcount->node, &obj->event_refcount);
kfree(refcount);
node = rb_first(&obj->event_refcount);
}
mutex_destroy(&obj->event_lock);
idr_remove(idr, obj->id);
}
/**
* adf_device_init - initialize ADF-internal data for a display device
* and create sysfs entries
*
* @dev: the display device
* : the device's parent device
* @ops: the device's associated ops
* @fmt: formatting string for the display device's name
*
* @fmt specifies the device's sysfs filename and the name returned to
* userspace through the %ADF_GET_DEVICE_DATA ioctl.
*
* Returns 0 on success or error code (<0) on failure.
*/
int adf_device_init(struct adf_device *dev, struct device *parent,
const struct adf_device_ops *ops, const char *fmt, ...)
{
int ret;
va_list args;
if (!ops->validate || !ops->post) {
pr_err("%s: device must implement validate and post\n",
__func__);
return -EINVAL;
}
if (!ops->complete_fence && !ops->advance_timeline) {
if (!IS_ENABLED(CONFIG_SW_SYNC)) {
pr_err("%s: device requires sw_sync but it is not enabled in the kernel\n",
__func__);
return -EINVAL;
}
} else if (!(ops->complete_fence && ops->advance_timeline)) {
pr_err("%s: device must implement both complete_fence and advance_timeline, or implement neither\n",
__func__);
return -EINVAL;
}
memset(dev, 0, sizeof(*dev));
va_start(args, fmt);
ret = adf_obj_init(&dev->base, ADF_OBJ_DEVICE, &adf_devices, dev,
&ops->base, fmt, args);
va_end(args);
if (ret < 0)
return ret;
dev->dev = parent;
dev->ops = ops;
idr_init(&dev->overlay_engines);
idr_init(&dev->interfaces);
mutex_init(&dev->client_lock);
INIT_LIST_HEAD(&dev->post_list);
mutex_init(&dev->post_lock);
init_kthread_worker(&dev->post_worker);
INIT_LIST_HEAD(&dev->attached);
INIT_LIST_HEAD(&dev->attach_allowed);
dev->post_thread = kthread_run(kthread_worker_fn,
&dev->post_worker, dev->base.name);
if (IS_ERR(dev->post_thread)) {
ret = PTR_ERR(dev->post_thread);
dev->post_thread = NULL;
pr_err("%s: failed to run config posting thread: %d\n",
__func__, ret);
goto err;
}
init_kthread_work(&dev->post_work, adf_post_work_func);
ret = adf_device_sysfs_init(dev);
if (ret < 0)
goto err;
return 0;
err:
adf_device_destroy(dev);
return ret;
}
EXPORT_SYMBOL(adf_device_init);
/**
* adf_device_destroy - clean up ADF-internal data for a display device
*
* @dev: the display device
*/
void adf_device_destroy(struct adf_device *dev)
{
struct adf_attachment_list *entry, *next;
idr_destroy(&dev->interfaces);
idr_destroy(&dev->overlay_engines);
if (dev->post_thread) {
flush_kthread_worker(&dev->post_worker);
kthread_stop(dev->post_thread);
}
if (dev->onscreen)
adf_post_cleanup(dev, dev->onscreen);
adf_device_sysfs_destroy(dev);
list_for_each_entry_safe(entry, next, &dev->attach_allowed, head) {
adf_attachment_free(entry);
}
list_for_each_entry_safe(entry, next, &dev->attached, head) {
adf_attachment_free(entry);
}
mutex_destroy(&dev->post_lock);
mutex_destroy(&dev->client_lock);
if (dev->timeline)
sync_timeline_destroy(&dev->timeline->obj);
adf_obj_destroy(&dev->base, &adf_devices);
}
EXPORT_SYMBOL(adf_device_destroy);
/**
* adf_interface_init - initialize ADF-internal data for a display interface
* and create sysfs entries
*
* @intf: the display interface
* @dev: the interface's "parent" display device
* @type: interface type (see enum @adf_interface_type)
* @idx: which interface of type @type;
* e.g. interface DSI.1 -> @type=%ADF_INTF_TYPE_DSI, @idx=1
* @flags: informational flags (bitmask of %ADF_INTF_FLAG_* values)
* @ops: the interface's associated ops
* @fmt: formatting string for the display interface's name
*
* @dev must have previously been initialized with adf_device_init().
*
* @fmt affects the name returned to userspace through the
* %ADF_GET_INTERFACE_DATA ioctl. It does not affect the sysfs filename,
* which is derived from @dev's name.
*
* Returns 0 on success or error code (<0) on failure.
*/
int adf_interface_init(struct adf_interface *intf, struct adf_device *dev,
enum adf_interface_type type, u32 idx, u32 flags,
const struct adf_interface_ops *ops, const char *fmt, ...)
{
int ret;
va_list args;
const u32 allowed_flags = ADF_INTF_FLAG_PRIMARY |
ADF_INTF_FLAG_EXTERNAL;
if (dev->n_interfaces == ADF_MAX_INTERFACES) {
pr_err("%s: parent device %s has too many interfaces\n",
__func__, dev->base.name);
return -ENOMEM;
}
if (type >= ADF_INTF_MEMORY && type <= ADF_INTF_TYPE_DEVICE_CUSTOM) {
pr_err("%s: invalid interface type %u\n", __func__, type);
return -EINVAL;
}
if (flags & ~allowed_flags) {
pr_err("%s: invalid interface flags 0x%X\n", __func__,
flags & ~allowed_flags);
return -EINVAL;
}
memset(intf, 0, sizeof(*intf));
va_start(args, fmt);
ret = adf_obj_init(&intf->base, ADF_OBJ_INTERFACE, &dev->interfaces,
dev, ops ? &ops->base : NULL, fmt, args);
va_end(args);
if (ret < 0)
return ret;
intf->type = type;
intf->idx = idx;
intf->flags = flags;
intf->ops = ops;
intf->dpms_state = DRM_MODE_DPMS_OFF;
init_waitqueue_head(&intf->vsync_wait);
rwlock_init(&intf->vsync_lock);
rwlock_init(&intf->hotplug_modelist_lock);
ret = adf_interface_sysfs_init(intf);
if (ret < 0)
goto err;
dev->n_interfaces++;
return 0;
err:
adf_obj_destroy(&intf->base, &dev->interfaces);
return ret;
}
EXPORT_SYMBOL(adf_interface_init);
/**
* adf_interface_destroy - clean up ADF-internal data for a display interface
*
* @intf: the display interface
*/
void adf_interface_destroy(struct adf_interface *intf)
{
struct adf_device *dev = adf_interface_parent(intf);
struct adf_attachment_list *entry, *next;
mutex_lock(&dev->client_lock);
list_for_each_entry_safe(entry, next, &dev->attach_allowed, head) {
if (entry->attachment.interface == intf) {
adf_attachment_free(entry);
dev->n_attach_allowed--;
}
}
list_for_each_entry_safe(entry, next, &dev->attached, head) {
if (entry->attachment.interface == intf) {
adf_device_detach_op(dev,
entry->attachment.overlay_engine, intf);
adf_attachment_free(entry);
dev->n_attached--;
}
}
kfree(intf->modelist);
adf_interface_sysfs_destroy(intf);
adf_obj_destroy(&intf->base, &dev->interfaces);
dev->n_interfaces--;
mutex_unlock(&dev->client_lock);
}
EXPORT_SYMBOL(adf_interface_destroy);
static bool adf_overlay_engine_has_custom_formats(
const struct adf_overlay_engine_ops *ops)
{
size_t i;
for (i = 0; i < ops->n_supported_formats; i++)
if (!adf_format_is_standard(ops->supported_formats[i]))
return true;
return false;
}
/**
* adf_overlay_engine_init - initialize ADF-internal data for an
* overlay engine and create sysfs entries
*
* @eng: the overlay engine
* @dev: the overlay engine's "parent" display device
* @ops: the overlay engine's associated ops
* @fmt: formatting string for the overlay engine's name
*
* @dev must have previously been initialized with adf_device_init().
*
* @fmt affects the name returned to userspace through the
* %ADF_GET_OVERLAY_ENGINE_DATA ioctl. It does not affect the sysfs filename,
* which is derived from @dev's name.
*
* Returns 0 on success or error code (<0) on failure.
*/
int adf_overlay_engine_init(struct adf_overlay_engine *eng,
struct adf_device *dev,
const struct adf_overlay_engine_ops *ops, const char *fmt, ...)
{
int ret;
va_list args;
if (!ops->supported_formats) {
pr_err("%s: overlay engine must support at least one format\n",
__func__);
return -EINVAL;
}
if (ops->n_supported_formats > ADF_MAX_SUPPORTED_FORMATS) {
pr_err("%s: overlay engine supports too many formats\n",
__func__);
return -EINVAL;
}
if (adf_overlay_engine_has_custom_formats(ops) &&
!dev->ops->validate_custom_format) {
pr_err("%s: overlay engine has custom formats but parent device %s does not implement validate_custom_format\n",
__func__, dev->base.name);
return -EINVAL;
}
memset(eng, 0, sizeof(*eng));
va_start(args, fmt);
ret = adf_obj_init(&eng->base, ADF_OBJ_OVERLAY_ENGINE,
&dev->overlay_engines, dev, &ops->base, fmt, args);
va_end(args);
if (ret < 0)
return ret;
eng->ops = ops;
ret = adf_overlay_engine_sysfs_init(eng);
if (ret < 0)
goto err;
return 0;
err:
adf_obj_destroy(&eng->base, &dev->overlay_engines);
return ret;
}
EXPORT_SYMBOL(adf_overlay_engine_init);
/**
* adf_interface_destroy - clean up ADF-internal data for an overlay engine
*
* @eng: the overlay engine
*/
void adf_overlay_engine_destroy(struct adf_overlay_engine *eng)
{
struct adf_device *dev = adf_overlay_engine_parent(eng);
struct adf_attachment_list *entry, *next;
mutex_lock(&dev->client_lock);
list_for_each_entry_safe(entry, next, &dev->attach_allowed, head) {
if (entry->attachment.overlay_engine == eng) {
adf_attachment_free(entry);
dev->n_attach_allowed--;
}
}
list_for_each_entry_safe(entry, next, &dev->attached, head) {
if (entry->attachment.overlay_engine == eng) {
adf_device_detach_op(dev, eng,
entry->attachment.interface);
adf_attachment_free(entry);
dev->n_attached--;
}
}
adf_overlay_engine_sysfs_destroy(eng);
adf_obj_destroy(&eng->base, &dev->overlay_engines);
mutex_unlock(&dev->client_lock);
}
EXPORT_SYMBOL(adf_overlay_engine_destroy);
struct adf_attachment_list *adf_attachment_find(struct list_head *list,
struct adf_overlay_engine *eng, struct adf_interface *intf)
{
struct adf_attachment_list *entry;
list_for_each_entry(entry, list, head) {
if (entry->attachment.interface == intf &&
entry->attachment.overlay_engine == eng)
return entry;
}
return NULL;
}
int adf_attachment_validate(struct adf_device *dev,
struct adf_overlay_engine *eng, struct adf_interface *intf)
{
struct adf_device *intf_dev = adf_interface_parent(intf);
struct adf_device *eng_dev = adf_overlay_engine_parent(eng);
if (intf_dev != dev) {
dev_err(&dev->base.dev, "can't attach interface %s belonging to device %s\n",
intf->base.name, intf_dev->base.name);
return -EINVAL;
}
if (eng_dev != dev) {
dev_err(&dev->base.dev, "can't attach overlay engine %s belonging to device %s\n",
eng->base.name, eng_dev->base.name);
return -EINVAL;
}
return 0;
}
/**
* adf_attachment_allow - add a new entry to the list of allowed
* attachments
*
* @dev: the parent device
* @eng: the overlay engine
* @intf: the interface
*
* adf_attachment_allow() indicates that the underlying display hardware allows
* @intf to scan out @eng's output. It is intended to be called at
* driver initialization for each supported overlay engine + interface pair.
*
* Returns 0 on success, -%EALREADY if the entry already exists, or -errno on
* any other failure.
*/
int adf_attachment_allow(struct adf_device *dev,
struct adf_overlay_engine *eng, struct adf_interface *intf)
{
int ret;
struct adf_attachment_list *entry = NULL;
ret = adf_attachment_validate(dev, eng, intf);
if (ret < 0)
return ret;
mutex_lock(&dev->client_lock);
if (dev->n_attach_allowed == ADF_MAX_ATTACHMENTS) {
ret = -ENOMEM;
goto done;
}
if (adf_attachment_find(&dev->attach_allowed, eng, intf)) {
ret = -EALREADY;
goto done;
}
entry = kzalloc(sizeof(*entry), GFP_KERNEL);
if (!entry) {
ret = -ENOMEM;
goto done;
}
entry->attachment.interface = intf;
entry->attachment.overlay_engine = eng;
list_add_tail(&entry->head, &dev->attach_allowed);
dev->n_attach_allowed++;
done:
mutex_unlock(&dev->client_lock);
if (ret < 0)
kfree(entry);
return ret;
}
EXPORT_SYMBOL(adf_attachment_allow);
/**
* adf_obj_type_str - string representation of an adf_obj_type
*
* @type: the object type
*/
const char *adf_obj_type_str(enum adf_obj_type type)
{
switch (type) {
case ADF_OBJ_OVERLAY_ENGINE:
return "overlay engine";
case ADF_OBJ_INTERFACE:
return "interface";
case ADF_OBJ_DEVICE:
return "device";
default:
return "unknown";
}
}
EXPORT_SYMBOL(adf_obj_type_str);
/**
* adf_interface_type_str - string representation of an adf_interface's type
*
* @intf: the interface
*/
const char *adf_interface_type_str(struct adf_interface *intf)
{
switch (intf->type) {
case ADF_INTF_DSI:
return "DSI";
case ADF_INTF_eDP:
return "eDP";
case ADF_INTF_DPI:
return "DPI";
case ADF_INTF_VGA:
return "VGA";
case ADF_INTF_DVI:
return "DVI";
case ADF_INTF_HDMI:
return "HDMI";
case ADF_INTF_MEMORY:
return "memory";
default:
if (intf->type >= ADF_INTF_TYPE_DEVICE_CUSTOM) {
if (intf->ops && intf->ops->type_str)
return intf->ops->type_str(intf);
return "custom";
}
return "unknown";
}
}
EXPORT_SYMBOL(adf_interface_type_str);
/**
* adf_event_type_str - string representation of an adf_event_type
*
* @obj: ADF object that produced the event
* @type: event type
*/
const char *adf_event_type_str(struct adf_obj *obj, enum adf_event_type type)
{
switch (type) {
case ADF_EVENT_VSYNC:
return "vsync";
case ADF_EVENT_HOTPLUG:
return "hotplug";
default:
if (type >= ADF_EVENT_DEVICE_CUSTOM) {
if (obj->ops && obj->ops->event_type_str)
return obj->ops->event_type_str(obj, type);
return "custom";
}
return "unknown";
}
}
EXPORT_SYMBOL(adf_event_type_str);
/**
* adf_format_str - string representation of an ADF/DRM fourcc format
*
* @format: format fourcc
* @buf: target buffer for the format's string representation
*/
void adf_format_str(u32 format, char buf[ADF_FORMAT_STR_SIZE])
{
buf[0] = format & 0xFF;
buf[1] = (format >> 8) & 0xFF;
buf[2] = (format >> 16) & 0xFF;
buf[3] = (format >> 24) & 0xFF;
buf[4] = '\0';
}
EXPORT_SYMBOL(adf_format_str);
/**
* adf_format_validate_yuv - validate the number and size of planes in buffers
* with a custom YUV format.
*
* @dev: ADF device performing the validation
* @buf: buffer to validate
* @num_planes: expected number of planes
* @hsub: expected horizontal chroma subsampling factor, in pixels
* @vsub: expected vertical chroma subsampling factor, in pixels
* @cpp: expected bytes per pixel for each plane (length @num_planes)
*
* adf_format_validate_yuv() is intended to be called as a helper from @dev's
* validate_custom_format() op.
*
* Returns 0 if @buf has the expected number of planes and each plane
* has sufficient size, or -EINVAL otherwise.
*/
int adf_format_validate_yuv(struct adf_device *dev, struct adf_buffer *buf,
u8 num_planes, u8 hsub, u8 vsub, u8 cpp[])
{
u8 i;
if (num_planes != buf->n_planes) {
char format_str[ADF_FORMAT_STR_SIZE];
adf_format_str(buf->format, format_str);
dev_err(&dev->base.dev, "%u planes expected for format %s but %u planes provided\n",
num_planes, format_str, buf->n_planes);
return -EINVAL;
}
if (buf->w == 0 || buf->w % hsub) {
dev_err(&dev->base.dev, "bad buffer width %u\n", buf->w);
return -EINVAL;
}
if (buf->h == 0 || buf->h % vsub) {
dev_err(&dev->base.dev, "bad buffer height %u\n", buf->h);
return -EINVAL;
}
for (i = 0; i < num_planes; i++) {
u32 width = buf->w / (i != 0 ? hsub : 1);
u32 height = buf->h / (i != 0 ? vsub : 1);
u8 cpp = adf_format_plane_cpp(buf->format, i);
u32 last_line_size;
if (buf->pitch[i] < (u64) width * cpp) {
dev_err(&dev->base.dev, "plane %u pitch is shorter than buffer width (pitch = %u, width = %u, bpp = %u)\n",
i, buf->pitch[i], width, cpp * 8);
return -EINVAL;
}
switch (dev->ops->quirks.buffer_padding) {
case ADF_BUFFER_PADDED_TO_PITCH:
last_line_size = buf->pitch[i];
break;
case ADF_BUFFER_UNPADDED:
last_line_size = width * cpp;
break;
default:
BUG();
}
if ((u64) (height - 1) * buf->pitch[i] + last_line_size +
buf->offset[i] > buf->dma_bufs[i]->size) {
dev_err(&dev->base.dev, "plane %u buffer too small (height = %u, pitch = %u, offset = %u, size = %zu)\n",
i, height, buf->pitch[i],
buf->offset[i], buf->dma_bufs[i]->size);
return -EINVAL;
}
}
return 0;
}
EXPORT_SYMBOL(adf_format_validate_yuv);
/**
* adf_modeinfo_set_name - sets the name of a mode from its display resolution
*
* @mode: mode
*
* adf_modeinfo_set_name() fills in @mode->name in the format
* "[hdisplay]x[vdisplay](i)". It is intended to help drivers create
* ADF/DRM-style modelists from other mode formats.
*/
void adf_modeinfo_set_name(struct drm_mode_modeinfo *mode)
{
bool interlaced = mode->flags & DRM_MODE_FLAG_INTERLACE;
snprintf(mode->name, DRM_DISPLAY_MODE_LEN, "%dx%d%s",
mode->hdisplay, mode->vdisplay,
interlaced ? "i" : "");
}
EXPORT_SYMBOL(adf_modeinfo_set_name);
/**
* adf_modeinfo_set_vrefresh - sets the vrefresh of a mode from its other
* timing data
*
* @mode: mode
*
* adf_modeinfo_set_vrefresh() calculates @mode->vrefresh from
* @mode->{h,v}display and @mode->flags. It is intended to help drivers
* create ADF/DRM-style modelists from other mode formats.
*/
void adf_modeinfo_set_vrefresh(struct drm_mode_modeinfo *mode)
{
int refresh = 0;
unsigned int calc_val;
if (mode->vrefresh > 0)
return;
if (mode->htotal <= 0 || mode->vtotal <= 0)
return;
/* work out vrefresh the value will be x1000 */
calc_val = (mode->clock * 1000);
calc_val /= mode->htotal;
refresh = (calc_val + mode->vtotal / 2) / mode->vtotal;
if (mode->flags & DRM_MODE_FLAG_INTERLACE)
refresh *= 2;
if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
refresh /= 2;
if (mode->vscan > 1)
refresh /= mode->vscan;
mode->vrefresh = refresh;
}
EXPORT_SYMBOL(adf_modeinfo_set_vrefresh);
static int __init adf_init(void)
{
int err;
err = adf_sysfs_init();
if (err < 0)
return err;
return 0;
}
static void __exit adf_exit(void)
{
adf_sysfs_destroy();
}
module_init(adf_init);
module_exit(adf_exit);