- Improved HDMI and Mixer drivers
. It moves mode setup and plane update code to commit like other CRTC drivers . It makes mode commit to be called in enable callback only one time . some cleanup and fixup to HDMI and Mixer drivers. . It adds 1024x768, 1280x1024 and 1366x768 modes support - Added HDMI audio interface driver . As of now, HDMI audio worked on boards with external audio codec connected in parallel with the HDMI audio transmitter's I2S interface. This patch is required to support HDMI audio properly. -----BEGIN PGP SIGNATURE----- Version: GnuPG v1 iQIcBAABAgAGBQJZ8SydAAoJEFc4NIkMQxK4CW8P/1cwTPcVcsdjjWQ9xuYEPjum 2bdi9CkCxwlCM6t05azcm1x6fMoZMTuTqkL0eEsS+g64ZFCmd+kRwKkxJxp2zMGO CAz7D+baliOEuELtSJHQ9zOartiwHWLfMptJZFpOciQOSDPOMOVhJNBW6mnxC4xn J+YDUTbW/Rbd4CwBeBCW9s+VidDP21QhXrZui5k6ZZP+rOSRgtTtKcbWaSzZIdp0 mmqnWIwgmThkSGc17a5wcXHHal1YxvbdiV1gzAZUo+mrBKSHFc60ibgfEV5atnvn OctaBVA/glNhSz1F1OoUZVUDMg5IsrnJ9QND8DjJcm9MgXMFM5BfQQOkcGs2uq4w hZBEr4MRi1rJ9+Q3Cc2AXcGOkFhnJJOVtgUWd4u0UsKk7BGY+9XF2/e5eA0Sp1ep hkE4kbXf6efENqbTD0a4gnucBJhcG/nD0+PJh+IE7HFfLHgMsEkjKy3gDZRiu3lu 1QSljBGLXgYjHR8BM/oMwxJBGJwCGMY2/+MMzaWckrQ7YxMct72Fh0Nzh1R/o/Su jBtsjre4Vob1I5OoVolL6gvZLik49yB0FmXsnGXvQjAEuRwoxNAxvjMYQjGpnOme Ya8xsSFYEdzfE/yNgwJK+hsB/EaOgSr1zaGE0Gobo54nHbtBnyEC2gY1cg3296hS 9lwuxQvuJrzQVqlbJYbY =wpjH -----END PGP SIGNATURE----- Merge tag 'exynos-drm-next-for-v4.15' of git://git.kernel.org/pub/scm/linux/kernel/git/daeinki/drm-exynos into drm-next - Improved HDMI and Mixer drivers . It moves mode setup and plane update code to commit like other CRTC drivers . It makes mode commit to be called in enable callback only one time . some cleanup and fixup to HDMI and Mixer drivers. . It adds 1024x768, 1280x1024 and 1366x768 modes support - Added HDMI audio interface driver . As of now, HDMI audio worked on boards with external audio codec connected in parallel with the HDMI audio transmitter's I2S interface. This patch is required to support HDMI audio properly. * tag 'exynos-drm-next-for-v4.15' of git://git.kernel.org/pub/scm/linux/kernel/git/daeinki/drm-exynos: drm: exynos: Add driver for HDMI audio interface drm/exynos/hdmi: add 85.5MHz pixel clock for v14 HDMI PHY drm/exynos/mixer: enable support for 1024x768 and 1280x1024 modes drm/exynos/hdmi: quirk for support mode timings conversion drm/exynos/mixer: pass actual mode on MIXER to encoder drm/exynos: add mode_fixup callback to exynos_drm_crtc_ops drm/exynos/hdmi: remove redundant mode field drm/exynos/mixer: remove mixer_resources sub-structure drm/exynos/mixer: fix mode validation code drm/exynos/mixer: move resolution configuration to single function drm/exynos/mixer: move mode commit to enable callback drm/exynos/mixer: abstract out output mode setup code
This commit is contained in:
commit
f150891fd9
@ -3,6 +3,7 @@ config DRM_EXYNOS
|
||||
depends on OF && DRM && (ARCH_S3C64XX || ARCH_EXYNOS || ARCH_MULTIPLATFORM)
|
||||
select DRM_KMS_HELPER
|
||||
select VIDEOMODE_HELPERS
|
||||
select SND_SOC_HDMI_CODEC if SND_SOC
|
||||
help
|
||||
Choose this option if you have a Samsung SoC EXYNOS chipset.
|
||||
If M is selected the module will be called exynosdrm.
|
||||
|
@ -95,8 +95,23 @@ static enum drm_mode_status exynos_crtc_mode_valid(struct drm_crtc *crtc,
|
||||
return MODE_OK;
|
||||
}
|
||||
|
||||
static bool exynos_crtc_mode_fixup(struct drm_crtc *crtc,
|
||||
const struct drm_display_mode *mode,
|
||||
struct drm_display_mode *adjusted_mode)
|
||||
{
|
||||
struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
|
||||
|
||||
if (exynos_crtc->ops->mode_fixup)
|
||||
return exynos_crtc->ops->mode_fixup(exynos_crtc, mode,
|
||||
adjusted_mode);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
static const struct drm_crtc_helper_funcs exynos_crtc_helper_funcs = {
|
||||
.mode_valid = exynos_crtc_mode_valid,
|
||||
.mode_fixup = exynos_crtc_mode_fixup,
|
||||
.atomic_check = exynos_crtc_atomic_check,
|
||||
.atomic_begin = exynos_crtc_atomic_begin,
|
||||
.atomic_flush = exynos_crtc_atomic_flush,
|
||||
|
@ -136,6 +136,9 @@ struct exynos_drm_crtc_ops {
|
||||
u32 (*get_vblank_counter)(struct exynos_drm_crtc *crtc);
|
||||
enum drm_mode_status (*mode_valid)(struct exynos_drm_crtc *crtc,
|
||||
const struct drm_display_mode *mode);
|
||||
bool (*mode_fixup)(struct exynos_drm_crtc *crtc,
|
||||
const struct drm_display_mode *mode,
|
||||
struct drm_display_mode *adjusted_mode);
|
||||
int (*atomic_check)(struct exynos_drm_crtc *crtc,
|
||||
struct drm_crtc_state *state);
|
||||
void (*atomic_begin)(struct exynos_drm_crtc *crtc);
|
||||
|
@ -40,7 +40,7 @@
|
||||
#include <linux/component.h>
|
||||
#include <linux/mfd/syscon.h>
|
||||
#include <linux/regmap.h>
|
||||
|
||||
#include <sound/hdmi-codec.h>
|
||||
#include <drm/exynos_drm.h>
|
||||
|
||||
#include <media/cec-notifier.h>
|
||||
@ -111,15 +111,20 @@ struct hdmi_driver_data {
|
||||
struct string_array_spec clk_muxes;
|
||||
};
|
||||
|
||||
struct hdmi_audio {
|
||||
struct platform_device *pdev;
|
||||
struct hdmi_audio_infoframe infoframe;
|
||||
struct hdmi_codec_params params;
|
||||
bool mute;
|
||||
};
|
||||
|
||||
struct hdmi_context {
|
||||
struct drm_encoder encoder;
|
||||
struct device *dev;
|
||||
struct drm_device *drm_dev;
|
||||
struct drm_connector connector;
|
||||
bool powered;
|
||||
bool dvi_mode;
|
||||
struct delayed_work hotplug_work;
|
||||
struct drm_display_mode current_mode;
|
||||
struct cec_notifier *notifier;
|
||||
const struct hdmi_driver_data *drv_data;
|
||||
|
||||
@ -137,6 +142,11 @@ struct hdmi_context {
|
||||
struct regulator *reg_hdmi_en;
|
||||
struct exynos_drm_clk phy_clk;
|
||||
struct drm_bridge *bridge;
|
||||
|
||||
/* mutex protecting subsequent fields below */
|
||||
struct mutex mutex;
|
||||
struct hdmi_audio audio;
|
||||
bool powered;
|
||||
};
|
||||
|
||||
static inline struct hdmi_context *encoder_to_hdmi(struct drm_encoder *e)
|
||||
@ -297,6 +307,15 @@ static const struct hdmiphy_config hdmiphy_v14_configs[] = {
|
||||
0x54, 0x93, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
|
||||
},
|
||||
},
|
||||
{
|
||||
.pixel_clock = 85500000,
|
||||
.conf = {
|
||||
0x01, 0xd1, 0x24, 0x11, 0x40, 0x40, 0xd0, 0x08,
|
||||
0x84, 0xa0, 0xd6, 0xd8, 0x45, 0xa0, 0xac, 0x80,
|
||||
0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
|
||||
0x54, 0x90, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
|
||||
},
|
||||
},
|
||||
{
|
||||
.pixel_clock = 106500000,
|
||||
.conf = {
|
||||
@ -768,8 +787,25 @@ static int hdmi_clk_set_parents(struct hdmi_context *hdata, bool to_phy)
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int hdmi_audio_infoframe_apply(struct hdmi_context *hdata)
|
||||
{
|
||||
struct hdmi_audio_infoframe *infoframe = &hdata->audio.infoframe;
|
||||
u8 buf[HDMI_INFOFRAME_SIZE(AUDIO)];
|
||||
int len;
|
||||
|
||||
len = hdmi_audio_infoframe_pack(infoframe, buf, sizeof(buf));
|
||||
if (len < 0)
|
||||
return len;
|
||||
|
||||
hdmi_reg_writeb(hdata, HDMI_AUI_CON, HDMI_AUI_CON_EVERY_VSYNC);
|
||||
hdmi_reg_write_buf(hdata, HDMI_AUI_HEADER0, buf, len);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void hdmi_reg_infoframes(struct hdmi_context *hdata)
|
||||
{
|
||||
struct drm_display_mode *m = &hdata->encoder.crtc->state->mode;
|
||||
union hdmi_infoframe frm;
|
||||
u8 buf[25];
|
||||
int ret;
|
||||
@ -783,8 +819,7 @@ static void hdmi_reg_infoframes(struct hdmi_context *hdata)
|
||||
return;
|
||||
}
|
||||
|
||||
ret = drm_hdmi_avi_infoframe_from_display_mode(&frm.avi,
|
||||
&hdata->current_mode, false);
|
||||
ret = drm_hdmi_avi_infoframe_from_display_mode(&frm.avi, m, false);
|
||||
if (!ret)
|
||||
ret = hdmi_avi_infoframe_pack(&frm.avi, buf, sizeof(buf));
|
||||
if (ret > 0) {
|
||||
@ -794,8 +829,7 @@ static void hdmi_reg_infoframes(struct hdmi_context *hdata)
|
||||
DRM_INFO("%s: invalid AVI infoframe (%d)\n", __func__, ret);
|
||||
}
|
||||
|
||||
ret = drm_hdmi_vendor_infoframe_from_display_mode(&frm.vendor.hdmi,
|
||||
&hdata->current_mode);
|
||||
ret = drm_hdmi_vendor_infoframe_from_display_mode(&frm.vendor.hdmi, m);
|
||||
if (!ret)
|
||||
ret = hdmi_vendor_infoframe_pack(&frm.vendor.hdmi, buf,
|
||||
sizeof(buf));
|
||||
@ -805,15 +839,7 @@ static void hdmi_reg_infoframes(struct hdmi_context *hdata)
|
||||
hdmi_reg_write_buf(hdata, HDMI_VSI_DATA(0), buf + 3, ret - 3);
|
||||
}
|
||||
|
||||
ret = hdmi_audio_infoframe_init(&frm.audio);
|
||||
if (!ret) {
|
||||
frm.audio.channels = 2;
|
||||
ret = hdmi_audio_infoframe_pack(&frm.audio, buf, sizeof(buf));
|
||||
}
|
||||
if (ret > 0) {
|
||||
hdmi_reg_writeb(hdata, HDMI_AUI_CON, HDMI_AUI_CON_EVERY_VSYNC);
|
||||
hdmi_reg_write_buf(hdata, HDMI_AUI_HEADER0, buf, ret);
|
||||
}
|
||||
hdmi_audio_infoframe_apply(hdata);
|
||||
}
|
||||
|
||||
static enum drm_connector_status hdmi_detect(struct drm_connector *connector,
|
||||
@ -1003,23 +1029,18 @@ static void hdmi_reg_acr(struct hdmi_context *hdata, u32 freq)
|
||||
hdmi_reg_writeb(hdata, HDMI_ACR_CON, 4);
|
||||
}
|
||||
|
||||
static void hdmi_audio_init(struct hdmi_context *hdata)
|
||||
static void hdmi_audio_config(struct hdmi_context *hdata)
|
||||
{
|
||||
u32 sample_rate, bits_per_sample;
|
||||
u32 data_num, bit_ch, sample_frq;
|
||||
u32 val;
|
||||
u32 bit_ch = 1;
|
||||
u32 data_num, val;
|
||||
int i;
|
||||
|
||||
sample_rate = 44100;
|
||||
bits_per_sample = 16;
|
||||
|
||||
switch (bits_per_sample) {
|
||||
switch (hdata->audio.params.sample_width) {
|
||||
case 20:
|
||||
data_num = 2;
|
||||
bit_ch = 1;
|
||||
break;
|
||||
case 24:
|
||||
data_num = 3;
|
||||
bit_ch = 1;
|
||||
break;
|
||||
default:
|
||||
data_num = 1;
|
||||
@ -1027,7 +1048,7 @@ static void hdmi_audio_init(struct hdmi_context *hdata)
|
||||
break;
|
||||
}
|
||||
|
||||
hdmi_reg_acr(hdata, sample_rate);
|
||||
hdmi_reg_acr(hdata, hdata->audio.params.sample_rate);
|
||||
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CON, HDMI_I2S_IN_DISABLE
|
||||
| HDMI_I2S_AUD_I2S | HDMI_I2S_CUV_I2S_ENABLE
|
||||
@ -1037,12 +1058,6 @@ static void hdmi_audio_init(struct hdmi_context *hdata)
|
||||
| HDMI_I2S_CH1_EN | HDMI_I2S_CH2_EN);
|
||||
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CUV, HDMI_I2S_CUV_RL_EN);
|
||||
|
||||
sample_frq = (sample_rate == 44100) ? 0 :
|
||||
(sample_rate == 48000) ? 2 :
|
||||
(sample_rate == 32000) ? 3 :
|
||||
(sample_rate == 96000) ? 0xa : 0x0;
|
||||
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CLK_CON, HDMI_I2S_CLK_DIS);
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CLK_CON, HDMI_I2S_CLK_EN);
|
||||
|
||||
@ -1066,39 +1081,33 @@ static void hdmi_audio_init(struct hdmi_context *hdata)
|
||||
| HDMI_I2S_SET_SDATA_BIT(data_num)
|
||||
| HDMI_I2S_BASIC_FORMAT);
|
||||
|
||||
/* Configure register related to CUV information */
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_0, HDMI_I2S_CH_STATUS_MODE_0
|
||||
| HDMI_I2S_2AUD_CH_WITHOUT_PREEMPH
|
||||
| HDMI_I2S_COPYRIGHT
|
||||
| HDMI_I2S_LINEAR_PCM
|
||||
| HDMI_I2S_CONSUMER_FORMAT);
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_1, HDMI_I2S_CD_PLAYER);
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_2, HDMI_I2S_SET_SOURCE_NUM(0));
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_3, HDMI_I2S_CLK_ACCUR_LEVEL_2
|
||||
| HDMI_I2S_SET_SMP_FREQ(sample_frq));
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_4,
|
||||
HDMI_I2S_ORG_SMP_FREQ_44_1
|
||||
| HDMI_I2S_WORD_LEN_MAX24_24BITS
|
||||
| HDMI_I2S_WORD_LEN_MAX_24BITS);
|
||||
/* Configuration of the audio channel status registers */
|
||||
for (i = 0; i < HDMI_I2S_CH_ST_MAXNUM; i++)
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST(i),
|
||||
hdata->audio.params.iec.status[i]);
|
||||
|
||||
hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_CON, HDMI_I2S_CH_STATUS_RELOAD);
|
||||
}
|
||||
|
||||
static void hdmi_audio_control(struct hdmi_context *hdata, bool onoff)
|
||||
static void hdmi_audio_control(struct hdmi_context *hdata)
|
||||
{
|
||||
bool enable = !hdata->audio.mute;
|
||||
|
||||
if (hdata->dvi_mode)
|
||||
return;
|
||||
|
||||
hdmi_reg_writeb(hdata, HDMI_AUI_CON, onoff ? 2 : 0);
|
||||
hdmi_reg_writemask(hdata, HDMI_CON_0, onoff ?
|
||||
hdmi_reg_writeb(hdata, HDMI_AUI_CON, enable ?
|
||||
HDMI_AVI_CON_EVERY_VSYNC : HDMI_AUI_CON_NO_TRAN);
|
||||
hdmi_reg_writemask(hdata, HDMI_CON_0, enable ?
|
||||
HDMI_ASP_EN : HDMI_ASP_DIS, HDMI_ASP_MASK);
|
||||
}
|
||||
|
||||
static void hdmi_start(struct hdmi_context *hdata, bool start)
|
||||
{
|
||||
struct drm_display_mode *m = &hdata->encoder.crtc->state->mode;
|
||||
u32 val = start ? HDMI_TG_EN : 0;
|
||||
|
||||
if (hdata->current_mode.flags & DRM_MODE_FLAG_INTERLACE)
|
||||
if (m->flags & DRM_MODE_FLAG_INTERLACE)
|
||||
val |= HDMI_FIELD_EN;
|
||||
|
||||
hdmi_reg_writemask(hdata, HDMI_CON_0, val, HDMI_EN);
|
||||
@ -1168,7 +1177,7 @@ static void hdmiphy_wait_for_pll(struct hdmi_context *hdata)
|
||||
|
||||
static void hdmi_v13_mode_apply(struct hdmi_context *hdata)
|
||||
{
|
||||
struct drm_display_mode *m = &hdata->current_mode;
|
||||
struct drm_display_mode *m = &hdata->encoder.crtc->state->mode;
|
||||
unsigned int val;
|
||||
|
||||
hdmi_reg_writev(hdata, HDMI_H_BLANK_0, 2, m->htotal - m->hdisplay);
|
||||
@ -1247,7 +1256,19 @@ static void hdmi_v13_mode_apply(struct hdmi_context *hdata)
|
||||
|
||||
static void hdmi_v14_mode_apply(struct hdmi_context *hdata)
|
||||
{
|
||||
struct drm_display_mode *m = &hdata->current_mode;
|
||||
struct drm_display_mode *m = &hdata->encoder.crtc->state->mode;
|
||||
struct drm_display_mode *am =
|
||||
&hdata->encoder.crtc->state->adjusted_mode;
|
||||
int hquirk = 0;
|
||||
|
||||
/*
|
||||
* In case video mode coming from CRTC differs from requested one HDMI
|
||||
* sometimes is able to almost properly perform conversion - only
|
||||
* first line is distorted.
|
||||
*/
|
||||
if ((m->vdisplay != am->vdisplay) &&
|
||||
(m->hdisplay == 1280 || m->hdisplay == 1024 || m->hdisplay == 1366))
|
||||
hquirk = 258;
|
||||
|
||||
hdmi_reg_writev(hdata, HDMI_H_BLANK_0, 2, m->htotal - m->hdisplay);
|
||||
hdmi_reg_writev(hdata, HDMI_V_LINE_0, 2, m->vtotal);
|
||||
@ -1341,8 +1362,9 @@ static void hdmi_v14_mode_apply(struct hdmi_context *hdata)
|
||||
hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_6_0, 2, 0xffff);
|
||||
|
||||
hdmi_reg_writev(hdata, HDMI_TG_H_FSZ_L, 2, m->htotal);
|
||||
hdmi_reg_writev(hdata, HDMI_TG_HACT_ST_L, 2, m->htotal - m->hdisplay);
|
||||
hdmi_reg_writev(hdata, HDMI_TG_HACT_SZ_L, 2, m->hdisplay);
|
||||
hdmi_reg_writev(hdata, HDMI_TG_HACT_ST_L, 2,
|
||||
m->htotal - m->hdisplay - hquirk);
|
||||
hdmi_reg_writev(hdata, HDMI_TG_HACT_SZ_L, 2, m->hdisplay + hquirk);
|
||||
hdmi_reg_writev(hdata, HDMI_TG_V_FSZ_L, 2, m->vtotal);
|
||||
if (hdata->drv_data == &exynos5433_hdmi_driver_data)
|
||||
hdmi_reg_writeb(hdata, HDMI_TG_DECON_EN, 1);
|
||||
@ -1380,10 +1402,11 @@ static void hdmiphy_enable_mode_set(struct hdmi_context *hdata, bool enable)
|
||||
|
||||
static void hdmiphy_conf_apply(struct hdmi_context *hdata)
|
||||
{
|
||||
struct drm_display_mode *m = &hdata->encoder.crtc->state->mode;
|
||||
int ret;
|
||||
const u8 *phy_conf;
|
||||
|
||||
ret = hdmi_find_phy_conf(hdata, hdata->current_mode.clock * 1000);
|
||||
ret = hdmi_find_phy_conf(hdata, m->clock * 1000);
|
||||
if (ret < 0) {
|
||||
DRM_ERROR("failed to find hdmiphy conf\n");
|
||||
return;
|
||||
@ -1406,28 +1429,14 @@ static void hdmiphy_conf_apply(struct hdmi_context *hdata)
|
||||
hdmiphy_wait_for_pll(hdata);
|
||||
}
|
||||
|
||||
/* Should be called with hdata->mutex mutex held */
|
||||
static void hdmi_conf_apply(struct hdmi_context *hdata)
|
||||
{
|
||||
hdmi_start(hdata, false);
|
||||
hdmi_conf_init(hdata);
|
||||
hdmi_audio_init(hdata);
|
||||
hdmi_audio_config(hdata);
|
||||
hdmi_mode_apply(hdata);
|
||||
hdmi_audio_control(hdata, true);
|
||||
}
|
||||
|
||||
static void hdmi_mode_set(struct drm_encoder *encoder,
|
||||
struct drm_display_mode *mode,
|
||||
struct drm_display_mode *adjusted_mode)
|
||||
{
|
||||
struct hdmi_context *hdata = encoder_to_hdmi(encoder);
|
||||
struct drm_display_mode *m = adjusted_mode;
|
||||
|
||||
DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%s\n",
|
||||
m->hdisplay, m->vdisplay,
|
||||
m->vrefresh, (m->flags & DRM_MODE_FLAG_INTERLACE) ?
|
||||
"INTERLACED" : "PROGRESSIVE");
|
||||
|
||||
drm_mode_copy(&hdata->current_mode, m);
|
||||
hdmi_audio_control(hdata);
|
||||
}
|
||||
|
||||
static void hdmi_set_refclk(struct hdmi_context *hdata, bool on)
|
||||
@ -1439,6 +1448,7 @@ static void hdmi_set_refclk(struct hdmi_context *hdata, bool on)
|
||||
SYSREG_HDMI_REFCLK_INT_CLK, on ? ~0 : 0);
|
||||
}
|
||||
|
||||
/* Should be called with hdata->mutex mutex held. */
|
||||
static void hdmiphy_enable(struct hdmi_context *hdata)
|
||||
{
|
||||
if (hdata->powered)
|
||||
@ -1461,6 +1471,7 @@ static void hdmiphy_enable(struct hdmi_context *hdata)
|
||||
hdata->powered = true;
|
||||
}
|
||||
|
||||
/* Should be called with hdata->mutex mutex held. */
|
||||
static void hdmiphy_disable(struct hdmi_context *hdata)
|
||||
{
|
||||
if (!hdata->powered)
|
||||
@ -1486,33 +1497,42 @@ static void hdmi_enable(struct drm_encoder *encoder)
|
||||
{
|
||||
struct hdmi_context *hdata = encoder_to_hdmi(encoder);
|
||||
|
||||
mutex_lock(&hdata->mutex);
|
||||
|
||||
hdmiphy_enable(hdata);
|
||||
hdmi_conf_apply(hdata);
|
||||
|
||||
mutex_unlock(&hdata->mutex);
|
||||
}
|
||||
|
||||
static void hdmi_disable(struct drm_encoder *encoder)
|
||||
{
|
||||
struct hdmi_context *hdata = encoder_to_hdmi(encoder);
|
||||
|
||||
if (!hdata->powered)
|
||||
return;
|
||||
mutex_lock(&hdata->mutex);
|
||||
|
||||
/*
|
||||
* The SFRs of VP and Mixer are updated by Vertical Sync of
|
||||
* Timing generator which is a part of HDMI so the sequence
|
||||
* to disable TV Subsystem should be as following,
|
||||
* VP -> Mixer -> HDMI
|
||||
*
|
||||
* To achieve such sequence HDMI is disabled together with HDMI PHY, via
|
||||
* pipe clock callback.
|
||||
*/
|
||||
cancel_delayed_work(&hdata->hotplug_work);
|
||||
cec_notifier_set_phys_addr(hdata->notifier, CEC_PHYS_ADDR_INVALID);
|
||||
if (hdata->powered) {
|
||||
/*
|
||||
* The SFRs of VP and Mixer are updated by Vertical Sync of
|
||||
* Timing generator which is a part of HDMI so the sequence
|
||||
* to disable TV Subsystem should be as following,
|
||||
* VP -> Mixer -> HDMI
|
||||
*
|
||||
* To achieve such sequence HDMI is disabled together with
|
||||
* HDMI PHY, via pipe clock callback.
|
||||
*/
|
||||
mutex_unlock(&hdata->mutex);
|
||||
cancel_delayed_work(&hdata->hotplug_work);
|
||||
cec_notifier_set_phys_addr(hdata->notifier,
|
||||
CEC_PHYS_ADDR_INVALID);
|
||||
return;
|
||||
}
|
||||
|
||||
mutex_unlock(&hdata->mutex);
|
||||
}
|
||||
|
||||
static const struct drm_encoder_helper_funcs exynos_hdmi_encoder_helper_funcs = {
|
||||
.mode_fixup = hdmi_mode_fixup,
|
||||
.mode_set = hdmi_mode_set,
|
||||
.enable = hdmi_enable,
|
||||
.disable = hdmi_disable,
|
||||
};
|
||||
@ -1521,6 +1541,99 @@ static const struct drm_encoder_funcs exynos_hdmi_encoder_funcs = {
|
||||
.destroy = drm_encoder_cleanup,
|
||||
};
|
||||
|
||||
static void hdmi_audio_shutdown(struct device *dev, void *data)
|
||||
{
|
||||
struct hdmi_context *hdata = dev_get_drvdata(dev);
|
||||
|
||||
mutex_lock(&hdata->mutex);
|
||||
|
||||
hdata->audio.mute = true;
|
||||
|
||||
if (hdata->powered)
|
||||
hdmi_audio_control(hdata);
|
||||
|
||||
mutex_unlock(&hdata->mutex);
|
||||
}
|
||||
|
||||
static int hdmi_audio_hw_params(struct device *dev, void *data,
|
||||
struct hdmi_codec_daifmt *daifmt,
|
||||
struct hdmi_codec_params *params)
|
||||
{
|
||||
struct hdmi_context *hdata = dev_get_drvdata(dev);
|
||||
|
||||
if (daifmt->fmt != HDMI_I2S || daifmt->bit_clk_inv ||
|
||||
daifmt->frame_clk_inv || daifmt->bit_clk_master ||
|
||||
daifmt->frame_clk_master) {
|
||||
dev_err(dev, "%s: Bad flags %d %d %d %d\n", __func__,
|
||||
daifmt->bit_clk_inv, daifmt->frame_clk_inv,
|
||||
daifmt->bit_clk_master,
|
||||
daifmt->frame_clk_master);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
mutex_lock(&hdata->mutex);
|
||||
|
||||
hdata->audio.params = *params;
|
||||
|
||||
if (hdata->powered) {
|
||||
hdmi_audio_config(hdata);
|
||||
hdmi_audio_infoframe_apply(hdata);
|
||||
}
|
||||
|
||||
mutex_unlock(&hdata->mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hdmi_audio_digital_mute(struct device *dev, void *data, bool mute)
|
||||
{
|
||||
struct hdmi_context *hdata = dev_get_drvdata(dev);
|
||||
|
||||
mutex_lock(&hdata->mutex);
|
||||
|
||||
hdata->audio.mute = mute;
|
||||
|
||||
if (hdata->powered)
|
||||
hdmi_audio_control(hdata);
|
||||
|
||||
mutex_unlock(&hdata->mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hdmi_audio_get_eld(struct device *dev, void *data, uint8_t *buf,
|
||||
size_t len)
|
||||
{
|
||||
struct hdmi_context *hdata = dev_get_drvdata(dev);
|
||||
struct drm_connector *connector = &hdata->connector;
|
||||
|
||||
memcpy(buf, connector->eld, min(sizeof(connector->eld), len));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct hdmi_codec_ops audio_codec_ops = {
|
||||
.hw_params = hdmi_audio_hw_params,
|
||||
.audio_shutdown = hdmi_audio_shutdown,
|
||||
.digital_mute = hdmi_audio_digital_mute,
|
||||
.get_eld = hdmi_audio_get_eld,
|
||||
};
|
||||
|
||||
static int hdmi_register_audio_device(struct hdmi_context *hdata)
|
||||
{
|
||||
struct hdmi_codec_pdata codec_data = {
|
||||
.ops = &audio_codec_ops,
|
||||
.max_i2s_channels = 6,
|
||||
.i2s = 1,
|
||||
};
|
||||
|
||||
hdata->audio.pdev = platform_device_register_data(
|
||||
hdata->dev, HDMI_CODEC_DRV_NAME, PLATFORM_DEVID_AUTO,
|
||||
&codec_data, sizeof(codec_data));
|
||||
|
||||
return PTR_ERR_OR_ZERO(hdata->audio.pdev);
|
||||
}
|
||||
|
||||
static void hdmi_hotplug_work_func(struct work_struct *work)
|
||||
{
|
||||
struct hdmi_context *hdata;
|
||||
@ -1596,11 +1709,14 @@ static void hdmiphy_clk_enable(struct exynos_drm_clk *clk, bool enable)
|
||||
{
|
||||
struct hdmi_context *hdata = container_of(clk, struct hdmi_context,
|
||||
phy_clk);
|
||||
mutex_lock(&hdata->mutex);
|
||||
|
||||
if (enable)
|
||||
hdmiphy_enable(hdata);
|
||||
else
|
||||
hdmiphy_disable(hdata);
|
||||
|
||||
mutex_unlock(&hdata->mutex);
|
||||
}
|
||||
|
||||
static int hdmi_bridge_init(struct hdmi_context *hdata)
|
||||
@ -1811,6 +1927,7 @@ out:
|
||||
|
||||
static int hdmi_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct hdmi_audio_infoframe *audio_infoframe;
|
||||
struct device *dev = &pdev->dev;
|
||||
struct hdmi_context *hdata;
|
||||
struct resource *res;
|
||||
@ -1826,6 +1943,8 @@ static int hdmi_probe(struct platform_device *pdev)
|
||||
|
||||
hdata->dev = dev;
|
||||
|
||||
mutex_init(&hdata->mutex);
|
||||
|
||||
ret = hdmi_resources_init(hdata);
|
||||
if (ret) {
|
||||
if (ret != -EPROBE_DEFER)
|
||||
@ -1885,12 +2004,26 @@ static int hdmi_probe(struct platform_device *pdev)
|
||||
|
||||
pm_runtime_enable(dev);
|
||||
|
||||
ret = component_add(&pdev->dev, &hdmi_component_ops);
|
||||
audio_infoframe = &hdata->audio.infoframe;
|
||||
hdmi_audio_infoframe_init(audio_infoframe);
|
||||
audio_infoframe->coding_type = HDMI_AUDIO_CODING_TYPE_STREAM;
|
||||
audio_infoframe->sample_size = HDMI_AUDIO_SAMPLE_SIZE_STREAM;
|
||||
audio_infoframe->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_STREAM;
|
||||
audio_infoframe->channels = 2;
|
||||
|
||||
ret = hdmi_register_audio_device(hdata);
|
||||
if (ret)
|
||||
goto err_notifier_put;
|
||||
|
||||
ret = component_add(&pdev->dev, &hdmi_component_ops);
|
||||
if (ret)
|
||||
goto err_unregister_audio;
|
||||
|
||||
return ret;
|
||||
|
||||
err_unregister_audio:
|
||||
platform_device_unregister(hdata->audio.pdev);
|
||||
|
||||
err_notifier_put:
|
||||
cec_notifier_put(hdata->notifier);
|
||||
pm_runtime_disable(dev);
|
||||
@ -1914,6 +2047,7 @@ static int hdmi_remove(struct platform_device *pdev)
|
||||
cec_notifier_set_phys_addr(hdata->notifier, CEC_PHYS_ADDR_INVALID);
|
||||
|
||||
component_del(&pdev->dev, &hdmi_component_ops);
|
||||
platform_device_unregister(hdata->audio.pdev);
|
||||
|
||||
cec_notifier_put(hdata->notifier);
|
||||
pm_runtime_disable(&pdev->dev);
|
||||
@ -1929,6 +2063,8 @@ static int hdmi_remove(struct platform_device *pdev)
|
||||
|
||||
put_device(&hdata->ddc_adpt->dev);
|
||||
|
||||
mutex_destroy(&hdata->mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -67,19 +67,6 @@
|
||||
#define MXR_FORMAT_ARGB4444 6
|
||||
#define MXR_FORMAT_ARGB8888 7
|
||||
|
||||
struct mixer_resources {
|
||||
int irq;
|
||||
void __iomem *mixer_regs;
|
||||
void __iomem *vp_regs;
|
||||
spinlock_t reg_slock;
|
||||
struct clk *mixer;
|
||||
struct clk *vp;
|
||||
struct clk *hdmi;
|
||||
struct clk *sclk_mixer;
|
||||
struct clk *sclk_hdmi;
|
||||
struct clk *mout_mixer;
|
||||
};
|
||||
|
||||
enum mixer_version_id {
|
||||
MXR_VER_0_0_0_16,
|
||||
MXR_VER_16_0_33_0,
|
||||
@ -117,8 +104,18 @@ struct mixer_context {
|
||||
struct exynos_drm_plane planes[MIXER_WIN_NR];
|
||||
unsigned long flags;
|
||||
|
||||
struct mixer_resources mixer_res;
|
||||
int irq;
|
||||
void __iomem *mixer_regs;
|
||||
void __iomem *vp_regs;
|
||||
spinlock_t reg_slock;
|
||||
struct clk *mixer;
|
||||
struct clk *vp;
|
||||
struct clk *hdmi;
|
||||
struct clk *sclk_mixer;
|
||||
struct clk *sclk_hdmi;
|
||||
struct clk *mout_mixer;
|
||||
enum mixer_version_id mxr_ver;
|
||||
int scan_value;
|
||||
};
|
||||
|
||||
struct mixer_drv_data {
|
||||
@ -194,44 +191,44 @@ static inline bool is_alpha_format(unsigned int pixel_format)
|
||||
}
|
||||
}
|
||||
|
||||
static inline u32 vp_reg_read(struct mixer_resources *res, u32 reg_id)
|
||||
static inline u32 vp_reg_read(struct mixer_context *ctx, u32 reg_id)
|
||||
{
|
||||
return readl(res->vp_regs + reg_id);
|
||||
return readl(ctx->vp_regs + reg_id);
|
||||
}
|
||||
|
||||
static inline void vp_reg_write(struct mixer_resources *res, u32 reg_id,
|
||||
static inline void vp_reg_write(struct mixer_context *ctx, u32 reg_id,
|
||||
u32 val)
|
||||
{
|
||||
writel(val, res->vp_regs + reg_id);
|
||||
writel(val, ctx->vp_regs + reg_id);
|
||||
}
|
||||
|
||||
static inline void vp_reg_writemask(struct mixer_resources *res, u32 reg_id,
|
||||
static inline void vp_reg_writemask(struct mixer_context *ctx, u32 reg_id,
|
||||
u32 val, u32 mask)
|
||||
{
|
||||
u32 old = vp_reg_read(res, reg_id);
|
||||
u32 old = vp_reg_read(ctx, reg_id);
|
||||
|
||||
val = (val & mask) | (old & ~mask);
|
||||
writel(val, res->vp_regs + reg_id);
|
||||
writel(val, ctx->vp_regs + reg_id);
|
||||
}
|
||||
|
||||
static inline u32 mixer_reg_read(struct mixer_resources *res, u32 reg_id)
|
||||
static inline u32 mixer_reg_read(struct mixer_context *ctx, u32 reg_id)
|
||||
{
|
||||
return readl(res->mixer_regs + reg_id);
|
||||
return readl(ctx->mixer_regs + reg_id);
|
||||
}
|
||||
|
||||
static inline void mixer_reg_write(struct mixer_resources *res, u32 reg_id,
|
||||
static inline void mixer_reg_write(struct mixer_context *ctx, u32 reg_id,
|
||||
u32 val)
|
||||
{
|
||||
writel(val, res->mixer_regs + reg_id);
|
||||
writel(val, ctx->mixer_regs + reg_id);
|
||||
}
|
||||
|
||||
static inline void mixer_reg_writemask(struct mixer_resources *res,
|
||||
static inline void mixer_reg_writemask(struct mixer_context *ctx,
|
||||
u32 reg_id, u32 val, u32 mask)
|
||||
{
|
||||
u32 old = mixer_reg_read(res, reg_id);
|
||||
u32 old = mixer_reg_read(ctx, reg_id);
|
||||
|
||||
val = (val & mask) | (old & ~mask);
|
||||
writel(val, res->mixer_regs + reg_id);
|
||||
writel(val, ctx->mixer_regs + reg_id);
|
||||
}
|
||||
|
||||
static void mixer_regs_dump(struct mixer_context *ctx)
|
||||
@ -239,7 +236,7 @@ static void mixer_regs_dump(struct mixer_context *ctx)
|
||||
#define DUMPREG(reg_id) \
|
||||
do { \
|
||||
DRM_DEBUG_KMS(#reg_id " = %08x\n", \
|
||||
(u32)readl(ctx->mixer_res.mixer_regs + reg_id)); \
|
||||
(u32)readl(ctx->mixer_regs + reg_id)); \
|
||||
} while (0)
|
||||
|
||||
DUMPREG(MXR_STATUS);
|
||||
@ -271,7 +268,7 @@ static void vp_regs_dump(struct mixer_context *ctx)
|
||||
#define DUMPREG(reg_id) \
|
||||
do { \
|
||||
DRM_DEBUG_KMS(#reg_id " = %08x\n", \
|
||||
(u32) readl(ctx->mixer_res.vp_regs + reg_id)); \
|
||||
(u32) readl(ctx->vp_regs + reg_id)); \
|
||||
} while (0)
|
||||
|
||||
DUMPREG(VP_ENABLE);
|
||||
@ -301,7 +298,7 @@ do { \
|
||||
#undef DUMPREG
|
||||
}
|
||||
|
||||
static inline void vp_filter_set(struct mixer_resources *res,
|
||||
static inline void vp_filter_set(struct mixer_context *ctx,
|
||||
int reg_id, const u8 *data, unsigned int size)
|
||||
{
|
||||
/* assure 4-byte align */
|
||||
@ -309,24 +306,23 @@ static inline void vp_filter_set(struct mixer_resources *res,
|
||||
for (; size; size -= 4, reg_id += 4, data += 4) {
|
||||
u32 val = (data[0] << 24) | (data[1] << 16) |
|
||||
(data[2] << 8) | data[3];
|
||||
vp_reg_write(res, reg_id, val);
|
||||
vp_reg_write(ctx, reg_id, val);
|
||||
}
|
||||
}
|
||||
|
||||
static void vp_default_filter(struct mixer_resources *res)
|
||||
static void vp_default_filter(struct mixer_context *ctx)
|
||||
{
|
||||
vp_filter_set(res, VP_POLY8_Y0_LL,
|
||||
vp_filter_set(ctx, VP_POLY8_Y0_LL,
|
||||
filter_y_horiz_tap8, sizeof(filter_y_horiz_tap8));
|
||||
vp_filter_set(res, VP_POLY4_Y0_LL,
|
||||
vp_filter_set(ctx, VP_POLY4_Y0_LL,
|
||||
filter_y_vert_tap4, sizeof(filter_y_vert_tap4));
|
||||
vp_filter_set(res, VP_POLY4_C0_LL,
|
||||
vp_filter_set(ctx, VP_POLY4_C0_LL,
|
||||
filter_cr_horiz_tap4, sizeof(filter_cr_horiz_tap4));
|
||||
}
|
||||
|
||||
static void mixer_cfg_gfx_blend(struct mixer_context *ctx, unsigned int win,
|
||||
bool alpha)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
u32 val;
|
||||
|
||||
val = MXR_GRP_CFG_COLOR_KEY_DISABLE; /* no blank key */
|
||||
@ -335,13 +331,12 @@ static void mixer_cfg_gfx_blend(struct mixer_context *ctx, unsigned int win,
|
||||
val |= MXR_GRP_CFG_BLEND_PRE_MUL;
|
||||
val |= MXR_GRP_CFG_PIXEL_BLEND_EN;
|
||||
}
|
||||
mixer_reg_writemask(res, MXR_GRAPHIC_CFG(win),
|
||||
mixer_reg_writemask(ctx, MXR_GRAPHIC_CFG(win),
|
||||
val, MXR_GRP_CFG_MISC_MASK);
|
||||
}
|
||||
|
||||
static void mixer_cfg_vp_blend(struct mixer_context *ctx)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
u32 val;
|
||||
|
||||
/*
|
||||
@ -351,51 +346,39 @@ static void mixer_cfg_vp_blend(struct mixer_context *ctx)
|
||||
* support blending of the video layer through this.
|
||||
*/
|
||||
val = 0;
|
||||
mixer_reg_write(res, MXR_VIDEO_CFG, val);
|
||||
mixer_reg_write(ctx, MXR_VIDEO_CFG, val);
|
||||
}
|
||||
|
||||
static void mixer_vsync_set_update(struct mixer_context *ctx, bool enable)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
|
||||
/* block update on vsync */
|
||||
mixer_reg_writemask(res, MXR_STATUS, enable ?
|
||||
mixer_reg_writemask(ctx, MXR_STATUS, enable ?
|
||||
MXR_STATUS_SYNC_ENABLE : 0, MXR_STATUS_SYNC_ENABLE);
|
||||
|
||||
if (test_bit(MXR_BIT_VP_ENABLED, &ctx->flags))
|
||||
vp_reg_write(res, VP_SHADOW_UPDATE, enable ?
|
||||
vp_reg_write(ctx, VP_SHADOW_UPDATE, enable ?
|
||||
VP_SHADOW_UPDATE_ENABLE : 0);
|
||||
}
|
||||
|
||||
static void mixer_cfg_scan(struct mixer_context *ctx, unsigned int height)
|
||||
static void mixer_cfg_scan(struct mixer_context *ctx, int width, int height)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
u32 val;
|
||||
|
||||
/* choosing between interlace and progressive mode */
|
||||
val = test_bit(MXR_BIT_INTERLACE, &ctx->flags) ?
|
||||
MXR_CFG_SCAN_INTERLACE : MXR_CFG_SCAN_PROGRESSIVE;
|
||||
|
||||
if (ctx->mxr_ver != MXR_VER_128_0_0_184) {
|
||||
/* choosing between proper HD and SD mode */
|
||||
if (height <= 480)
|
||||
val |= MXR_CFG_SCAN_NTSC | MXR_CFG_SCAN_SD;
|
||||
else if (height <= 576)
|
||||
val |= MXR_CFG_SCAN_PAL | MXR_CFG_SCAN_SD;
|
||||
else if (height <= 720)
|
||||
val |= MXR_CFG_SCAN_HD_720 | MXR_CFG_SCAN_HD;
|
||||
else if (height <= 1080)
|
||||
val |= MXR_CFG_SCAN_HD_1080 | MXR_CFG_SCAN_HD;
|
||||
else
|
||||
val |= MXR_CFG_SCAN_HD_720 | MXR_CFG_SCAN_HD;
|
||||
}
|
||||
if (ctx->mxr_ver == MXR_VER_128_0_0_184)
|
||||
mixer_reg_write(ctx, MXR_RESOLUTION,
|
||||
MXR_MXR_RES_HEIGHT(height) | MXR_MXR_RES_WIDTH(width));
|
||||
else
|
||||
val |= ctx->scan_value;
|
||||
|
||||
mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_SCAN_MASK);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, val, MXR_CFG_SCAN_MASK);
|
||||
}
|
||||
|
||||
static void mixer_cfg_rgb_fmt(struct mixer_context *ctx, unsigned int height)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
u32 val;
|
||||
|
||||
switch (height) {
|
||||
@ -408,45 +391,44 @@ static void mixer_cfg_rgb_fmt(struct mixer_context *ctx, unsigned int height)
|
||||
default:
|
||||
val = MXR_CFG_RGB709_16_235;
|
||||
/* Configure the BT.709 CSC matrix for full range RGB. */
|
||||
mixer_reg_write(res, MXR_CM_COEFF_Y,
|
||||
mixer_reg_write(ctx, MXR_CM_COEFF_Y,
|
||||
MXR_CSC_CT( 0.184, 0.614, 0.063) |
|
||||
MXR_CM_COEFF_RGB_FULL);
|
||||
mixer_reg_write(res, MXR_CM_COEFF_CB,
|
||||
mixer_reg_write(ctx, MXR_CM_COEFF_CB,
|
||||
MXR_CSC_CT(-0.102, -0.338, 0.440));
|
||||
mixer_reg_write(res, MXR_CM_COEFF_CR,
|
||||
mixer_reg_write(ctx, MXR_CM_COEFF_CR,
|
||||
MXR_CSC_CT( 0.440, -0.399, -0.040));
|
||||
break;
|
||||
}
|
||||
|
||||
mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_RGB_FMT_MASK);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, val, MXR_CFG_RGB_FMT_MASK);
|
||||
}
|
||||
|
||||
static void mixer_cfg_layer(struct mixer_context *ctx, unsigned int win,
|
||||
unsigned int priority, bool enable)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
u32 val = enable ? ~0 : 0;
|
||||
|
||||
switch (win) {
|
||||
case 0:
|
||||
mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_GRP0_ENABLE);
|
||||
mixer_reg_writemask(res, MXR_LAYER_CFG,
|
||||
mixer_reg_writemask(ctx, MXR_CFG, val, MXR_CFG_GRP0_ENABLE);
|
||||
mixer_reg_writemask(ctx, MXR_LAYER_CFG,
|
||||
MXR_LAYER_CFG_GRP0_VAL(priority),
|
||||
MXR_LAYER_CFG_GRP0_MASK);
|
||||
break;
|
||||
case 1:
|
||||
mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_GRP1_ENABLE);
|
||||
mixer_reg_writemask(res, MXR_LAYER_CFG,
|
||||
mixer_reg_writemask(ctx, MXR_CFG, val, MXR_CFG_GRP1_ENABLE);
|
||||
mixer_reg_writemask(ctx, MXR_LAYER_CFG,
|
||||
MXR_LAYER_CFG_GRP1_VAL(priority),
|
||||
MXR_LAYER_CFG_GRP1_MASK);
|
||||
|
||||
break;
|
||||
case VP_DEFAULT_WIN:
|
||||
if (test_bit(MXR_BIT_VP_ENABLED, &ctx->flags)) {
|
||||
vp_reg_writemask(res, VP_ENABLE, val, VP_ENABLE_ON);
|
||||
mixer_reg_writemask(res, MXR_CFG, val,
|
||||
vp_reg_writemask(ctx, VP_ENABLE, val, VP_ENABLE_ON);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, val,
|
||||
MXR_CFG_VP_ENABLE);
|
||||
mixer_reg_writemask(res, MXR_LAYER_CFG,
|
||||
mixer_reg_writemask(ctx, MXR_LAYER_CFG,
|
||||
MXR_LAYER_CFG_VP_VAL(priority),
|
||||
MXR_LAYER_CFG_VP_MASK);
|
||||
}
|
||||
@ -456,30 +438,34 @@ static void mixer_cfg_layer(struct mixer_context *ctx, unsigned int win,
|
||||
|
||||
static void mixer_run(struct mixer_context *ctx)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
|
||||
mixer_reg_writemask(res, MXR_STATUS, ~0, MXR_STATUS_REG_RUN);
|
||||
mixer_reg_writemask(ctx, MXR_STATUS, ~0, MXR_STATUS_REG_RUN);
|
||||
}
|
||||
|
||||
static void mixer_stop(struct mixer_context *ctx)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
int timeout = 20;
|
||||
|
||||
mixer_reg_writemask(res, MXR_STATUS, 0, MXR_STATUS_REG_RUN);
|
||||
mixer_reg_writemask(ctx, MXR_STATUS, 0, MXR_STATUS_REG_RUN);
|
||||
|
||||
while (!(mixer_reg_read(res, MXR_STATUS) & MXR_STATUS_REG_IDLE) &&
|
||||
while (!(mixer_reg_read(ctx, MXR_STATUS) & MXR_STATUS_REG_IDLE) &&
|
||||
--timeout)
|
||||
usleep_range(10000, 12000);
|
||||
}
|
||||
|
||||
static void mixer_commit(struct mixer_context *ctx)
|
||||
{
|
||||
struct drm_display_mode *mode = &ctx->crtc->base.state->adjusted_mode;
|
||||
|
||||
mixer_cfg_scan(ctx, mode->hdisplay, mode->vdisplay);
|
||||
mixer_cfg_rgb_fmt(ctx, mode->vdisplay);
|
||||
mixer_run(ctx);
|
||||
}
|
||||
|
||||
static void vp_video_buffer(struct mixer_context *ctx,
|
||||
struct exynos_drm_plane *plane)
|
||||
{
|
||||
struct exynos_drm_plane_state *state =
|
||||
to_exynos_plane_state(plane->base.state);
|
||||
struct drm_display_mode *mode = &state->base.crtc->state->adjusted_mode;
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
struct drm_framebuffer *fb = state->base.fb;
|
||||
unsigned int priority = state->base.normalized_zpos + 1;
|
||||
unsigned long flags;
|
||||
@ -493,8 +479,7 @@ static void vp_video_buffer(struct mixer_context *ctx,
|
||||
luma_addr[0] = exynos_drm_fb_dma_addr(fb, 0);
|
||||
chroma_addr[0] = exynos_drm_fb_dma_addr(fb, 1);
|
||||
|
||||
if (mode->flags & DRM_MODE_FLAG_INTERLACE) {
|
||||
__set_bit(MXR_BIT_INTERLACE, &ctx->flags);
|
||||
if (test_bit(MXR_BIT_INTERLACE, &ctx->flags)) {
|
||||
if (is_tiled) {
|
||||
luma_addr[1] = luma_addr[0] + 0x40;
|
||||
chroma_addr[1] = chroma_addr[0] + 0x40;
|
||||
@ -503,63 +488,59 @@ static void vp_video_buffer(struct mixer_context *ctx,
|
||||
chroma_addr[1] = chroma_addr[0] + fb->pitches[0];
|
||||
}
|
||||
} else {
|
||||
__clear_bit(MXR_BIT_INTERLACE, &ctx->flags);
|
||||
luma_addr[1] = 0;
|
||||
chroma_addr[1] = 0;
|
||||
}
|
||||
|
||||
spin_lock_irqsave(&res->reg_slock, flags);
|
||||
spin_lock_irqsave(&ctx->reg_slock, flags);
|
||||
|
||||
/* interlace or progressive scan mode */
|
||||
val = (test_bit(MXR_BIT_INTERLACE, &ctx->flags) ? ~0 : 0);
|
||||
vp_reg_writemask(res, VP_MODE, val, VP_MODE_LINE_SKIP);
|
||||
vp_reg_writemask(ctx, VP_MODE, val, VP_MODE_LINE_SKIP);
|
||||
|
||||
/* setup format */
|
||||
val = (is_nv21 ? VP_MODE_NV21 : VP_MODE_NV12);
|
||||
val |= (is_tiled ? VP_MODE_MEM_TILED : VP_MODE_MEM_LINEAR);
|
||||
vp_reg_writemask(res, VP_MODE, val, VP_MODE_FMT_MASK);
|
||||
vp_reg_writemask(ctx, VP_MODE, val, VP_MODE_FMT_MASK);
|
||||
|
||||
/* setting size of input image */
|
||||
vp_reg_write(res, VP_IMG_SIZE_Y, VP_IMG_HSIZE(fb->pitches[0]) |
|
||||
vp_reg_write(ctx, VP_IMG_SIZE_Y, VP_IMG_HSIZE(fb->pitches[0]) |
|
||||
VP_IMG_VSIZE(fb->height));
|
||||
/* chroma plane for NV12/NV21 is half the height of the luma plane */
|
||||
vp_reg_write(res, VP_IMG_SIZE_C, VP_IMG_HSIZE(fb->pitches[0]) |
|
||||
vp_reg_write(ctx, VP_IMG_SIZE_C, VP_IMG_HSIZE(fb->pitches[0]) |
|
||||
VP_IMG_VSIZE(fb->height / 2));
|
||||
|
||||
vp_reg_write(res, VP_SRC_WIDTH, state->src.w);
|
||||
vp_reg_write(res, VP_SRC_HEIGHT, state->src.h);
|
||||
vp_reg_write(res, VP_SRC_H_POSITION,
|
||||
vp_reg_write(ctx, VP_SRC_WIDTH, state->src.w);
|
||||
vp_reg_write(ctx, VP_SRC_HEIGHT, state->src.h);
|
||||
vp_reg_write(ctx, VP_SRC_H_POSITION,
|
||||
VP_SRC_H_POSITION_VAL(state->src.x));
|
||||
vp_reg_write(res, VP_SRC_V_POSITION, state->src.y);
|
||||
vp_reg_write(ctx, VP_SRC_V_POSITION, state->src.y);
|
||||
|
||||
vp_reg_write(res, VP_DST_WIDTH, state->crtc.w);
|
||||
vp_reg_write(res, VP_DST_H_POSITION, state->crtc.x);
|
||||
vp_reg_write(ctx, VP_DST_WIDTH, state->crtc.w);
|
||||
vp_reg_write(ctx, VP_DST_H_POSITION, state->crtc.x);
|
||||
if (test_bit(MXR_BIT_INTERLACE, &ctx->flags)) {
|
||||
vp_reg_write(res, VP_DST_HEIGHT, state->crtc.h / 2);
|
||||
vp_reg_write(res, VP_DST_V_POSITION, state->crtc.y / 2);
|
||||
vp_reg_write(ctx, VP_DST_HEIGHT, state->crtc.h / 2);
|
||||
vp_reg_write(ctx, VP_DST_V_POSITION, state->crtc.y / 2);
|
||||
} else {
|
||||
vp_reg_write(res, VP_DST_HEIGHT, state->crtc.h);
|
||||
vp_reg_write(res, VP_DST_V_POSITION, state->crtc.y);
|
||||
vp_reg_write(ctx, VP_DST_HEIGHT, state->crtc.h);
|
||||
vp_reg_write(ctx, VP_DST_V_POSITION, state->crtc.y);
|
||||
}
|
||||
|
||||
vp_reg_write(res, VP_H_RATIO, state->h_ratio);
|
||||
vp_reg_write(res, VP_V_RATIO, state->v_ratio);
|
||||
vp_reg_write(ctx, VP_H_RATIO, state->h_ratio);
|
||||
vp_reg_write(ctx, VP_V_RATIO, state->v_ratio);
|
||||
|
||||
vp_reg_write(res, VP_ENDIAN_MODE, VP_ENDIAN_MODE_LITTLE);
|
||||
vp_reg_write(ctx, VP_ENDIAN_MODE, VP_ENDIAN_MODE_LITTLE);
|
||||
|
||||
/* set buffer address to vp */
|
||||
vp_reg_write(res, VP_TOP_Y_PTR, luma_addr[0]);
|
||||
vp_reg_write(res, VP_BOT_Y_PTR, luma_addr[1]);
|
||||
vp_reg_write(res, VP_TOP_C_PTR, chroma_addr[0]);
|
||||
vp_reg_write(res, VP_BOT_C_PTR, chroma_addr[1]);
|
||||
vp_reg_write(ctx, VP_TOP_Y_PTR, luma_addr[0]);
|
||||
vp_reg_write(ctx, VP_BOT_Y_PTR, luma_addr[1]);
|
||||
vp_reg_write(ctx, VP_TOP_C_PTR, chroma_addr[0]);
|
||||
vp_reg_write(ctx, VP_BOT_C_PTR, chroma_addr[1]);
|
||||
|
||||
mixer_cfg_scan(ctx, mode->vdisplay);
|
||||
mixer_cfg_rgb_fmt(ctx, mode->vdisplay);
|
||||
mixer_cfg_layer(ctx, plane->index, priority, true);
|
||||
mixer_cfg_vp_blend(ctx);
|
||||
mixer_run(ctx);
|
||||
|
||||
spin_unlock_irqrestore(&res->reg_slock, flags);
|
||||
spin_unlock_irqrestore(&ctx->reg_slock, flags);
|
||||
|
||||
mixer_regs_dump(ctx);
|
||||
vp_regs_dump(ctx);
|
||||
@ -567,9 +548,7 @@ static void vp_video_buffer(struct mixer_context *ctx,
|
||||
|
||||
static void mixer_layer_update(struct mixer_context *ctx)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
|
||||
mixer_reg_writemask(res, MXR_CFG, ~0, MXR_CFG_LAYER_UPDATE);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, ~0, MXR_CFG_LAYER_UPDATE);
|
||||
}
|
||||
|
||||
static void mixer_graph_buffer(struct mixer_context *ctx,
|
||||
@ -577,8 +556,6 @@ static void mixer_graph_buffer(struct mixer_context *ctx,
|
||||
{
|
||||
struct exynos_drm_plane_state *state =
|
||||
to_exynos_plane_state(plane->base.state);
|
||||
struct drm_display_mode *mode = &state->base.crtc->state->adjusted_mode;
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
struct drm_framebuffer *fb = state->base.fb;
|
||||
unsigned int priority = state->base.normalized_zpos + 1;
|
||||
unsigned long flags;
|
||||
@ -623,45 +600,30 @@ static void mixer_graph_buffer(struct mixer_context *ctx,
|
||||
+ (state->src.x * fb->format->cpp[0])
|
||||
+ (state->src.y * fb->pitches[0]);
|
||||
|
||||
if (mode->flags & DRM_MODE_FLAG_INTERLACE)
|
||||
__set_bit(MXR_BIT_INTERLACE, &ctx->flags);
|
||||
else
|
||||
__clear_bit(MXR_BIT_INTERLACE, &ctx->flags);
|
||||
|
||||
spin_lock_irqsave(&res->reg_slock, flags);
|
||||
spin_lock_irqsave(&ctx->reg_slock, flags);
|
||||
|
||||
/* setup format */
|
||||
mixer_reg_writemask(res, MXR_GRAPHIC_CFG(win),
|
||||
mixer_reg_writemask(ctx, MXR_GRAPHIC_CFG(win),
|
||||
MXR_GRP_CFG_FORMAT_VAL(fmt), MXR_GRP_CFG_FORMAT_MASK);
|
||||
|
||||
/* setup geometry */
|
||||
mixer_reg_write(res, MXR_GRAPHIC_SPAN(win),
|
||||
mixer_reg_write(ctx, MXR_GRAPHIC_SPAN(win),
|
||||
fb->pitches[0] / fb->format->cpp[0]);
|
||||
|
||||
/* setup display size */
|
||||
if (ctx->mxr_ver == MXR_VER_128_0_0_184 &&
|
||||
win == DEFAULT_WIN) {
|
||||
val = MXR_MXR_RES_HEIGHT(mode->vdisplay);
|
||||
val |= MXR_MXR_RES_WIDTH(mode->hdisplay);
|
||||
mixer_reg_write(res, MXR_RESOLUTION, val);
|
||||
}
|
||||
|
||||
val = MXR_GRP_WH_WIDTH(state->src.w);
|
||||
val |= MXR_GRP_WH_HEIGHT(state->src.h);
|
||||
val |= MXR_GRP_WH_H_SCALE(x_ratio);
|
||||
val |= MXR_GRP_WH_V_SCALE(y_ratio);
|
||||
mixer_reg_write(res, MXR_GRAPHIC_WH(win), val);
|
||||
mixer_reg_write(ctx, MXR_GRAPHIC_WH(win), val);
|
||||
|
||||
/* setup offsets in display image */
|
||||
val = MXR_GRP_DXY_DX(dst_x_offset);
|
||||
val |= MXR_GRP_DXY_DY(dst_y_offset);
|
||||
mixer_reg_write(res, MXR_GRAPHIC_DXY(win), val);
|
||||
mixer_reg_write(ctx, MXR_GRAPHIC_DXY(win), val);
|
||||
|
||||
/* set buffer address to mixer */
|
||||
mixer_reg_write(res, MXR_GRAPHIC_BASE(win), dma_addr);
|
||||
mixer_reg_write(ctx, MXR_GRAPHIC_BASE(win), dma_addr);
|
||||
|
||||
mixer_cfg_scan(ctx, mode->vdisplay);
|
||||
mixer_cfg_rgb_fmt(ctx, mode->vdisplay);
|
||||
mixer_cfg_layer(ctx, win, priority, true);
|
||||
mixer_cfg_gfx_blend(ctx, win, is_alpha_format(fb->format->format));
|
||||
|
||||
@ -670,22 +632,19 @@ static void mixer_graph_buffer(struct mixer_context *ctx,
|
||||
ctx->mxr_ver == MXR_VER_128_0_0_184)
|
||||
mixer_layer_update(ctx);
|
||||
|
||||
mixer_run(ctx);
|
||||
|
||||
spin_unlock_irqrestore(&res->reg_slock, flags);
|
||||
spin_unlock_irqrestore(&ctx->reg_slock, flags);
|
||||
|
||||
mixer_regs_dump(ctx);
|
||||
}
|
||||
|
||||
static void vp_win_reset(struct mixer_context *ctx)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
unsigned int tries = 100;
|
||||
|
||||
vp_reg_write(res, VP_SRESET, VP_SRESET_PROCESSING);
|
||||
vp_reg_write(ctx, VP_SRESET, VP_SRESET_PROCESSING);
|
||||
while (--tries) {
|
||||
/* waiting until VP_SRESET_PROCESSING is 0 */
|
||||
if (~vp_reg_read(res, VP_SRESET) & VP_SRESET_PROCESSING)
|
||||
if (~vp_reg_read(ctx, VP_SRESET) & VP_SRESET_PROCESSING)
|
||||
break;
|
||||
mdelay(10);
|
||||
}
|
||||
@ -694,57 +653,55 @@ static void vp_win_reset(struct mixer_context *ctx)
|
||||
|
||||
static void mixer_win_reset(struct mixer_context *ctx)
|
||||
{
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&res->reg_slock, flags);
|
||||
spin_lock_irqsave(&ctx->reg_slock, flags);
|
||||
|
||||
mixer_reg_writemask(res, MXR_CFG, MXR_CFG_DST_HDMI, MXR_CFG_DST_MASK);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, MXR_CFG_DST_HDMI, MXR_CFG_DST_MASK);
|
||||
|
||||
/* set output in RGB888 mode */
|
||||
mixer_reg_writemask(res, MXR_CFG, MXR_CFG_OUT_RGB888, MXR_CFG_OUT_MASK);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, MXR_CFG_OUT_RGB888, MXR_CFG_OUT_MASK);
|
||||
|
||||
/* 16 beat burst in DMA */
|
||||
mixer_reg_writemask(res, MXR_STATUS, MXR_STATUS_16_BURST,
|
||||
mixer_reg_writemask(ctx, MXR_STATUS, MXR_STATUS_16_BURST,
|
||||
MXR_STATUS_BURST_MASK);
|
||||
|
||||
/* reset default layer priority */
|
||||
mixer_reg_write(res, MXR_LAYER_CFG, 0);
|
||||
mixer_reg_write(ctx, MXR_LAYER_CFG, 0);
|
||||
|
||||
/* set all background colors to RGB (0,0,0) */
|
||||
mixer_reg_write(res, MXR_BG_COLOR0, MXR_YCBCR_VAL(0, 128, 128));
|
||||
mixer_reg_write(res, MXR_BG_COLOR1, MXR_YCBCR_VAL(0, 128, 128));
|
||||
mixer_reg_write(res, MXR_BG_COLOR2, MXR_YCBCR_VAL(0, 128, 128));
|
||||
mixer_reg_write(ctx, MXR_BG_COLOR0, MXR_YCBCR_VAL(0, 128, 128));
|
||||
mixer_reg_write(ctx, MXR_BG_COLOR1, MXR_YCBCR_VAL(0, 128, 128));
|
||||
mixer_reg_write(ctx, MXR_BG_COLOR2, MXR_YCBCR_VAL(0, 128, 128));
|
||||
|
||||
if (test_bit(MXR_BIT_VP_ENABLED, &ctx->flags)) {
|
||||
/* configuration of Video Processor Registers */
|
||||
vp_win_reset(ctx);
|
||||
vp_default_filter(res);
|
||||
vp_default_filter(ctx);
|
||||
}
|
||||
|
||||
/* disable all layers */
|
||||
mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_GRP0_ENABLE);
|
||||
mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_GRP1_ENABLE);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, 0, MXR_CFG_GRP0_ENABLE);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, 0, MXR_CFG_GRP1_ENABLE);
|
||||
if (test_bit(MXR_BIT_VP_ENABLED, &ctx->flags))
|
||||
mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_VP_ENABLE);
|
||||
mixer_reg_writemask(ctx, MXR_CFG, 0, MXR_CFG_VP_ENABLE);
|
||||
|
||||
/* set all source image offsets to zero */
|
||||
mixer_reg_write(res, MXR_GRAPHIC_SXY(0), 0);
|
||||
mixer_reg_write(res, MXR_GRAPHIC_SXY(1), 0);
|
||||
mixer_reg_write(ctx, MXR_GRAPHIC_SXY(0), 0);
|
||||
mixer_reg_write(ctx, MXR_GRAPHIC_SXY(1), 0);
|
||||
|
||||
spin_unlock_irqrestore(&res->reg_slock, flags);
|
||||
spin_unlock_irqrestore(&ctx->reg_slock, flags);
|
||||
}
|
||||
|
||||
static irqreturn_t mixer_irq_handler(int irq, void *arg)
|
||||
{
|
||||
struct mixer_context *ctx = arg;
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
u32 val, base, shadow;
|
||||
|
||||
spin_lock(&res->reg_slock);
|
||||
spin_lock(&ctx->reg_slock);
|
||||
|
||||
/* read interrupt status for handling and clearing flags for VSYNC */
|
||||
val = mixer_reg_read(res, MXR_INT_STATUS);
|
||||
val = mixer_reg_read(ctx, MXR_INT_STATUS);
|
||||
|
||||
/* handling VSYNC */
|
||||
if (val & MXR_INT_STATUS_VSYNC) {
|
||||
@ -754,13 +711,13 @@ static irqreturn_t mixer_irq_handler(int irq, void *arg)
|
||||
|
||||
/* interlace scan need to check shadow register */
|
||||
if (test_bit(MXR_BIT_INTERLACE, &ctx->flags)) {
|
||||
base = mixer_reg_read(res, MXR_GRAPHIC_BASE(0));
|
||||
shadow = mixer_reg_read(res, MXR_GRAPHIC_BASE_S(0));
|
||||
base = mixer_reg_read(ctx, MXR_GRAPHIC_BASE(0));
|
||||
shadow = mixer_reg_read(ctx, MXR_GRAPHIC_BASE_S(0));
|
||||
if (base != shadow)
|
||||
goto out;
|
||||
|
||||
base = mixer_reg_read(res, MXR_GRAPHIC_BASE(1));
|
||||
shadow = mixer_reg_read(res, MXR_GRAPHIC_BASE_S(1));
|
||||
base = mixer_reg_read(ctx, MXR_GRAPHIC_BASE(1));
|
||||
shadow = mixer_reg_read(ctx, MXR_GRAPHIC_BASE_S(1));
|
||||
if (base != shadow)
|
||||
goto out;
|
||||
}
|
||||
@ -770,9 +727,9 @@ static irqreturn_t mixer_irq_handler(int irq, void *arg)
|
||||
|
||||
out:
|
||||
/* clear interrupts */
|
||||
mixer_reg_write(res, MXR_INT_STATUS, val);
|
||||
mixer_reg_write(ctx, MXR_INT_STATUS, val);
|
||||
|
||||
spin_unlock(&res->reg_slock);
|
||||
spin_unlock(&ctx->reg_slock);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
@ -780,26 +737,25 @@ out:
|
||||
static int mixer_resources_init(struct mixer_context *mixer_ctx)
|
||||
{
|
||||
struct device *dev = &mixer_ctx->pdev->dev;
|
||||
struct mixer_resources *mixer_res = &mixer_ctx->mixer_res;
|
||||
struct resource *res;
|
||||
int ret;
|
||||
|
||||
spin_lock_init(&mixer_res->reg_slock);
|
||||
spin_lock_init(&mixer_ctx->reg_slock);
|
||||
|
||||
mixer_res->mixer = devm_clk_get(dev, "mixer");
|
||||
if (IS_ERR(mixer_res->mixer)) {
|
||||
mixer_ctx->mixer = devm_clk_get(dev, "mixer");
|
||||
if (IS_ERR(mixer_ctx->mixer)) {
|
||||
dev_err(dev, "failed to get clock 'mixer'\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
mixer_res->hdmi = devm_clk_get(dev, "hdmi");
|
||||
if (IS_ERR(mixer_res->hdmi)) {
|
||||
mixer_ctx->hdmi = devm_clk_get(dev, "hdmi");
|
||||
if (IS_ERR(mixer_ctx->hdmi)) {
|
||||
dev_err(dev, "failed to get clock 'hdmi'\n");
|
||||
return PTR_ERR(mixer_res->hdmi);
|
||||
return PTR_ERR(mixer_ctx->hdmi);
|
||||
}
|
||||
|
||||
mixer_res->sclk_hdmi = devm_clk_get(dev, "sclk_hdmi");
|
||||
if (IS_ERR(mixer_res->sclk_hdmi)) {
|
||||
mixer_ctx->sclk_hdmi = devm_clk_get(dev, "sclk_hdmi");
|
||||
if (IS_ERR(mixer_ctx->sclk_hdmi)) {
|
||||
dev_err(dev, "failed to get clock 'sclk_hdmi'\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
@ -809,9 +765,9 @@ static int mixer_resources_init(struct mixer_context *mixer_ctx)
|
||||
return -ENXIO;
|
||||
}
|
||||
|
||||
mixer_res->mixer_regs = devm_ioremap(dev, res->start,
|
||||
mixer_ctx->mixer_regs = devm_ioremap(dev, res->start,
|
||||
resource_size(res));
|
||||
if (mixer_res->mixer_regs == NULL) {
|
||||
if (mixer_ctx->mixer_regs == NULL) {
|
||||
dev_err(dev, "register mapping failed.\n");
|
||||
return -ENXIO;
|
||||
}
|
||||
@ -828,7 +784,7 @@ static int mixer_resources_init(struct mixer_context *mixer_ctx)
|
||||
dev_err(dev, "request interrupt failed.\n");
|
||||
return ret;
|
||||
}
|
||||
mixer_res->irq = res->start;
|
||||
mixer_ctx->irq = res->start;
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -836,30 +792,29 @@ static int mixer_resources_init(struct mixer_context *mixer_ctx)
|
||||
static int vp_resources_init(struct mixer_context *mixer_ctx)
|
||||
{
|
||||
struct device *dev = &mixer_ctx->pdev->dev;
|
||||
struct mixer_resources *mixer_res = &mixer_ctx->mixer_res;
|
||||
struct resource *res;
|
||||
|
||||
mixer_res->vp = devm_clk_get(dev, "vp");
|
||||
if (IS_ERR(mixer_res->vp)) {
|
||||
mixer_ctx->vp = devm_clk_get(dev, "vp");
|
||||
if (IS_ERR(mixer_ctx->vp)) {
|
||||
dev_err(dev, "failed to get clock 'vp'\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
if (test_bit(MXR_BIT_HAS_SCLK, &mixer_ctx->flags)) {
|
||||
mixer_res->sclk_mixer = devm_clk_get(dev, "sclk_mixer");
|
||||
if (IS_ERR(mixer_res->sclk_mixer)) {
|
||||
mixer_ctx->sclk_mixer = devm_clk_get(dev, "sclk_mixer");
|
||||
if (IS_ERR(mixer_ctx->sclk_mixer)) {
|
||||
dev_err(dev, "failed to get clock 'sclk_mixer'\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
mixer_res->mout_mixer = devm_clk_get(dev, "mout_mixer");
|
||||
if (IS_ERR(mixer_res->mout_mixer)) {
|
||||
mixer_ctx->mout_mixer = devm_clk_get(dev, "mout_mixer");
|
||||
if (IS_ERR(mixer_ctx->mout_mixer)) {
|
||||
dev_err(dev, "failed to get clock 'mout_mixer'\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
if (mixer_res->sclk_hdmi && mixer_res->mout_mixer)
|
||||
clk_set_parent(mixer_res->mout_mixer,
|
||||
mixer_res->sclk_hdmi);
|
||||
if (mixer_ctx->sclk_hdmi && mixer_ctx->mout_mixer)
|
||||
clk_set_parent(mixer_ctx->mout_mixer,
|
||||
mixer_ctx->sclk_hdmi);
|
||||
}
|
||||
|
||||
res = platform_get_resource(mixer_ctx->pdev, IORESOURCE_MEM, 1);
|
||||
@ -868,9 +823,9 @@ static int vp_resources_init(struct mixer_context *mixer_ctx)
|
||||
return -ENXIO;
|
||||
}
|
||||
|
||||
mixer_res->vp_regs = devm_ioremap(dev, res->start,
|
||||
mixer_ctx->vp_regs = devm_ioremap(dev, res->start,
|
||||
resource_size(res));
|
||||
if (mixer_res->vp_regs == NULL) {
|
||||
if (mixer_ctx->vp_regs == NULL) {
|
||||
dev_err(dev, "register mapping failed.\n");
|
||||
return -ENXIO;
|
||||
}
|
||||
@ -914,15 +869,14 @@ static void mixer_ctx_remove(struct mixer_context *mixer_ctx)
|
||||
static int mixer_enable_vblank(struct exynos_drm_crtc *crtc)
|
||||
{
|
||||
struct mixer_context *mixer_ctx = crtc->ctx;
|
||||
struct mixer_resources *res = &mixer_ctx->mixer_res;
|
||||
|
||||
__set_bit(MXR_BIT_VSYNC, &mixer_ctx->flags);
|
||||
if (!test_bit(MXR_BIT_POWERED, &mixer_ctx->flags))
|
||||
return 0;
|
||||
|
||||
/* enable vsync interrupt */
|
||||
mixer_reg_writemask(res, MXR_INT_STATUS, ~0, MXR_INT_CLEAR_VSYNC);
|
||||
mixer_reg_writemask(res, MXR_INT_EN, ~0, MXR_INT_EN_VSYNC);
|
||||
mixer_reg_writemask(mixer_ctx, MXR_INT_STATUS, ~0, MXR_INT_CLEAR_VSYNC);
|
||||
mixer_reg_writemask(mixer_ctx, MXR_INT_EN, ~0, MXR_INT_EN_VSYNC);
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -930,7 +884,6 @@ static int mixer_enable_vblank(struct exynos_drm_crtc *crtc)
|
||||
static void mixer_disable_vblank(struct exynos_drm_crtc *crtc)
|
||||
{
|
||||
struct mixer_context *mixer_ctx = crtc->ctx;
|
||||
struct mixer_resources *res = &mixer_ctx->mixer_res;
|
||||
|
||||
__clear_bit(MXR_BIT_VSYNC, &mixer_ctx->flags);
|
||||
|
||||
@ -938,8 +891,8 @@ static void mixer_disable_vblank(struct exynos_drm_crtc *crtc)
|
||||
return;
|
||||
|
||||
/* disable vsync interrupt */
|
||||
mixer_reg_writemask(res, MXR_INT_STATUS, ~0, MXR_INT_CLEAR_VSYNC);
|
||||
mixer_reg_writemask(res, MXR_INT_EN, 0, MXR_INT_EN_VSYNC);
|
||||
mixer_reg_writemask(mixer_ctx, MXR_INT_STATUS, ~0, MXR_INT_CLEAR_VSYNC);
|
||||
mixer_reg_writemask(mixer_ctx, MXR_INT_EN, 0, MXR_INT_EN_VSYNC);
|
||||
}
|
||||
|
||||
static void mixer_atomic_begin(struct exynos_drm_crtc *crtc)
|
||||
@ -972,7 +925,6 @@ static void mixer_disable_plane(struct exynos_drm_crtc *crtc,
|
||||
struct exynos_drm_plane *plane)
|
||||
{
|
||||
struct mixer_context *mixer_ctx = crtc->ctx;
|
||||
struct mixer_resources *res = &mixer_ctx->mixer_res;
|
||||
unsigned long flags;
|
||||
|
||||
DRM_DEBUG_KMS("win: %d\n", plane->index);
|
||||
@ -980,9 +932,9 @@ static void mixer_disable_plane(struct exynos_drm_crtc *crtc,
|
||||
if (!test_bit(MXR_BIT_POWERED, &mixer_ctx->flags))
|
||||
return;
|
||||
|
||||
spin_lock_irqsave(&res->reg_slock, flags);
|
||||
spin_lock_irqsave(&mixer_ctx->reg_slock, flags);
|
||||
mixer_cfg_layer(mixer_ctx, plane->index, 0, false);
|
||||
spin_unlock_irqrestore(&res->reg_slock, flags);
|
||||
spin_unlock_irqrestore(&mixer_ctx->reg_slock, flags);
|
||||
}
|
||||
|
||||
static void mixer_atomic_flush(struct exynos_drm_crtc *crtc)
|
||||
@ -999,7 +951,6 @@ static void mixer_atomic_flush(struct exynos_drm_crtc *crtc)
|
||||
static void mixer_enable(struct exynos_drm_crtc *crtc)
|
||||
{
|
||||
struct mixer_context *ctx = crtc->ctx;
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
|
||||
if (test_bit(MXR_BIT_POWERED, &ctx->flags))
|
||||
return;
|
||||
@ -1010,14 +961,17 @@ static void mixer_enable(struct exynos_drm_crtc *crtc)
|
||||
|
||||
mixer_vsync_set_update(ctx, false);
|
||||
|
||||
mixer_reg_writemask(res, MXR_STATUS, ~0, MXR_STATUS_SOFT_RESET);
|
||||
mixer_reg_writemask(ctx, MXR_STATUS, ~0, MXR_STATUS_SOFT_RESET);
|
||||
|
||||
if (test_bit(MXR_BIT_VSYNC, &ctx->flags)) {
|
||||
mixer_reg_writemask(res, MXR_INT_STATUS, ~0, MXR_INT_CLEAR_VSYNC);
|
||||
mixer_reg_writemask(res, MXR_INT_EN, ~0, MXR_INT_EN_VSYNC);
|
||||
mixer_reg_writemask(ctx, MXR_INT_STATUS, ~0,
|
||||
MXR_INT_CLEAR_VSYNC);
|
||||
mixer_reg_writemask(ctx, MXR_INT_EN, ~0, MXR_INT_EN_VSYNC);
|
||||
}
|
||||
mixer_win_reset(ctx);
|
||||
|
||||
mixer_commit(ctx);
|
||||
|
||||
mixer_vsync_set_update(ctx, true);
|
||||
|
||||
set_bit(MXR_BIT_POWERED, &ctx->flags);
|
||||
@ -1044,26 +998,75 @@ static void mixer_disable(struct exynos_drm_crtc *crtc)
|
||||
clear_bit(MXR_BIT_POWERED, &ctx->flags);
|
||||
}
|
||||
|
||||
/* Only valid for Mixer version 16.0.33.0 */
|
||||
static int mixer_atomic_check(struct exynos_drm_crtc *crtc,
|
||||
struct drm_crtc_state *state)
|
||||
static int mixer_mode_valid(struct exynos_drm_crtc *crtc,
|
||||
const struct drm_display_mode *mode)
|
||||
{
|
||||
struct drm_display_mode *mode = &state->adjusted_mode;
|
||||
u32 w, h;
|
||||
struct mixer_context *ctx = crtc->ctx;
|
||||
u32 w = mode->hdisplay, h = mode->vdisplay;
|
||||
|
||||
w = mode->hdisplay;
|
||||
h = mode->vdisplay;
|
||||
DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%d\n", w, h,
|
||||
mode->vrefresh, !!(mode->flags & DRM_MODE_FLAG_INTERLACE));
|
||||
|
||||
DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%d\n",
|
||||
mode->hdisplay, mode->vdisplay, mode->vrefresh,
|
||||
(mode->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0);
|
||||
if (ctx->mxr_ver == MXR_VER_128_0_0_184)
|
||||
return MODE_OK;
|
||||
|
||||
if ((w >= 464 && w <= 720 && h >= 261 && h <= 576) ||
|
||||
(w >= 1024 && w <= 1280 && h >= 576 && h <= 720) ||
|
||||
(w >= 1664 && w <= 1920 && h >= 936 && h <= 1080))
|
||||
return 0;
|
||||
(w >= 1024 && w <= 1280 && h >= 576 && h <= 720) ||
|
||||
(w >= 1664 && w <= 1920 && h >= 936 && h <= 1080))
|
||||
return MODE_OK;
|
||||
|
||||
return -EINVAL;
|
||||
if ((w == 1024 && h == 768) ||
|
||||
(w == 1366 && h == 768) ||
|
||||
(w == 1280 && h == 1024))
|
||||
return MODE_OK;
|
||||
|
||||
return MODE_BAD;
|
||||
}
|
||||
|
||||
static bool mixer_mode_fixup(struct exynos_drm_crtc *crtc,
|
||||
const struct drm_display_mode *mode,
|
||||
struct drm_display_mode *adjusted_mode)
|
||||
{
|
||||
struct mixer_context *ctx = crtc->ctx;
|
||||
int width = mode->hdisplay, height = mode->vdisplay, i;
|
||||
|
||||
struct {
|
||||
int hdisplay, vdisplay, htotal, vtotal, scan_val;
|
||||
} static const modes[] = {
|
||||
{ 720, 480, 858, 525, MXR_CFG_SCAN_NTSC | MXR_CFG_SCAN_SD },
|
||||
{ 720, 576, 864, 625, MXR_CFG_SCAN_PAL | MXR_CFG_SCAN_SD },
|
||||
{ 1280, 720, 1650, 750, MXR_CFG_SCAN_HD_720 | MXR_CFG_SCAN_HD },
|
||||
{ 1920, 1080, 2200, 1125, MXR_CFG_SCAN_HD_1080 |
|
||||
MXR_CFG_SCAN_HD }
|
||||
};
|
||||
|
||||
if (mode->flags & DRM_MODE_FLAG_INTERLACE)
|
||||
__set_bit(MXR_BIT_INTERLACE, &ctx->flags);
|
||||
else
|
||||
__clear_bit(MXR_BIT_INTERLACE, &ctx->flags);
|
||||
|
||||
if (ctx->mxr_ver == MXR_VER_128_0_0_184)
|
||||
return true;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(modes); ++i)
|
||||
if (width <= modes[i].hdisplay && height <= modes[i].vdisplay) {
|
||||
ctx->scan_value = modes[i].scan_val;
|
||||
if (width < modes[i].hdisplay ||
|
||||
height < modes[i].vdisplay) {
|
||||
adjusted_mode->hdisplay = modes[i].hdisplay;
|
||||
adjusted_mode->hsync_start = modes[i].hdisplay;
|
||||
adjusted_mode->hsync_end = modes[i].htotal;
|
||||
adjusted_mode->htotal = modes[i].htotal;
|
||||
adjusted_mode->vdisplay = modes[i].vdisplay;
|
||||
adjusted_mode->vsync_start = modes[i].vdisplay;
|
||||
adjusted_mode->vsync_end = modes[i].vtotal;
|
||||
adjusted_mode->vtotal = modes[i].vtotal;
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
static const struct exynos_drm_crtc_ops mixer_crtc_ops = {
|
||||
@ -1075,7 +1078,8 @@ static const struct exynos_drm_crtc_ops mixer_crtc_ops = {
|
||||
.update_plane = mixer_update_plane,
|
||||
.disable_plane = mixer_disable_plane,
|
||||
.atomic_flush = mixer_atomic_flush,
|
||||
.atomic_check = mixer_atomic_check,
|
||||
.mode_valid = mixer_mode_valid,
|
||||
.mode_fixup = mixer_mode_fixup,
|
||||
};
|
||||
|
||||
static const struct mixer_drv_data exynos5420_mxr_drv_data = {
|
||||
@ -1217,14 +1221,13 @@ static int mixer_remove(struct platform_device *pdev)
|
||||
static int __maybe_unused exynos_mixer_suspend(struct device *dev)
|
||||
{
|
||||
struct mixer_context *ctx = dev_get_drvdata(dev);
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
|
||||
clk_disable_unprepare(res->hdmi);
|
||||
clk_disable_unprepare(res->mixer);
|
||||
clk_disable_unprepare(ctx->hdmi);
|
||||
clk_disable_unprepare(ctx->mixer);
|
||||
if (test_bit(MXR_BIT_VP_ENABLED, &ctx->flags)) {
|
||||
clk_disable_unprepare(res->vp);
|
||||
clk_disable_unprepare(ctx->vp);
|
||||
if (test_bit(MXR_BIT_HAS_SCLK, &ctx->flags))
|
||||
clk_disable_unprepare(res->sclk_mixer);
|
||||
clk_disable_unprepare(ctx->sclk_mixer);
|
||||
}
|
||||
|
||||
return 0;
|
||||
@ -1233,28 +1236,27 @@ static int __maybe_unused exynos_mixer_suspend(struct device *dev)
|
||||
static int __maybe_unused exynos_mixer_resume(struct device *dev)
|
||||
{
|
||||
struct mixer_context *ctx = dev_get_drvdata(dev);
|
||||
struct mixer_resources *res = &ctx->mixer_res;
|
||||
int ret;
|
||||
|
||||
ret = clk_prepare_enable(res->mixer);
|
||||
ret = clk_prepare_enable(ctx->mixer);
|
||||
if (ret < 0) {
|
||||
DRM_ERROR("Failed to prepare_enable the mixer clk [%d]\n", ret);
|
||||
return ret;
|
||||
}
|
||||
ret = clk_prepare_enable(res->hdmi);
|
||||
ret = clk_prepare_enable(ctx->hdmi);
|
||||
if (ret < 0) {
|
||||
DRM_ERROR("Failed to prepare_enable the hdmi clk [%d]\n", ret);
|
||||
return ret;
|
||||
}
|
||||
if (test_bit(MXR_BIT_VP_ENABLED, &ctx->flags)) {
|
||||
ret = clk_prepare_enable(res->vp);
|
||||
ret = clk_prepare_enable(ctx->vp);
|
||||
if (ret < 0) {
|
||||
DRM_ERROR("Failed to prepare_enable the vp clk [%d]\n",
|
||||
ret);
|
||||
return ret;
|
||||
}
|
||||
if (test_bit(MXR_BIT_HAS_SCLK, &ctx->flags)) {
|
||||
ret = clk_prepare_enable(res->sclk_mixer);
|
||||
ret = clk_prepare_enable(ctx->sclk_mixer);
|
||||
if (ret < 0) {
|
||||
DRM_ERROR("Failed to prepare_enable the " \
|
||||
"sclk_mixer clk [%d]\n",
|
||||
|
@ -419,11 +419,9 @@
|
||||
#define HDMI_I2S_DSD_CON HDMI_I2S_BASE(0x01c)
|
||||
#define HDMI_I2S_MUX_CON HDMI_I2S_BASE(0x020)
|
||||
#define HDMI_I2S_CH_ST_CON HDMI_I2S_BASE(0x024)
|
||||
#define HDMI_I2S_CH_ST_0 HDMI_I2S_BASE(0x028)
|
||||
#define HDMI_I2S_CH_ST_1 HDMI_I2S_BASE(0x02c)
|
||||
#define HDMI_I2S_CH_ST_2 HDMI_I2S_BASE(0x030)
|
||||
#define HDMI_I2S_CH_ST_3 HDMI_I2S_BASE(0x034)
|
||||
#define HDMI_I2S_CH_ST_4 HDMI_I2S_BASE(0x038)
|
||||
/* n must be within range 0...(HDMI_I2S_CH_ST_MAXNUM - 1) */
|
||||
#define HDMI_I2S_CH_ST_MAXNUM 5
|
||||
#define HDMI_I2S_CH_ST(n) HDMI_I2S_BASE(0x028 + 4 * (n))
|
||||
#define HDMI_I2S_CH_ST_SH_0 HDMI_I2S_BASE(0x03c)
|
||||
#define HDMI_I2S_CH_ST_SH_1 HDMI_I2S_BASE(0x040)
|
||||
#define HDMI_I2S_CH_ST_SH_2 HDMI_I2S_BASE(0x044)
|
||||
|
Loading…
Reference in New Issue
Block a user