1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (C) 2018 Renesas Electronics 4 * 5 * Copyright (C) 2016 Atmel 6 * Bo Shen <voice.shen@atmel.com> 7 * 8 * Authors: Bo Shen <voice.shen@atmel.com> 9 * Boris Brezillon <boris.brezillon@free-electrons.com> 10 * Wu, Songjun <Songjun.Wu@atmel.com> 11 * 12 * Copyright (C) 2010-2011 Freescale Semiconductor, Inc. All Rights Reserved. 13 */ 14 15 #include <linux/gpio/consumer.h> 16 #include <linux/i2c-mux.h> 17 #include <linux/i2c.h> 18 #include <linux/module.h> 19 #include <linux/regmap.h> 20 #include <linux/clk.h> 21 22 #include <drm/drm_atomic_helper.h> 23 #include <drm/drm_drv.h> 24 #include <drm/drm_edid.h> 25 #include <drm/drm_print.h> 26 #include <drm/drm_probe_helper.h> 27 28 #include <sound/hdmi-codec.h> 29 30 #define SII902X_TPI_VIDEO_DATA 0x0 31 32 #define SII902X_TPI_PIXEL_REPETITION 0x8 33 #define SII902X_TPI_AVI_PIXEL_REP_BUS_24BIT BIT(5) 34 #define SII902X_TPI_AVI_PIXEL_REP_RISING_EDGE BIT(4) 35 #define SII902X_TPI_AVI_PIXEL_REP_4X 3 36 #define SII902X_TPI_AVI_PIXEL_REP_2X 1 37 #define SII902X_TPI_AVI_PIXEL_REP_NONE 0 38 #define SII902X_TPI_CLK_RATIO_HALF (0 << 6) 39 #define SII902X_TPI_CLK_RATIO_1X (1 << 6) 40 #define SII902X_TPI_CLK_RATIO_2X (2 << 6) 41 #define SII902X_TPI_CLK_RATIO_4X (3 << 6) 42 43 #define SII902X_TPI_AVI_IN_FORMAT 0x9 44 #define SII902X_TPI_AVI_INPUT_BITMODE_12BIT BIT(7) 45 #define SII902X_TPI_AVI_INPUT_DITHER BIT(6) 46 #define SII902X_TPI_AVI_INPUT_RANGE_LIMITED (2 << 2) 47 #define SII902X_TPI_AVI_INPUT_RANGE_FULL (1 << 2) 48 #define SII902X_TPI_AVI_INPUT_RANGE_AUTO (0 << 2) 49 #define SII902X_TPI_AVI_INPUT_COLORSPACE_BLACK (3 << 0) 50 #define SII902X_TPI_AVI_INPUT_COLORSPACE_YUV422 (2 << 0) 51 #define SII902X_TPI_AVI_INPUT_COLORSPACE_YUV444 (1 << 0) 52 #define SII902X_TPI_AVI_INPUT_COLORSPACE_RGB (0 << 0) 53 54 #define SII902X_TPI_AVI_INFOFRAME 0x0c 55 56 #define SII902X_SYS_CTRL_DATA 0x1a 57 #define SII902X_SYS_CTRL_PWR_DWN BIT(4) 58 #define SII902X_SYS_CTRL_AV_MUTE BIT(3) 59 #define SII902X_SYS_CTRL_DDC_BUS_REQ BIT(2) 60 #define SII902X_SYS_CTRL_DDC_BUS_GRTD BIT(1) 61 #define SII902X_SYS_CTRL_OUTPUT_MODE BIT(0) 62 #define SII902X_SYS_CTRL_OUTPUT_HDMI 1 63 #define SII902X_SYS_CTRL_OUTPUT_DVI 0 64 65 #define SII902X_REG_CHIPID(n) (0x1b + (n)) 66 67 #define SII902X_PWR_STATE_CTRL 0x1e 68 #define SII902X_AVI_POWER_STATE_MSK GENMASK(1, 0) 69 #define SII902X_AVI_POWER_STATE_D(l) ((l) & SII902X_AVI_POWER_STATE_MSK) 70 71 /* Audio */ 72 #define SII902X_TPI_I2S_ENABLE_MAPPING_REG 0x1f 73 #define SII902X_TPI_I2S_CONFIG_FIFO0 (0 << 0) 74 #define SII902X_TPI_I2S_CONFIG_FIFO1 (1 << 0) 75 #define SII902X_TPI_I2S_CONFIG_FIFO2 (2 << 0) 76 #define SII902X_TPI_I2S_CONFIG_FIFO3 (3 << 0) 77 #define SII902X_TPI_I2S_LEFT_RIGHT_SWAP (1 << 2) 78 #define SII902X_TPI_I2S_AUTO_DOWNSAMPLE (1 << 3) 79 #define SII902X_TPI_I2S_SELECT_SD0 (0 << 4) 80 #define SII902X_TPI_I2S_SELECT_SD1 (1 << 4) 81 #define SII902X_TPI_I2S_SELECT_SD2 (2 << 4) 82 #define SII902X_TPI_I2S_SELECT_SD3 (3 << 4) 83 #define SII902X_TPI_I2S_FIFO_ENABLE (1 << 7) 84 85 #define SII902X_TPI_I2S_INPUT_CONFIG_REG 0x20 86 #define SII902X_TPI_I2S_FIRST_BIT_SHIFT_YES (0 << 0) 87 #define SII902X_TPI_I2S_FIRST_BIT_SHIFT_NO (1 << 0) 88 #define SII902X_TPI_I2S_SD_DIRECTION_MSB_FIRST (0 << 1) 89 #define SII902X_TPI_I2S_SD_DIRECTION_LSB_FIRST (1 << 1) 90 #define SII902X_TPI_I2S_SD_JUSTIFY_LEFT (0 << 2) 91 #define SII902X_TPI_I2S_SD_JUSTIFY_RIGHT (1 << 2) 92 #define SII902X_TPI_I2S_WS_POLARITY_LOW (0 << 3) 93 #define SII902X_TPI_I2S_WS_POLARITY_HIGH (1 << 3) 94 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_128 (0 << 4) 95 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_256 (1 << 4) 96 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_384 (2 << 4) 97 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_512 (3 << 4) 98 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_768 (4 << 4) 99 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_1024 (5 << 4) 100 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_1152 (6 << 4) 101 #define SII902X_TPI_I2S_MCLK_MULTIPLIER_192 (7 << 4) 102 #define SII902X_TPI_I2S_SCK_EDGE_FALLING (0 << 7) 103 #define SII902X_TPI_I2S_SCK_EDGE_RISING (1 << 7) 104 105 #define SII902X_TPI_I2S_STRM_HDR_BASE 0x21 106 #define SII902X_TPI_I2S_STRM_HDR_SIZE 5 107 108 #define SII902X_TPI_AUDIO_CONFIG_BYTE2_REG 0x26 109 #define SII902X_TPI_AUDIO_CODING_STREAM_HEADER (0 << 0) 110 #define SII902X_TPI_AUDIO_CODING_PCM (1 << 0) 111 #define SII902X_TPI_AUDIO_CODING_AC3 (2 << 0) 112 #define SII902X_TPI_AUDIO_CODING_MPEG1 (3 << 0) 113 #define SII902X_TPI_AUDIO_CODING_MP3 (4 << 0) 114 #define SII902X_TPI_AUDIO_CODING_MPEG2 (5 << 0) 115 #define SII902X_TPI_AUDIO_CODING_AAC (6 << 0) 116 #define SII902X_TPI_AUDIO_CODING_DTS (7 << 0) 117 #define SII902X_TPI_AUDIO_CODING_ATRAC (8 << 0) 118 #define SII902X_TPI_AUDIO_MUTE_DISABLE (0 << 4) 119 #define SII902X_TPI_AUDIO_MUTE_ENABLE (1 << 4) 120 #define SII902X_TPI_AUDIO_LAYOUT_2_CHANNELS (0 << 5) 121 #define SII902X_TPI_AUDIO_LAYOUT_8_CHANNELS (1 << 5) 122 #define SII902X_TPI_AUDIO_INTERFACE_DISABLE (0 << 6) 123 #define SII902X_TPI_AUDIO_INTERFACE_SPDIF (1 << 6) 124 #define SII902X_TPI_AUDIO_INTERFACE_I2S (2 << 6) 125 126 #define SII902X_TPI_AUDIO_CONFIG_BYTE3_REG 0x27 127 #define SII902X_TPI_AUDIO_FREQ_STREAM (0 << 3) 128 #define SII902X_TPI_AUDIO_FREQ_32KHZ (1 << 3) 129 #define SII902X_TPI_AUDIO_FREQ_44KHZ (2 << 3) 130 #define SII902X_TPI_AUDIO_FREQ_48KHZ (3 << 3) 131 #define SII902X_TPI_AUDIO_FREQ_88KHZ (4 << 3) 132 #define SII902X_TPI_AUDIO_FREQ_96KHZ (5 << 3) 133 #define SII902X_TPI_AUDIO_FREQ_176KHZ (6 << 3) 134 #define SII902X_TPI_AUDIO_FREQ_192KHZ (7 << 3) 135 #define SII902X_TPI_AUDIO_SAMPLE_SIZE_STREAM (0 << 6) 136 #define SII902X_TPI_AUDIO_SAMPLE_SIZE_16 (1 << 6) 137 #define SII902X_TPI_AUDIO_SAMPLE_SIZE_20 (2 << 6) 138 #define SII902X_TPI_AUDIO_SAMPLE_SIZE_24 (3 << 6) 139 140 #define SII902X_TPI_AUDIO_CONFIG_BYTE4_REG 0x28 141 142 #define SII902X_INT_ENABLE 0x3c 143 #define SII902X_INT_STATUS 0x3d 144 #define SII902X_HOTPLUG_EVENT BIT(0) 145 #define SII902X_PLUGGED_STATUS BIT(2) 146 147 #define SII902X_REG_TPI_RQB 0xc7 148 149 /* Indirect internal register access */ 150 #define SII902X_IND_SET_PAGE 0xbc 151 #define SII902X_IND_OFFSET 0xbd 152 #define SII902X_IND_VALUE 0xbe 153 154 #define SII902X_TPI_MISC_INFOFRAME_BASE 0xbf 155 #define SII902X_TPI_MISC_INFOFRAME_END 0xde 156 #define SII902X_TPI_MISC_INFOFRAME_SIZE \ 157 (SII902X_TPI_MISC_INFOFRAME_END - SII902X_TPI_MISC_INFOFRAME_BASE) 158 159 #define SII902X_I2C_BUS_ACQUISITION_TIMEOUT_MS 500 160 161 #define SII902X_AUDIO_PORT_INDEX 3 162 163 struct sii902x { 164 struct i2c_client *i2c; 165 struct regmap *regmap; 166 struct drm_bridge bridge; 167 struct drm_connector connector; 168 struct gpio_desc *reset_gpio; 169 struct i2c_mux_core *i2cmux; 170 /* 171 * Mutex protects audio and video functions from interfering 172 * each other, by keeping their i2c command sequences atomic. 173 */ 174 struct mutex mutex; 175 struct sii902x_audio { 176 struct platform_device *pdev; 177 struct clk *mclk; 178 u32 i2s_fifo_sequence[4]; 179 } audio; 180 }; 181 182 static int sii902x_read_unlocked(struct i2c_client *i2c, u8 reg, u8 *val) 183 { 184 union i2c_smbus_data data; 185 int ret; 186 187 ret = __i2c_smbus_xfer(i2c->adapter, i2c->addr, i2c->flags, 188 I2C_SMBUS_READ, reg, I2C_SMBUS_BYTE_DATA, &data); 189 190 if (ret < 0) 191 return ret; 192 193 *val = data.byte; 194 return 0; 195 } 196 197 static int sii902x_write_unlocked(struct i2c_client *i2c, u8 reg, u8 val) 198 { 199 union i2c_smbus_data data; 200 201 data.byte = val; 202 203 return __i2c_smbus_xfer(i2c->adapter, i2c->addr, i2c->flags, 204 I2C_SMBUS_WRITE, reg, I2C_SMBUS_BYTE_DATA, 205 &data); 206 } 207 208 static int sii902x_update_bits_unlocked(struct i2c_client *i2c, u8 reg, u8 mask, 209 u8 val) 210 { 211 int ret; 212 u8 status; 213 214 ret = sii902x_read_unlocked(i2c, reg, &status); 215 if (ret) 216 return ret; 217 status &= ~mask; 218 status |= val & mask; 219 return sii902x_write_unlocked(i2c, reg, status); 220 } 221 222 static inline struct sii902x *bridge_to_sii902x(struct drm_bridge *bridge) 223 { 224 return container_of(bridge, struct sii902x, bridge); 225 } 226 227 static inline struct sii902x *connector_to_sii902x(struct drm_connector *con) 228 { 229 return container_of(con, struct sii902x, connector); 230 } 231 232 static void sii902x_reset(struct sii902x *sii902x) 233 { 234 if (!sii902x->reset_gpio) 235 return; 236 237 gpiod_set_value(sii902x->reset_gpio, 1); 238 239 /* The datasheet says treset-min = 100us. Make it 150us to be sure. */ 240 usleep_range(150, 200); 241 242 gpiod_set_value(sii902x->reset_gpio, 0); 243 } 244 245 static enum drm_connector_status 246 sii902x_connector_detect(struct drm_connector *connector, bool force) 247 { 248 struct sii902x *sii902x = connector_to_sii902x(connector); 249 unsigned int status; 250 251 mutex_lock(&sii902x->mutex); 252 253 regmap_read(sii902x->regmap, SII902X_INT_STATUS, &status); 254 255 mutex_unlock(&sii902x->mutex); 256 257 return (status & SII902X_PLUGGED_STATUS) ? 258 connector_status_connected : connector_status_disconnected; 259 } 260 261 static const struct drm_connector_funcs sii902x_connector_funcs = { 262 .detect = sii902x_connector_detect, 263 .fill_modes = drm_helper_probe_single_connector_modes, 264 .destroy = drm_connector_cleanup, 265 .reset = drm_atomic_helper_connector_reset, 266 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, 267 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, 268 }; 269 270 static int sii902x_get_modes(struct drm_connector *connector) 271 { 272 struct sii902x *sii902x = connector_to_sii902x(connector); 273 u32 bus_format = MEDIA_BUS_FMT_RGB888_1X24; 274 u8 output_mode = SII902X_SYS_CTRL_OUTPUT_DVI; 275 struct edid *edid; 276 int num = 0, ret; 277 278 mutex_lock(&sii902x->mutex); 279 280 edid = drm_get_edid(connector, sii902x->i2cmux->adapter[0]); 281 drm_connector_update_edid_property(connector, edid); 282 if (edid) { 283 if (drm_detect_hdmi_monitor(edid)) 284 output_mode = SII902X_SYS_CTRL_OUTPUT_HDMI; 285 286 num = drm_add_edid_modes(connector, edid); 287 kfree(edid); 288 } 289 290 ret = drm_display_info_set_bus_formats(&connector->display_info, 291 &bus_format, 1); 292 if (ret) 293 goto error_out; 294 295 ret = regmap_update_bits(sii902x->regmap, SII902X_SYS_CTRL_DATA, 296 SII902X_SYS_CTRL_OUTPUT_MODE, output_mode); 297 if (ret) 298 goto error_out; 299 300 ret = num; 301 302 error_out: 303 mutex_unlock(&sii902x->mutex); 304 305 return ret; 306 } 307 308 static enum drm_mode_status sii902x_mode_valid(struct drm_connector *connector, 309 struct drm_display_mode *mode) 310 { 311 /* TODO: check mode */ 312 313 return MODE_OK; 314 } 315 316 static const struct drm_connector_helper_funcs sii902x_connector_helper_funcs = { 317 .get_modes = sii902x_get_modes, 318 .mode_valid = sii902x_mode_valid, 319 }; 320 321 static void sii902x_bridge_disable(struct drm_bridge *bridge) 322 { 323 struct sii902x *sii902x = bridge_to_sii902x(bridge); 324 325 mutex_lock(&sii902x->mutex); 326 327 regmap_update_bits(sii902x->regmap, SII902X_SYS_CTRL_DATA, 328 SII902X_SYS_CTRL_PWR_DWN, 329 SII902X_SYS_CTRL_PWR_DWN); 330 331 mutex_unlock(&sii902x->mutex); 332 } 333 334 static void sii902x_bridge_enable(struct drm_bridge *bridge) 335 { 336 struct sii902x *sii902x = bridge_to_sii902x(bridge); 337 338 mutex_lock(&sii902x->mutex); 339 340 regmap_update_bits(sii902x->regmap, SII902X_PWR_STATE_CTRL, 341 SII902X_AVI_POWER_STATE_MSK, 342 SII902X_AVI_POWER_STATE_D(0)); 343 regmap_update_bits(sii902x->regmap, SII902X_SYS_CTRL_DATA, 344 SII902X_SYS_CTRL_PWR_DWN, 0); 345 346 mutex_unlock(&sii902x->mutex); 347 } 348 349 static void sii902x_bridge_mode_set(struct drm_bridge *bridge, 350 const struct drm_display_mode *mode, 351 const struct drm_display_mode *adj) 352 { 353 struct sii902x *sii902x = bridge_to_sii902x(bridge); 354 struct regmap *regmap = sii902x->regmap; 355 u8 buf[HDMI_INFOFRAME_SIZE(AVI)]; 356 struct hdmi_avi_infoframe frame; 357 u16 pixel_clock_10kHz = adj->clock / 10; 358 int ret; 359 360 buf[0] = pixel_clock_10kHz & 0xff; 361 buf[1] = pixel_clock_10kHz >> 8; 362 buf[2] = adj->vrefresh; 363 buf[3] = 0x00; 364 buf[4] = adj->hdisplay; 365 buf[5] = adj->hdisplay >> 8; 366 buf[6] = adj->vdisplay; 367 buf[7] = adj->vdisplay >> 8; 368 buf[8] = SII902X_TPI_CLK_RATIO_1X | SII902X_TPI_AVI_PIXEL_REP_NONE | 369 SII902X_TPI_AVI_PIXEL_REP_BUS_24BIT; 370 buf[9] = SII902X_TPI_AVI_INPUT_RANGE_AUTO | 371 SII902X_TPI_AVI_INPUT_COLORSPACE_RGB; 372 373 mutex_lock(&sii902x->mutex); 374 375 ret = regmap_bulk_write(regmap, SII902X_TPI_VIDEO_DATA, buf, 10); 376 if (ret) 377 goto out; 378 379 ret = drm_hdmi_avi_infoframe_from_display_mode(&frame, 380 &sii902x->connector, adj); 381 if (ret < 0) { 382 DRM_ERROR("couldn't fill AVI infoframe\n"); 383 goto out; 384 } 385 386 ret = hdmi_avi_infoframe_pack(&frame, buf, sizeof(buf)); 387 if (ret < 0) { 388 DRM_ERROR("failed to pack AVI infoframe: %d\n", ret); 389 goto out; 390 } 391 392 /* Do not send the infoframe header, but keep the CRC field. */ 393 regmap_bulk_write(regmap, SII902X_TPI_AVI_INFOFRAME, 394 buf + HDMI_INFOFRAME_HEADER_SIZE - 1, 395 HDMI_AVI_INFOFRAME_SIZE + 1); 396 397 out: 398 mutex_unlock(&sii902x->mutex); 399 } 400 401 static int sii902x_bridge_attach(struct drm_bridge *bridge) 402 { 403 struct sii902x *sii902x = bridge_to_sii902x(bridge); 404 struct drm_device *drm = bridge->dev; 405 int ret; 406 407 drm_connector_helper_add(&sii902x->connector, 408 &sii902x_connector_helper_funcs); 409 410 if (!drm_core_check_feature(drm, DRIVER_ATOMIC)) { 411 dev_err(&sii902x->i2c->dev, 412 "sii902x driver is only compatible with DRM devices supporting atomic updates\n"); 413 return -ENOTSUPP; 414 } 415 416 ret = drm_connector_init(drm, &sii902x->connector, 417 &sii902x_connector_funcs, 418 DRM_MODE_CONNECTOR_HDMIA); 419 if (ret) 420 return ret; 421 422 if (sii902x->i2c->irq > 0) 423 sii902x->connector.polled = DRM_CONNECTOR_POLL_HPD; 424 else 425 sii902x->connector.polled = DRM_CONNECTOR_POLL_CONNECT; 426 427 drm_connector_attach_encoder(&sii902x->connector, bridge->encoder); 428 429 return 0; 430 } 431 432 static const struct drm_bridge_funcs sii902x_bridge_funcs = { 433 .attach = sii902x_bridge_attach, 434 .mode_set = sii902x_bridge_mode_set, 435 .disable = sii902x_bridge_disable, 436 .enable = sii902x_bridge_enable, 437 }; 438 439 static int sii902x_mute(struct sii902x *sii902x, bool mute) 440 { 441 struct device *dev = &sii902x->i2c->dev; 442 unsigned int val = mute ? SII902X_TPI_AUDIO_MUTE_ENABLE : 443 SII902X_TPI_AUDIO_MUTE_DISABLE; 444 445 dev_dbg(dev, "%s: %s\n", __func__, mute ? "Muted" : "Unmuted"); 446 447 return regmap_update_bits(sii902x->regmap, 448 SII902X_TPI_AUDIO_CONFIG_BYTE2_REG, 449 SII902X_TPI_AUDIO_MUTE_ENABLE, val); 450 } 451 452 static const int sii902x_mclk_div_table[] = { 453 128, 256, 384, 512, 768, 1024, 1152, 192 }; 454 455 static int sii902x_select_mclk_div(u8 *i2s_config_reg, unsigned int rate, 456 unsigned int mclk) 457 { 458 int div = mclk / rate; 459 int distance = 100000; 460 u8 i, nearest = 0; 461 462 for (i = 0; i < ARRAY_SIZE(sii902x_mclk_div_table); i++) { 463 unsigned int d = abs(div - sii902x_mclk_div_table[i]); 464 465 if (d >= distance) 466 continue; 467 468 nearest = i; 469 distance = d; 470 if (d == 0) 471 break; 472 } 473 474 *i2s_config_reg |= nearest << 4; 475 476 return sii902x_mclk_div_table[nearest]; 477 } 478 479 static const struct sii902x_sample_freq { 480 u32 freq; 481 u8 val; 482 } sii902x_sample_freq[] = { 483 { .freq = 32000, .val = SII902X_TPI_AUDIO_FREQ_32KHZ }, 484 { .freq = 44000, .val = SII902X_TPI_AUDIO_FREQ_44KHZ }, 485 { .freq = 48000, .val = SII902X_TPI_AUDIO_FREQ_48KHZ }, 486 { .freq = 88000, .val = SII902X_TPI_AUDIO_FREQ_88KHZ }, 487 { .freq = 96000, .val = SII902X_TPI_AUDIO_FREQ_96KHZ }, 488 { .freq = 176000, .val = SII902X_TPI_AUDIO_FREQ_176KHZ }, 489 { .freq = 192000, .val = SII902X_TPI_AUDIO_FREQ_192KHZ }, 490 }; 491 492 static int sii902x_audio_hw_params(struct device *dev, void *data, 493 struct hdmi_codec_daifmt *daifmt, 494 struct hdmi_codec_params *params) 495 { 496 struct sii902x *sii902x = dev_get_drvdata(dev); 497 u8 i2s_config_reg = SII902X_TPI_I2S_SD_DIRECTION_MSB_FIRST; 498 u8 config_byte2_reg = (SII902X_TPI_AUDIO_INTERFACE_I2S | 499 SII902X_TPI_AUDIO_MUTE_ENABLE | 500 SII902X_TPI_AUDIO_CODING_PCM); 501 u8 config_byte3_reg = 0; 502 u8 infoframe_buf[HDMI_INFOFRAME_SIZE(AUDIO)]; 503 unsigned long mclk_rate; 504 int i, ret; 505 506 if (daifmt->bit_clk_master || daifmt->frame_clk_master) { 507 dev_dbg(dev, "%s: I2S master mode not supported\n", __func__); 508 return -EINVAL; 509 } 510 511 switch (daifmt->fmt) { 512 case HDMI_I2S: 513 i2s_config_reg |= SII902X_TPI_I2S_FIRST_BIT_SHIFT_YES | 514 SII902X_TPI_I2S_SD_JUSTIFY_LEFT; 515 break; 516 case HDMI_RIGHT_J: 517 i2s_config_reg |= SII902X_TPI_I2S_SD_JUSTIFY_RIGHT; 518 break; 519 case HDMI_LEFT_J: 520 i2s_config_reg |= SII902X_TPI_I2S_SD_JUSTIFY_LEFT; 521 break; 522 default: 523 dev_dbg(dev, "%s: Unsupported i2s format %u\n", __func__, 524 daifmt->fmt); 525 return -EINVAL; 526 } 527 528 if (daifmt->bit_clk_inv) 529 i2s_config_reg |= SII902X_TPI_I2S_SCK_EDGE_FALLING; 530 else 531 i2s_config_reg |= SII902X_TPI_I2S_SCK_EDGE_RISING; 532 533 if (daifmt->frame_clk_inv) 534 i2s_config_reg |= SII902X_TPI_I2S_WS_POLARITY_LOW; 535 else 536 i2s_config_reg |= SII902X_TPI_I2S_WS_POLARITY_HIGH; 537 538 if (params->channels > 2) 539 config_byte2_reg |= SII902X_TPI_AUDIO_LAYOUT_8_CHANNELS; 540 else 541 config_byte2_reg |= SII902X_TPI_AUDIO_LAYOUT_2_CHANNELS; 542 543 switch (params->sample_width) { 544 case 16: 545 config_byte3_reg |= SII902X_TPI_AUDIO_SAMPLE_SIZE_16; 546 break; 547 case 20: 548 config_byte3_reg |= SII902X_TPI_AUDIO_SAMPLE_SIZE_20; 549 break; 550 case 24: 551 case 32: 552 config_byte3_reg |= SII902X_TPI_AUDIO_SAMPLE_SIZE_24; 553 break; 554 default: 555 dev_err(dev, "%s: Unsupported sample width %u\n", __func__, 556 params->sample_width); 557 return -EINVAL; 558 } 559 560 for (i = 0; i < ARRAY_SIZE(sii902x_sample_freq); i++) { 561 if (params->sample_rate == sii902x_sample_freq[i].freq) { 562 config_byte3_reg |= sii902x_sample_freq[i].val; 563 break; 564 } 565 } 566 567 ret = clk_prepare_enable(sii902x->audio.mclk); 568 if (ret) { 569 dev_err(dev, "Enabling mclk failed: %d\n", ret); 570 return ret; 571 } 572 573 if (sii902x->audio.mclk) { 574 mclk_rate = clk_get_rate(sii902x->audio.mclk); 575 ret = sii902x_select_mclk_div(&i2s_config_reg, 576 params->sample_rate, mclk_rate); 577 if (mclk_rate != ret * params->sample_rate) 578 dev_dbg(dev, "Inaccurate reference clock (%ld/%d != %u)\n", 579 mclk_rate, ret, params->sample_rate); 580 } 581 582 mutex_lock(&sii902x->mutex); 583 584 ret = regmap_write(sii902x->regmap, 585 SII902X_TPI_AUDIO_CONFIG_BYTE2_REG, 586 config_byte2_reg); 587 if (ret < 0) 588 goto out; 589 590 ret = regmap_write(sii902x->regmap, SII902X_TPI_I2S_INPUT_CONFIG_REG, 591 i2s_config_reg); 592 if (ret) 593 goto out; 594 595 for (i = 0; i < ARRAY_SIZE(sii902x->audio.i2s_fifo_sequence) && 596 sii902x->audio.i2s_fifo_sequence[i]; i++) 597 regmap_write(sii902x->regmap, 598 SII902X_TPI_I2S_ENABLE_MAPPING_REG, 599 sii902x->audio.i2s_fifo_sequence[i]); 600 601 ret = regmap_write(sii902x->regmap, SII902X_TPI_AUDIO_CONFIG_BYTE3_REG, 602 config_byte3_reg); 603 if (ret) 604 goto out; 605 606 ret = regmap_bulk_write(sii902x->regmap, SII902X_TPI_I2S_STRM_HDR_BASE, 607 params->iec.status, 608 min((size_t) SII902X_TPI_I2S_STRM_HDR_SIZE, 609 sizeof(params->iec.status))); 610 if (ret) 611 goto out; 612 613 ret = hdmi_audio_infoframe_pack(¶ms->cea, infoframe_buf, 614 sizeof(infoframe_buf)); 615 if (ret < 0) { 616 dev_err(dev, "%s: Failed to pack audio infoframe: %d\n", 617 __func__, ret); 618 goto out; 619 } 620 621 ret = regmap_bulk_write(sii902x->regmap, 622 SII902X_TPI_MISC_INFOFRAME_BASE, 623 infoframe_buf, 624 min(ret, SII902X_TPI_MISC_INFOFRAME_SIZE)); 625 if (ret) 626 goto out; 627 628 /* Decode Level 0 Packets */ 629 ret = regmap_write(sii902x->regmap, SII902X_IND_SET_PAGE, 0x02); 630 if (ret) 631 goto out; 632 633 ret = regmap_write(sii902x->regmap, SII902X_IND_OFFSET, 0x24); 634 if (ret) 635 goto out; 636 637 ret = regmap_write(sii902x->regmap, SII902X_IND_VALUE, 0x02); 638 if (ret) 639 goto out; 640 641 dev_dbg(dev, "%s: hdmi audio enabled\n", __func__); 642 out: 643 mutex_unlock(&sii902x->mutex); 644 645 if (ret) { 646 clk_disable_unprepare(sii902x->audio.mclk); 647 dev_err(dev, "%s: hdmi audio enable failed: %d\n", __func__, 648 ret); 649 } 650 651 return ret; 652 } 653 654 static void sii902x_audio_shutdown(struct device *dev, void *data) 655 { 656 struct sii902x *sii902x = dev_get_drvdata(dev); 657 658 mutex_lock(&sii902x->mutex); 659 660 regmap_write(sii902x->regmap, SII902X_TPI_AUDIO_CONFIG_BYTE2_REG, 661 SII902X_TPI_AUDIO_INTERFACE_DISABLE); 662 663 mutex_unlock(&sii902x->mutex); 664 665 clk_disable_unprepare(sii902x->audio.mclk); 666 } 667 668 static int sii902x_audio_digital_mute(struct device *dev, 669 void *data, bool enable) 670 { 671 struct sii902x *sii902x = dev_get_drvdata(dev); 672 673 mutex_lock(&sii902x->mutex); 674 675 sii902x_mute(sii902x, enable); 676 677 mutex_unlock(&sii902x->mutex); 678 679 return 0; 680 } 681 682 static int sii902x_audio_get_eld(struct device *dev, void *data, 683 uint8_t *buf, size_t len) 684 { 685 struct sii902x *sii902x = dev_get_drvdata(dev); 686 687 mutex_lock(&sii902x->mutex); 688 689 memcpy(buf, sii902x->connector.eld, 690 min(sizeof(sii902x->connector.eld), len)); 691 692 mutex_unlock(&sii902x->mutex); 693 694 return 0; 695 } 696 697 static int sii902x_audio_get_dai_id(struct snd_soc_component *component, 698 struct device_node *endpoint) 699 { 700 struct of_endpoint of_ep; 701 int ret; 702 703 ret = of_graph_parse_endpoint(endpoint, &of_ep); 704 if (ret < 0) 705 return ret; 706 707 /* 708 * HDMI sound should be located at reg = <3> 709 * Return expected DAI index 0. 710 */ 711 if (of_ep.port == SII902X_AUDIO_PORT_INDEX) 712 return 0; 713 714 return -EINVAL; 715 } 716 717 static const struct hdmi_codec_ops sii902x_audio_codec_ops = { 718 .hw_params = sii902x_audio_hw_params, 719 .audio_shutdown = sii902x_audio_shutdown, 720 .digital_mute = sii902x_audio_digital_mute, 721 .get_eld = sii902x_audio_get_eld, 722 .get_dai_id = sii902x_audio_get_dai_id, 723 }; 724 725 static int sii902x_audio_codec_init(struct sii902x *sii902x, 726 struct device *dev) 727 { 728 static const u8 audio_fifo_id[] = { 729 SII902X_TPI_I2S_CONFIG_FIFO0, 730 SII902X_TPI_I2S_CONFIG_FIFO1, 731 SII902X_TPI_I2S_CONFIG_FIFO2, 732 SII902X_TPI_I2S_CONFIG_FIFO3, 733 }; 734 static const u8 i2s_lane_id[] = { 735 SII902X_TPI_I2S_SELECT_SD0, 736 SII902X_TPI_I2S_SELECT_SD1, 737 SII902X_TPI_I2S_SELECT_SD2, 738 SII902X_TPI_I2S_SELECT_SD3, 739 }; 740 struct hdmi_codec_pdata codec_data = { 741 .ops = &sii902x_audio_codec_ops, 742 .i2s = 1, /* Only i2s support for now. */ 743 .spdif = 0, 744 .max_i2s_channels = 0, 745 }; 746 u8 lanes[4]; 747 int num_lanes, i; 748 749 if (!of_property_read_bool(dev->of_node, "#sound-dai-cells")) { 750 dev_dbg(dev, "%s: No \"#sound-dai-cells\", no audio\n", 751 __func__); 752 return 0; 753 } 754 755 num_lanes = of_property_read_variable_u8_array(dev->of_node, 756 "sil,i2s-data-lanes", 757 lanes, 1, 758 ARRAY_SIZE(lanes)); 759 760 if (num_lanes == -EINVAL) { 761 dev_dbg(dev, 762 "%s: No \"sil,i2s-data-lanes\", use default <0>\n", 763 __func__); 764 num_lanes = 1; 765 lanes[0] = 0; 766 } else if (num_lanes < 0) { 767 dev_err(dev, 768 "%s: Error gettin \"sil,i2s-data-lanes\": %d\n", 769 __func__, num_lanes); 770 return num_lanes; 771 } 772 codec_data.max_i2s_channels = 2 * num_lanes; 773 774 for (i = 0; i < num_lanes; i++) 775 sii902x->audio.i2s_fifo_sequence[i] |= audio_fifo_id[i] | 776 i2s_lane_id[lanes[i]] | SII902X_TPI_I2S_FIFO_ENABLE; 777 778 sii902x->audio.mclk = devm_clk_get_optional(dev, "mclk"); 779 if (IS_ERR(sii902x->audio.mclk)) { 780 dev_err(dev, "%s: No clock (audio mclk) found: %ld\n", 781 __func__, PTR_ERR(sii902x->audio.mclk)); 782 return PTR_ERR(sii902x->audio.mclk); 783 } 784 785 sii902x->audio.pdev = platform_device_register_data( 786 dev, HDMI_CODEC_DRV_NAME, PLATFORM_DEVID_AUTO, 787 &codec_data, sizeof(codec_data)); 788 789 return PTR_ERR_OR_ZERO(sii902x->audio.pdev); 790 } 791 792 static const struct regmap_range sii902x_volatile_ranges[] = { 793 { .range_min = 0, .range_max = 0xff }, 794 }; 795 796 static const struct regmap_access_table sii902x_volatile_table = { 797 .yes_ranges = sii902x_volatile_ranges, 798 .n_yes_ranges = ARRAY_SIZE(sii902x_volatile_ranges), 799 }; 800 801 static const struct regmap_config sii902x_regmap_config = { 802 .reg_bits = 8, 803 .val_bits = 8, 804 .disable_locking = true, /* struct sii902x mutex should be enough */ 805 .max_register = SII902X_TPI_MISC_INFOFRAME_END, 806 .volatile_table = &sii902x_volatile_table, 807 .cache_type = REGCACHE_NONE, 808 }; 809 810 static irqreturn_t sii902x_interrupt(int irq, void *data) 811 { 812 struct sii902x *sii902x = data; 813 unsigned int status = 0; 814 815 mutex_lock(&sii902x->mutex); 816 817 regmap_read(sii902x->regmap, SII902X_INT_STATUS, &status); 818 regmap_write(sii902x->regmap, SII902X_INT_STATUS, status); 819 820 mutex_unlock(&sii902x->mutex); 821 822 if ((status & SII902X_HOTPLUG_EVENT) && sii902x->bridge.dev) 823 drm_helper_hpd_irq_event(sii902x->bridge.dev); 824 825 return IRQ_HANDLED; 826 } 827 828 /* 829 * The purpose of sii902x_i2c_bypass_select is to enable the pass through 830 * mode of the HDMI transmitter. Do not use regmap from within this function, 831 * only use sii902x_*_unlocked functions to read/modify/write registers. 832 * We are holding the parent adapter lock here, keep this in mind before 833 * adding more i2c transactions. 834 * 835 * Also, since SII902X_SYS_CTRL_DATA is used with regmap_update_bits elsewhere 836 * in this driver, we need to make sure that we only touch 0x1A[2:1] from 837 * within sii902x_i2c_bypass_select and sii902x_i2c_bypass_deselect, and that 838 * we leave the remaining bits as we have found them. 839 */ 840 static int sii902x_i2c_bypass_select(struct i2c_mux_core *mux, u32 chan_id) 841 { 842 struct sii902x *sii902x = i2c_mux_priv(mux); 843 struct device *dev = &sii902x->i2c->dev; 844 unsigned long timeout; 845 u8 status; 846 int ret; 847 848 ret = sii902x_update_bits_unlocked(sii902x->i2c, SII902X_SYS_CTRL_DATA, 849 SII902X_SYS_CTRL_DDC_BUS_REQ, 850 SII902X_SYS_CTRL_DDC_BUS_REQ); 851 if (ret) 852 return ret; 853 854 timeout = jiffies + 855 msecs_to_jiffies(SII902X_I2C_BUS_ACQUISITION_TIMEOUT_MS); 856 do { 857 ret = sii902x_read_unlocked(sii902x->i2c, SII902X_SYS_CTRL_DATA, 858 &status); 859 if (ret) 860 return ret; 861 } while (!(status & SII902X_SYS_CTRL_DDC_BUS_GRTD) && 862 time_before(jiffies, timeout)); 863 864 if (!(status & SII902X_SYS_CTRL_DDC_BUS_GRTD)) { 865 dev_err(dev, "Failed to acquire the i2c bus\n"); 866 return -ETIMEDOUT; 867 } 868 869 return sii902x_write_unlocked(sii902x->i2c, SII902X_SYS_CTRL_DATA, 870 status); 871 } 872 873 /* 874 * The purpose of sii902x_i2c_bypass_deselect is to disable the pass through 875 * mode of the HDMI transmitter. Do not use regmap from within this function, 876 * only use sii902x_*_unlocked functions to read/modify/write registers. 877 * We are holding the parent adapter lock here, keep this in mind before 878 * adding more i2c transactions. 879 * 880 * Also, since SII902X_SYS_CTRL_DATA is used with regmap_update_bits elsewhere 881 * in this driver, we need to make sure that we only touch 0x1A[2:1] from 882 * within sii902x_i2c_bypass_select and sii902x_i2c_bypass_deselect, and that 883 * we leave the remaining bits as we have found them. 884 */ 885 static int sii902x_i2c_bypass_deselect(struct i2c_mux_core *mux, u32 chan_id) 886 { 887 struct sii902x *sii902x = i2c_mux_priv(mux); 888 struct device *dev = &sii902x->i2c->dev; 889 unsigned long timeout; 890 unsigned int retries; 891 u8 status; 892 int ret; 893 894 /* 895 * When the HDMI transmitter is in pass through mode, we need an 896 * (undocumented) additional delay between STOP and START conditions 897 * to guarantee the bus won't get stuck. 898 */ 899 udelay(30); 900 901 /* 902 * Sometimes the I2C bus can stall after failure to use the 903 * EDID channel. Retry a few times to see if things clear 904 * up, else continue anyway. 905 */ 906 retries = 5; 907 do { 908 ret = sii902x_read_unlocked(sii902x->i2c, SII902X_SYS_CTRL_DATA, 909 &status); 910 retries--; 911 } while (ret && retries); 912 if (ret) { 913 dev_err(dev, "failed to read status (%d)\n", ret); 914 return ret; 915 } 916 917 ret = sii902x_update_bits_unlocked(sii902x->i2c, SII902X_SYS_CTRL_DATA, 918 SII902X_SYS_CTRL_DDC_BUS_REQ | 919 SII902X_SYS_CTRL_DDC_BUS_GRTD, 0); 920 if (ret) 921 return ret; 922 923 timeout = jiffies + 924 msecs_to_jiffies(SII902X_I2C_BUS_ACQUISITION_TIMEOUT_MS); 925 do { 926 ret = sii902x_read_unlocked(sii902x->i2c, SII902X_SYS_CTRL_DATA, 927 &status); 928 if (ret) 929 return ret; 930 } while (status & (SII902X_SYS_CTRL_DDC_BUS_REQ | 931 SII902X_SYS_CTRL_DDC_BUS_GRTD) && 932 time_before(jiffies, timeout)); 933 934 if (status & (SII902X_SYS_CTRL_DDC_BUS_REQ | 935 SII902X_SYS_CTRL_DDC_BUS_GRTD)) { 936 dev_err(dev, "failed to release the i2c bus\n"); 937 return -ETIMEDOUT; 938 } 939 940 return 0; 941 } 942 943 static const struct drm_bridge_timings default_sii902x_timings = { 944 .input_bus_flags = DRM_BUS_FLAG_PIXDATA_SAMPLE_NEGEDGE 945 | DRM_BUS_FLAG_SYNC_SAMPLE_NEGEDGE 946 | DRM_BUS_FLAG_DE_HIGH, 947 }; 948 949 static int sii902x_probe(struct i2c_client *client, 950 const struct i2c_device_id *id) 951 { 952 struct device *dev = &client->dev; 953 unsigned int status = 0; 954 struct sii902x *sii902x; 955 u8 chipid[4]; 956 int ret; 957 958 ret = i2c_check_functionality(client->adapter, 959 I2C_FUNC_SMBUS_BYTE_DATA); 960 if (!ret) { 961 dev_err(dev, "I2C adapter not suitable\n"); 962 return -EIO; 963 } 964 965 sii902x = devm_kzalloc(dev, sizeof(*sii902x), GFP_KERNEL); 966 if (!sii902x) 967 return -ENOMEM; 968 969 sii902x->i2c = client; 970 sii902x->regmap = devm_regmap_init_i2c(client, &sii902x_regmap_config); 971 if (IS_ERR(sii902x->regmap)) 972 return PTR_ERR(sii902x->regmap); 973 974 sii902x->reset_gpio = devm_gpiod_get_optional(dev, "reset", 975 GPIOD_OUT_LOW); 976 if (IS_ERR(sii902x->reset_gpio)) { 977 dev_err(dev, "Failed to retrieve/request reset gpio: %ld\n", 978 PTR_ERR(sii902x->reset_gpio)); 979 return PTR_ERR(sii902x->reset_gpio); 980 } 981 982 mutex_init(&sii902x->mutex); 983 984 sii902x_reset(sii902x); 985 986 ret = regmap_write(sii902x->regmap, SII902X_REG_TPI_RQB, 0x0); 987 if (ret) 988 return ret; 989 990 ret = regmap_bulk_read(sii902x->regmap, SII902X_REG_CHIPID(0), 991 &chipid, 4); 992 if (ret) { 993 dev_err(dev, "regmap_read failed %d\n", ret); 994 return ret; 995 } 996 997 if (chipid[0] != 0xb0) { 998 dev_err(dev, "Invalid chipid: %02x (expecting 0xb0)\n", 999 chipid[0]); 1000 return -EINVAL; 1001 } 1002 1003 /* Clear all pending interrupts */ 1004 regmap_read(sii902x->regmap, SII902X_INT_STATUS, &status); 1005 regmap_write(sii902x->regmap, SII902X_INT_STATUS, status); 1006 1007 if (client->irq > 0) { 1008 regmap_write(sii902x->regmap, SII902X_INT_ENABLE, 1009 SII902X_HOTPLUG_EVENT); 1010 1011 ret = devm_request_threaded_irq(dev, client->irq, NULL, 1012 sii902x_interrupt, 1013 IRQF_ONESHOT, dev_name(dev), 1014 sii902x); 1015 if (ret) 1016 return ret; 1017 } 1018 1019 sii902x->bridge.funcs = &sii902x_bridge_funcs; 1020 sii902x->bridge.of_node = dev->of_node; 1021 sii902x->bridge.timings = &default_sii902x_timings; 1022 drm_bridge_add(&sii902x->bridge); 1023 1024 sii902x_audio_codec_init(sii902x, dev); 1025 1026 i2c_set_clientdata(client, sii902x); 1027 1028 sii902x->i2cmux = i2c_mux_alloc(client->adapter, dev, 1029 1, 0, I2C_MUX_GATE, 1030 sii902x_i2c_bypass_select, 1031 sii902x_i2c_bypass_deselect); 1032 if (!sii902x->i2cmux) 1033 return -ENOMEM; 1034 1035 sii902x->i2cmux->priv = sii902x; 1036 return i2c_mux_add_adapter(sii902x->i2cmux, 0, 0, 0); 1037 } 1038 1039 static int sii902x_remove(struct i2c_client *client) 1040 1041 { 1042 struct sii902x *sii902x = i2c_get_clientdata(client); 1043 1044 i2c_mux_del_adapters(sii902x->i2cmux); 1045 drm_bridge_remove(&sii902x->bridge); 1046 1047 return 0; 1048 } 1049 1050 static const struct of_device_id sii902x_dt_ids[] = { 1051 { .compatible = "sil,sii9022", }, 1052 { } 1053 }; 1054 MODULE_DEVICE_TABLE(of, sii902x_dt_ids); 1055 1056 static const struct i2c_device_id sii902x_i2c_ids[] = { 1057 { "sii9022", 0 }, 1058 { }, 1059 }; 1060 MODULE_DEVICE_TABLE(i2c, sii902x_i2c_ids); 1061 1062 static struct i2c_driver sii902x_driver = { 1063 .probe = sii902x_probe, 1064 .remove = sii902x_remove, 1065 .driver = { 1066 .name = "sii902x", 1067 .of_match_table = sii902x_dt_ids, 1068 }, 1069 .id_table = sii902x_i2c_ids, 1070 }; 1071 module_i2c_driver(sii902x_driver); 1072 1073 MODULE_AUTHOR("Boris Brezillon <boris.brezillon@free-electrons.com>"); 1074 MODULE_DESCRIPTION("SII902x RGB -> HDMI bridges"); 1075 MODULE_LICENSE("GPL"); 1076