Blame view
drivers/video/sh_mobile_hdmi.c
46.4 KB
6011bdeaa fbdev: sh-mobile:... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 |
/* * SH-Mobile High-Definition Multimedia Interface (HDMI) driver * for SLISHDMI13T and SLIPHDMIT IP cores * * Copyright (C) 2010, Guennadi Liakhovetski <g.liakhovetski@gmx.de> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ #include <linux/clk.h> #include <linux/console.h> #include <linux/delay.h> #include <linux/err.h> #include <linux/init.h> #include <linux/interrupt.h> #include <linux/io.h> #include <linux/module.h> #include <linux/platform_device.h> #include <linux/pm_runtime.h> #include <linux/slab.h> #include <linux/types.h> #include <linux/workqueue.h> |
644a98453 fbdev: sh_mobile_... |
25 |
#include <sound/soc.h> |
1d6be338c ASoC: Add sh_mobi... |
26 27 |
#include <sound/soc-dapm.h> #include <sound/initval.h> |
6011bdeaa fbdev: sh-mobile:... |
28 29 30 |
#include <video/sh_mobile_hdmi.h> #include <video/sh_mobile_lcdc.h> |
6de9edd5b fbdev: sh_mobile_... |
31 |
#include "sh_mobile_lcdcfb.h" |
6011bdeaa fbdev: sh-mobile:... |
32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 |
#define HDMI_SYSTEM_CTRL 0x00 /* System control */ #define HDMI_L_R_DATA_SWAP_CTRL_RPKT 0x01 /* L/R data swap control, bits 19..16 of 20-bit N for Audio Clock Regeneration packet */ #define HDMI_20_BIT_N_FOR_AUDIO_RPKT_15_8 0x02 /* bits 15..8 of 20-bit N for Audio Clock Regeneration packet */ #define HDMI_20_BIT_N_FOR_AUDIO_RPKT_7_0 0x03 /* bits 7..0 of 20-bit N for Audio Clock Regeneration packet */ #define HDMI_SPDIF_AUDIO_SAMP_FREQ_CTS 0x04 /* SPDIF audio sampling frequency, bits 19..16 of Internal CTS */ #define HDMI_INTERNAL_CTS_15_8 0x05 /* bits 15..8 of Internal CTS */ #define HDMI_INTERNAL_CTS_7_0 0x06 /* bits 7..0 of Internal CTS */ #define HDMI_EXTERNAL_CTS_19_16 0x07 /* External CTS */ #define HDMI_EXTERNAL_CTS_15_8 0x08 /* External CTS */ #define HDMI_EXTERNAL_CTS_7_0 0x09 /* External CTS */ #define HDMI_AUDIO_SETTING_1 0x0A /* Audio setting.1 */ #define HDMI_AUDIO_SETTING_2 0x0B /* Audio setting.2 */ #define HDMI_I2S_AUDIO_SET 0x0C /* I2S audio setting */ #define HDMI_DSD_AUDIO_SET 0x0D /* DSD audio setting */ #define HDMI_DEBUG_MONITOR_1 0x0E /* Debug monitor.1 */ #define HDMI_DEBUG_MONITOR_2 0x0F /* Debug monitor.2 */ #define HDMI_I2S_INPUT_PIN_SWAP 0x10 /* I2S input pin swap */ #define HDMI_AUDIO_STATUS_BITS_SETTING_1 0x11 /* Audio status bits setting.1 */ #define HDMI_AUDIO_STATUS_BITS_SETTING_2 0x12 /* Audio status bits setting.2 */ #define HDMI_CATEGORY_CODE 0x13 /* Category code */ #define HDMI_SOURCE_NUM_AUDIO_WORD_LEN 0x14 /* Source number/Audio word length */ #define HDMI_AUDIO_VIDEO_SETTING_1 0x15 /* Audio/Video setting.1 */ #define HDMI_VIDEO_SETTING_1 0x16 /* Video setting.1 */ #define HDMI_DEEP_COLOR_MODES 0x17 /* Deep Color Modes */ /* 12 16- and 10-bit Color space conversion parameters: 0x18..0x2f */ #define HDMI_COLOR_SPACE_CONVERSION_PARAMETERS 0x18 #define HDMI_EXTERNAL_VIDEO_PARAM_SETTINGS 0x30 /* External video parameter settings */ #define HDMI_EXTERNAL_H_TOTAL_7_0 0x31 /* External horizontal total (LSB) */ #define HDMI_EXTERNAL_H_TOTAL_11_8 0x32 /* External horizontal total (MSB) */ #define HDMI_EXTERNAL_H_BLANK_7_0 0x33 /* External horizontal blank (LSB) */ #define HDMI_EXTERNAL_H_BLANK_9_8 0x34 /* External horizontal blank (MSB) */ #define HDMI_EXTERNAL_H_DELAY_7_0 0x35 /* External horizontal delay (LSB) */ #define HDMI_EXTERNAL_H_DELAY_9_8 0x36 /* External horizontal delay (MSB) */ #define HDMI_EXTERNAL_H_DURATION_7_0 0x37 /* External horizontal duration (LSB) */ #define HDMI_EXTERNAL_H_DURATION_9_8 0x38 /* External horizontal duration (MSB) */ #define HDMI_EXTERNAL_V_TOTAL_7_0 0x39 /* External vertical total (LSB) */ #define HDMI_EXTERNAL_V_TOTAL_9_8 0x3A /* External vertical total (MSB) */ #define HDMI_AUDIO_VIDEO_SETTING_2 0x3B /* Audio/Video setting.2 */ #define HDMI_EXTERNAL_V_BLANK 0x3D /* External vertical blank */ #define HDMI_EXTERNAL_V_DELAY 0x3E /* External vertical delay */ #define HDMI_EXTERNAL_V_DURATION 0x3F /* External vertical duration */ #define HDMI_CTRL_PKT_MANUAL_SEND_CONTROL 0x40 /* Control packet manual send control */ #define HDMI_CTRL_PKT_AUTO_SEND 0x41 /* Control packet auto send with VSYNC control */ #define HDMI_AUTO_CHECKSUM_OPTION 0x42 /* Auto checksum option */ #define HDMI_VIDEO_SETTING_2 0x45 /* Video setting.2 */ #define HDMI_OUTPUT_OPTION 0x46 /* Output option */ #define HDMI_SLIPHDMIT_PARAM_OPTION 0x51 /* SLIPHDMIT parameter option */ #define HDMI_HSYNC_PMENT_AT_EMB_7_0 0x52 /* HSYNC placement at embedded sync (LSB) */ #define HDMI_HSYNC_PMENT_AT_EMB_15_8 0x53 /* HSYNC placement at embedded sync (MSB) */ #define HDMI_VSYNC_PMENT_AT_EMB_7_0 0x54 /* VSYNC placement at embedded sync (LSB) */ #define HDMI_VSYNC_PMENT_AT_EMB_14_8 0x55 /* VSYNC placement at embedded sync (MSB) */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_1 0x56 /* SLIPHDMIT parameter settings.1 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_2 0x57 /* SLIPHDMIT parameter settings.2 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_3 0x58 /* SLIPHDMIT parameter settings.3 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_5 0x59 /* SLIPHDMIT parameter settings.5 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_6 0x5A /* SLIPHDMIT parameter settings.6 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_7 0x5B /* SLIPHDMIT parameter settings.7 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_8 0x5C /* SLIPHDMIT parameter settings.8 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_9 0x5D /* SLIPHDMIT parameter settings.9 */ #define HDMI_SLIPHDMIT_PARAM_SETTINGS_10 0x5E /* SLIPHDMIT parameter settings.10 */ #define HDMI_CTRL_PKT_BUF_INDEX 0x5F /* Control packet buffer index */ #define HDMI_CTRL_PKT_BUF_ACCESS_HB0 0x60 /* Control packet data buffer access window - HB0 */ #define HDMI_CTRL_PKT_BUF_ACCESS_HB1 0x61 /* Control packet data buffer access window - HB1 */ #define HDMI_CTRL_PKT_BUF_ACCESS_HB2 0x62 /* Control packet data buffer access window - HB2 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB0 0x63 /* Control packet data buffer access window - PB0 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB1 0x64 /* Control packet data buffer access window - PB1 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB2 0x65 /* Control packet data buffer access window - PB2 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB3 0x66 /* Control packet data buffer access window - PB3 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB4 0x67 /* Control packet data buffer access window - PB4 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB5 0x68 /* Control packet data buffer access window - PB5 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB6 0x69 /* Control packet data buffer access window - PB6 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB7 0x6A /* Control packet data buffer access window - PB7 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB8 0x6B /* Control packet data buffer access window - PB8 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB9 0x6C /* Control packet data buffer access window - PB9 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB10 0x6D /* Control packet data buffer access window - PB10 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB11 0x6E /* Control packet data buffer access window - PB11 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB12 0x6F /* Control packet data buffer access window - PB12 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB13 0x70 /* Control packet data buffer access window - PB13 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB14 0x71 /* Control packet data buffer access window - PB14 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB15 0x72 /* Control packet data buffer access window - PB15 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB16 0x73 /* Control packet data buffer access window - PB16 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB17 0x74 /* Control packet data buffer access window - PB17 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB18 0x75 /* Control packet data buffer access window - PB18 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB19 0x76 /* Control packet data buffer access window - PB19 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB20 0x77 /* Control packet data buffer access window - PB20 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB21 0x78 /* Control packet data buffer access window - PB21 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB22 0x79 /* Control packet data buffer access window - PB22 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB23 0x7A /* Control packet data buffer access window - PB23 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB24 0x7B /* Control packet data buffer access window - PB24 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB25 0x7C /* Control packet data buffer access window - PB25 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB26 0x7D /* Control packet data buffer access window - PB26 */ #define HDMI_CTRL_PKT_BUF_ACCESS_PB27 0x7E /* Control packet data buffer access window - PB27 */ #define HDMI_EDID_KSV_FIFO_ACCESS_WINDOW 0x80 /* EDID/KSV FIFO access window */ #define HDMI_DDC_BUS_ACCESS_FREQ_CTRL_7_0 0x81 /* DDC bus access frequency control (LSB) */ #define HDMI_DDC_BUS_ACCESS_FREQ_CTRL_15_8 0x82 /* DDC bus access frequency control (MSB) */ #define HDMI_INTERRUPT_MASK_1 0x92 /* Interrupt mask.1 */ #define HDMI_INTERRUPT_MASK_2 0x93 /* Interrupt mask.2 */ #define HDMI_INTERRUPT_STATUS_1 0x94 /* Interrupt status.1 */ #define HDMI_INTERRUPT_STATUS_2 0x95 /* Interrupt status.2 */ #define HDMI_INTERRUPT_MASK_3 0x96 /* Interrupt mask.3 */ #define HDMI_INTERRUPT_MASK_4 0x97 /* Interrupt mask.4 */ #define HDMI_INTERRUPT_STATUS_3 0x98 /* Interrupt status.3 */ #define HDMI_INTERRUPT_STATUS_4 0x99 /* Interrupt status.4 */ #define HDMI_SOFTWARE_HDCP_CONTROL_1 0x9A /* Software HDCP control.1 */ #define HDMI_FRAME_COUNTER 0x9C /* Frame counter */ #define HDMI_FRAME_COUNTER_FOR_RI_CHECK 0x9D /* Frame counter for Ri check */ #define HDMI_HDCP_CONTROL 0xAF /* HDCP control */ #define HDMI_RI_FRAME_COUNT_REGISTER 0xB2 /* Ri frame count register */ #define HDMI_DDC_BUS_CONTROL 0xB7 /* DDC bus control */ #define HDMI_HDCP_STATUS 0xB8 /* HDCP status */ #define HDMI_SHA0 0xB9 /* sha0 */ #define HDMI_SHA1 0xBA /* sha1 */ #define HDMI_SHA2 0xBB /* sha2 */ #define HDMI_SHA3 0xBC /* sha3 */ #define HDMI_SHA4 0xBD /* sha4 */ #define HDMI_BCAPS_READ 0xBE /* BCAPS read / debug */ #define HDMI_AKSV_BKSV_7_0_MONITOR 0xBF /* AKSV/BKSV[7:0] monitor */ #define HDMI_AKSV_BKSV_15_8_MONITOR 0xC0 /* AKSV/BKSV[15:8] monitor */ #define HDMI_AKSV_BKSV_23_16_MONITOR 0xC1 /* AKSV/BKSV[23:16] monitor */ #define HDMI_AKSV_BKSV_31_24_MONITOR 0xC2 /* AKSV/BKSV[31:24] monitor */ #define HDMI_AKSV_BKSV_39_32_MONITOR 0xC3 /* AKSV/BKSV[39:32] monitor */ #define HDMI_EDID_SEGMENT_POINTER 0xC4 /* EDID segment pointer */ #define HDMI_EDID_WORD_ADDRESS 0xC5 /* EDID word address */ #define HDMI_EDID_DATA_FIFO_ADDRESS 0xC6 /* EDID data FIFO address */ #define HDMI_NUM_OF_HDMI_DEVICES 0xC7 /* Number of HDMI devices */ #define HDMI_HDCP_ERROR_CODE 0xC8 /* HDCP error code */ #define HDMI_100MS_TIMER_SET 0xC9 /* 100ms timer setting */ #define HDMI_5SEC_TIMER_SET 0xCA /* 5sec timer setting */ #define HDMI_RI_READ_COUNT 0xCB /* Ri read count */ #define HDMI_AN_SEED 0xCC /* An seed */ #define HDMI_MAX_NUM_OF_RCIVRS_ALLOWED 0xCD /* Maximum number of receivers allowed */ #define HDMI_HDCP_MEMORY_ACCESS_CONTROL_1 0xCE /* HDCP memory access control.1 */ #define HDMI_HDCP_MEMORY_ACCESS_CONTROL_2 0xCF /* HDCP memory access control.2 */ #define HDMI_HDCP_CONTROL_2 0xD0 /* HDCP Control 2 */ #define HDMI_HDCP_KEY_MEMORY_CONTROL 0xD2 /* HDCP Key Memory Control */ #define HDMI_COLOR_SPACE_CONV_CONFIG_1 0xD3 /* Color space conversion configuration.1 */ #define HDMI_VIDEO_SETTING_3 0xD4 /* Video setting.3 */ #define HDMI_RI_7_0 0xD5 /* Ri[7:0] */ #define HDMI_RI_15_8 0xD6 /* Ri[15:8] */ #define HDMI_PJ 0xD7 /* Pj */ #define HDMI_SHA_RD 0xD8 /* sha_rd */ #define HDMI_RI_7_0_SAVED 0xD9 /* Ri[7:0] saved */ #define HDMI_RI_15_8_SAVED 0xDA /* Ri[15:8] saved */ #define HDMI_PJ_SAVED 0xDB /* Pj saved */ #define HDMI_NUM_OF_DEVICES 0xDC /* Number of devices */ #define HDMI_HOT_PLUG_MSENS_STATUS 0xDF /* Hot plug/MSENS status */ #define HDMI_BCAPS_WRITE 0xE0 /* bcaps */ #define HDMI_BSTAT_7_0 0xE1 /* bstat[7:0] */ #define HDMI_BSTAT_15_8 0xE2 /* bstat[15:8] */ #define HDMI_BKSV_7_0 0xE3 /* bksv[7:0] */ #define HDMI_BKSV_15_8 0xE4 /* bksv[15:8] */ #define HDMI_BKSV_23_16 0xE5 /* bksv[23:16] */ #define HDMI_BKSV_31_24 0xE6 /* bksv[31:24] */ #define HDMI_BKSV_39_32 0xE7 /* bksv[39:32] */ #define HDMI_AN_7_0 0xE8 /* An[7:0] */ #define HDMI_AN_15_8 0xE9 /* An [15:8] */ #define HDMI_AN_23_16 0xEA /* An [23:16] */ #define HDMI_AN_31_24 0xEB /* An [31:24] */ #define HDMI_AN_39_32 0xEC /* An [39:32] */ #define HDMI_AN_47_40 0xED /* An [47:40] */ #define HDMI_AN_55_48 0xEE /* An [55:48] */ #define HDMI_AN_63_56 0xEF /* An [63:56] */ #define HDMI_PRODUCT_ID 0xF0 /* Product ID */ #define HDMI_REVISION_ID 0xF1 /* Revision ID */ #define HDMI_TEST_MODE 0xFE /* Test mode */ enum hotplug_state { HDMI_HOTPLUG_DISCONNECTED, HDMI_HOTPLUG_CONNECTED, HDMI_HOTPLUG_EDID_DONE, }; struct sh_hdmi { void __iomem *base; |
6aa966e61 fbdev: sh_mobile_... |
210 |
enum hotplug_state hp_state; /* hot-plug status */ |
0ea2af1c1 fbdev: sh_mobile_... |
211 212 |
u8 preprogrammed_vic; /* use a pre-programmed VIC or the external mode */ |
4232f6079 fbdev: sh_mobile_... |
213 214 215 |
u8 edid_block_addr; u8 edid_segment_nr; u8 edid_blocks; |
6011bdeaa fbdev: sh-mobile:... |
216 217 218 |
struct clk *hdmi_clk; struct device *dev; struct fb_info *info; |
6de9edd5b fbdev: sh_mobile_... |
219 |
struct mutex mutex; /* Protect the info pointer */ |
6011bdeaa fbdev: sh-mobile:... |
220 221 |
struct delayed_work edid_work; struct fb_var_screeninfo var; |
afe417c03 fbdev: sh_mobile_... |
222 |
struct fb_monspecs monspec; |
eb0778bd3 fbdev: sh_mobile_... |
223 |
struct notifier_block notifier; |
6011bdeaa fbdev: sh-mobile:... |
224 225 226 227 228 229 230 231 232 233 234 |
}; static void hdmi_write(struct sh_hdmi *hdmi, u8 data, u8 reg) { iowrite8(data, hdmi->base + reg); } static u8 hdmi_read(struct sh_hdmi *hdmi, u8 reg) { return ioread8(hdmi->base + reg); } |
f4363b7d8 fbdev: sh_mobile_... |
235 236 237 |
/* * HDMI sound */ |
1d6be338c ASoC: Add sh_mobi... |
238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 |
static unsigned int sh_hdmi_snd_read(struct snd_soc_codec *codec, unsigned int reg) { struct sh_hdmi *hdmi = snd_soc_codec_get_drvdata(codec); return hdmi_read(hdmi, reg); } static int sh_hdmi_snd_write(struct snd_soc_codec *codec, unsigned int reg, unsigned int value) { struct sh_hdmi *hdmi = snd_soc_codec_get_drvdata(codec); hdmi_write(hdmi, value, reg); return 0; } static struct snd_soc_dai_driver sh_hdmi_dai = { .name = "sh_mobile_hdmi-hifi", .playback = { .stream_name = "Playback", |
17731f8df fbdev: sh_mobile_... |
260 261 262 263 264 265 |
.channels_min = 2, .channels_max = 8, .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_192000, |
1d6be338c ASoC: Add sh_mobi... |
266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 |
.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, }, }; static int sh_hdmi_snd_probe(struct snd_soc_codec *codec) { dev_info(codec->dev, "SH Mobile HDMI Audio Codec"); return 0; } static struct snd_soc_codec_driver soc_codec_dev_sh_hdmi = { .probe = sh_hdmi_snd_probe, .read = sh_hdmi_snd_read, .write = sh_hdmi_snd_write, }; |
f4363b7d8 fbdev: sh_mobile_... |
282 283 284 |
/* * HDMI video */ |
1d6be338c ASoC: Add sh_mobi... |
285 |
|
6011bdeaa fbdev: sh-mobile:... |
286 |
/* External video parameter settings */ |
6aa966e61 fbdev: sh_mobile_... |
287 |
static void sh_hdmi_external_video_param(struct sh_hdmi *hdmi) |
6011bdeaa fbdev: sh-mobile:... |
288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 |
{ struct fb_var_screeninfo *var = &hdmi->var; u16 htotal, hblank, hdelay, vtotal, vblank, vdelay, voffset; u8 sync = 0; htotal = var->xres + var->right_margin + var->left_margin + var->hsync_len; hdelay = var->hsync_len + var->left_margin; hblank = var->right_margin + hdelay; /* * Vertical timing looks a bit different in Figure 18, * but let's try the same first by setting offset = 0 */ vtotal = var->yres + var->upper_margin + var->lower_margin + var->vsync_len; vdelay = var->vsync_len + var->upper_margin; vblank = var->lower_margin + vdelay; voffset = min(var->upper_margin / 2, 6U); /* * [3]: VSYNC polarity: Positive * [2]: HSYNC polarity: Positive * [1]: Interlace/Progressive: Progressive * [0]: External video settings enable: used. */ if (var->sync & FB_SYNC_HOR_HIGH_ACT) sync |= 4; if (var->sync & FB_SYNC_VERT_HIGH_ACT) sync |= 8; |
6aa966e61 fbdev: sh_mobile_... |
318 319 320 321 |
dev_dbg(hdmi->dev, "H: %u, %u, %u, %u; V: %u, %u, %u, %u; sync 0x%x ", htotal, hblank, hdelay, var->hsync_len, vtotal, vblank, vdelay, var->vsync_len, sync); |
6011bdeaa fbdev: sh-mobile:... |
322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 |
hdmi_write(hdmi, sync | (voffset << 4), HDMI_EXTERNAL_VIDEO_PARAM_SETTINGS); hdmi_write(hdmi, htotal, HDMI_EXTERNAL_H_TOTAL_7_0); hdmi_write(hdmi, htotal >> 8, HDMI_EXTERNAL_H_TOTAL_11_8); hdmi_write(hdmi, hblank, HDMI_EXTERNAL_H_BLANK_7_0); hdmi_write(hdmi, hblank >> 8, HDMI_EXTERNAL_H_BLANK_9_8); hdmi_write(hdmi, hdelay, HDMI_EXTERNAL_H_DELAY_7_0); hdmi_write(hdmi, hdelay >> 8, HDMI_EXTERNAL_H_DELAY_9_8); hdmi_write(hdmi, var->hsync_len, HDMI_EXTERNAL_H_DURATION_7_0); hdmi_write(hdmi, var->hsync_len >> 8, HDMI_EXTERNAL_H_DURATION_9_8); hdmi_write(hdmi, vtotal, HDMI_EXTERNAL_V_TOTAL_7_0); hdmi_write(hdmi, vtotal >> 8, HDMI_EXTERNAL_V_TOTAL_9_8); hdmi_write(hdmi, vblank, HDMI_EXTERNAL_V_BLANK); hdmi_write(hdmi, vdelay, HDMI_EXTERNAL_V_DELAY); hdmi_write(hdmi, var->vsync_len, HDMI_EXTERNAL_V_DURATION); |
89712699d fbdev: sh_mobile_... |
345 |
/* Set bit 0 of HDMI_EXTERNAL_VIDEO_PARAM_SETTINGS here for external mode */ |
0ea2af1c1 fbdev: sh_mobile_... |
346 |
if (!hdmi->preprogrammed_vic) |
89712699d fbdev: sh_mobile_... |
347 348 |
hdmi_write(hdmi, sync | 1 | (voffset << 4), HDMI_EXTERNAL_VIDEO_PARAM_SETTINGS); |
6011bdeaa fbdev: sh-mobile:... |
349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 |
} /** * sh_hdmi_video_config() */ static void sh_hdmi_video_config(struct sh_hdmi *hdmi) { /* * [7:4]: Audio sampling frequency: 48kHz * [3:1]: Input video format: RGB and YCbCr 4:4:4 (Y on Green) * [0]: Internal/External DE select: internal */ hdmi_write(hdmi, 0x20, HDMI_AUDIO_VIDEO_SETTING_1); /* * [7:6]: Video output format: RGB 4:4:4 * [5:4]: Input video data width: 8 bit * [3:1]: EAV/SAV location: channel 1 * [0]: Video input color space: RGB */ hdmi_write(hdmi, 0x34, HDMI_VIDEO_SETTING_1); /* * [7:6]: Together with bit [6] of HDMI_AUDIO_VIDEO_SETTING_2, which is * left at 0 by default, this configures 24bpp and sets the Color Depth * (CD) field in the General Control Packet */ hdmi_write(hdmi, 0x20, HDMI_DEEP_COLOR_MODES); } /** * sh_hdmi_audio_config() */ static void sh_hdmi_audio_config(struct sh_hdmi *hdmi) { |
6d8657712 fbdev: sh-mobile:... |
384 385 |
u8 data; struct sh_mobile_hdmi_info *pdata = hdmi->dev->platform_data; |
6011bdeaa fbdev: sh-mobile:... |
386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 |
/* * [7:4] L/R data swap control * [3:0] appropriate N[19:16] */ hdmi_write(hdmi, 0x00, HDMI_L_R_DATA_SWAP_CTRL_RPKT); /* appropriate N[15:8] */ hdmi_write(hdmi, 0x18, HDMI_20_BIT_N_FOR_AUDIO_RPKT_15_8); /* appropriate N[7:0] */ hdmi_write(hdmi, 0x00, HDMI_20_BIT_N_FOR_AUDIO_RPKT_7_0); /* [7:4] 48 kHz SPDIF not used */ hdmi_write(hdmi, 0x20, HDMI_SPDIF_AUDIO_SAMP_FREQ_CTS); /* * [6:5] set required down sampling rate if required * [4:3] set required audio source */ |
dec6aa49a fbdev: sh_mobile_... |
403 |
switch (pdata->flags & HDMI_SND_SRC_MASK) { |
6d8657712 fbdev: sh-mobile:... |
404 |
default: |
f4363b7d8 fbdev: sh_mobile_... |
405 |
/* fall through */ |
dec6aa49a fbdev: sh_mobile_... |
406 407 |
case HDMI_SND_SRC_I2S: data = 0x0 << 3; |
6d8657712 fbdev: sh-mobile:... |
408 |
break; |
dec6aa49a fbdev: sh_mobile_... |
409 410 |
case HDMI_SND_SRC_SPDIF: data = 0x1 << 3; |
6d8657712 fbdev: sh-mobile:... |
411 |
break; |
dec6aa49a fbdev: sh_mobile_... |
412 413 |
case HDMI_SND_SRC_DSD: data = 0x2 << 3; |
6d8657712 fbdev: sh-mobile:... |
414 |
break; |
dec6aa49a fbdev: sh_mobile_... |
415 416 |
case HDMI_SND_SRC_HBR: data = 0x3 << 3; |
6d8657712 fbdev: sh-mobile:... |
417 418 419 |
break; } hdmi_write(hdmi, data, HDMI_AUDIO_SETTING_1); |
6011bdeaa fbdev: sh-mobile:... |
420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 |
/* [3:0] set sending channel number for channel status */ hdmi_write(hdmi, 0x40, HDMI_AUDIO_SETTING_2); /* * [5:2] set valid I2S source input pin * [1:0] set input I2S source mode */ hdmi_write(hdmi, 0x04, HDMI_I2S_AUDIO_SET); /* [7:4] set valid DSD source input pin */ hdmi_write(hdmi, 0x00, HDMI_DSD_AUDIO_SET); /* [7:0] set appropriate I2S input pin swap settings if required */ hdmi_write(hdmi, 0x00, HDMI_I2S_INPUT_PIN_SWAP); /* * [7] set validity bit for channel status * [3:0] set original sample frequency for channel status */ hdmi_write(hdmi, 0x00, HDMI_AUDIO_STATUS_BITS_SETTING_1); /* * [7] set value for channel status * [6] set value for channel status * [5] set copyright bit for channel status * [4:2] set additional information for channel status * [1:0] set clock accuracy for channel status */ hdmi_write(hdmi, 0x00, HDMI_AUDIO_STATUS_BITS_SETTING_2); /* [7:0] set category code for channel status */ hdmi_write(hdmi, 0x00, HDMI_CATEGORY_CODE); /* * [7:4] set source number for channel status * [3:0] set word length for channel status */ hdmi_write(hdmi, 0x00, HDMI_SOURCE_NUM_AUDIO_WORD_LEN); /* [7:4] set sample frequency for channel status */ hdmi_write(hdmi, 0x20, HDMI_AUDIO_VIDEO_SETTING_1); } /** |
6e45746c3 fbdev: sh_mobile_... |
465 |
* sh_hdmi_phy_config() - configure the HDMI PHY for the used video mode |
6011bdeaa fbdev: sh-mobile:... |
466 467 468 |
*/ static void sh_hdmi_phy_config(struct sh_hdmi *hdmi) { |
0ea2af1c1 fbdev: sh_mobile_... |
469 470 471 472 473 474 475 476 477 478 479 480 |
if (hdmi->var.pixclock < 10000) { /* for 1080p8bit 148MHz */ hdmi_write(hdmi, 0x1d, HDMI_SLIPHDMIT_PARAM_SETTINGS_1); hdmi_write(hdmi, 0x00, HDMI_SLIPHDMIT_PARAM_SETTINGS_2); hdmi_write(hdmi, 0x00, HDMI_SLIPHDMIT_PARAM_SETTINGS_3); hdmi_write(hdmi, 0x4c, HDMI_SLIPHDMIT_PARAM_SETTINGS_5); hdmi_write(hdmi, 0x1e, HDMI_SLIPHDMIT_PARAM_SETTINGS_6); hdmi_write(hdmi, 0x48, HDMI_SLIPHDMIT_PARAM_SETTINGS_7); hdmi_write(hdmi, 0x0e, HDMI_SLIPHDMIT_PARAM_SETTINGS_8); hdmi_write(hdmi, 0x25, HDMI_SLIPHDMIT_PARAM_SETTINGS_9); hdmi_write(hdmi, 0x04, HDMI_SLIPHDMIT_PARAM_SETTINGS_10); } else if (hdmi->var.pixclock < 30000) { |
6e45746c3 fbdev: sh_mobile_... |
481 482 483 484 485 486 487 488 |
/* 720p, 8bit, 74.25MHz. Might need to be adjusted for other formats */ /* * [1:0] Speed_A * [3:2] Speed_B * [4] PLLA_Bypass * [6] DRV_TEST_EN * [7] DRV_TEST_IN */ |
9289c4758 fbdev: sh_mobile_... |
489 |
hdmi_write(hdmi, 0x0f, HDMI_SLIPHDMIT_PARAM_SETTINGS_1); |
6e45746c3 fbdev: sh_mobile_... |
490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 |
/* PLLB_CONFIG[17], PLLA_CONFIG[17] - not in PHY datasheet */ hdmi_write(hdmi, 0x00, HDMI_SLIPHDMIT_PARAM_SETTINGS_2); /* * [2:0] BGR_I_OFFSET * [6:4] BGR_V_OFFSET */ hdmi_write(hdmi, 0x00, HDMI_SLIPHDMIT_PARAM_SETTINGS_3); /* PLLA_CONFIG[7:0]: VCO gain, VCO offset, LPF resistance[0] */ hdmi_write(hdmi, 0x44, HDMI_SLIPHDMIT_PARAM_SETTINGS_5); /* * PLLA_CONFIG[15:8]: regulator voltage[0], CP current, * LPF capacitance, LPF resistance[1] */ hdmi_write(hdmi, 0x32, HDMI_SLIPHDMIT_PARAM_SETTINGS_6); /* PLLB_CONFIG[7:0]: LPF resistance[0], VCO offset, VCO gain */ hdmi_write(hdmi, 0x4A, HDMI_SLIPHDMIT_PARAM_SETTINGS_7); /* * PLLB_CONFIG[15:8]: regulator voltage[0], CP current, * LPF capacitance, LPF resistance[1] */ |
9289c4758 fbdev: sh_mobile_... |
510 |
hdmi_write(hdmi, 0x00, HDMI_SLIPHDMIT_PARAM_SETTINGS_8); |
6e45746c3 fbdev: sh_mobile_... |
511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 |
/* DRV_CONFIG, PE_CONFIG */ hdmi_write(hdmi, 0x25, HDMI_SLIPHDMIT_PARAM_SETTINGS_9); /* * [2:0] AMON_SEL (4 == LPF voltage) * [4] PLLA_CONFIG[16] * [5] PLLB_CONFIG[16] */ hdmi_write(hdmi, 0x04, HDMI_SLIPHDMIT_PARAM_SETTINGS_10); } else { /* for 480p8bit 27MHz */ hdmi_write(hdmi, 0x19, HDMI_SLIPHDMIT_PARAM_SETTINGS_1); hdmi_write(hdmi, 0x00, HDMI_SLIPHDMIT_PARAM_SETTINGS_2); hdmi_write(hdmi, 0x00, HDMI_SLIPHDMIT_PARAM_SETTINGS_3); hdmi_write(hdmi, 0x44, HDMI_SLIPHDMIT_PARAM_SETTINGS_5); hdmi_write(hdmi, 0x32, HDMI_SLIPHDMIT_PARAM_SETTINGS_6); hdmi_write(hdmi, 0x48, HDMI_SLIPHDMIT_PARAM_SETTINGS_7); hdmi_write(hdmi, 0x0F, HDMI_SLIPHDMIT_PARAM_SETTINGS_8); hdmi_write(hdmi, 0x20, HDMI_SLIPHDMIT_PARAM_SETTINGS_9); hdmi_write(hdmi, 0x04, HDMI_SLIPHDMIT_PARAM_SETTINGS_10); } |
6011bdeaa fbdev: sh-mobile:... |
531 532 533 534 535 536 537 |
} /** * sh_hdmi_avi_infoframe_setup() - Auxiliary Video Information InfoFrame CONTROL PACKET */ static void sh_hdmi_avi_infoframe_setup(struct sh_hdmi *hdmi) { |
6e45746c3 fbdev: sh_mobile_... |
538 |
u8 vic; |
6011bdeaa fbdev: sh-mobile:... |
539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 |
/* AVI InfoFrame */ hdmi_write(hdmi, 0x06, HDMI_CTRL_PKT_BUF_INDEX); /* Packet Type = 0x82 */ hdmi_write(hdmi, 0x82, HDMI_CTRL_PKT_BUF_ACCESS_HB0); /* Version = 0x02 */ hdmi_write(hdmi, 0x02, HDMI_CTRL_PKT_BUF_ACCESS_HB1); /* Length = 13 (0x0D) */ hdmi_write(hdmi, 0x0D, HDMI_CTRL_PKT_BUF_ACCESS_HB2); /* N. A. Checksum */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB0); /* * Y = RGB * A0 = No Data * B = Bar Data not valid * S = No Data */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB1); /* |
6aa966e61 fbdev: sh_mobile_... |
563 564 565 |
* [7:6] C = Colorimetry: no data * [5:4] M = 2: 16:9, 1: 4:3 Picture Aspect Ratio * [3:0] R = 8: Active Frame Aspect Ratio: same as picture aspect ratio |
6011bdeaa fbdev: sh-mobile:... |
566 567 568 569 570 571 572 573 574 575 576 577 |
*/ hdmi_write(hdmi, 0x28, HDMI_CTRL_PKT_BUF_ACCESS_PB2); /* * ITC = No Data * EC = xvYCC601 * Q = Default (depends on video format) * SC = No Known non_uniform Scaling */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB3); /* |
0ea2af1c1 fbdev: sh_mobile_... |
578 579 |
* VIC should be ignored if external config is used, so, we could just use 0, * but play safe and use a valid value in any case just in case |
6011bdeaa fbdev: sh-mobile:... |
580 |
*/ |
0ea2af1c1 fbdev: sh_mobile_... |
581 582 |
if (hdmi->preprogrammed_vic) vic = hdmi->preprogrammed_vic; |
6e45746c3 fbdev: sh_mobile_... |
583 584 585 |
else vic = 4; hdmi_write(hdmi, vic, HDMI_CTRL_PKT_BUF_ACCESS_PB4); |
6011bdeaa fbdev: sh-mobile:... |
586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 |
/* PR = No Repetition */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB5); /* Line Number of End of Top Bar (lower 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB6); /* Line Number of End of Top Bar (upper 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB7); /* Line Number of Start of Bottom Bar (lower 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB8); /* Line Number of Start of Bottom Bar (upper 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB9); /* Pixel Number of End of Left Bar (lower 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB10); /* Pixel Number of End of Left Bar (upper 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB11); /* Pixel Number of Start of Right Bar (lower 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB12); /* Pixel Number of Start of Right Bar (upper 8 bits) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB13); } /** * sh_hdmi_audio_infoframe_setup() - Audio InfoFrame of CONTROL PACKET */ static void sh_hdmi_audio_infoframe_setup(struct sh_hdmi *hdmi) { /* Audio InfoFrame */ hdmi_write(hdmi, 0x08, HDMI_CTRL_PKT_BUF_INDEX); /* Packet Type = 0x84 */ hdmi_write(hdmi, 0x84, HDMI_CTRL_PKT_BUF_ACCESS_HB0); /* Version Number = 0x01 */ hdmi_write(hdmi, 0x01, HDMI_CTRL_PKT_BUF_ACCESS_HB1); /* 0 Length = 10 (0x0A) */ hdmi_write(hdmi, 0x0A, HDMI_CTRL_PKT_BUF_ACCESS_HB2); /* n. a. Checksum */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB0); /* Audio Channel Count = Refer to Stream Header */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB1); /* Refer to Stream Header */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB2); /* Format depends on coding type (i.e. CT0...CT3) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB3); /* Speaker Channel Allocation = Front Right + Front Left */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB4); /* Level Shift Value = 0 dB, Down - mix is permitted or no information */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB5); /* Reserved (0) */ hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB6); hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB7); hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB8); hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB9); hdmi_write(hdmi, 0x00, HDMI_CTRL_PKT_BUF_ACCESS_PB10); } /** |
6011bdeaa fbdev: sh-mobile:... |
659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 |
* sh_hdmi_configure() - Initialise HDMI for output */ static void sh_hdmi_configure(struct sh_hdmi *hdmi) { /* Configure video format */ sh_hdmi_video_config(hdmi); /* Configure audio format */ sh_hdmi_audio_config(hdmi); /* Configure PHY */ sh_hdmi_phy_config(hdmi); /* Auxiliary Video Information (AVI) InfoFrame */ sh_hdmi_avi_infoframe_setup(hdmi); /* Audio InfoFrame */ sh_hdmi_audio_infoframe_setup(hdmi); |
6011bdeaa fbdev: sh-mobile:... |
677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 |
/* * Control packet auto send with VSYNC control: auto send * General control, Gamut metadata, ISRC, and ACP packets */ hdmi_write(hdmi, 0x8E, HDMI_CTRL_PKT_AUTO_SEND); /* FIXME */ msleep(10); /* PS mode b->d, reset PLLA and PLLB */ hdmi_write(hdmi, 0x4C, HDMI_SYSTEM_CTRL); udelay(10); hdmi_write(hdmi, 0x40, HDMI_SYSTEM_CTRL); } |
f1198d1ea fbdev: sh_mobile_... |
693 |
static unsigned long sh_hdmi_rate_error(struct sh_hdmi *hdmi, |
c36940e67 fbdev: sh_mobile_... |
694 695 |
const struct fb_videomode *mode, unsigned long *hdmi_rate, unsigned long *parent_rate) |
6011bdeaa fbdev: sh-mobile:... |
696 |
{ |
c36940e67 fbdev: sh_mobile_... |
697 698 699 700 701 702 703 704 705 706 707 708 |
unsigned long target = PICOS2KHZ(mode->pixclock) * 1000, rate_error; struct sh_mobile_hdmi_info *pdata = hdmi->dev->platform_data; *hdmi_rate = clk_round_rate(hdmi->hdmi_clk, target); if ((long)*hdmi_rate < 0) *hdmi_rate = clk_get_rate(hdmi->hdmi_clk); rate_error = (long)*hdmi_rate > 0 ? abs(*hdmi_rate - target) : ULONG_MAX; if (rate_error && pdata->clk_optimize_parent) rate_error = pdata->clk_optimize_parent(target, hdmi_rate, parent_rate); else if (clk_get_parent(hdmi->hdmi_clk)) *parent_rate = clk_get_rate(clk_get_parent(hdmi->hdmi_clk)); |
f1198d1ea fbdev: sh_mobile_... |
709 710 711 712 713 714 715 |
dev_dbg(hdmi->dev, "%u-%u-%u-%u x %u-%u-%u-%u ", mode->left_margin, mode->xres, mode->right_margin, mode->hsync_len, mode->upper_margin, mode->yres, mode->lower_margin, mode->vsync_len); |
c36940e67 fbdev: sh_mobile_... |
716 717 718 719 |
dev_dbg(hdmi->dev, "\t@%lu(+/-%lu)Hz, e=%lu / 1000, r=%uHz, p=%luHz ", target, rate_error, rate_error ? 10000 / (10 * target / rate_error) : 0, mode->refresh, *parent_rate); |
f1198d1ea fbdev: sh_mobile_... |
720 721 722 |
return rate_error; } |
c36940e67 fbdev: sh_mobile_... |
723 724 |
static int sh_hdmi_read_edid(struct sh_hdmi *hdmi, unsigned long *hdmi_rate, unsigned long *parent_rate) |
6011bdeaa fbdev: sh-mobile:... |
725 |
{ |
6ee484527 fbdev: sh_mobile_... |
726 |
struct fb_var_screeninfo tmpvar; |
6ee484527 fbdev: sh_mobile_... |
727 |
struct fb_var_screeninfo *var = &tmpvar; |
afe417c03 fbdev: sh_mobile_... |
728 |
const struct fb_videomode *mode, *found = NULL; |
f1198d1ea fbdev: sh_mobile_... |
729 730 731 732 |
struct fb_info *info = hdmi->info; struct fb_modelist *modelist = NULL; unsigned int f_width = 0, f_height = 0, f_refresh = 0; unsigned long found_rate_error = ULONG_MAX; /* silly compiler... */ |
c7321d6f8 fbdev: sh_mobile_... |
733 |
bool scanning = false, preferred_bad = false; |
6011bdeaa fbdev: sh-mobile:... |
734 |
u8 edid[128]; |
f1198d1ea fbdev: sh_mobile_... |
735 736 |
char *forced; int i; |
6011bdeaa fbdev: sh-mobile:... |
737 738 |
/* Read EDID */ |
6aa966e61 fbdev: sh_mobile_... |
739 |
dev_dbg(hdmi->dev, "Read back EDID code:"); |
6011bdeaa fbdev: sh-mobile:... |
740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 |
for (i = 0; i < 128; i++) { edid[i] = hdmi_read(hdmi, HDMI_EDID_KSV_FIFO_ACCESS_WINDOW); #ifdef DEBUG if ((i % 16) == 0) { printk(KERN_CONT " "); printk(KERN_DEBUG "%02X | %02X", i, edid[i]); } else { printk(KERN_CONT " %02X", edid[i]); } #endif } #ifdef DEBUG printk(KERN_CONT " "); #endif |
afe417c03 fbdev: sh_mobile_... |
756 |
|
4232f6079 fbdev: sh_mobile_... |
757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 |
if (!hdmi->edid_blocks) { fb_edid_to_monspecs(edid, &hdmi->monspec); hdmi->edid_blocks = edid[126] + 1; dev_dbg(hdmi->dev, "%d main modes, %d extension blocks ", hdmi->monspec.modedb_len, hdmi->edid_blocks - 1); } else { dev_dbg(hdmi->dev, "Extension %u detected, DTD start %u ", edid[0], edid[2]); fb_edid_add_monspecs(edid, &hdmi->monspec); } if (hdmi->edid_blocks > hdmi->edid_segment_nr * 2 + (hdmi->edid_block_addr >> 7) + 1) { /* More blocks to read */ if (hdmi->edid_block_addr) { hdmi->edid_block_addr = 0; hdmi->edid_segment_nr++; } else { hdmi->edid_block_addr = 0x80; } /* Set EDID word address */ hdmi_write(hdmi, hdmi->edid_block_addr, HDMI_EDID_WORD_ADDRESS); /* Enable EDID interrupt */ hdmi_write(hdmi, 0xC6, HDMI_INTERRUPT_MASK_1); /* Set EDID segment pointer - starts reading EDID */ hdmi_write(hdmi, hdmi->edid_segment_nr, HDMI_EDID_SEGMENT_POINTER); return -EAGAIN; } /* All E-EDID blocks ready */ dev_dbg(hdmi->dev, "%d main and extended modes ", hdmi->monspec.modedb_len); |
afe417c03 fbdev: sh_mobile_... |
792 |
|
f1198d1ea fbdev: sh_mobile_... |
793 794 795 796 797 798 799 800 |
fb_get_options("sh_mobile_lcdc", &forced); if (forced && *forced) { /* Only primitive parsing so far */ i = sscanf(forced, "%ux%u@%u", &f_width, &f_height, &f_refresh); if (i < 2) { f_width = 0; f_height = 0; |
c7321d6f8 fbdev: sh_mobile_... |
801 802 803 |
} else { /* The user wants us to use the EDID data */ scanning = true; |
f1198d1ea fbdev: sh_mobile_... |
804 805 806 807 808 809 810 811 |
} dev_dbg(hdmi->dev, "Forced mode %ux%u@%uHz ", f_width, f_height, f_refresh); } /* Walk monitor modes to find the best or the exact match */ for (i = 0, mode = hdmi->monspec.modedb; |
c7321d6f8 fbdev: sh_mobile_... |
812 |
i < hdmi->monspec.modedb_len && scanning; |
afe417c03 fbdev: sh_mobile_... |
813 |
i++, mode++) { |
c36940e67 fbdev: sh_mobile_... |
814 |
unsigned long rate_error; |
f1198d1ea fbdev: sh_mobile_... |
815 |
|
c7321d6f8 fbdev: sh_mobile_... |
816 817 818 819 820 821 822 823 824 825 826 827 828 |
if (!f_width && !f_height) { /* * A parameter string "video=sh_mobile_lcdc:0x0" means * use the preferred EDID mode. If it is rejected by * .fb_check_var(), keep looking, until an acceptable * one is found. */ if ((mode->flag & FB_MODE_IS_FIRST) || preferred_bad) scanning = false; else continue; } else if (f_width != mode->xres || f_height != mode->yres) { /* No interest in unmatching modes */ |
f1198d1ea fbdev: sh_mobile_... |
829 |
continue; |
c7321d6f8 fbdev: sh_mobile_... |
830 |
} |
c36940e67 fbdev: sh_mobile_... |
831 832 |
rate_error = sh_hdmi_rate_error(hdmi, mode, hdmi_rate, parent_rate); |
c7321d6f8 fbdev: sh_mobile_... |
833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 |
if (scanning) { if (f_refresh == mode->refresh || (!f_refresh && !rate_error)) /* * Exact match if either the refresh rate * matches or it hasn't been specified and we've * found a mode, for which we can configure the * clock precisely */ scanning = false; else if (found && found_rate_error <= rate_error) /* * We otherwise search for the closest matching * clock rate - either if no refresh rate has * been specified or we cannot find an exactly * matching one */ continue; } |
f1198d1ea fbdev: sh_mobile_... |
851 852 853 |
/* Check if supported: sufficient fb memory, supported clock-rate */ fb_videomode_to_var(var, mode); |
c7321d6f8 fbdev: sh_mobile_... |
854 |
var->bits_per_pixel = info->var.bits_per_pixel; |
f1198d1ea fbdev: sh_mobile_... |
855 856 |
if (info && info->fbops->fb_check_var && info->fbops->fb_check_var(var, info)) { |
c7321d6f8 fbdev: sh_mobile_... |
857 858 |
scanning = true; preferred_bad = true; |
f1198d1ea fbdev: sh_mobile_... |
859 |
continue; |
afe417c03 fbdev: sh_mobile_... |
860 |
} |
f1198d1ea fbdev: sh_mobile_... |
861 862 863 |
found = mode; found_rate_error = rate_error; |
afe417c03 fbdev: sh_mobile_... |
864 |
} |
8c1ac08b3 fbdev: sh-mobile:... |
865 866 |
hdmi->var.width = hdmi->monspec.max_x * 10; hdmi->var.height = hdmi->monspec.max_y * 10; |
afe417c03 fbdev: sh_mobile_... |
867 |
/* |
f1198d1ea fbdev: sh_mobile_... |
868 869 870 871 |
* TODO 1: if no ->info is present, postpone running the config until * after ->info first gets registered. * TODO 2: consider registering the HDMI platform device from the LCDC * driver, and passing ->info with HDMI platform data. |
afe417c03 fbdev: sh_mobile_... |
872 |
*/ |
f1198d1ea fbdev: sh_mobile_... |
873 |
if (info && !found) { |
0d7fa180a fbdev: sh_mobile_... |
874 875 876 |
modelist = info->modelist.next && !list_empty(&info->modelist) ? list_entry(info->modelist.next, |
f1198d1ea fbdev: sh_mobile_... |
877 878 879 880 881 |
struct fb_modelist, list) : NULL; if (modelist) { found = &modelist->mode; |
c36940e67 fbdev: sh_mobile_... |
882 |
found_rate_error = sh_hdmi_rate_error(hdmi, found, hdmi_rate, parent_rate); |
afe417c03 fbdev: sh_mobile_... |
883 884 |
} } |
afe417c03 fbdev: sh_mobile_... |
885 886 887 |
/* No cookie today */ if (!found) return -ENXIO; |
0ea2af1c1 fbdev: sh_mobile_... |
888 889 890 891 892 893 894 895 896 897 898 899 900 901 |
if (found->xres == 640 && found->yres == 480 && found->refresh == 60) hdmi->preprogrammed_vic = 1; else if (found->xres == 720 && found->yres == 480 && found->refresh == 60) hdmi->preprogrammed_vic = 2; else if (found->xres == 720 && found->yres == 576 && found->refresh == 50) hdmi->preprogrammed_vic = 17; else if (found->xres == 1280 && found->yres == 720 && found->refresh == 60) hdmi->preprogrammed_vic = 4; else if (found->xres == 1920 && found->yres == 1080 && found->refresh == 24) hdmi->preprogrammed_vic = 32; else if (found->xres == 1920 && found->yres == 1080 && found->refresh == 50) hdmi->preprogrammed_vic = 31; else if (found->xres == 1920 && found->yres == 1080 && found->refresh == 60) hdmi->preprogrammed_vic = 16; |
89712699d fbdev: sh_mobile_... |
902 |
else |
0ea2af1c1 fbdev: sh_mobile_... |
903 |
hdmi->preprogrammed_vic = 0; |
89712699d fbdev: sh_mobile_... |
904 |
|
c36940e67 fbdev: sh_mobile_... |
905 906 |
dev_dbg(hdmi->dev, "Using %s %s mode %ux%u@%uHz (%luHz), clock error %luHz ", |
0ea2af1c1 fbdev: sh_mobile_... |
907 |
modelist ? "default" : "EDID", hdmi->preprogrammed_vic ? "VIC" : "external", |
c36940e67 fbdev: sh_mobile_... |
908 909 |
found->xres, found->yres, found->refresh, PICOS2KHZ(found->pixclock) * 1000, found_rate_error); |
afe417c03 fbdev: sh_mobile_... |
910 |
fb_videomode_to_var(&hdmi->var, found); |
6aa966e61 fbdev: sh_mobile_... |
911 |
sh_hdmi_external_video_param(hdmi); |
afe417c03 fbdev: sh_mobile_... |
912 913 |
return 0; |
6011bdeaa fbdev: sh-mobile:... |
914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 |
} static irqreturn_t sh_hdmi_hotplug(int irq, void *dev_id) { struct sh_hdmi *hdmi = dev_id; u8 status1, status2, mask1, mask2; /* mode_b and PLLA and PLLB reset */ hdmi_write(hdmi, 0x2C, HDMI_SYSTEM_CTRL); /* How long shall reset be held? */ udelay(10); /* mode_b and PLLA and PLLB reset release */ hdmi_write(hdmi, 0x20, HDMI_SYSTEM_CTRL); status1 = hdmi_read(hdmi, HDMI_INTERRUPT_STATUS_1); status2 = hdmi_read(hdmi, HDMI_INTERRUPT_STATUS_2); mask1 = hdmi_read(hdmi, HDMI_INTERRUPT_MASK_1); mask2 = hdmi_read(hdmi, HDMI_INTERRUPT_MASK_2); /* Correct would be to ack only set bits, but the datasheet requires 0xff */ hdmi_write(hdmi, 0xFF, HDMI_INTERRUPT_STATUS_1); hdmi_write(hdmi, 0xFF, HDMI_INTERRUPT_STATUS_2); if (printk_ratelimit()) |
6aa966e61 fbdev: sh_mobile_... |
941 942 943 |
dev_dbg(hdmi->dev, "IRQ #%d: Status #1: 0x%x & 0x%x, #2: 0x%x & 0x%x ", irq, status1, mask1, status2, mask2); |
6011bdeaa fbdev: sh-mobile:... |
944 945 946 947 948 949 950 951 952 953 |
if (!((status1 & mask1) | (status2 & mask2))) { return IRQ_NONE; } else if (status1 & 0xc0) { u8 msens; /* Datasheet specifies 10ms... */ udelay(500); msens = hdmi_read(hdmi, HDMI_HOT_PLUG_MSENS_STATUS); |
6aa966e61 fbdev: sh_mobile_... |
954 955 |
dev_dbg(hdmi->dev, "MSENS 0x%x ", msens); |
6011bdeaa fbdev: sh-mobile:... |
956 957 958 |
/* Check, if hot plug & MSENS pin status are both high */ if ((msens & 0xC0) == 0xC0) { /* Display plug in */ |
4232f6079 fbdev: sh_mobile_... |
959 960 961 |
hdmi->edid_segment_nr = 0; hdmi->edid_block_addr = 0; hdmi->edid_blocks = 0; |
6011bdeaa fbdev: sh-mobile:... |
962 963 964 965 |
hdmi->hp_state = HDMI_HOTPLUG_CONNECTED; /* Set EDID word address */ hdmi_write(hdmi, 0x00, HDMI_EDID_WORD_ADDRESS); |
6011bdeaa fbdev: sh-mobile:... |
966 967 |
/* Enable EDID interrupt */ hdmi_write(hdmi, 0xC6, HDMI_INTERRUPT_MASK_1); |
4232f6079 fbdev: sh_mobile_... |
968 969 |
/* Set EDID segment pointer - starts reading EDID */ hdmi_write(hdmi, 0x00, HDMI_EDID_SEGMENT_POINTER); |
6011bdeaa fbdev: sh-mobile:... |
970 971 |
} else if (!(status1 & 0x80)) { /* Display unplug, beware multiple interrupts */ |
4232f6079 fbdev: sh_mobile_... |
972 973 |
if (hdmi->hp_state != HDMI_HOTPLUG_DISCONNECTED) { hdmi->hp_state = HDMI_HOTPLUG_DISCONNECTED; |
6011bdeaa fbdev: sh-mobile:... |
974 |
schedule_delayed_work(&hdmi->edid_work, 0); |
4232f6079 fbdev: sh_mobile_... |
975 |
} |
6011bdeaa fbdev: sh-mobile:... |
976 977 978 979 980 |
/* display_off will switch back to mode_a */ } } else if (status1 & 2) { /* EDID error interrupt: retry */ /* Set EDID word address */ |
4232f6079 fbdev: sh_mobile_... |
981 |
hdmi_write(hdmi, hdmi->edid_block_addr, HDMI_EDID_WORD_ADDRESS); |
6011bdeaa fbdev: sh-mobile:... |
982 |
/* Set EDID segment pointer */ |
4232f6079 fbdev: sh_mobile_... |
983 |
hdmi_write(hdmi, hdmi->edid_segment_nr, HDMI_EDID_SEGMENT_POINTER); |
6011bdeaa fbdev: sh-mobile:... |
984 985 986 |
} else if (status1 & 4) { /* Disable EDID interrupt */ hdmi_write(hdmi, 0xC0, HDMI_INTERRUPT_MASK_1); |
6011bdeaa fbdev: sh-mobile:... |
987 988 989 990 991 |
schedule_delayed_work(&hdmi->edid_work, msecs_to_jiffies(10)); } return IRQ_HANDLED; } |
6de9edd5b fbdev: sh_mobile_... |
992 |
/* locking: called with info->lock held, or before register_framebuffer() */ |
6aa966e61 fbdev: sh_mobile_... |
993 |
static void sh_hdmi_display_on(void *arg, struct fb_info *info) |
6011bdeaa fbdev: sh-mobile:... |
994 |
{ |
6de9edd5b fbdev: sh_mobile_... |
995 996 997 998 |
/* * info is guaranteed to be valid, when we are called, because our * FB_EVENT_FB_UNBIND notify is also called with info->lock held */ |
6011bdeaa fbdev: sh-mobile:... |
999 1000 |
struct sh_hdmi *hdmi = arg; struct sh_mobile_hdmi_info *pdata = hdmi->dev->platform_data; |
1c120deb6 fbdev: sh_mobile_... |
1001 |
struct sh_mobile_lcdc_chan *ch = info->par; |
6011bdeaa fbdev: sh-mobile:... |
1002 |
|
6aa966e61 fbdev: sh_mobile_... |
1003 1004 1005 |
dev_dbg(hdmi->dev, "%s(%p): state %x ", __func__, pdata->lcd_dev, info->state); |
6de9edd5b fbdev: sh_mobile_... |
1006 1007 |
/* No need to lock */ |
6011bdeaa fbdev: sh-mobile:... |
1008 |
hdmi->info = info; |
6011bdeaa fbdev: sh-mobile:... |
1009 |
|
6011bdeaa fbdev: sh-mobile:... |
1010 |
/* |
6aa966e61 fbdev: sh_mobile_... |
1011 1012 1013 1014 |
* hp_state can be set to * HDMI_HOTPLUG_DISCONNECTED: on monitor unplug * HDMI_HOTPLUG_CONNECTED: on monitor plug-in * HDMI_HOTPLUG_EDID_DONE: on EDID read completion |
6011bdeaa fbdev: sh-mobile:... |
1015 |
*/ |
6011bdeaa fbdev: sh-mobile:... |
1016 1017 1018 1019 |
switch (hdmi->hp_state) { case HDMI_HOTPLUG_EDID_DONE: /* PS mode d->e. All functions are active */ hdmi_write(hdmi, 0x80, HDMI_SYSTEM_CTRL); |
6aa966e61 fbdev: sh_mobile_... |
1020 1021 |
dev_dbg(hdmi->dev, "HDMI running "); |
6011bdeaa fbdev: sh-mobile:... |
1022 1023 1024 1025 |
break; case HDMI_HOTPLUG_DISCONNECTED: info->state = FBINFO_STATE_SUSPENDED; default: |
1c120deb6 fbdev: sh_mobile_... |
1026 |
hdmi->var = ch->display_var; |
6011bdeaa fbdev: sh-mobile:... |
1027 1028 |
} } |
6de9edd5b fbdev: sh_mobile_... |
1029 |
/* locking: called with info->lock held */ |
6aa966e61 fbdev: sh_mobile_... |
1030 |
static void sh_hdmi_display_off(void *arg) |
6011bdeaa fbdev: sh-mobile:... |
1031 1032 1033 |
{ struct sh_hdmi *hdmi = arg; struct sh_mobile_hdmi_info *pdata = hdmi->dev->platform_data; |
6aa966e61 fbdev: sh_mobile_... |
1034 1035 |
dev_dbg(hdmi->dev, "%s(%p) ", __func__, pdata->lcd_dev); |
6011bdeaa fbdev: sh-mobile:... |
1036 1037 1038 |
/* PS mode e->a */ hdmi_write(hdmi, 0x10, HDMI_SYSTEM_CTRL); } |
afe417c03 fbdev: sh_mobile_... |
1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 |
static bool sh_hdmi_must_reconfigure(struct sh_hdmi *hdmi) { struct fb_info *info = hdmi->info; struct sh_mobile_lcdc_chan *ch = info->par; struct fb_var_screeninfo *new_var = &hdmi->var, *old_var = &ch->display_var; struct fb_videomode mode1, mode2; fb_var_to_videomode(&mode1, old_var); fb_var_to_videomode(&mode2, new_var); dev_dbg(info->dev, "Old %ux%u, new %ux%u ", mode1.xres, mode1.yres, mode2.xres, mode2.yres); |
8c1ac08b3 fbdev: sh-mobile:... |
1052 1053 1054 1055 |
if (fb_mode_is_equal(&mode1, &mode2)) { /* It can be a different monitor with an equal video-mode */ old_var->width = new_var->width; old_var->height = new_var->height; |
afe417c03 fbdev: sh_mobile_... |
1056 |
return false; |
8c1ac08b3 fbdev: sh-mobile:... |
1057 |
} |
afe417c03 fbdev: sh_mobile_... |
1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 |
dev_dbg(info->dev, "Switching %u -> %u lines ", mode1.yres, mode2.yres); *old_var = *new_var; return true; } /** * sh_hdmi_clk_configure() - set HDMI clock frequency and enable the clock |
c36940e67 fbdev: sh_mobile_... |
1069 1070 1071 1072 1073 1074 |
* @hdmi: driver context * @hdmi_rate: HDMI clock frequency in Hz * @parent_rate: if != 0 - set parent clock rate for optimal precision * return: configured positive rate if successful * 0 if couldn't set the rate, but managed to enable the * clock, negative error, if couldn't enable the clock |
afe417c03 fbdev: sh_mobile_... |
1075 |
*/ |
c36940e67 fbdev: sh_mobile_... |
1076 1077 |
static long sh_hdmi_clk_configure(struct sh_hdmi *hdmi, unsigned long hdmi_rate, unsigned long parent_rate) |
afe417c03 fbdev: sh_mobile_... |
1078 |
{ |
afe417c03 fbdev: sh_mobile_... |
1079 |
int ret; |
c36940e67 fbdev: sh_mobile_... |
1080 1081 |
if (parent_rate && clk_get_parent(hdmi->hdmi_clk)) { ret = clk_set_rate(clk_get_parent(hdmi->hdmi_clk), parent_rate); |
afe417c03 fbdev: sh_mobile_... |
1082 |
if (ret < 0) { |
c36940e67 fbdev: sh_mobile_... |
1083 1084 1085 |
dev_warn(hdmi->dev, "Cannot set parent rate %ld: %d ", parent_rate, ret); hdmi_rate = clk_round_rate(hdmi->hdmi_clk, hdmi_rate); |
afe417c03 fbdev: sh_mobile_... |
1086 |
} else { |
c36940e67 fbdev: sh_mobile_... |
1087 1088 |
dev_dbg(hdmi->dev, "HDMI set parent frequency %lu ", parent_rate); |
afe417c03 fbdev: sh_mobile_... |
1089 |
} |
afe417c03 fbdev: sh_mobile_... |
1090 |
} |
c36940e67 fbdev: sh_mobile_... |
1091 |
ret = clk_set_rate(hdmi->hdmi_clk, hdmi_rate); |
afe417c03 fbdev: sh_mobile_... |
1092 |
if (ret < 0) { |
c36940e67 fbdev: sh_mobile_... |
1093 1094 1095 1096 1097 1098 |
dev_warn(hdmi->dev, "Cannot set rate %ld: %d ", hdmi_rate, ret); hdmi_rate = 0; } else { dev_dbg(hdmi->dev, "HDMI set frequency %lu ", hdmi_rate); |
afe417c03 fbdev: sh_mobile_... |
1099 |
} |
c36940e67 fbdev: sh_mobile_... |
1100 |
return hdmi_rate; |
afe417c03 fbdev: sh_mobile_... |
1101 |
} |
6011bdeaa fbdev: sh-mobile:... |
1102 |
/* Hotplug interrupt occurred, read EDID */ |
6aa966e61 fbdev: sh_mobile_... |
1103 |
static void sh_hdmi_edid_work_fn(struct work_struct *work) |
6011bdeaa fbdev: sh-mobile:... |
1104 1105 |
{ struct sh_hdmi *hdmi = container_of(work, struct sh_hdmi, edid_work.work); |
4a47a0e09 fb: sh-mobile: Fi... |
1106 |
struct fb_info *info; |
6011bdeaa fbdev: sh-mobile:... |
1107 |
struct sh_mobile_hdmi_info *pdata = hdmi->dev->platform_data; |
1c120deb6 fbdev: sh_mobile_... |
1108 |
struct sh_mobile_lcdc_chan *ch; |
afe417c03 fbdev: sh_mobile_... |
1109 |
int ret; |
6011bdeaa fbdev: sh-mobile:... |
1110 |
|
6aa966e61 fbdev: sh_mobile_... |
1111 1112 1113 |
dev_dbg(hdmi->dev, "%s(%p): begin, hotplug status %d ", __func__, pdata->lcd_dev, hdmi->hp_state); |
6011bdeaa fbdev: sh-mobile:... |
1114 1115 1116 |
if (!pdata->lcd_dev) return; |
6de9edd5b fbdev: sh_mobile_... |
1117 |
mutex_lock(&hdmi->mutex); |
4a47a0e09 fb: sh-mobile: Fi... |
1118 |
info = hdmi->info; |
4232f6079 fbdev: sh_mobile_... |
1119 |
if (hdmi->hp_state == HDMI_HOTPLUG_CONNECTED) { |
c36940e67 fbdev: sh_mobile_... |
1120 |
unsigned long parent_rate = 0, hdmi_rate; |
c36940e67 fbdev: sh_mobile_... |
1121 |
ret = sh_hdmi_read_edid(hdmi, &hdmi_rate, &parent_rate); |
d521dd944 fbdev: sh_mobile_... |
1122 |
if (ret < 0) |
afe417c03 fbdev: sh_mobile_... |
1123 |
goto out; |
4232f6079 fbdev: sh_mobile_... |
1124 |
hdmi->hp_state = HDMI_HOTPLUG_EDID_DONE; |
afe417c03 fbdev: sh_mobile_... |
1125 |
/* Reconfigure the clock */ |
c36940e67 fbdev: sh_mobile_... |
1126 |
ret = sh_hdmi_clk_configure(hdmi, hdmi_rate, parent_rate); |
d521dd944 fbdev: sh_mobile_... |
1127 |
if (ret < 0) |
afe417c03 fbdev: sh_mobile_... |
1128 |
goto out; |
6011bdeaa fbdev: sh-mobile:... |
1129 1130 1131 1132 |
msleep(10); sh_hdmi_configure(hdmi); /* Switched to another (d) power-save mode */ msleep(10); |
0d7fa180a fbdev: sh_mobile_... |
1133 |
if (!info) |
6de9edd5b fbdev: sh_mobile_... |
1134 |
goto out; |
6011bdeaa fbdev: sh-mobile:... |
1135 |
|
0d7fa180a fbdev: sh_mobile_... |
1136 |
ch = info->par; |
6011bdeaa fbdev: sh-mobile:... |
1137 |
|
4a47a0e09 fb: sh-mobile: Fi... |
1138 1139 |
if (lock_fb_info(info)) { console_lock(); |
6011bdeaa fbdev: sh-mobile:... |
1140 |
|
4a47a0e09 fb: sh-mobile: Fi... |
1141 1142 1143 1144 1145 1146 1147 |
/* HDMI plug in */ if (!sh_hdmi_must_reconfigure(hdmi) && info->state == FBINFO_STATE_RUNNING) { /* * First activation with the default monitor - just turn * on, if we run a resume here, the logo disappears */ |
8c1ac08b3 fbdev: sh-mobile:... |
1148 1149 1150 |
info->var.width = hdmi->var.width; info->var.height = hdmi->var.height; sh_hdmi_display_on(hdmi, info); |
4a47a0e09 fb: sh-mobile: Fi... |
1151 1152 1153 |
} else { /* New monitor or have to wake up */ fb_set_suspend(info, 0); |
6de9edd5b fbdev: sh_mobile_... |
1154 |
} |
6011bdeaa fbdev: sh-mobile:... |
1155 |
|
4a47a0e09 fb: sh-mobile: Fi... |
1156 1157 1158 |
console_unlock(); unlock_fb_info(info); } |
6011bdeaa fbdev: sh-mobile:... |
1159 |
} else { |
afe417c03 fbdev: sh_mobile_... |
1160 |
ret = 0; |
4a47a0e09 fb: sh-mobile: Fi... |
1161 |
if (!info) |
6de9edd5b fbdev: sh_mobile_... |
1162 |
goto out; |
6011bdeaa fbdev: sh-mobile:... |
1163 |
|
91d63f8a3 fbdev: sh_mobile_... |
1164 1165 1166 |
hdmi->monspec.modedb_len = 0; fb_destroy_modedb(hdmi->monspec.modedb); hdmi->monspec.modedb = NULL; |
4a47a0e09 fb: sh-mobile: Fi... |
1167 1168 |
if (lock_fb_info(info)) { console_lock(); |
6011bdeaa fbdev: sh-mobile:... |
1169 |
|
4a47a0e09 fb: sh-mobile: Fi... |
1170 1171 |
/* HDMI disconnect */ fb_set_suspend(info, 1); |
6011bdeaa fbdev: sh-mobile:... |
1172 |
|
4a47a0e09 fb: sh-mobile: Fi... |
1173 1174 1175 |
console_unlock(); unlock_fb_info(info); } |
6011bdeaa fbdev: sh-mobile:... |
1176 |
} |
6de9edd5b fbdev: sh_mobile_... |
1177 |
out: |
4232f6079 fbdev: sh_mobile_... |
1178 |
if (ret < 0 && ret != -EAGAIN) |
afe417c03 fbdev: sh_mobile_... |
1179 |
hdmi->hp_state = HDMI_HOTPLUG_DISCONNECTED; |
6de9edd5b fbdev: sh_mobile_... |
1180 |
mutex_unlock(&hdmi->mutex); |
6aa966e61 fbdev: sh_mobile_... |
1181 1182 |
dev_dbg(hdmi->dev, "%s(%p): end ", __func__, pdata->lcd_dev); |
6011bdeaa fbdev: sh-mobile:... |
1183 |
} |
6de9edd5b fbdev: sh_mobile_... |
1184 |
static int sh_hdmi_notify(struct notifier_block *nb, |
6de9edd5b fbdev: sh_mobile_... |
1185 1186 1187 1188 1189 1190 1191 |
unsigned long action, void *data) { struct fb_event *event = data; struct fb_info *info = event->info; struct sh_mobile_lcdc_chan *ch = info->par; struct sh_mobile_lcdc_board_cfg *board_cfg = &ch->cfg.board_cfg; struct sh_hdmi *hdmi = board_cfg->board_data; |
eb0778bd3 fbdev: sh_mobile_... |
1192 |
if (!hdmi || nb != &hdmi->notifier || hdmi->info != info) |
6de9edd5b fbdev: sh_mobile_... |
1193 1194 1195 1196 |
return NOTIFY_DONE; switch(action) { case FB_EVENT_FB_REGISTERED: |
6aa966e61 fbdev: sh_mobile_... |
1197 |
/* Unneeded, activation taken care by sh_hdmi_display_on() */ |
6de9edd5b fbdev: sh_mobile_... |
1198 1199 1200 1201 1202 1203 |
break; case FB_EVENT_FB_UNREGISTERED: /* * We are called from unregister_framebuffer() with the * info->lock held. This is bad for us, because we can race with * the scheduled work, which has to call fb_set_suspend(), which |
6aa966e61 fbdev: sh_mobile_... |
1204 1205 1206 1207 1208 1209 |
* takes info->lock internally, so, sh_hdmi_edid_work_fn() * cannot take and hold info->lock for the whole function * duration. Using an additional lock creates a classical AB-BA * lock up. Therefore, we have to release the info->lock * temporarily, synchronise with the work queue and re-acquire * the info->lock. |
6de9edd5b fbdev: sh_mobile_... |
1210 |
*/ |
eb0778bd3 fbdev: sh_mobile_... |
1211 |
unlock_fb_info(info); |
6de9edd5b fbdev: sh_mobile_... |
1212 1213 1214 |
mutex_lock(&hdmi->mutex); hdmi->info = NULL; mutex_unlock(&hdmi->mutex); |
eb0778bd3 fbdev: sh_mobile_... |
1215 |
lock_fb_info(info); |
6de9edd5b fbdev: sh_mobile_... |
1216 1217 1218 |
return NOTIFY_OK; } return NOTIFY_DONE; |
6011bdeaa fbdev: sh-mobile:... |
1219 1220 1221 1222 1223 1224 |
} static int __init sh_hdmi_probe(struct platform_device *pdev) { struct sh_mobile_hdmi_info *pdata = pdev->dev.platform_data; struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
6de9edd5b fbdev: sh_mobile_... |
1225 |
struct sh_mobile_lcdc_board_cfg *board_cfg; |
6011bdeaa fbdev: sh-mobile:... |
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 |
int irq = platform_get_irq(pdev, 0), ret; struct sh_hdmi *hdmi; long rate; if (!res || !pdata || irq < 0) return -ENODEV; hdmi = kzalloc(sizeof(*hdmi), GFP_KERNEL); if (!hdmi) { dev_err(&pdev->dev, "Cannot allocate device data "); return -ENOMEM; } |
6de9edd5b fbdev: sh_mobile_... |
1239 |
mutex_init(&hdmi->mutex); |
1d6be338c ASoC: Add sh_mobi... |
1240 |
|
6011bdeaa fbdev: sh-mobile:... |
1241 1242 1243 1244 1245 1246 1247 1248 1249 |
hdmi->dev = &pdev->dev; hdmi->hdmi_clk = clk_get(&pdev->dev, "ick"); if (IS_ERR(hdmi->hdmi_clk)) { ret = PTR_ERR(hdmi->hdmi_clk); dev_err(&pdev->dev, "Unable to get clock: %d ", ret); goto egetclk; } |
c36940e67 fbdev: sh_mobile_... |
1250 1251 1252 1253 |
/* An arbitrary relaxed pixclock just to get things started: from standard 480p */ rate = clk_round_rate(hdmi->hdmi_clk, PICOS2KHZ(37037)); if (rate > 0) rate = sh_hdmi_clk_configure(hdmi, rate, 0); |
6011bdeaa fbdev: sh-mobile:... |
1254 1255 |
if (rate < 0) { ret = rate; |
6011bdeaa fbdev: sh-mobile:... |
1256 1257 |
goto erate; } |
c36940e67 fbdev: sh_mobile_... |
1258 1259 1260 1261 1262 1263 |
ret = clk_enable(hdmi->hdmi_clk); if (ret < 0) { dev_err(hdmi->dev, "Cannot enable clock: %d ", ret); goto erate; } |
afe417c03 fbdev: sh_mobile_... |
1264 1265 |
dev_dbg(&pdev->dev, "Enabled HDMI clock at %luHz ", rate); |
6011bdeaa fbdev: sh-mobile:... |
1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 |
if (!request_mem_region(res->start, resource_size(res), dev_name(&pdev->dev))) { dev_err(&pdev->dev, "HDMI register region already claimed "); ret = -EBUSY; goto ereqreg; } hdmi->base = ioremap(res->start, resource_size(res)); if (!hdmi->base) { dev_err(&pdev->dev, "HDMI register region already claimed "); ret = -ENOMEM; goto emap; } platform_set_drvdata(pdev, hdmi); |
6011bdeaa fbdev: sh-mobile:... |
1283 |
/* Set up LCDC callbacks */ |
6de9edd5b fbdev: sh_mobile_... |
1284 1285 1286 |
board_cfg = &pdata->lcd_chan->board_cfg; board_cfg->owner = THIS_MODULE; board_cfg->board_data = hdmi; |
6aa966e61 fbdev: sh_mobile_... |
1287 1288 |
board_cfg->display_on = sh_hdmi_display_on; board_cfg->display_off = sh_hdmi_display_off; |
6011bdeaa fbdev: sh-mobile:... |
1289 |
|
6aa966e61 fbdev: sh_mobile_... |
1290 |
INIT_DELAYED_WORK(&hdmi->edid_work, sh_hdmi_edid_work_fn); |
6011bdeaa fbdev: sh-mobile:... |
1291 1292 |
pm_runtime_enable(&pdev->dev); |
d521dd944 fbdev: sh_mobile_... |
1293 |
pm_runtime_get_sync(&pdev->dev); |
6011bdeaa fbdev: sh-mobile:... |
1294 |
|
c36940e67 fbdev: sh_mobile_... |
1295 1296 1297 1298 |
/* Product and revision IDs are 0 in sh-mobile version */ dev_info(&pdev->dev, "Detected HDMI controller 0x%x:0x%x ", hdmi_read(hdmi, HDMI_PRODUCT_ID), hdmi_read(hdmi, HDMI_REVISION_ID)); |
6011bdeaa fbdev: sh-mobile:... |
1299 1300 1301 1302 1303 1304 1305 |
ret = request_irq(irq, sh_hdmi_hotplug, 0, dev_name(&pdev->dev), hdmi); if (ret < 0) { dev_err(&pdev->dev, "Unable to request irq: %d ", ret); goto ereqirq; } |
b3773301c Merge master.kern... |
1306 1307 1308 1309 1310 1311 1312 |
ret = snd_soc_register_codec(&pdev->dev, &soc_codec_dev_sh_hdmi, &sh_hdmi_dai, 1); if (ret < 0) { dev_err(&pdev->dev, "codec registration failed "); goto ecodec; } |
eb0778bd3 fbdev: sh_mobile_... |
1313 1314 |
hdmi->notifier.notifier_call = sh_hdmi_notify; fb_register_client(&hdmi->notifier); |
6011bdeaa fbdev: sh-mobile:... |
1315 |
return 0; |
b3773301c Merge master.kern... |
1316 1317 |
ecodec: free_irq(irq, hdmi); |
6011bdeaa fbdev: sh-mobile:... |
1318 |
ereqirq: |
d521dd944 fbdev: sh_mobile_... |
1319 |
pm_runtime_put(&pdev->dev); |
6011bdeaa fbdev: sh-mobile:... |
1320 1321 1322 1323 1324 1325 |
pm_runtime_disable(&pdev->dev); iounmap(hdmi->base); emap: release_mem_region(res->start, resource_size(res)); ereqreg: clk_disable(hdmi->hdmi_clk); |
6011bdeaa fbdev: sh-mobile:... |
1326 1327 1328 |
erate: clk_put(hdmi->hdmi_clk); egetclk: |
6de9edd5b fbdev: sh_mobile_... |
1329 |
mutex_destroy(&hdmi->mutex); |
6011bdeaa fbdev: sh-mobile:... |
1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 |
kfree(hdmi); return ret; } static int __exit sh_hdmi_remove(struct platform_device *pdev) { struct sh_mobile_hdmi_info *pdata = pdev->dev.platform_data; struct sh_hdmi *hdmi = platform_get_drvdata(pdev); struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
6de9edd5b fbdev: sh_mobile_... |
1340 |
struct sh_mobile_lcdc_board_cfg *board_cfg = &pdata->lcd_chan->board_cfg; |
6011bdeaa fbdev: sh-mobile:... |
1341 |
int irq = platform_get_irq(pdev, 0); |
1d6be338c ASoC: Add sh_mobi... |
1342 |
snd_soc_unregister_codec(&pdev->dev); |
eb0778bd3 fbdev: sh_mobile_... |
1343 |
fb_unregister_client(&hdmi->notifier); |
6de9edd5b fbdev: sh_mobile_... |
1344 1345 1346 1347 |
board_cfg->display_on = NULL; board_cfg->display_off = NULL; board_cfg->board_data = NULL; board_cfg->owner = NULL; |
6011bdeaa fbdev: sh-mobile:... |
1348 |
|
6de9edd5b fbdev: sh_mobile_... |
1349 |
/* No new work will be scheduled, wait for running ISR */ |
6011bdeaa fbdev: sh-mobile:... |
1350 |
free_irq(irq, hdmi); |
6de9edd5b fbdev: sh_mobile_... |
1351 |
/* Wait for already scheduled work */ |
6011bdeaa fbdev: sh-mobile:... |
1352 |
cancel_delayed_work_sync(&hdmi->edid_work); |
d521dd944 fbdev: sh_mobile_... |
1353 |
pm_runtime_put(&pdev->dev); |
6de9edd5b fbdev: sh_mobile_... |
1354 |
pm_runtime_disable(&pdev->dev); |
6011bdeaa fbdev: sh-mobile:... |
1355 1356 1357 1358 |
clk_disable(hdmi->hdmi_clk); clk_put(hdmi->hdmi_clk); iounmap(hdmi->base); release_mem_region(res->start, resource_size(res)); |
6de9edd5b fbdev: sh_mobile_... |
1359 |
mutex_destroy(&hdmi->mutex); |
6011bdeaa fbdev: sh-mobile:... |
1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 |
kfree(hdmi); return 0; } static struct platform_driver sh_hdmi_driver = { .remove = __exit_p(sh_hdmi_remove), .driver = { .name = "sh-mobile-hdmi", }, }; static int __init sh_hdmi_init(void) { return platform_driver_probe(&sh_hdmi_driver, sh_hdmi_probe); } module_init(sh_hdmi_init); static void __exit sh_hdmi_exit(void) { platform_driver_unregister(&sh_hdmi_driver); } module_exit(sh_hdmi_exit); MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>"); MODULE_DESCRIPTION("SuperH / ARM-shmobile HDMI driver"); MODULE_LICENSE("GPL v2"); |