446 lines
12 KiB
C
446 lines
12 KiB
C
/* exynos_drm_encoder.c
|
|
*
|
|
* Copyright (c) 2011 Samsung Electronics Co., Ltd.
|
|
* Authors:
|
|
* Inki Dae <inki.dae@samsung.com>
|
|
* Joonyoung Shim <jy0922.shim@samsung.com>
|
|
* Seung-Woo Kim <sw0312.kim@samsung.com>
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
* copy of this software and associated documentation files (the "Software"),
|
|
* to deal in the Software without restriction, including without limitation
|
|
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
|
* and/or sell copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice (including the next
|
|
* paragraph) shall be included in all copies or substantial portions of the
|
|
* Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
|
|
* OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
|
|
* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
|
|
* OTHER DEALINGS IN THE SOFTWARE.
|
|
*/
|
|
|
|
#include "drmP.h"
|
|
#include "drm_crtc_helper.h"
|
|
|
|
#include "exynos_drm_drv.h"
|
|
#include "exynos_drm_crtc.h"
|
|
#include "exynos_drm_encoder.h"
|
|
|
|
#define to_exynos_encoder(x) container_of(x, struct exynos_drm_encoder,\
|
|
drm_encoder)
|
|
|
|
/*
|
|
* exynos specific encoder structure.
|
|
*
|
|
* @drm_encoder: encoder object.
|
|
* @manager: specific encoder has its own manager to control a hardware
|
|
* appropriately and we can access a hardware drawing on this manager.
|
|
* @dpms: store the encoder dpms value.
|
|
*/
|
|
struct exynos_drm_encoder {
|
|
struct drm_encoder drm_encoder;
|
|
struct exynos_drm_manager *manager;
|
|
int dpms;
|
|
};
|
|
|
|
static void exynos_drm_display_power(struct drm_encoder *encoder, int mode)
|
|
{
|
|
struct drm_device *dev = encoder->dev;
|
|
struct drm_connector *connector;
|
|
struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
|
|
|
|
list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
|
|
if (connector->encoder == encoder) {
|
|
struct exynos_drm_display_ops *display_ops =
|
|
manager->display_ops;
|
|
|
|
DRM_DEBUG_KMS("connector[%d] dpms[%d]\n",
|
|
connector->base.id, mode);
|
|
if (display_ops && display_ops->power_on)
|
|
display_ops->power_on(manager->dev, mode);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void exynos_drm_encoder_dpms(struct drm_encoder *encoder, int mode)
|
|
{
|
|
struct drm_device *dev = encoder->dev;
|
|
struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
|
|
struct exynos_drm_manager_ops *manager_ops = manager->ops;
|
|
struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
|
|
|
|
DRM_DEBUG_KMS("%s, encoder dpms: %d\n", __FILE__, mode);
|
|
|
|
if (exynos_encoder->dpms == mode) {
|
|
DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
|
|
return;
|
|
}
|
|
|
|
mutex_lock(&dev->struct_mutex);
|
|
|
|
switch (mode) {
|
|
case DRM_MODE_DPMS_ON:
|
|
if (manager_ops && manager_ops->apply)
|
|
manager_ops->apply(manager->dev);
|
|
exynos_drm_display_power(encoder, mode);
|
|
exynos_encoder->dpms = mode;
|
|
break;
|
|
case DRM_MODE_DPMS_STANDBY:
|
|
case DRM_MODE_DPMS_SUSPEND:
|
|
case DRM_MODE_DPMS_OFF:
|
|
exynos_drm_display_power(encoder, mode);
|
|
exynos_encoder->dpms = mode;
|
|
break;
|
|
default:
|
|
DRM_ERROR("unspecified mode %d\n", mode);
|
|
break;
|
|
}
|
|
|
|
mutex_unlock(&dev->struct_mutex);
|
|
}
|
|
|
|
static bool
|
|
exynos_drm_encoder_mode_fixup(struct drm_encoder *encoder,
|
|
struct drm_display_mode *mode,
|
|
struct drm_display_mode *adjusted_mode)
|
|
{
|
|
struct drm_device *dev = encoder->dev;
|
|
struct drm_connector *connector;
|
|
struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
|
|
struct exynos_drm_manager_ops *manager_ops = manager->ops;
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
|
|
if (connector->encoder == encoder)
|
|
if (manager_ops && manager_ops->mode_fixup)
|
|
manager_ops->mode_fixup(manager->dev, connector,
|
|
mode, adjusted_mode);
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static void exynos_drm_encoder_mode_set(struct drm_encoder *encoder,
|
|
struct drm_display_mode *mode,
|
|
struct drm_display_mode *adjusted_mode)
|
|
{
|
|
struct drm_device *dev = encoder->dev;
|
|
struct drm_connector *connector;
|
|
struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
|
|
struct exynos_drm_manager_ops *manager_ops = manager->ops;
|
|
struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops;
|
|
struct exynos_drm_overlay *overlay = get_exynos_drm_overlay(dev,
|
|
encoder->crtc);
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
|
|
if (connector->encoder == encoder) {
|
|
if (manager_ops && manager_ops->mode_set)
|
|
manager_ops->mode_set(manager->dev,
|
|
adjusted_mode);
|
|
|
|
if (overlay_ops && overlay_ops->mode_set)
|
|
overlay_ops->mode_set(manager->dev, overlay);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void exynos_drm_encoder_prepare(struct drm_encoder *encoder)
|
|
{
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
/* drm framework doesn't check NULL. */
|
|
}
|
|
|
|
static void exynos_drm_encoder_commit(struct drm_encoder *encoder)
|
|
{
|
|
struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
|
|
struct exynos_drm_manager_ops *manager_ops = manager->ops;
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
if (manager_ops && manager_ops->commit)
|
|
manager_ops->commit(manager->dev);
|
|
}
|
|
|
|
static struct drm_crtc *
|
|
exynos_drm_encoder_get_crtc(struct drm_encoder *encoder)
|
|
{
|
|
return encoder->crtc;
|
|
}
|
|
|
|
static struct drm_encoder_helper_funcs exynos_encoder_helper_funcs = {
|
|
.dpms = exynos_drm_encoder_dpms,
|
|
.mode_fixup = exynos_drm_encoder_mode_fixup,
|
|
.mode_set = exynos_drm_encoder_mode_set,
|
|
.prepare = exynos_drm_encoder_prepare,
|
|
.commit = exynos_drm_encoder_commit,
|
|
.get_crtc = exynos_drm_encoder_get_crtc,
|
|
};
|
|
|
|
static void exynos_drm_encoder_destroy(struct drm_encoder *encoder)
|
|
{
|
|
struct exynos_drm_encoder *exynos_encoder =
|
|
to_exynos_encoder(encoder);
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
exynos_encoder->manager->pipe = -1;
|
|
|
|
drm_encoder_cleanup(encoder);
|
|
kfree(exynos_encoder);
|
|
}
|
|
|
|
static struct drm_encoder_funcs exynos_encoder_funcs = {
|
|
.destroy = exynos_drm_encoder_destroy,
|
|
};
|
|
|
|
static unsigned int exynos_drm_encoder_clones(struct drm_encoder *encoder)
|
|
{
|
|
struct drm_encoder *clone;
|
|
struct drm_device *dev = encoder->dev;
|
|
struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
|
|
struct exynos_drm_display_ops *display_ops =
|
|
exynos_encoder->manager->display_ops;
|
|
unsigned int clone_mask = 0;
|
|
int cnt = 0;
|
|
|
|
list_for_each_entry(clone, &dev->mode_config.encoder_list, head) {
|
|
switch (display_ops->type) {
|
|
case EXYNOS_DISPLAY_TYPE_LCD:
|
|
case EXYNOS_DISPLAY_TYPE_HDMI:
|
|
case EXYNOS_DISPLAY_TYPE_VIDI:
|
|
clone_mask |= (1 << (cnt++));
|
|
break;
|
|
default:
|
|
continue;
|
|
}
|
|
}
|
|
|
|
return clone_mask;
|
|
}
|
|
|
|
void exynos_drm_encoder_setup(struct drm_device *dev)
|
|
{
|
|
struct drm_encoder *encoder;
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
|
|
encoder->possible_clones = exynos_drm_encoder_clones(encoder);
|
|
}
|
|
|
|
struct drm_encoder *
|
|
exynos_drm_encoder_create(struct drm_device *dev,
|
|
struct exynos_drm_manager *manager,
|
|
unsigned int possible_crtcs)
|
|
{
|
|
struct drm_encoder *encoder;
|
|
struct exynos_drm_encoder *exynos_encoder;
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
if (!manager || !possible_crtcs)
|
|
return NULL;
|
|
|
|
if (!manager->dev)
|
|
return NULL;
|
|
|
|
exynos_encoder = kzalloc(sizeof(*exynos_encoder), GFP_KERNEL);
|
|
if (!exynos_encoder) {
|
|
DRM_ERROR("failed to allocate encoder\n");
|
|
return NULL;
|
|
}
|
|
|
|
exynos_encoder->dpms = DRM_MODE_DPMS_OFF;
|
|
exynos_encoder->manager = manager;
|
|
encoder = &exynos_encoder->drm_encoder;
|
|
encoder->possible_crtcs = possible_crtcs;
|
|
|
|
DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs);
|
|
|
|
drm_encoder_init(dev, encoder, &exynos_encoder_funcs,
|
|
DRM_MODE_ENCODER_TMDS);
|
|
|
|
drm_encoder_helper_add(encoder, &exynos_encoder_helper_funcs);
|
|
|
|
DRM_DEBUG_KMS("encoder has been created\n");
|
|
|
|
return encoder;
|
|
}
|
|
|
|
struct exynos_drm_manager *exynos_drm_get_manager(struct drm_encoder *encoder)
|
|
{
|
|
return to_exynos_encoder(encoder)->manager;
|
|
}
|
|
|
|
void exynos_drm_fn_encoder(struct drm_crtc *crtc, void *data,
|
|
void (*fn)(struct drm_encoder *, void *))
|
|
{
|
|
struct drm_device *dev = crtc->dev;
|
|
struct drm_encoder *encoder;
|
|
struct exynos_drm_private *private = dev->dev_private;
|
|
struct exynos_drm_manager *manager;
|
|
|
|
list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
|
|
/*
|
|
* if crtc is detached from encoder, check pipe,
|
|
* otherwise check crtc attached to encoder
|
|
*/
|
|
if (!encoder->crtc) {
|
|
manager = to_exynos_encoder(encoder)->manager;
|
|
if (manager->pipe < 0 ||
|
|
private->crtc[manager->pipe] != crtc)
|
|
continue;
|
|
} else {
|
|
if (encoder->crtc != crtc)
|
|
continue;
|
|
}
|
|
|
|
fn(encoder, data);
|
|
}
|
|
}
|
|
|
|
void exynos_drm_enable_vblank(struct drm_encoder *encoder, void *data)
|
|
{
|
|
struct exynos_drm_manager *manager =
|
|
to_exynos_encoder(encoder)->manager;
|
|
struct exynos_drm_manager_ops *manager_ops = manager->ops;
|
|
int crtc = *(int *)data;
|
|
|
|
if (manager->pipe == -1)
|
|
manager->pipe = crtc;
|
|
|
|
if (manager_ops->enable_vblank)
|
|
manager_ops->enable_vblank(manager->dev);
|
|
}
|
|
|
|
void exynos_drm_disable_vblank(struct drm_encoder *encoder, void *data)
|
|
{
|
|
struct exynos_drm_manager *manager =
|
|
to_exynos_encoder(encoder)->manager;
|
|
struct exynos_drm_manager_ops *manager_ops = manager->ops;
|
|
int crtc = *(int *)data;
|
|
|
|
if (manager->pipe == -1)
|
|
manager->pipe = crtc;
|
|
|
|
if (manager_ops->disable_vblank)
|
|
manager_ops->disable_vblank(manager->dev);
|
|
}
|
|
|
|
void exynos_drm_encoder_crtc_plane_commit(struct drm_encoder *encoder,
|
|
void *data)
|
|
{
|
|
struct exynos_drm_manager *manager =
|
|
to_exynos_encoder(encoder)->manager;
|
|
struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops;
|
|
int zpos = DEFAULT_ZPOS;
|
|
|
|
if (data)
|
|
zpos = *(int *)data;
|
|
|
|
if (overlay_ops && overlay_ops->commit)
|
|
overlay_ops->commit(manager->dev, zpos);
|
|
}
|
|
|
|
void exynos_drm_encoder_crtc_commit(struct drm_encoder *encoder, void *data)
|
|
{
|
|
struct exynos_drm_manager *manager =
|
|
to_exynos_encoder(encoder)->manager;
|
|
int crtc = *(int *)data;
|
|
int zpos = DEFAULT_ZPOS;
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
/*
|
|
* when crtc is detached from encoder, this pipe is used
|
|
* to select manager operation
|
|
*/
|
|
manager->pipe = crtc;
|
|
|
|
exynos_drm_encoder_crtc_plane_commit(encoder, &zpos);
|
|
}
|
|
|
|
void exynos_drm_encoder_dpms_from_crtc(struct drm_encoder *encoder, void *data)
|
|
{
|
|
struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
|
|
int mode = *(int *)data;
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
exynos_drm_encoder_dpms(encoder, mode);
|
|
|
|
exynos_encoder->dpms = mode;
|
|
}
|
|
|
|
void exynos_drm_encoder_crtc_dpms(struct drm_encoder *encoder, void *data)
|
|
{
|
|
struct drm_device *dev = encoder->dev;
|
|
struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
|
|
struct exynos_drm_manager *manager = exynos_encoder->manager;
|
|
struct exynos_drm_manager_ops *manager_ops = manager->ops;
|
|
struct drm_connector *connector;
|
|
int mode = *(int *)data;
|
|
|
|
DRM_DEBUG_KMS("%s\n", __FILE__);
|
|
|
|
if (manager_ops && manager_ops->dpms)
|
|
manager_ops->dpms(manager->dev, mode);
|
|
|
|
/*
|
|
* set current dpms mode to the connector connected to
|
|
* current encoder. connector->dpms would be checked
|
|
* at drm_helper_connector_dpms()
|
|
*/
|
|
list_for_each_entry(connector, &dev->mode_config.connector_list, head)
|
|
if (connector->encoder == encoder)
|
|
connector->dpms = mode;
|
|
|
|
/*
|
|
* if this condition is ok then it means that the crtc is already
|
|
* detached from encoder and last function for detaching is properly
|
|
* done, so clear pipe from manager to prevent repeated call.
|
|
*/
|
|
if (mode > DRM_MODE_DPMS_ON) {
|
|
if (!encoder->crtc)
|
|
manager->pipe = -1;
|
|
}
|
|
}
|
|
|
|
void exynos_drm_encoder_crtc_mode_set(struct drm_encoder *encoder, void *data)
|
|
{
|
|
struct exynos_drm_manager *manager =
|
|
to_exynos_encoder(encoder)->manager;
|
|
struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops;
|
|
struct exynos_drm_overlay *overlay = data;
|
|
|
|
if (overlay_ops && overlay_ops->mode_set)
|
|
overlay_ops->mode_set(manager->dev, overlay);
|
|
}
|
|
|
|
void exynos_drm_encoder_crtc_disable(struct drm_encoder *encoder, void *data)
|
|
{
|
|
struct exynos_drm_manager *manager =
|
|
to_exynos_encoder(encoder)->manager;
|
|
struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops;
|
|
int zpos = DEFAULT_ZPOS;
|
|
|
|
DRM_DEBUG_KMS("\n");
|
|
|
|
if (data)
|
|
zpos = *(int *)data;
|
|
|
|
if (overlay_ops && overlay_ops->disable)
|
|
overlay_ops->disable(manager->dev, zpos);
|
|
}
|